From c86d0a697c9799b3e32f78be404b17347c16d6b9 Mon Sep 17 00:00:00 2001
From: id101010 <aaron@duckpond.ch>
Date: Sun, 31 Jan 2016 22:18:44 +0100
Subject: [PATCH] Added read_switches

---
 src/io.s | 14 +++++++++-----
 1 file changed, 9 insertions(+), 5 deletions(-)

diff --git a/src/io.s b/src/io.s
index c90587a..01120ae 100644
--- a/src/io.s
+++ b/src/io.s
@@ -241,10 +241,14 @@ end_read_adc:
 //No Parameters, Return value in R0 (1 byte)
 read_switches:
 
-    //TODO: Implement
+    .set ADDR_LEDS, 0x6C000200
+    .set ADDR_SWITCHES, 0x6C000400
+
+    LDR r1, =ADDR_SWITCHES  // load switch address to r1
+    LDR r0, [r1]            // load switch value to r0
+    LDR r2, =ADDR_LEDS      // load led address to r1
+    STR r0, [r2]            // store switch value at led address
+
+    MOV pc, lr
 
 end_read_switches:
-
-
-
-