Error flags, error reporting

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

diff --git a/firmware/control.c b/firmware/control.c
index c351ca80b0fef5a386ce493a866dc65c98a0bb70..a0d2451a5df08cd0b095c7438b05bc714bd613c3 100644 (file)
--- a/firmware/control.c
+++ b/firmware/control.c
@@ -75,21 +75,24 @@ pattern_t test_pattern[] = {
 };
 #endif
 
-volatile unsigned char braking;
+volatile err_flags_t err_flags;
 static unsigned char dim_mode, towbar_mode;
 
 void init_control()
 {
        dim_mode = 0;
        towbar_mode = 0;
-       braking = 0;
+       err_flags.any_flag = 0;
+#ifdef notyet
+       err_flags.booting = 1;
+#endif
 
        pwmled_select_brightness();
 }
 
 void brake_on()
 {
-       braking = 1;
+       err_flags.braking = 1;
        gpio_set(0, 1);
        led_set_pattern(N_STATUS_LED, status_led_pattern_select());
        pwmleds_update_mode();
@@ -97,7 +100,7 @@ void brake_on()
 
 void brake_off()
 {
-       braking = 0;
+       err_flags.braking = 0;
        gpio_set(0, 0);
        led_set_pattern(N_STATUS_LED, status_led_pattern_select());
        pwmleds_update_mode();
@@ -112,8 +115,21 @@ void toggle_dim_mode()
 
 void set_panic_mode()
 {
-       led_set_pattern(0, panic_pattern);
-       led_set_pattern(N_ILLUM_LED, panic_pattern);
+       // if error, clean it up
+       if (err_flags.booting)
+               err_flags.booting = 0;
+       else if (err_flags.err_pwmled2)
+               err_flags.err_pwmled2 = 0;
+       else if (err_flags.err_pwmled1)
+               err_flags.err_pwmled1 = 0;
+       else if (err_flags.err_pwmled0)
+               err_flags.err_pwmled0 = 0;
+       else if (err_flags.err_battery)
+               err_flags.err_battery = 0;
+       else {
+               led_set_pattern(0, panic_pattern);
+               led_set_pattern(N_ILLUM_LED, panic_pattern);
+       }
 }
 
 pattern_t *pwmled_pattern_select()
@@ -121,7 +137,7 @@ pattern_t *pwmled_pattern_select()
 #ifdef TEST_PATTERN
        return tmp_pattern;
 #endif
-       if (battery_critical)
+       if (err_flags.err_battery)
                return slow_pattern;
 
        switch (ambient_zone) {
@@ -136,7 +152,22 @@ pattern_t *pwmled_pattern_select()
 
 pattern_t *status_led_pattern_select()
 {
-       if (braking)
+       if (err_flags.booting)
+               return number_pattern(1, 1);
+
+       if (err_flags.err_pwmled2)
+               return number_pattern(5, 1);
+
+       if (err_flags.err_pwmled1)
+               return number_pattern(4, 1);
+
+       if (err_flags.err_pwmled0)
+               return number_pattern(3, 1);
+
+       if (err_flags.err_battery)
+               return number_pattern(2, 1);
+
+       if (err_flags.braking)
                return on_pattern;
 
        if (buttons_setup_in_progress())
@@ -151,7 +182,7 @@ pattern_t *illumination_led_pattern_select()
        if (buttons_setup_in_progress())
                return buttons_setup_status1_pattern_select();
 
-       if (battery_critical)
+       if (err_flags.err_battery)
                return NULL;
 
        switch (ambient_zone) {
@@ -183,7 +214,7 @@ void pwmled_select_brightness()
 {
        uint16_t brightness = PWMLED_BRIGHTNESS(0, 2, 1, 0, 2); // default
 
-       if (battery_critical) {
+       if (err_flags.err_battery) {
                brightness = PWMLED_BRIGHTNESS(0, 0, 0, 0, 0);
        } else if (ambient_zone == 0) {
                if (dim_mode)