karo: tx6: disable Heartbeat LED in case of error

diff --git a/board/karo/tx6/tx6qdl.c b/board/karo/tx6/tx6qdl.c
index 87ff82bb892b750f3a3cd9c14797fa064f220598..ffd300eb8e40f015a2770f62e23bd4686e3a1b67 100644 (file)
--- a/board/karo/tx6/tx6qdl.c
+++ b/board/karo/tx6/tx6qdl.c
@@ -809,8 +809,11 @@ enum {
        LED_STATE_INIT = -1,
        LED_STATE_OFF,
        LED_STATE_ON,
        LED_STATE_INIT = -1,
        LED_STATE_OFF,
        LED_STATE_ON,

+       LED_STATE_DISABLED,

 };
 
 };
 

+static int led_state = LED_STATE_INIT;
+

 static inline int calc_blink_rate(void)
 {
        if (!tx6_temp_check_enabled)
 static inline int calc_blink_rate(void)
 {
        if (!tx6_temp_check_enabled)


@@ -823,16 +826,20 @@ static inline int calc_blink_rate(void)
 
 void show_activity(int arg)
 {
 
 void show_activity(int arg)
 {

-       static int led_state = LED_STATE_INIT;

        static int blink_rate;
        static ulong last;
        static int blink_rate;
        static ulong last;

+       int ret;

 
        if (led_state == LED_STATE_INIT) {
                last = get_timer(0);
 
        if (led_state == LED_STATE_INIT) {
                last = get_timer(0);

-               gpio_set_value(TX6_LED_GPIO, 1);
+               ret = gpio_set_value(TX6_LED_GPIO, 1);
+               if (ret) {
+                       led_state = LED_STATE_DISABLED;
+                       return;
+               }

                led_state = LED_STATE_ON;
                blink_rate = calc_blink_rate();
                led_state = LED_STATE_ON;
                blink_rate = calc_blink_rate();

-       } else {
+       } else if (led_state != LED_STATE_DISABLED) {

                if (get_timer(last) > blink_rate) {
                        blink_rate = calc_blink_rate();
                        last = get_timer_masked();
                if (get_timer(last) > blink_rate) {
                        blink_rate = calc_blink_rate();
                        last = get_timer_masked();


@@ -1402,6 +1409,7 @@ static void stk5_board_init(void)
                printf("Failed to request stk5_gpios: %d\n", ret);
                return;
        }
                printf("Failed to request stk5_gpios: %d\n", ret);
                return;
        }

+       led_state = LED_STATE_INIT;

        imx_iomux_v3_setup_multiple_pads(stk5_pads, ARRAY_SIZE(stk5_pads));
 }
 
        imx_iomux_v3_setup_multiple_pads(stk5_pads, ARRAY_SIZE(stk5_pads));
 }