From 90c3aec1fdc640ef15a610991251fa8a6ab202e8 Mon Sep 17 00:00:00 2001 From: Roman Bapst Date: Wed, 13 May 2015 16:23:29 +0200 Subject: [PATCH] make main LED show low and critical battery status --- src/modules/commander/commander.cpp | 8 +++++--- 1 file changed, 5 insertions(+), 3 deletions(-) diff --git a/src/modules/commander/commander.cpp b/src/modules/commander/commander.cpp index 50846ff4d0..f274879325 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);