Работа с прерываниями в at91sam7s, не вызывается повторное прерывание Опции

[Bulat]

Конфигурация прерываний происходит следующим образом:

Код

void RT()
{
AT91F_AIC_ConfigureIt( AT91C_BASE_AIC, AT91C_ID_PIOA, 0x06, AT91C_AIC_SRCTYPE_INT_POSITIVE_EDGE, irq_RT);
AT91F_PIO_InterruptEnable(AT91C_BASE_PIOA,SW2_MASK);
AT91F_PIO_InterruptEnable(AT91C_BASE_PIOA,SW3_MASK); //Маска прерываний на PA23, PA24
//* set the interrupt by software
AT91F_AIC_EnableIt(AT91C_BASE_AIC, AT91C_ID_PIOA);
  while(1); //Ожидание прерывания
}

Обработчик прерываний:

Код

__ramfunc void irq_RT()
{  
  //Определение источника прерывания и запрет прерываний
  int i_status = AT91F_PIO_GetInterruptStatus(AT91C_BASE_PIOA);
  if(i_status&0x800000) AT91F_PIO_InterruptDisable(AT91C_BASE_PIOA,SW3_MASK);   //Прерывание пришло от PA23
  if(i_status&0x1000000) AT91F_PIO_InterruptDisable(AT91C_BASE_PIOA,SW2_MASK);   //Прерывание пришло от PA24
  AT91F_AIC_DisableIt(AT91C_BASE_AIC, AT91C_ID_PIOA);
  ...
  //программа обработки прерывания
  ...
  //Разрешение прерываний
  if(i_status&0x800000) AT91F_PIO_InterruptEnable(AT91C_BASE_PIOA,SW3_MASK);
  if(i_status&0x1000000) AT91F_PIO_InterruptEnable(AT91C_BASE_PIOA,SW2_MASK);
  AT91F_AIC_EnableIt(AT91C_BASE_AIC, AT91C_ID_PIOA);

Первое прерывание нормально обрабатывается, но второе прерывание не обрабатывается, хотя источником является тот же вывод (PA24). Чтобы обработать следующее прерывание, приходится презагружать устройство и заново вызывать прерывание. То есть больше одного прерывания подряд не обрабатывает. Почемутак происходит, я ведь правильно конфигурирую прерывания?
Заранее благодарен!

[aaarrr]

Команда "В" изменяет регистр LR (адрес текущей команды)

Команда B не изменяет LR, изменяет BL.

Так вот, после обработки прерывания светодиод загорается, если нет дерективы __irq перед обработчиком.

С таким стартапом __irq не нужен.

Но я бы рекомендовал выкинуть IRQ_Handler_Entry, а вместо

Код

                B           IRQ_Handler_Entry  ; 0x18 IRQ

поставить

Код

    ldr        pc, [pc, #-0xf20]    ; IRQ

И вернуть __irq обработчикам.

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

Выложите полностью основную программу и обработчик в текущем состоянии. А то совершенно непонятно, как получаются такие выводы.