37 lines
855 B
C
37 lines
855 B
C
#include <kernel/hardware/tmu.h>
|
|
#include <kernel/util.h>
|
|
|
|
void timer_handler(void)
|
|
{
|
|
extern struct timer_cache_s timercache[TIMER_NUMBER];
|
|
static uint32_t counter = 0;
|
|
uint32_t intevt;
|
|
int timer_ID;
|
|
|
|
// Get timer ID
|
|
// @note: tricky way to get timer ID
|
|
// TODO: find better way !
|
|
intevt = *(uint32_t*)0xff000028;
|
|
timer_ID = (intevt - 0x400) / 0x20;
|
|
|
|
/*if (intevt != 0x400)
|
|
{
|
|
kvram_clear();
|
|
printk(0, 0, "Timer ID: %d\n", timer_ID);
|
|
printk(0, 1, "Interrupt: %#x\n", intevt);
|
|
printk(0, 2, "counter: %d\n", counter++);
|
|
kvram_display();
|
|
}*/
|
|
|
|
// Clear interrupt flags.
|
|
SH7305_TMU.TIMER[timer_ID].TCR.UNF = 0;
|
|
|
|
// Execute callback if possible.
|
|
if (timercache[timer_ID].status != TIMER_UNUSED &&
|
|
timercache[timer_ID].callback != NULL)
|
|
{
|
|
((void (*)(volatile void *))timercache[timer_ID].callback)(timercache[timer_ID].arg);
|
|
}
|
|
|
|
}
|