fly316/PX4-Autopilot
7
0
Fork 0
mirror of https://gitee.com/mirrors_PX4/PX4-Autopilot.git synced 2026-10-18 01:03:33 +08:00
Code Issues Packages Projects Releases Wiki Activity

sitl led:Support logical LED operations in commander

Browse Source 
add support for all the LEDS to support
   BOARD_HAS_CONTROL_STATUS_LEDS
This commit is contained in:
David Sidrane
2018-11-19 14:32:47 -05:00
committed by Daniel Agar
parent 0a1dd24af6
commit 96ba6c1174
1 changed files with 5 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files
src/drivers/boards/sitl/sitl_led.c
+5 -4
View File
@@ -40,6 +40,7 @@
#include <px4_config.h>
#include <px4_log.h>
#include <stdbool.h>
#include <systemlib/px4_macros.h>
__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");