thomas/mittos64
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Ability to bind handler functions to interrupts

Browse Source
This commit is contained in:
Thomas Lovén
2018-02-13 14:27:26 +01:00
parent c1c3842ace
commit 6f0a745adc
3 changed files with 28 additions and 3 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
src/kernel/cpu/interrupts.c
View File

@@ -5,9 +5,10 @@
struct int_gate_descriptor idt[NUM_INTERRUPTS];
struct idtr idtr;
extern uintptr_t isr_table[];
int_handler_t int_handlers[NUM_INTERRUPTS];
void idt_set_gate(uint32_t num, uintptr_t vector, uint16_t cs, uint8_t ist, uint8_t flags)
{
idt[num].base_l = vector & 0xFFFF;
@@ -21,6 +22,7 @@ void idt_set_gate(uint32_t num, uintptr_t vector, uint16_t cs, uint8_t ist, uint
void interrupt_init()
{
memset(idt, 0, sizeof(idt));
memset(int_handlers, 0, sizeof(int_handlers));
for(int i=0; i < NUM_INTERRUPTS; i++)
{
@@ -32,9 +34,18 @@ void interrupt_init()
load_idt(&idtr);
}
int_handler_t bind_interrupt(uint32_t num, int_handler_t fn)
{
int_handler_t old = int_handlers[num];
int_handlers[num] = fn;
return old;
}
registers *int_handler(registers *r)
{
(void)r;
if(int_handlers[r->int_no])
return int_handlers[r->int_no](r);
debug("Unhandled interrupt occurred\n");
debug("Interrupt number: %d Error code: %d\n", r->int_no, r->err_code);
debug_print_registers(r);