From 004b6f8d1c4e73883032f74e20d581dd080a386e Mon Sep 17 00:00:00 2001 From: "Jan \"Yenya\" Kasprzak" Date: Fri, 26 Apr 2013 23:33:47 +0200 Subject: [PATCH] Imported control.c from http://www.fi.muni.cz/~kas/bike-lights/ Git repository as of commit c30006aaf666f7cff3a6ab949c613c2f8cc6163b --- projects/step-up/control.c | 254 +++++++++++++++++++++++++++++++++++++ 1 file changed, 254 insertions(+) create mode 100644 projects/step-up/control.c diff --git a/projects/step-up/control.c b/projects/step-up/control.c new file mode 100644 index 0000000..da59972 --- /dev/null +++ b/projects/step-up/control.c @@ -0,0 +1,254 @@ +#include +#include // for NULL + +#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 }, + PATTERN_END +}; + +pattern_t on1_pattern [] = { + { 1, 0x10 }, + PATTERN_END +}; + +static pattern_t on2_pattern [] = { + { 2, 0x10 }, + PATTERN_END +}; + +static pattern_t on3_pattern [] = { + { 3, 0x10 }, + PATTERN_END +}; + +static pattern_t brake_pattern [] = { + { 4, 0x2 }, + { 3, 0x8 }, + PATTERN_END +}; + +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 }, + 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 }, + PATTERN_END +}; + +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_PWMLEDS, status_led_pattern_select()); + led_set_pattern(0, pwmled0_pattern_select()); +} + +void brake_off() +{ + braking = 0; + gpio_set(0, 0); + led_set_pattern(N_PWMLEDS, status_led_pattern_select()); + led_set_pattern(0, pwmled0_pattern_select()); +} + +void toggle_dim_mode() +{ + dim_mode = !dim_mode; + pattern_reload(); +} + +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); +} + +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; + } +} + +pattern_t *pwmled1_pattern_select() +{ +#ifndef TESTING_FW + return NULL; +#else + if (battery_critical) + return on1_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() +{ +#ifndef TESTING_FW + 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; + case 2: + case 3: + default: + return dim_mode ? slow2_pattern : normal3_pattern; + } +} + +pattern_t *status_led_pattern_select() +{ + if (braking) + return on1_pattern; + + if (buttons_setup_in_progress()) + return buttons_setup_status0_pattern_select(); + + // FIXME: do something sane + return number_pattern(battery_gauge(), 0); +} + +pattern_t *illumination_led_pattern_select() +{ + if (battery_critical) + return NULL; + + switch (ambient_zone) { + case 0: return dim_mode + ? number_pattern(1, 1) + : on1_pattern; + case 1: return dim_mode + ? number_pattern(2, 1) + : number_pattern(3, 1); + case 2: return dim_mode + ? number_pattern(1, 0) + : number_pattern(2, 0); + case 3: + default: return dim_mode + ? 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; +} -- 2.39.3