aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--src/cpu/irq.S21
1 files changed, 20 insertions, 1 deletions
diff --git a/src/cpu/irq.S b/src/cpu/irq.S
index 53a749e..5b1ec43 100644
--- a/src/cpu/irq.S
+++ b/src/cpu/irq.S
@@ -24,13 +24,32 @@ a_irq_handler:
movt r2, #0x3F20
ldrb r0, [r2]
push {r0}
- bl enable_irq
+
+ // If 't' was pressed
+ // disable timer
+ cmp r0, #0x74
+ bne a_irq_handler.ttimer
+ mrc p15, #0, r0, c14, c3, #1
+ cmp r0, #0
+ beq a_irq_handler.etimer
+ // Disable
+ bl disable_cntv
+ b a_irq_handler.ttimer
+a_irq_handler.etimer:
+ // Enable
+ ldr r0, =cntfrq
+ bl write_cntv_tval
+ bl enable_cntv
+ // Otherwise continue
+a_irq_handler.ttimer:
pop {r0}
bl uart_char
ldr r0, =imsg
bl uart_string
+ bl enable_irq
pop {pc}
a_irq_handler.timer:
+
// r2 = CORE0_INTERRUPT_SOURCE
// if r2 & 0b1000
mov r2, #0x40000000