//*----------------------------------------------------------------------------
//*         ATMEL Microcontroller Software Support  -  ROUSSET  -
//*----------------------------------------------------------------------------
//* The software is delivered "AS IS" without warranty or condition of any
//* kind, either express, implied or statutory. This includes without
//* limitation any warranty or condition with respect to merchantability or
//* fitness for any particular purpose, or against the infringements of
//* intellectual property rights of others.
//*----------------------------------------------------------------------------
//* File Name           : main.c
//* Object              : main application written in C
//* 1.0 24/Jun/04 JPP   : Creation
//* modify				: Embest z.j.zheng 2005,05,12
//*					    : In pio_c_irq_handler:SW1_MASK was changed into SW3_MASK
//*						: In main(): SW2_MASK was switched with SW4_MASK,
//*						:            SW1_MASK was switched with SW3_MASK
//*						: Global variable count_timer1_interrupt was deleted
//*----------------------------------------------------------------------------

// Include Standard LIB  files
#include "Board.h"

//*   Waiting time between LED1 and LED2
#define     WAIT_TIME       MCK

#define PIO_INTERRUPT_LEVEL		6
#define IRQ0_INTERRUPT_LEVEL	2
#define SOFT_INTERRUPT_LEVEL	5
#define FIQ_INTERRUPT_LEVEL		0

//* Global variable
int count_timer0_interrupt;

// Use the Library Handler defined in file periph/pio/pio_irq/irq_pio.s

extern void FIQ_init_handler(void);

extern void at91_IRQ0_handler(void);
// External Function Prototype
extern void timer_init (void );
extern void Usart_init (void);


//*----------------------------------------------------------------------------
//* Function Name       : aic_software_interrupt
//* Object              : Software interrupt function
//* Input Parameters    : none
//* Output Parameters   : none
//* Functions called    : at91_pio_write
//*----------------------------------------------------------------------------
void aic_software_interrupt(void)
{
    // Read the output state
    if ( (AT91F_PIO_GetInput(AT91C_BASE_PIOA) & LED2 ) == LED2 )
    {
        AT91F_PIO_ClearOutput( AT91C_BASE_PIOA, LED2 );
    }
    else
    {
        AT91F_PIO_SetOutput( AT91C_BASE_PIOA, LED2 );
    }
}

//*----------------------------------------------------------------------------
//* Function Name       : pio_c_irq_handler
//* Object              : Irq Handler called by the irq_pio.s
//* Input Parameters    : none
//* Output Parameters   : none
//* Functions called    : at91_pio_read, at91_pio_write
//*----------------------------------------------------------------------------
void pio_c_irq_handler ( void )
{
int dummy;
    // Read the output state
    if ( (AT91F_PIO_GetInput(AT91C_BASE_PIOA) & LED2 ) == LED2 )
    {
		AT91F_PIO_ClearOutput( AT91C_BASE_PIOA, LED2);
    }
    else
    {
		AT91F_PIO_SetOutput( AT91C_BASE_PIOA, LED2);
    }
    // enable the next PIO IRQ
    dummy =AT91C_BASE_PIOA->PIO_ISR;
    // suppress the compilation warning
    dummy =dummy;
    // while SW1 is push wait
    while ( (AT91F_PIO_GetInput(AT91C_BASE_PIOA) & SW1_MASK ) != SW1_MASK );
}

//*----------------------------------------------------------------------------
//* Function Name       : delay
//* Object              : Wait
//* Input Parameters    : none
//* Output Parameters   : none
//* Functions called    : none
//*----------------------------------------------------------------------------
void delay ( void )
{
	// Set in Volatile for Optimisation
    volatile unsigned int    i ;
	// loop delay
    for ( i = 0 ;(i < WAIT_TIME/100 );i++ ) ;
}
//*----------------------------------------------------------------------------
//* Function Name       : main
//* Object              : Main interrupt function
//*		level timer 0 => 1
//*	SW4	level Irq0    => 2
//*		level timer 1 => 4
//*	SW2	level PIOA    => 6
//*		level USART   => 7
//*		LEVEL FIQ     => MAX
//* Input Parameters    : none
//* Output Parameters   : TRUE
//*----------------------------------------------------------------------------
int Main( void )
// Begin
{
    unsigned int   loop_count ;
    AT91PS_AIC     pAic;
    // Load System pAic Base address
	pAic = AT91C_BASE_AIC;

	// Init
	loop_count = 0 ;
	// First, enable the clock of the PIOB
	AT91F_PMC_EnablePeriphClock ( AT91C_BASE_PMC, 1 << AT91C_ID_PIOA ) ;

   	// then, we configure the PIO Lines corresponding to LED1 to LED8
   	// to be outputs. No need to set these pins to be driven by the PIO because it is GPIO pins only.
	AT91F_PIO_CfgOutput( AT91C_BASE_PIOA, LED_MASK ) ;
   	// Clear the LED's. On the EB55 we must apply a "1" to turn off LEDs
	AT91F_PIO_SetOutput( AT91C_BASE_PIOA, LED_MASK ) ;

    // open external PIO interrupt
    // define switch SW1 at PIO input for interrupt IRQ loop
	AT91F_PIO_CfgInput(AT91C_BASE_PIOA, SW1_MASK | SW2_MASK);

	AT91F_AIC_ConfigureIt ( pAic, AT91C_ID_PIOA, PIO_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_LEVEL_SENSITIVE, pio_c_irq_handler);
	AT91F_PIO_InterruptEnable(AT91C_BASE_PIOA,SW2_MASK);
	// set the interrupt by software
	AT91F_AIC_EnableIt (pAic, AT91C_ID_PIOA);

    // open external IRQ interrupt
	AT91F_PIO_CfgPeriph(AT91C_BASE_PIOA,SW4_MASK,0);
   	// open external IRQ0 interrupt
	AT91F_AIC_ConfigureIt ( pAic, AT91C_ID_IRQ0, IRQ0_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_EDGE_TRIGGERED, at91_IRQ0_handler);
	AT91F_AIC_EnableIt (pAic, AT91C_ID_IRQ0);

   	// Open the software interrupt on the AIC
	AT91F_AIC_ConfigureIt ( pAic, AT91C_ID_SYS, SOFT_INTERRUPT_LEVEL, AT91C_AIC_SRCTYPE_EXT_POSITIVE_EDGE,  aic_software_interrupt);
	AT91F_AIC_EnableIt (pAic, AT91C_ID_SYS);

   // open  FIQ interrupt
	AT91F_PIO_CfgPeriph(AT91C_BASE_PIOA,SW3_MASK,0);
	AT91F_AIC_ConfigureIt ( pAic, AT91C_ID_FIQ, FIQ_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_EDGE_TRIGGERED, FIQ_init_handler);
	AT91F_AIC_EnableIt (pAic, AT91C_ID_FIQ);
   // generate FIQ interrupt by software
	AT91F_AIC_Trig (pAic,AT91C_ID_FIQ) ;


    // Init timer interrupt
	timer_init();

    // Init Usart
	Usart_init();

    // generate software interrupt
	AT91F_AIC_Trig (pAic,AT91C_ID_SYS) ;

for (;;)
    {

	AT91F_PIO_ClearOutput( AT91C_BASE_PIOA, LED1 );
	delay () ;
	AT91F_PIO_SetOutput( AT91C_BASE_PIOA, LED1 );
	delay () ;

	loop_count ++ ;
    // Set LED by software interrupt
	if (loop_count == 10)
		{
		loop_count=0;
        // Software interrupt
    	AT91F_AIC_Trig (pAic,AT91C_ID_SYS) ;
        }
    }
}