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=efc61ad2498d4a240d31a64415b545a0946769b9;hp=eb35aca947ba3be71a0b2b53bb58d96e5e7ad7cd;hb=ea3a89b1a1e089f72fc7a5a7a9cc9f46cf666faa;hpb=9a376291d21ae17ba19b72be055534f425d24431 diff --git a/firmware/control.c b/firmware/control.c index eb35aca..efc61ad 100644 --- a/firmware/control.c +++ b/firmware/control.c @@ -4,103 +4,96 @@ #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 }, + { 3, D_1 }, // FIXME: will be 4, but let's be safe while testing + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, + { 3, D_1 }, + { 0, D_1 }, PATTERN_END }; -pattern_t on1_pattern [] = { - { 1, PATTERN_FOREVER } -}; - -static pattern_t on2_pattern [] = { - { 2, PATTERN_FOREVER } -}; - -static pattern_t on3_pattern [] = { - { 3, PATTERN_FOREVER } -}; - -static pattern_t normal2_pattern[] = { - { 2, 0x1 }, - { 0, 0x1 }, - { 2, 0x1 }, - { 0, 0x8 }, - { 1, 0x1 }, - { 0, 0x1 }, - { 1, 0x1 }, - { 0, 0x8 }, - PATTERN_END -}; - -static pattern_t normal3_pattern[] = { - { 3, 0x1 }, - { 0, 0x1 }, - { 3, 0x1 }, - { 0, 0x8 }, - { 1, 0x1 }, - { 0, 0x1 }, - { 1, 0x1 }, - { 0, 0x8 }, +static pattern_t brake_pattern [] = { + { 4, D_2 }, + { 3, D_8 }, PATTERN_END }; -static pattern_t normal4_pattern[] = { - { 4, 0x1 }, - { 0, 0x1 }, - { 4, 0x1 }, - { 0, 0x8 }, - { 1, 0x1 }, - { 0, 0x1 }, - { 1, 0x1 }, - { 0, 0x8 }, +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 slow1_pattern[] = { - { 1, 0x01 }, - { 0, 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 slow2_pattern[] = { - { 2, 0x01 }, - { 0, 0x10 }, +static pattern_t night_pattern[] = { + { PWM_PAT(2, 0, 2), D_3 }, + { PWM_PAT(3, 0, 0), D_8 }, + { PWM_PAT(2, 0, 2), D_1 }, + { PWM_PAT(3, 0, 0), D_2 }, + { PWM_PAT(2, 0, 2), D_1 }, + { PWM_PAT(3, 0, 0), D_8 }, PATTERN_END }; -static pattern_t slow3_pattern[] = { - { 3, 0x01 }, - { 0, 0x10 }, +pattern_t on_pattern[] = { + { 1, D_8 }, PATTERN_END }; -static unsigned char dim_mode, towbar_mode; +static unsigned char dim_mode, towbar_mode, braking; void init_control() { dim_mode = 0; towbar_mode = 0; + braking = 0; +} + +void brake_on() +{ + braking = 1; + gpio_set(0, 1); + led_set_pattern(N_STATUS_LED, status_led_pattern_select()); + led_set_pattern(0, pwmled_pattern_select()); +} + +void brake_off() +{ + braking = 0; + gpio_set(0, 0); + led_set_pattern(N_STATUS_LED, status_led_pattern_select()); + led_set_pattern(0, pwmled_pattern_select()); } void toggle_dim_mode() @@ -111,105 +104,69 @@ void toggle_dim_mode() void set_panic_mode() { - if (!dim_mode) - led_set_pattern(0, panic_pattern); - - led_set_pattern(1, panic_pattern); - led_set_pattern(2, panic_pattern); - led_set_pattern(4, panic_pattern); + led_set_pattern(0, panic_pattern); + led_set_pattern(N_ILLUM_LED, panic_pattern); } -pattern_t *pwmled0_pattern_select() +pattern_t *pwmled_pattern_select() { - // TODO: battery critical - -#ifndef TESTING_FW - return normal3_pattern; -#endif + if (battery_critical) + return slow_pattern; if (towbar_mode) return NULL; - switch (ambient_zone) { - case 0: return dim_mode ? NULL : on1_pattern; - case 1: return dim_mode ? NULL : slow2_pattern; - case 2: return dim_mode ? slow3_pattern : slow2_pattern; - case 3: - default: return dim_mode ? slow3_pattern : normal4_pattern; - } -} - -pattern_t *pwmled1_pattern_select() -{ - // TODO: battery critical - -#ifndef TESTING_FW - return off_pattern; -#endif - 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() -{ - // TODO: battery critical + if (braking) + return brake_pattern; -#ifndef TESTING_FW - return on3_pattern; -#endif 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 on_pattern; + if (buttons_setup_in_progress()) return buttons_setup_status0_pattern_select(); // FIXME: do something sane - return number_pattern(1 + ambient_zone, 0); + return number_pattern(battery_gauge(), 0); } pattern_t *illumination_led_pattern_select() { - // todo: battery critical + if (battery_critical) + return NULL; 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); case 2: return dim_mode - ? number_pattern(3, 0) - : number_pattern(4, 0); + ? number_pattern(1, 0) + : number_pattern(2, 0); case 3: default: return dim_mode - ? number_pattern(5, 0) - : number_pattern(6, 0); + ? number_pattern(3, 0) + : number_pattern(4, 0); } } +pattern_t *laser_pattern_select() +{ + if (!dim_mode && ambient_zone <= 1) + return number_pattern(2, 1); + else + return NULL; +}