#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 }
+ { 1, D_8 },
+ PATTERN_END
};
static pattern_t on2_pattern [] = {
- { 2, PATTERN_FOREVER }
+ { 2, D_8 },
+ PATTERN_END
};
static pattern_t on3_pattern [] = {
- { 3, PATTERN_FOREVER }
+ { 3, D_8 },
+ PATTERN_END
+};
+
+static pattern_t brake_pattern [] = {
+ { 4, D_2 },
+ { 3, 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 },
+ { 2, D_1 },
+ { 0, D_1 },
+ { 2, D_1 },
+ { 0, D_8 },
+ { 1, D_1 },
+ { 0, D_1 },
+ { 1, D_1 },
+ { 0, 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 },
+ { 3, D_1 },
+ { 0, D_1 },
+ { 3, D_1 },
+ { 0, D_8 },
+ { 1, D_1 },
+ { 0, D_1 },
+ { 1, D_1 },
+ { 0, 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 },
+ { 4, D_1 },
+ { 0, D_1 },
+ { 4, D_1 },
+ { 0, D_8 },
+ { 1, D_1 },
+ { 0, D_1 },
+ { 1, D_1 },
+ { 0, D_8 },
PATTERN_END
};
static pattern_t slow1_pattern[] = {
- { 1, 0x01 },
- { 0, 0x10 },
+ { 1, D_1 },
+ { 0, D_13 },
PATTERN_END
};
static pattern_t slow2_pattern[] = {
- { 2, 0x01 },
- { 0, 0x10 },
+ { 2, D_1 },
+ { 0, D_13 },
PATTERN_END
};
static pattern_t slow3_pattern[] = {
- { 3, 0x01 },
- { 0, 0x10 },
+ { 3, D_1 },
+ { 0, D_13 },
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_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()
pattern_t *pwmled0_pattern_select()
{
- // TODO: battery critical
-
-#ifndef TESTING_FW
- return normal3_pattern;
-#endif
+ 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 : on1_pattern;
- case 1: return dim_mode ? NULL : slow2_pattern;
- case 2: return dim_mode ? slow3_pattern : slow2_pattern;
+ 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()
{
- // TODO: battery critical
-
#ifndef TESTING_FW
- return off_pattern;
+ return NULL;
+#else
+ if (battery_critical)
+ return on1_pattern;
#endif
+
if (towbar_mode) {
switch (ambient_zone) {
case 0:
pattern_t *pwmled2_pattern_select()
{
- // TODO: battery critical
-
#ifndef TESTING_FW
- return on3_pattern;
+ 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;
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(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(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;
+}