From 3fea4bbdea86287b07515dbb794d2fd03518a0f8 Mon Sep 17 00:00:00 2001
From: Jacques Comeaux <jacquesrcomeaux@protonmail.com>
Date: Mon, 8 Jan 2024 02:03:28 -0600
Subject: Add led_on subroutine

---
 blink.s | 14 +++++++++++++-
 main.s  |  5 +----
 2 files changed, 14 insertions(+), 5 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
 
diff --git a/main.s b/main.s
index 0f137d6..8f72dfe 100644
--- a/main.s
+++ b/main.s
@@ -11,7 +11,4 @@ main:
   bl setup_clocks
   bl setup_gpio
   bl setup_led
-  movs r0, 3
-  bl blinkN
-stop:
-  b stop
+  b led_on
-- 
cgit v1.2.3