diff options
author | Roman Bapst <romanbapst@yahoo.de> | 2015-05-13 16:23:29 +0200 |
---|---|---|
committer | Roman Bapst <romanbapst@yahoo.de> | 2015-05-13 16:24:44 +0200 |
commit | 90c3aec1fdc640ef15a610991251fa8a6ab202e8 (patch) | |
tree | 2dcff562ff3b00b03784d3c980b99f3b54811270 | |
parent | b3ed0cf36b985771c50108016277f2148c8b000f (diff) | |
download | px4-firmware-90c3aec1fdc640ef15a610991251fa8a6ab202e8.tar.gz px4-firmware-90c3aec1fdc640ef15a610991251fa8a6ab202e8.tar.bz2 px4-firmware-90c3aec1fdc640ef15a610991251fa8a6ab202e8.zip |
make main LED show low and critical battery status
-rw-r--r-- | src/modules/commander/commander.cpp | 8 |
1 files changed, 5 insertions, 3 deletions
diff --git a/src/modules/commander/commander.cpp b/src/modules/commander/commander.cpp index 50846ff4d..f27487932 100644 --- a/src/modules/commander/commander.cpp +++ b/src/modules/commander/commander.cpp @@ -2157,10 +2157,12 @@ control_status_leds(vehicle_status_s *status_local, const actuator_armed_s *actu if (set_normal_color) { /* set color */ - if (status_local->battery_warning == vehicle_status_s::VEHICLE_BATTERY_WARNING_LOW || status_local->failsafe) { + if (status_local->failsafe) { + rgbled_set_color(RGBLED_COLOR_PURPLE); + } else if (status_local->battery_warning == vehicle_status_s::VEHICLE_BATTERY_WARNING_LOW) { rgbled_set_color(RGBLED_COLOR_AMBER); - /* vehicle_status_s::VEHICLE_BATTERY_WARNING_CRITICAL handled as vehicle_status_s::ARMING_STATE_ARMED_ERROR / vehicle_status_s::ARMING_STATE_STANDBY_ERROR */ - + } else if (status_local->battery_warning == vehicle_status_s::VEHICLE_BATTERY_WARNING_CRITICAL) { + rgbled_set_color(RGBLED_COLOR_RED); } else { if (status_local->condition_global_position_valid) { rgbled_set_color(RGBLED_COLOR_GREEN); |