Прерывание от таймера в AT91SAM7X256 Опции

[ZAA]

Используем FreeRTOS. ВОзникла необходимость использования таймера. Вроде просто так таймер запускается и работает, а вот прерывания не обрабатывает. Я подозреваю, что функцию обработки прерывания нельзя объявлять, как обычную функцию. Наверное, надо прописывать ещё вектор прерывания от таймера где-то там. В том и проблема, что не очень хорошо разбираюсь во всяких там секциях памяти, размещении векторов и т. д (по крайней мере в этом контроллере). Как бы это попроще организовать???
ТЕкст (кстати стандартный) приведен ниже:
//ф-ия обработки прерывания
void timer1_c_irq_handler(void)
{
AT91PS_TC TC_pt = AT91C_BASE_TC1;
unsigned int dummy;
//* Acknowledge interrupt status
dummy = TC_pt->TC_SR;
//* Suppress warning variable "dummy" was set but never used
dummy = dummy;
count_timer0_interrupt++;
vParTestToggleLED( 2 );
}

void AT91F_TC_Open ( AT91PS_TC TC_pt, unsigned int Mode, unsigned int TimerId)
{
unsigned int dummy;
AT91F_PMC_EnablePeriphClock ( AT91C_BASE_PMC, 1<< TimerId ) ;
AT91C_BASE_PMC->PMC_PCER = (1<<AT91C_ID_TC1);
TC_pt->TC_CCR = AT91C_TC_CLKDIS ;
TC_pt->TC_IDR = 0xFFFFFFFF ;

dummy = TC_pt->TC_SR;

TC_pt->TC_CMR = Mode ;

TC_pt->TC_CCR = AT91C_TC_CLKEN ;
}

void timer_init ( void )
{
unsigned int oldHandler;
unsigned int mask ;
AT91S_AIC *pAIC = AT91C_BASE_AIC;
AT91S_TC *pTMR = AT91C_BASE_TC1;

//init the timer interrupt counter
count_timer0_interrupt=0;
count_timer1_interrupt=0;

//* Open timer1
AT91F_TC_Open(AT91C_BASE_TC1,TC_CLKS_MCK128,AT91C_ID_TC1);

//* Open Timer 1 interrupt
AT91F_AIC_ConfigureIt ( AT91C_BASE_AIC, AT91C_ID_TC1, TIMER1_INTERRUPT_LEVEL,AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL, timer1_c_irq_handler);
AT91C_BASE_TC1->TC_IER = AT91C_TC_CPCS; // IRQ enable CPC
AT91F_AIC_EnableIt (AT91C_BASE_AIC, AT91C_ID_TC1);

//* Start timer1
//AT91C_BASE_TC1->TC_CCR = AT91C_TC_SWTRG ;

}

P.S. Знаю, что подобные посты уже были, но хотелось бы ещё раз остановиться на данной проблеме! Спасибо заранее за ответы.

[aaarrr]

CPCSTOP не забыли убрать?

[ZAA]

CPCSTOP не забыли убрать?

Я понимаю, что Вам надоело наверное на такие вопросы отвечать, но все же...
Я проверяю CPCSTOP строчкой
if((AT91C_BASE_TC1->TC_CMR && AT91C_TC_CPCSTOP) != AT91C_TC_CPCSTOP)
{
vParTestToggleLED(3);
}
Лампочка загорается, т е этот бит не равен 1.
Такое ощущение, что как-то этот самый шедулер не хочет с прерыванием нормально работать.
В файле main.c ф-ия main выглядит так:

int main( void )
{
prvSetupHardware();

timer_init();
vParTestToggleLED(0);

/* Start the scheduler.

vTaskStartScheduler();

/* We should never get here as control is now taken by the scheduler. */
return 0;
}
То есть timer_init должна вызываться один раз, потом в ней настраивается и запускается таймер и дальше он уже должен работать по прерываним?
Ф-ия timer_init выглядит так:
AT91C_BASE_PMC->PMC_PCER = (1<<AT91C_ID_TC1);
AT91C_BASE_TC1->TC_CMR = AT91C_TC_CLKS_TIMER_DIV3_CLOCK | AT91C_TC_WAVESEL_UP_AUTO
| AT91C_TC_WAVE;

AT91C_BASE_TC1->TC_IER = (1<<4); //прерывание RC Compare

AT91C_BASE_TC1->TC_RC = 0x00FF;

AT91C_BASE_AIC->AIC_SVR[AT91C_ID_TC1] = (unsigned int) vTIMER_ISR_Handler;
AT91C_BASE_AIC->AIC_SMR[AT91C_ID_TC1] = ( AT91C_AIC_SRCTYPE_INT_HIGH_LEVEL | 0x5 );
AT91C_BASE_AIC->AIC_ICCR = (1<<AT91C_ID_TC1);
AT91C_BASE_AIC->AIC_IECR = (1<<AT91C_ID_TC1);
AT91C_BASE_TC1->TC_CCR = AT91C_TC_CLKEN | AT91C_TC_SWTRG;
vParTestToggleLED(1);

обработчик прерывания:
void vTIMER_ISR_Handler( void )
{
int i;
AT91PS_TC TC_pt = AT91C_BASE_TC1;
unsigned int dummy;

AT91C_BASE_AIC->AIC_ICCR = (1 << AT91C_ID_TC1);

//* Acknowledge interrupt status
dummy = AT91C_BASE_TC1->TC_SR;
//* Suppress warning variable "dummy" was set but never used
dummy = dummy;

if((AT91C_BASE_TC1->TC_SR && AT91C_TC_CPCS) == AT91C_TC_CPCS)
{
vParTestToggleLED(2);
count_timer1_interrupt++;
}
AT91C_BASE_AIC->AIC_EOICR = 0x00;
}
И еще, не надо ли в конце обработчика вызывать функцию portYIELD_FROM_ISR()?

[aaarrr]

AT91C_BASE_AIC->AIC_SVR[AT91C_ID_TC1] = (unsigned int) vTIMER_ISR_Handler;

Почему здесь Handler, а не Wrapper?

void vTIMER_ISR_Handler( void )
{
...
AT91C_BASE_AIC->AIC_ICCR = (1 << AT91C_ID_TC1);

Это действие лишнее.

И еще, не надо ли в конце обработчика вызывать функцию portYIELD_FROM_ISR()?

Не обязательно.

AT91C_BASE_TC1->TC_CCR = AT91C_TC_CLKEN | AT91C_TC_SWTRG;

Это я бы разделил на две операции: trigger нужно делать, когда тактирование уже разрешено.

[ZAA]

Почему здесь Handler, а не Wrapper?

Большое, большое Вам спасибо!!! Дело действительно было в Wrapper! Сейчас начну с прерываниями от UART разбираться