diff options
| -rw-r--r-- | src/cpu/irq.c | 94 |
1 files changed, 94 insertions, 0 deletions
diff --git a/src/cpu/irq.c b/src/cpu/irq.c index 2cb0856..f1d8fb6 100644 --- a/src/cpu/irq.c +++ b/src/cpu/irq.c @@ -106,6 +106,100 @@ void c_irq_handler(void) return; } +void c_fiq_handler(void) +{ + unsigned long source = load32(CORE0_FIQ_SOURCE); + if (source & (1 << 8)) { + if(load32(IRQ_PENDING2) & (1 << 25)) { + if(load32(UART0_MIS) & (1<<4)) { + unsigned long data = load32(UART0_DR); + // Ctrl+Tab to toggle timer + if(data == 0x14) { + unsigned long timer_status; + asm volatile("mrc p15, 0, %0, c14, c3, 1" : "=r"(timer_status)); + unsigned int x = g_Drawer.x; + unsigned int y = g_Drawer.y; + g_Drawer.x = 0; + g_Drawer.y = 5; + write_string(&g_Drawer, "TIMER: "); + if(timer_status == 0) { + cntfrq = read_cntfrq(); + write_cntv_tval(cntfrq/CPS); + enablecntv(); + write_cstring(&g_Drawer, "Enabled ", 0x00FF00); + } else { + disablecntv(); + write_cstring(&g_Drawer, "Disabled", 0xFF0000); + } + g_Drawer.x = x; + g_Drawer.y = y; + } else { + unsigned long off = cmdidx; + if (off < 2048) { + // Newline Case + if (data == 0x0D) { + for(int i = off; i>=0;i--) + cmd[i] = 0x0; + off = 0; + // Backspace Case + } else if (data == 0x08 || data == 0x7F) { + if (off > 0) { + off -= 1; + } + cmd[off] = 0x0; + // Lock Case + } else if (data == 0x6C) { + cmd[off] = (char) data; + off += 1; + lock_mutex(&exe_cnt_m, SYS_PID); + // Release Case + } else if (data == 0x72) { + cmd[off] = (char) data; + off += 1; + release_mutex(&exe_cnt_m, SYS_PID); + // New Task Case + } else if (data == 0x61) { + cmd[off] = (char) data; + off += 1; + //_start(); // Trigger reset + //heap_info_u(); + // Else output + } else { + cmd[off] = (char) data; + off += 1; + } + } else if (off == 2048) { + if (data == 0x0D) { + for(int i = off; i>=0;i--) + cmd[i] = 0x0; + off = 0; + } else if (data == 0x08 || data == 0x7F) { + if (off > 0) { + off -= 1; + } + cmd[off] = 0x0; + } + } + cmdidx = off; + } + g_Drawer.x = 0; + g_Drawer.y = 7; + for(int i = 0; i < 128; i++) + write_char(&g_Drawer, ' '); + g_Drawer.x = 0; + g_Drawer.y = 7; + write_string(&g_Drawer, "> "); + write_string(&g_Drawer, cmd); + return; + } + } + } else if (source & (1 << 3)) { + c_timer(); + return; + } + return; +} + void localtest(void) { struct Thread* t = scheduler.rthread_ll->data; |