57 lines
1.1 KiB
C
57 lines
1.1 KiB
C
#include <kernel/drivers/vbr.h>
|
|
#include <kernel/devices/earlyterm.h>
|
|
#include <kernel/util/atomic.h>
|
|
|
|
// TODO: update me
|
|
void interrupt_handler(void)
|
|
{
|
|
extern void (*int_handler[VBR_INTERRUPT_NB])(void);
|
|
uint32_t intevt = *(uint32_t*)0xff000028;
|
|
int id;
|
|
|
|
// Get the interrupt ID
|
|
VBR_GET_INTERRUPT_CODE(id, intevt);
|
|
|
|
// Check id validity and handler error
|
|
if (id < 0 || id >= VBR_INTERRUPT_NB || int_handler[id] == NULL)
|
|
{
|
|
earlyterm_write(
|
|
"Ho crap ! Interrupt error !\n"
|
|
"Interrupt ID (%#x)\n"
|
|
"Error: handler not foud !\n",
|
|
intevt
|
|
);
|
|
while (1);
|
|
}
|
|
|
|
// Call handler and exit
|
|
(*int_handler[id])();
|
|
}
|
|
|
|
void *vbr_interrupt_set(int intcode, void (*handler)(void))
|
|
{
|
|
extern void (*int_handler[VBR_INTERRUPT_NB])(void);
|
|
void *old;
|
|
int id;
|
|
|
|
// Get the interrupt ID
|
|
VBR_GET_INTERRUPT_CODE(id, intcode);
|
|
|
|
// Check id validity
|
|
if (id < 0 || id >= VBR_INTERRUPT_NB)
|
|
return (NULL);
|
|
|
|
// Start atomic operations
|
|
atomic_start();
|
|
|
|
// Switch interupt handler
|
|
old = int_handler[id];
|
|
int_handler[id] = handler;
|
|
|
|
// Stop atomic operations
|
|
atomic_stop();
|
|
|
|
// Return old interrupt handler
|
|
return (old);
|
|
}
|