aboutsummaryrefslogtreecommitdiff
diff options
context:
space:
mode:
-rw-r--r--src/uart.S27
1 files changed, 27 insertions, 0 deletions
diff --git a/src/uart.S b/src/uart.S
index bd98bac..94ce458 100644
--- a/src/uart.S
+++ b/src/uart.S
@@ -44,3 +44,30 @@ uart_string.loop:
cmp r0, #0
bne uart_string.loop
pop {r4, pc}
+
+.globl uart_hex
+uart_hex:
+ push {r4, lr}
+ mov r2, #0x1000
+ movt r2, #0x3f20
+uart_hex.loop:
+ ldr r3, [r2, #24]
+ tst r3, #0b100000
+ bne uart_hex.loop
+ mov r3, #7
+uart_hex.hloop:
+ mov r1, r0
+ asr r1, r3
+ asr r1, r3
+ asr r1, r3
+ asr r1, r3
+ and r1, #0xf
+ add r1, #0x30
+ cmp r1, #0x3A
+ blt uart_hex.print
+ add r1, #7
+uart_hex.print:
+ str r1, [r2]
+ subs r3, #1
+ bge uart_hex.hloop
+ pop {r4, pc}