Refactor led macro, now we can specify the led to on/off.

[bertos.git] / boards / sam3n-ek / hw / hw_led.h

diff --git a/boards/sam3n-ek/hw/hw_led.h b/boards/sam3n-ek/hw/hw_led.h
index c441a0f04f64255be462078f28fb1f78e09a1181..8f92b3be5f703f76c86bbd3341d74ab8c90f31df 100644 (file)
--- a/boards/sam3n-ek/hw/hw_led.h
+++ b/boards/sam3n-ek/hw/hw_led.h
@@ -38,15 +38,44 @@
 #ifndef HW_LED_H
 #define HW_LED_H
 
+#include <io/cm3.h>
+
 #include <cfg/macros.h>
 
+#define LED_BLUE     0
+#define LED_GREEN    1
+#define LED_AMBER    2
+
 // Leds
 #define LED_BLUE_PIN       BV(23)  // Port A
 #define LED_AMBER_PIN      BV(25)  // Port A
 #define LED_GREEN_PIN      BV(14)  // Port B
 
-#define LED_ON(led)  (PIOA_CODR = led)
-#define LED_OFF(led)  (PIOA_SODR = led)
+#define LED_ON(led) \
+       do { \
+               if (led == LED_BLUE) \
+                       PIOA_CODR = LED_BLUE_PIN; \
+               else if (led == LED_GREEN) \
+                       PIOB_CODR = LED_GREEN_PIN; \
+               else if (led == LED_AMBER) \
+                       PIOA_CODR = LED_AMBER_PIN; \
+               else \
+                       ASSERT(0); \
+       } while (0)
+
+
+#define LED_OFF(led) \
+       do { \
+               if (led == LED_BLUE) \
+                       PIOA_SODR = LED_BLUE_PIN; \
+               else if (led == LED_GREEN) \
+                       PIOB_SODR = LED_GREEN_PIN; \
+               else if (led == LED_AMBER) \
+                       PIOA_SODR = LED_AMBER_PIN; \
+               else \
+                       ASSERT(0); \
+       } while (0)
+
 
 #define LED_INIT() \
        do { \