/***************************************************************************
 *   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);
}