There're cases we want to use active-low LEDs and the 'inverted' logic
needs to be added. This includes it using the STATUS_LED_INVERT macro.

Signed-off-by: Otavio Salvador <ota...@ossystems.com.br>
---
 doc/README.LED            |  2 ++
 drivers/misc/status_led.c | 21 ++++++++++++++++++---
 include/status_led.h      | 14 ++++++++++++++
 3 files changed, 34 insertions(+), 3 deletions(-)

diff --git a/doc/README.LED b/doc/README.LED
index c3bcb3a..c14555a 100644
--- a/doc/README.LED
+++ b/doc/README.LED
@@ -43,6 +43,8 @@ STATUS_LED_RED is the red LED.  It is used signal errors. 
This must be a valid
 STATUS_LED_BIT value. Other similar color LED's are STATUS_LED_YELLOW and
 STATUS_LED_BLUE.
 
+STATUS_LED_INVERT and STATUS_LED_INVERT<n> to use active-low LEDs.
+
 These board must define these functions
 
 __led_init is called once to initialize the LED to STATUS_LED_STATE. One time
diff --git a/drivers/misc/status_led.c b/drivers/misc/status_led.c
index 6b71ad4..5878d15 100644
--- a/drivers/misc/status_led.c
+++ b/drivers/misc/status_led.c
@@ -23,19 +23,22 @@ typedef struct {
        led_id_t mask;
        int state;
        int period;
+       int invert;
        int cnt;
 } led_dev_t;
 
-led_dev_t led_dev[] = {
+static led_dev_t led_dev[] = {
     {  STATUS_LED_BIT,
        STATUS_LED_STATE,
        STATUS_LED_PERIOD,
+       STATUS_LED_INVERT,
        0,
     },
 #if defined(STATUS_LED_BIT1)
     {  STATUS_LED_BIT1,
        STATUS_LED_STATE1,
        STATUS_LED_PERIOD1,
+       STATUS_LED_INVERT1,
        0,
     },
 #endif
@@ -43,6 +46,7 @@ led_dev_t led_dev[] = {
     {  STATUS_LED_BIT2,
        STATUS_LED_STATE2,
        STATUS_LED_PERIOD2,
+       STATUS_LED_INVERT2,
        0,
     },
 #endif
@@ -50,6 +54,7 @@ led_dev_t led_dev[] = {
     {  STATUS_LED_BIT3,
        STATUS_LED_STATE3,
        STATUS_LED_PERIOD3,
+       STATUS_LED_INVERT3,
        0,
     },
 #endif
@@ -64,9 +69,11 @@ static void status_led_init (void)
        led_dev_t *ld;
        int i;
 
-       for (i = 0, ld = led_dev; i < MAX_LED_DEV; i++, ld++)
-               __led_init (ld->mask, ld->state);
+       /* Avoid join in a call loop */
        status_led_init_done = 1;
+
+       for (i = 0, ld = led_dev; i < MAX_LED_DEV; i++, ld++)
+               status_led_set (i, ld->state);
 }
 
 void status_led_tick (ulong timestamp)
@@ -107,5 +114,13 @@ void status_led_set (int led, int state)
                ld->cnt = 0;            /* always start with full period    */
                state = STATUS_LED_ON;  /* always start with LED _ON_       */
        }
+
+       if (ld->invert) {
+               if (state == STATUS_LED_ON)
+                       state = STATUS_LED_OFF;
+               else
+                       state = STATUS_LED_ON;
+       }
+
        __led_set (ld->mask, state);
 }
diff --git a/include/status_led.h b/include/status_led.h
index ecff60d..0da3fda 100644
--- a/include/status_led.h
+++ b/include/status_led.h
@@ -288,6 +288,20 @@ extern void __led_set (led_id_t mask, int state);
 #else
 # error Status LED configuration missing
 #endif
+
+#ifndef STATUS_LED_INVERT
+#define STATUS_LED_INVERT 0
+#endif
+#ifndef STATUS_LED_INVERT1
+#define STATUS_LED_INVERT1 0
+#endif
+#ifndef STATUS_LED_INVERT2
+#define STATUS_LED_INVERT2 0
+#endif
+#ifndef STATUS_LED_INVERT3
+#define STATUS_LED_INVERT3 0
+#endif
+
 /************************************************************************/
 
 #ifndef CONFIG_BOARD_SPECIFIC_LED
-- 
1.8.4.rc3

_______________________________________________
U-Boot mailing list
U-Boot@lists.denx.de
http://lists.denx.de/mailman/listinfo/u-boot

Reply via email to