From 00ff04fc4932fc7c3fc2f9b9074f11c189045dad Mon Sep 17 00:00:00 2001
From: Damien
Date: Sat, 19 Oct 2013 14:40:54 +0100
Subject: Working SysTick, code factoring, some boot-up code.

---
 stm/led.c | 23 +++++++++++++++++++++--
 1 file changed, 21 insertions(+), 2 deletions(-)

(limited to 'stm/led.c')

diff --git a/stm/led.c b/stm/led.c
index a6255540f..1377a8407 100644
--- a/stm/led.c
+++ b/stm/led.c
@@ -38,10 +38,29 @@ void led_state(pyb_led_t led, int state) {
         default: return;
     }
     if (state == 0) {
-        // LED off, output is high
+        // turn LED off (output is high)
         port->BSRRL = pin;
     } else {
-        // LED on, output is low
+        // turn LED on (output is low)
+        port->BSRRH = pin;
+    }
+}
+
+void led_toggle(pyb_led_t led) {
+    GPIO_TypeDef *port;
+    uint32_t pin;
+    switch (led) {
+        case PYB_LED_R1: port = PYB_LED_R_PORT; pin = PYB_LED_R1_PIN; break;
+        case PYB_LED_R2: port = PYB_LED_R_PORT; pin = PYB_LED_R2_PIN; break;
+        case PYB_LED_G1: port = PYB_LED_G_PORT; pin = PYB_LED_G1_PIN; break;
+        case PYB_LED_G2: port = PYB_LED_G_PORT; pin = PYB_LED_G2_PIN; break;
+        default: return;
+    }
+    if (!(port->ODR & pin)) {
+        // turn LED off (output high)
+        port->BSRRL = pin;
+    } else {
+        // turn LED on (output low)
         port->BSRRH = pin;
     }
 }
-- 
cgit v1.2.3