control.c: handle "battery critical" state

[bike-lights.git] / firmware / control.c

diff --git a/firmware/control.c b/firmware/control.c
index 1a768e6ca9d2d84f5b3932a7424c9a1bd6201178..7a8d4473c9cf52da0640e3e3870f88cd2de69711 100644 (file)
--- a/firmware/control.c
+++ b/firmware/control.c
@@ -124,7 +124,8 @@ void set_panic_mode()
 
 pattern_t *pwmled0_pattern_select()
 {
-       // TODO: battery critical
+       if (battery_critical)
+               return on1_pattern;
 
        if (towbar_mode)
                return NULL;
@@ -140,10 +141,11 @@ pattern_t *pwmled0_pattern_select()
 
 pattern_t *pwmled1_pattern_select()
 {
-       // TODO: battery critical
-
 #ifndef TESTING_FW
        return NULL;
+#else
+       if (battery_critical)
+               return on1_pattern;
 #endif
 
        if (towbar_mode) {
@@ -168,11 +170,11 @@ pattern_t *pwmled1_pattern_select()
 
 pattern_t *pwmled2_pattern_select()
 {
-       // TODO: battery critical
-
 #ifndef TESTING_FW
-       return on3_pattern;
+       if (battery_critical)
+               return on1_pattern;
 #endif
+
        switch (ambient_zone) {
        case 0: return dim_mode ? on2_pattern : on3_pattern;
        case 1: return dim_mode ? slow1_pattern : normal2_pattern;
@@ -194,7 +196,8 @@ pattern_t *status_led_pattern_select()
 
 pattern_t *illumination_led_pattern_select()
 {
-       // todo: battery critical
+       if (battery_critical)
+               return NULL;
 
        switch (ambient_zone) {
        case 0: return dim_mode