diff options
Diffstat (limited to 'src/cpu/irq.c')
| -rw-r--r-- | src/cpu/irq.c | 15 |
1 files changed, 2 insertions, 13 deletions
diff --git a/src/cpu/irq.c b/src/cpu/irq.c index e3353e8..3bd28e6 100644 --- a/src/cpu/irq.c +++ b/src/cpu/irq.c @@ -80,20 +80,9 @@ unsigned long c_irq_handler(void) unsigned long c_fiq_handler(void) { unsigned long source = load32(CORE0_FIQ_SOURCE); - if (source & (1 << 8)) { - // Check if System Time Compare 0 Triggered the Interrupt - if (*(volatile unsigned long*)SYS_TIMER_CS & SYS_TIMER_SC_M0) { - volatile unsigned long* timer_cs = (volatile unsigned long*)SYS_TIMER_CS; - volatile unsigned long* timer_chi = (volatile unsigned long*)SYS_TIMER_CHI; - volatile unsigned long* nexttime = (volatile unsigned long*)SYS_TIMER_C0; - add_thread_without_duplicate(test_entry, 0, 2); - *nexttime = *timer_chi + 4000000; - *timer_cs = SYS_TIMER_SC_M0; - return 1; - } - } // Check if CNTV triggered the interrupt - else if (source & (1 << 3)) { + if (source & (1 << 3)) { + write_cntv_tval(cntfrq); } return 0; } |