X-Git-Url: https://www.fi.muni.cz/~kas/git//home/kas/public_html/git/?p=bike-lights.git;a=blobdiff_plain;f=firmware%2Fcontrol.c;h=73f5e8ee02ee5ce7ce9ad5da593274dbdbc7f6b6;hp=007a0c2883ff87d494c58192048e05615846b22f;hb=3e13c7f4abd65b939c1645d77cf6ed5e0124808e;hpb=1e3c9f876c88582e3da20a51f43d340c40c372ab diff --git a/firmware/control.c b/firmware/control.c index 007a0c2..73f5e8e 100644 --- a/firmware/control.c +++ b/firmware/control.c @@ -4,207 +4,174 @@ #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, 0x10 }, +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, 0x10 }, +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, 0x10 }, +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 normal2_pattern[] = { - { 2, 0x1 }, - { 0, 0x1 }, - { 2, 0x1 }, - { 0, 0x8 }, - { 1, 0x1 }, - { 0, 0x1 }, - { 1, 0x1 }, - { 0, 0x8 }, +pattern_t on_pattern[] = { + { 1, D_8 }, PATTERN_END }; -static pattern_t normal3_pattern[] = { - { 3, 0x1 }, - { 0, 0x1 }, - { 3, 0x1 }, - { 0, 0x8 }, - { 1, 0x1 }, - { 0, 0x1 }, - { 1, 0x1 }, - { 0, 0x8 }, - PATTERN_END -}; - -static pattern_t normal4_pattern[] = { - { 4, 0x1 }, - { 0, 0x1 }, - { 4, 0x1 }, - { 0, 0x8 }, - { 1, 0x1 }, - { 0, 0x1 }, - { 1, 0x1 }, - { 0, 0x8 }, - PATTERN_END -}; - -static pattern_t slow1_pattern[] = { - { 1, 0x01 }, - { 0, 0x10 }, - PATTERN_END -}; - -static pattern_t slow2_pattern[] = { - { 2, 0x01 }, - { 0, 0x10 }, - PATTERN_END -}; - -static pattern_t slow3_pattern[] = { - { 3, 0x01 }, - { 0, 0x10 }, +// #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; + 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()); - // TODO brighten rear light + 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()); - // TODO dim rear light + 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; - - switch (ambient_zone) { - case 0: return dim_mode ? NULL : on3_pattern; - case 1: return dim_mode ? NULL : normal3_pattern; - case 2: return dim_mode ? slow3_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(); @@ -215,13 +182,19 @@ pattern_t *status_led_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); @@ -242,3 +215,28 @@ pattern_t *laser_pattern_select() 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, 2); + else + brightness = PWMLED_BRIGHTNESS(1, 3, 2, 1, 4); + } 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, 5); + } + + pwmled_set_brightness(brightness); +}