#include "lights.h"
static pattern_t panic_pattern[] = {
- { 3, 1 }, // FIXME: will be 4, but let's be safe while testing
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
- { 3, 1 },
- { 0, 1 },
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(0, 0, 0), D_1 },
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(0, 0, 0), D_1 },
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(0, 0, 0), D_1 },
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(0, 0, 0), D_1 },
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(0, 0, 0), D_1 },
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(0, 0, 0), D_1 },
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(0, 0, 0), D_1 },
PATTERN_END
};
-pattern_t on1_pattern [] = {
- { 1, 0x7 },
+static pattern_t slow_pattern[] = {
+ { PWM_PAT(1, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 1), D_1 },
+ { PWM_PAT(0, 0, 0), D_13 },
PATTERN_END
};
-static pattern_t on2_pattern [] = {
- { 2, 0x7 },
+static pattern_t fast_pattern[] = {
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(2, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 2), D_1 },
+ { PWM_PAT(0, 0, 0), D_8 },
+ { PWM_PAT(1, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 1), D_1 },
+ { PWM_PAT(1, 0, 0), D_1 },
+ { PWM_PAT(0, 0, 1), D_1 },
+ { PWM_PAT(0, 0, 0), D_8 },
PATTERN_END
};
-static pattern_t on3_pattern [] = {
- { 3, 0x7 },
+static pattern_t night_pattern[] = {
+ { PWM_PAT(3, 0, 1), D_3 },
+ { PWM_PAT(2, 0, 0), D_8 },
+ { PWM_PAT(3, 0, 1), D_1 },
+ { PWM_PAT(2, 0, 0), D_2 },
+ { PWM_PAT(3, 0, 1), D_1 },
+ { PWM_PAT(2, 0, 0), D_8 },
PATTERN_END
};
-static pattern_t brake_pattern [] = {
- { 4, 0x2 },
- { 3, 0x7 },
+pattern_t on_pattern[] = {
+ { 1, D_8 },
PATTERN_END
};
-static pattern_t normal2_pattern[] = {
- { 2, 0x1 },
- { 0, 0x1 },
- { 2, 0x1 },
- { 0, 0x7 },
- { 1, 0x1 },
- { 0, 0x1 },
- { 1, 0x1 },
- { 0, 0x7 },
- PATTERN_END
-};
-
-static pattern_t normal3_pattern[] = {
- { 3, 0x1 },
- { 0, 0x1 },
- { 3, 0x1 },
- { 0, 0x7 },
- { 1, 0x1 },
- { 0, 0x1 },
- { 1, 0x1 },
- { 0, 0x7 },
- PATTERN_END
-};
-
-static pattern_t normal4_pattern[] = {
- { 4, 0x1 },
- { 0, 0x1 },
- { 4, 0x1 },
- { 0, 0x7 },
- { 1, 0x1 },
- { 0, 0x1 },
- { 1, 0x1 },
- { 0, 0x7 },
- PATTERN_END
-};
-
-static pattern_t slow1_pattern[] = {
- { 1, 0x01 },
- { 0, 0x7 },
- { 0, 0x7 },
- PATTERN_END
-};
-
-static pattern_t slow2_pattern[] = {
- { 2, 0x01 },
- { 0, 0x7 },
- { 0, 0x7 },
- PATTERN_END
-};
-
-static pattern_t slow3_pattern[] = {
- { 3, 0x01 },
- { 0, 0x7 },
- { 0, 0x7 },
+// #define TEST_PATTERN 1
+#ifdef TEST_PATTERN
+pattern_t test_pattern[] = {
+ { PWM_PAT(1, 0, 0), D_13 },
+ { PWM_PAT(2, 0, 0), D_13 },
+ { PWM_PAT(0, 0, 1), D_13 },
+ { PWM_PAT(0, 0, 2), D_13 },
PATTERN_END
};
+#endif
-static unsigned char dim_mode, towbar_mode, 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_PWMLEDS, status_led_pattern_select());
- led_set_pattern(0, pwmled0_pattern_select());
+ led_set_pattern(N_STATUS_LED, status_led_pattern_select());
+ pwmleds_update_mode();
}
void brake_off()
{
- braking = 0;
+ err_flags.braking = 0;
gpio_set(0, 0);
- led_set_pattern(N_PWMLEDS, status_led_pattern_select());
- led_set_pattern(0, pwmled0_pattern_select());
+ led_set_pattern(N_STATUS_LED, status_led_pattern_select());
+ pwmleds_update_mode();
}
void toggle_dim_mode()
{
dim_mode = !dim_mode;
+ pwmled_select_brightness();
pattern_reload();
}
void set_panic_mode()
{
- if (!dim_mode)
+ // 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(1, panic_pattern);
- led_set_pattern(2, panic_pattern);
- led_set_pattern(4, panic_pattern);
-}
-
-pattern_t *pwmled0_pattern_select()
-{
- if (battery_critical)
- return on1_pattern;
-
- if (towbar_mode)
- return NULL;
-
- if (braking)
- return brake_pattern;
-
- switch (ambient_zone) {
- case 0: return dim_mode ? NULL : number_pattern(2, 1);
- case 1: return dim_mode ? slow1_pattern : normal2_pattern;
- case 2: return dim_mode ? slow2_pattern : normal3_pattern;
- case 3:
- default: return dim_mode ? slow3_pattern : normal4_pattern;
+ led_set_pattern(N_ILLUM_LED, panic_pattern);
}
}
-pattern_t *pwmled1_pattern_select()
+pattern_t *pwmled_pattern_select()
{
-#ifndef TESTING_FW
- return NULL;
-#else
- if (battery_critical)
- return on1_pattern;
+#ifdef TEST_PATTERN
+ return tmp_pattern;
#endif
+ if (err_flags.err_battery)
+ return slow_pattern;
- if (towbar_mode) {
- switch (ambient_zone) {
- case 0:
- case 1:
- return dim_mode ? on2_pattern : on1_pattern;
- case 2: return dim_mode ? NULL : on2_pattern;
- case 3:
- default: return dim_mode ? NULL : on3_pattern;
- }
- } else {
- switch (ambient_zone) {
- case 0: return dim_mode ? slow1_pattern : normal2_pattern;
- case 1: return dim_mode ? slow2_pattern : normal3_pattern;
- case 2: return dim_mode ? NULL : normal4_pattern;
- case 3:
- default: return NULL;
- }
- }
-}
-
-pattern_t *pwmled2_pattern_select()
-{
-#ifndef TESTING_FW
- if (battery_critical)
- return on1_pattern;
-#endif
+ if (ambient_shadow)
+ return night_pattern;
switch (ambient_zone) {
- case 0: return dim_mode ? on2_pattern : on3_pattern;
- case 1: return dim_mode ? slow1_pattern : normal2_pattern;
+ case 0: return night_pattern;
+ case 1:
case 2:
case 3:
default:
- return dim_mode ? slow2_pattern : normal3_pattern;
+ return dim_mode ? slow_pattern : fast_pattern;
}
}
pattern_t *status_led_pattern_select()
{
- if (braking)
- return on1_pattern;
+ 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())
return buttons_setup_status0_pattern_select();
pattern_t *illumination_led_pattern_select()
{
- if (battery_critical)
+ if (buttons_setup_in_progress())
+ return buttons_setup_status1_pattern_select();
+
+ if (err_flags.err_battery)
return NULL;
+ if (ambient_shadow)
+ return on_pattern;
+
switch (ambient_zone) {
case 0: return dim_mode
? number_pattern(1, 1)
- : on1_pattern;
+ : on_pattern;
case 1: return dim_mode
? number_pattern(2, 1)
: number_pattern(3, 1);
else
return NULL;
}
+
+void pwmled_select_brightness()
+{
+ uint16_t brightness = PWMLED_BRIGHTNESS(0, 2, 1, 0, 2); // default
+
+ if (err_flags.err_battery) {
+ brightness = PWMLED_BRIGHTNESS(0, 0, 0, 0, 0);
+ } else if (ambient_zone == 0) {
+ if (dim_mode)
+ brightness = PWMLED_BRIGHTNESS(0, 1, 0, 0, 1);
+ else
+ brightness = PWMLED_BRIGHTNESS(1, 3, 2, 1, 3);
+ } else if (ambient_zone == 1) {
+ if (dim_mode)
+ brightness = PWMLED_BRIGHTNESS(0, 1, 0, 0, 1);
+ else
+ brightness = PWMLED_BRIGHTNESS(0, 2, 1, 0, 2);
+ } else if (ambient_zone == 2) {
+ brightness = PWMLED_BRIGHTNESS(1, 3, 2, 1, 3);
+ } else if (ambient_zone == 3) {
+ brightness = PWMLED_BRIGHTNESS(2, 4, 2, 2, 4);
+ }
+
+ pwmled_set_brightness(brightness);
+}