Прерывание PIO AT91SAM7A3 Опции

[Balaganoff]

Помогите разобраться, что не так. Хочу разобраться с прерываниями по изменению уровня на PIOA, прерывание должно наступать по нажатию джойстика. Код брал из примера,немного переработав для удобства. Не входит в прерывание и все тут.

Код

void main (void)
{
AT91F_PMC_EnablePeriphClock ( AT91C_BASE_PMC, 1 << AT91C_ID_PIOA );
AT91F_PIO_CfgOutput( AT91C_BASE_PIOA, LED_MASK );
AT91F_PIO_SetOutput( AT91C_BASE_PIOA, LED_MASK );
AT91F_PIO_CfgInput(AT91C_BASE_PIOA, SW3_MASK | SW4_MASK);


AT91F_AIC_ConfigureIt ( pAic, AT91C_ID_PIOA, PIO_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL, pio_c_irq_handler);
AT91F_PIO_InterruptEnable(AT91C_BASE_PIOA,SW4_MASK);
//* set the interrupt by software
AT91F_AIC_EnableIt (pAic, AT91C_ID_PIOA);

for (;;)
{}
}


// обработчик

void pio_c_irq_handler ( void )
{
int dummy;
count_int_pio++;

    
    AT91F_PIO_ClearOutput( AT91C_BASE_PIOA, LED2);
    delay_t (2000000);
    AT91F_PIO_SetOutput( AT91C_BASE_PIOA, LED2);
    delay_t (2000000);
  
    dummy =AT91C_BASE_PIOA->PIO_ISR;
    


}

[Balaganoff]

по Адрессу
irgvec :
0x18 содержится IRQ_Handler_Entry ; IRQ 0x90

по
IRQ_Handler_Entry:
0x90 SUB LR,LR, #0x4


Это наверное и есть обработчик,
А почему нет разрешения прерываний, ведь

// настроили прерывания,указали обработчик
AT91F_AIC_ConfigureIt ( pAic, AT91C_ID_PIOA,PIO_INTERRUPT_LEVEL, AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL, pio_c_irq_handler);

// разрешили прерывания от маски SW4_MASK PIOA
AT91F_PIO_InterruptEnable(AT91C_BASE_PIOA,SW4_MASK);

// разрешили прерывания для контроллера прерываний от периферии AT91C_ID_PIOA
AT91F_AIC_EnableIt (pAic, AT91C_ID_PIOA);