2 #include <stdlib.h> // for NULL
6 static pattern_t panic_pattern[] = {
7 { PWM_PAT(2, 0, 0), D_1 },
8 { PWM_PAT(0, 0, 2), D_1 },
9 { PWM_PAT(0, 0, 0), D_1 },
10 { PWM_PAT(2, 0, 0), D_1 },
11 { PWM_PAT(0, 0, 2), D_1 },
12 { PWM_PAT(0, 0, 0), D_1 },
13 { PWM_PAT(2, 0, 0), D_1 },
14 { PWM_PAT(0, 0, 2), D_1 },
15 { PWM_PAT(0, 0, 0), D_1 },
16 { PWM_PAT(2, 0, 0), D_1 },
17 { PWM_PAT(0, 0, 2), D_1 },
18 { PWM_PAT(0, 0, 0), D_1 },
19 { PWM_PAT(2, 0, 0), D_1 },
20 { PWM_PAT(0, 0, 2), D_1 },
21 { PWM_PAT(0, 0, 0), D_1 },
22 { PWM_PAT(2, 0, 0), D_1 },
23 { PWM_PAT(0, 0, 2), D_1 },
24 { PWM_PAT(0, 0, 0), D_1 },
25 { PWM_PAT(2, 0, 0), D_1 },
26 { PWM_PAT(0, 0, 2), D_1 },
27 { PWM_PAT(0, 0, 0), D_1 },
31 static pattern_t slow_pattern[] = {
32 { PWM_PAT(1, 0, 0), D_1 },
33 { PWM_PAT(0, 0, 1), D_1 },
34 { PWM_PAT(0, 0, 0), D_13 },
38 static pattern_t fast_pattern[] = {
39 { PWM_PAT(2, 0, 0), D_1 },
40 { PWM_PAT(0, 0, 2), D_1 },
41 { PWM_PAT(2, 0, 0), D_1 },
42 { PWM_PAT(0, 0, 2), D_1 },
43 { PWM_PAT(0, 0, 0), D_8 },
44 { PWM_PAT(1, 0, 0), D_1 },
45 { PWM_PAT(0, 0, 1), D_1 },
46 { PWM_PAT(1, 0, 0), D_1 },
47 { PWM_PAT(0, 0, 1), D_1 },
48 { PWM_PAT(0, 0, 0), D_8 },
52 static pattern_t night_pattern[] = {
53 { PWM_PAT(3, 0, 1), D_3 },
54 { PWM_PAT(2, 0, 0), D_8 },
55 { PWM_PAT(3, 0, 1), D_1 },
56 { PWM_PAT(2, 0, 0), D_2 },
57 { PWM_PAT(3, 0, 1), D_1 },
58 { PWM_PAT(2, 0, 0), D_8 },
62 pattern_t on_pattern[] = {
67 // #define TEST_PATTERN 1
69 pattern_t test_pattern[] = {
70 { PWM_PAT(1, 0, 0), D_13 },
71 { PWM_PAT(2, 0, 0), D_13 },
72 { PWM_PAT(0, 0, 1), D_13 },
73 { PWM_PAT(0, 0, 2), D_13 },
78 volatile err_flags_t err_flags;
79 static unsigned char dim_mode, towbar_mode;
85 err_flags.any_flag = 0;
87 err_flags.booting = 1;
90 pwmled_select_brightness();
95 err_flags.braking = 1;
97 led_set_pattern(N_STATUS_LED, status_led_pattern_select());
98 pwmleds_update_mode();
103 err_flags.braking = 0;
105 led_set_pattern(N_STATUS_LED, status_led_pattern_select());
106 pwmleds_update_mode();
109 void toggle_dim_mode()
111 dim_mode = !dim_mode;
112 pwmled_select_brightness();
116 void set_panic_mode()
118 // if error, clean it up
119 if (err_flags.booting)
120 err_flags.booting = 0;
121 else if (err_flags.err_pwmled2)
122 err_flags.err_pwmled2 = 0;
123 else if (err_flags.err_pwmled1)
124 err_flags.err_pwmled1 = 0;
125 else if (err_flags.err_pwmled0)
126 err_flags.err_pwmled0 = 0;
127 else if (err_flags.err_battery)
128 err_flags.err_battery = 0;
130 led_set_pattern(0, panic_pattern);
131 led_set_pattern(N_ILLUM_LED, panic_pattern);
135 pattern_t *pwmled_pattern_select()
140 if (err_flags.err_battery)
143 switch (ambient_zone) {
144 case 0: return night_pattern;
149 return dim_mode ? slow_pattern : fast_pattern;
153 pattern_t *status_led_pattern_select()
155 if (err_flags.booting)
156 return number_pattern(1, 1);
158 if (err_flags.err_pwmled2)
159 return number_pattern(5, 1);
161 if (err_flags.err_pwmled1)
162 return number_pattern(4, 1);
164 if (err_flags.err_pwmled0)
165 return number_pattern(3, 1);
167 if (err_flags.err_battery)
168 return number_pattern(2, 1);
170 if (err_flags.braking)
173 if (buttons_setup_in_progress())
174 return buttons_setup_status0_pattern_select();
176 // FIXME: do something sane
177 return number_pattern(battery_gauge(), 0);
180 pattern_t *illumination_led_pattern_select()
182 if (buttons_setup_in_progress())
183 return buttons_setup_status1_pattern_select();
185 if (err_flags.err_battery)
188 switch (ambient_zone) {
189 case 0: return dim_mode
190 ? number_pattern(1, 1)
192 case 1: return dim_mode
193 ? number_pattern(2, 1)
194 : number_pattern(3, 1);
195 case 2: return dim_mode
196 ? number_pattern(1, 0)
197 : number_pattern(2, 0);
199 default: return dim_mode
200 ? number_pattern(3, 0)
201 : number_pattern(4, 0);
205 pattern_t *laser_pattern_select()
207 if (!dim_mode && ambient_zone <= 1)
208 return number_pattern(2, 1);
213 void pwmled_select_brightness()
215 uint16_t brightness = PWMLED_BRIGHTNESS(0, 2, 1, 0, 2); // default
217 if (err_flags.err_battery) {
218 brightness = PWMLED_BRIGHTNESS(0, 0, 0, 0, 0);
219 } else if (ambient_zone == 0) {
221 brightness = PWMLED_BRIGHTNESS(0, 1, 0, 0, 1);
223 brightness = PWMLED_BRIGHTNESS(1, 3, 2, 1, 3);
224 } else if (ambient_zone == 1) {
226 brightness = PWMLED_BRIGHTNESS(0, 1, 0, 0, 1);
228 brightness = PWMLED_BRIGHTNESS(0, 2, 1, 0, 2);
229 } else if (ambient_zone == 2) {
230 brightness = PWMLED_BRIGHTNESS(1, 3, 2, 1, 3);
231 } else if (ambient_zone == 3) {
232 brightness = PWMLED_BRIGHTNESS(2, 4, 2, 2, 4);
235 pwmled_set_brightness(brightness);