70 lines
2.7 KiB
C
70 lines
2.7 KiB
C
|
/***************************************************************************
|
||
|
* Copyright (C) 01/2008 by Olaf Rempel *
|
||
|
* razzor@kopf-tisch.de *
|
||
|
* *
|
||
|
* This program is free software; you can redistribute it and/or modify *
|
||
|
* it under the terms of the GNU General Public License as published by *
|
||
|
* the Free Software Foundation; version 2 of the License *
|
||
|
* *
|
||
|
* This program is distributed in the hope that it will be useful, *
|
||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of *
|
||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the *
|
||
|
* GNU General Public License for more details. *
|
||
|
* *
|
||
|
* You should have received a copy of the GNU General Public License *
|
||
|
* along with this program; if not, write to the *
|
||
|
* Free Software Foundation, Inc., *
|
||
|
* 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. *
|
||
|
***************************************************************************/
|
||
|
#include <stdint.h>
|
||
|
#include <stdio.h>
|
||
|
#include "AT91SAM7S256.h"
|
||
|
#include "board.h"
|
||
|
#include "at91_pio.h"
|
||
|
|
||
|
/* extern symbols, defined in ldscript */
|
||
|
extern struct pio_pinchange_isr _pio_isr_table;
|
||
|
extern struct pio_pinchange_isr _pio_isr_table_end;
|
||
|
|
||
|
static void pio_isr(void)
|
||
|
{
|
||
|
uint32_t status = *AT91C_PIOA_ISR;
|
||
|
uint32_t input = *AT91C_PIOA_PDSR;
|
||
|
|
||
|
struct pio_pinchange_isr *isr;
|
||
|
for (isr = &_pio_isr_table; isr < &_pio_isr_table_end; isr++)
|
||
|
if (isr->mask & status)
|
||
|
isr->func(status, input);
|
||
|
}
|
||
|
|
||
|
void pio_trigger_isr(uint32_t mask)
|
||
|
{
|
||
|
uint32_t input = *AT91C_PIOA_PDSR;
|
||
|
|
||
|
struct pio_pinchange_isr *isr;
|
||
|
for (isr = &_pio_isr_table; isr < &_pio_isr_table_end; isr++)
|
||
|
if (isr->mask & mask)
|
||
|
isr->func(mask, input);
|
||
|
}
|
||
|
|
||
|
void at91_pio_init(void)
|
||
|
{
|
||
|
/* enable PIO clock */
|
||
|
*AT91C_PMC_PCER = (1 << AT91C_ID_PIOA);
|
||
|
|
||
|
/* enable pinchange interrupts */
|
||
|
struct pio_pinchange_isr *isr;
|
||
|
for (isr = &_pio_isr_table; isr < &_pio_isr_table_end; isr++)
|
||
|
*AT91C_PIOA_IER = isr->mask;
|
||
|
|
||
|
/* dummy read to clear interrupts */
|
||
|
uint32_t dummy = *AT91C_PIOA_ISR;
|
||
|
dummy = dummy;
|
||
|
|
||
|
/* low priority, level triggered, own vector */
|
||
|
AT91S_AIC *aic = AT91C_BASE_AIC;
|
||
|
aic->AIC_SMR[AT91C_ID_PIOA] = IRQPRIO_PIOA | AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL;
|
||
|
aic->AIC_SVR[AT91C_ID_PIOA] = (uint32_t)pio_isr;
|
||
|
aic->AIC_IECR = (1 << AT91C_ID_PIOA);
|
||
|
}
|