From 96ba6c1174351f3f1d41de062c61088d85bf6296 Mon Sep 17 00:00:00 2001 From: David Sidrane Date: Wed, 26 Sep 2018 08:55:48 -0700 Subject: [PATCH] sitl led:Support logical LED operations in commander add support for all the LEDS to support BOARD_HAS_CONTROL_STATUS_LEDS --- src/drivers/boards/sitl/sitl_led.c | 9 +++++---- 1 file changed, 5 insertions(+), 4 deletions(-) diff --git a/src/drivers/boards/sitl/sitl_led.c b/src/drivers/boards/sitl/sitl_led.c index 4c43ffc578..0f126f1c88 100644 --- a/src/drivers/boards/sitl/sitl_led.c +++ b/src/drivers/boards/sitl/sitl_led.c @@ -40,6 +40,7 @@ #include #include #include +#include __BEGIN_DECLS extern void led_init(void); @@ -48,7 +49,7 @@ extern void led_off(int led); extern void led_toggle(int led); __END_DECLS -static bool _led_state[2] = { false, false }; +static bool _led_state[] = { false, false, false, false }; __EXPORT void led_init() { @@ -57,7 +58,7 @@ __EXPORT void led_init() __EXPORT void led_on(int led) { - if (led == 1 || led == 0) { + if ((unsigned int)led < arraySize(_led_state)) { PX4_DEBUG("LED%d_ON", led); _led_state[led] = true; } @@ -65,7 +66,7 @@ __EXPORT void led_on(int led) __EXPORT void led_off(int led) { - if (led == 1 || led == 0) { + if ((unsigned int)led < arraySize(_led_state)) { PX4_DEBUG("LED%d_OFF", led); _led_state[led] = false; } @@ -73,7 +74,7 @@ __EXPORT void led_off(int led) __EXPORT void led_toggle(int led) { - if (led == 1 || led == 0) { + if ((unsigned int)led < arraySize(_led_state)) { _led_state[led] = !_led_state[led]; PX4_DEBUG("LED%d_TOGGLE: %s", led, _led_state[led] ? "ON" : "OFF");