From 733a45d82e84de894be0c3d29b3305219827f448 Mon Sep 17 00:00:00 2001
From: Christian Cunningham <cc@localhost>
Date: Thu, 2 Dec 2021 23:17:41 -0700
Subject: Initial Commit

---
 src/irq.S | 91 +++++++++++++++++++++++++++++++++++----------------------------
 1 file changed, 51 insertions(+), 40 deletions(-)

(limited to 'src/irq.S')

diff --git a/src/irq.S b/src/irq.S
index 5434a60..53a749e 100644
--- a/src/irq.S
+++ b/src/irq.S
@@ -1,51 +1,62 @@
 .globl a_irq_handler
 a_irq_handler:
-    push {lr}
-    bl disable_irq
-    // r2 = CORE0_INTERRUPT_SOURCE
-    // if r2 & 0b100000000
-    mov r2, #0x40000000
-    ldr r3, [r2, #0x60]
-    tst r3, #256
-    beq a_irq_handler.exit
-    // r2 = IRQ_PEND2
-    // r2 & 1 << 25
-    mov r2, #0xB208
-    movt r2, #0x3F00
-    ldr r3, [r2]
-    tst r3, #0x2000000
-    beq a_irq_handler.exit
-    mov r2, #0x1040
-    movt r2, #0x3F20
-    ldr r3, [r2]
-    tst r3, #16
-    beq a_irq_handler.exit
-    mov r2, #0x1000
-    movt r2, #0x3F20
-    ldrb r0, [r2]
-    push {r0}
-    bl enable_irq
-    pop {r0}
-    bl uart_char
-    ldr r0, =imsg
-    bl uart_string
-    pop {pc}
+	push {lr}
+	bl disable_irq
+	// r2 = CORE0_INTERRUPT_SOURCE
+	// if r2 & 0b100000000
+	mov r2, #0x40000000
+	ldr r3, [r2, #0x60]
+	tst r3, #256
+	beq a_irq_handler.timer
+	// r2 = IRQ_PEND2
+	// r2 & 1 << 25
+	mov r2, #0xB208
+	movt r2, #0x3F00
+	ldr r3, [r2]
+	tst r3, #0x2000000
+	beq a_irq_handler.exit
+	mov r2, #0x1040
+	movt r2, #0x3F20
+	ldr r3, [r2]
+	tst r3, #16
+	beq a_irq_handler.exit
+	mov r2, #0x1000
+	movt r2, #0x3F20
+	ldrb r0, [r2]
+	push {r0}
+	bl enable_irq
+	pop {r0}
+	bl uart_char
+	ldr r0, =imsg
+	bl uart_string
+	pop {pc}
+a_irq_handler.timer:
+	// r2 = CORE0_INTERRUPT_SOURCE
+	// if r2 & 0b1000
+	mov r2, #0x40000000
+	ldr r3, [r2, #0x60]
+	tst r3, #8
+	beq a_irq_handler.exit
+	bl c_timer
+	//ldr r0, =imsg
+	//bl uart_string
 a_irq_handler.exit:
-    bl enable_irq
-    pop {pc}
+	bl enable_irq
+	pop {pc}
 
 .globl a_fiq_handler
 a_fiq_handler:
-    push {lr}
-    bl disable_fiq
-    ldr r0, =fmsg
-    bl uart_string
+	push {lr}
+	bl disable_fiq
+	bl c_timer
+	ldr r0, =fmsg
+	bl uart_string
 a_fiq_handler.exit:
-    bl enable_fiq
-    pop {pc}
+	bl enable_fiq
+	pop {pc}
 
 .section ".data"
 imsg:
-    .asciz " a_irq_handler\n"
+	.asciz " asm_irq_handler\n"
 fmsg:
-    .asciz " a_fiq_handler\n"
+	.asciz " asm_fiq_handler\n"
-- 
cgit v1.2.1