Add led_on subroutine

1 files changed, 13 insertions, 1 deletions

diff --git a/blink.s b/blink.s
index 5150cab..5b65eb4 100644
--- a/blink.s
+++ b/blink.s
@@ -7,8 +7,9 @@
 .equ GPIO25_CTRL,     (IO_BANK0_BASE + 0x0cc)
 
 .equ SIO_BASE,          0xd0000000
-.equ GPIO_OE_SET_OFST,  0x024
+.equ GPIO_OUT_SET_OFST, 0x014
 .equ GPIO_OUT_XOR_OFST, 0x01c
+.equ GPIO_OE_SET_OFST,  0x024
 
 .equ ATOMIC_CLEAR,    0x3000
 
@@ -25,6 +26,17 @@ setup_led:
   str r0, [r1, GPIO_OE_SET_OFST]
   bx lr
 
+.type led_on, %function
+.global led_on
+
+led_on:
+  ldr r1, =SIO_BASE
+  movs r0, 1
+  lsls r0, 25
+  str r0, [r1, GPIO_OUT_SET_OFST]
+1:
+  b 1b
+
 .type blink, %function
 .global blink