X-Git-Url: https://codewiz.org/gitweb?a=blobdiff_plain;f=boards%2Fsam3n-ek%2Fhw%2Fhw_led.h;h=8f92b3be5f703f76c86bbd3341d74ab8c90f31df;hb=cc07cdcf518f1f2176e5754f26ba7aa4e9b9fbda;hp=c441a0f04f64255be462078f28fb1f78e09a1181;hpb=42c64eab961cf2370a2e75358ff5e77162544b7d;p=bertos.git

diff --git a/boards/sam3n-ek/hw/hw_led.h b/boards/sam3n-ek/hw/hw_led.h
index c441a0f0..8f92b3be 100644
--- 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 { \