2 * Copyright © 2012 Keith Packard <keithp@keithp.com>
4 * This program is free software; you can redistribute it and/or modify
5 * it under the terms of the GNU General Public License as published by
6 * the Free Software Foundation; either version 2 of the License, or
7 * (at your option) any later version.
9 * This program is distributed in the hope that it will be useful, but
10 * WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * General Public License for more details.
14 * You should have received a copy of the GNU General Public License along
15 * with this program; if not, write to the Free Software Foundation, Inc.,
16 * 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
22 #include <ao_quadrature.h>
23 #include <ao_radio_cmac.h>
24 #include <ao_st7565.h>
25 #include <ao_adc_single.h>
28 #define WIDTH AO_ST7565_WIDTH
29 #define HEIGHT AO_ST7565_HEIGHT
30 #define STRIDE AO_BITMAP_STRIDE(WIDTH)
32 static uint32_t image[STRIDE * HEIGHT];
34 static struct ao_bitmap fb = {
39 .damage = AO_BOX_INIT,
42 static const struct ao_transform logo_transform = {
43 .x_scale = 40, .x_off = 8,
44 .y_scale = 40, .y_off = 0,
47 static const struct ao_transform show_transform = {
48 .x_scale = 36, .x_off = 100,
49 .y_scale = 36, .y_off = 0,
52 #define BIG_FONT BitstreamVeraSans_Roman_58_font
53 #define VOLT_FONT BitstreamVeraSans_Roman_58_font
54 #define SMALL_FONT BitstreamVeraSans_Roman_12_font
55 #define TINY_FONT BitstreamVeraSans_Roman_10_font
56 #define LOGO_FONT BenguiatGothicStd_Bold_24_font
58 #define LABEL_Y (int16_t) (SMALL_FONT.ascent)
59 #define VALUE_Y (int16_t) (LABEL_Y + 5 + BIG_FONT.ascent)
64 #define BOX_X (SEP_X / 2)
65 #define PAD_X ((WIDTH + SEP_X + SEP_WIDTH) / 2)
67 #define VALUE_LABEL_X 64
68 #define RSSI_LABEL_X 15
70 #define SCAN_X (WIDTH - 100) / 2
73 #define SCANNING_X (WIDTH / 2)
74 #define SCANNING_Y (SCAN_Y - 2)
77 #define FOUND_WIDTH (WIDTH - 6)
78 #define CONTRAST_LABEL_X 37
79 #define CONTRAST_WIDTH 100
80 #define CONTRAST_X (WIDTH - CONTRAST_WIDTH) / 2
82 #define CONTRAST_HEIGHT 20
83 #define CONTRAST_VALUE_X 64
84 #define CONTRAST_VALUE_Y (CONTRAST_Y + CONTRAST_HEIGHT + SMALL_FONT.ascent + 3)
85 #define BACKLIGHT_LABEL_X 37
86 #define BACKLIGHT_WIDTH 100
87 #define BACKLIGHT_X (WIDTH - BACKLIGHT_WIDTH) / 2
88 #define BACKLIGHT_Y 20
89 #define BACKLIGHT_HEIGHT 20
90 #define BACKLIGHT_VALUE_X 64
91 #define BACKLIGHT_VALUE_Y (BACKLIGHT_Y + BACKLIGHT_HEIGHT + SMALL_FONT.ascent + 3)
92 #define INFO_START_Y ((int16_t) (SMALL_FONT.ascent + 2))
93 #define INFO_STEP_Y ((int16_t) (SMALL_FONT.ascent + 3))
95 #define AO_LCO_DRAG_RACE_START_TIME AO_SEC_TO_TICKS(5)
96 #define AO_LCO_DRAG_RACE_STOP_TIME AO_SEC_TO_TICKS(2)
99 static uint8_t ao_lco_select_mode;
100 static uint8_t ao_lco_event_debug;
102 #define PRINTE(...) do { if (!ao_lco_debug && !ao_lco_event_debug) break; printf ("\r%5lu %s: ", (unsigned long) ao_tick_count, __func__); printf(__VA_ARGS__); flush(); } while(0)
103 #define AO_LCO_SELECT_BOX 0
104 #define AO_LCO_SELECT_PAD 1
106 static uint8_t ao_lco_display_mutex;
109 _ao_center_text(int16_t x, int16_t y, const struct ao_font *font, const char *str)
111 int16_t width = ao_text_width(font, str);
112 ao_text(&fb, font, x - width/2, y, str, AO_BLACK, AO_COPY);
116 _ao_lco_show_pad(int8_t pad)
120 _ao_center_text(PAD_X, LABEL_Y, &SMALL_FONT, "Pad");
121 snprintf(str, sizeof(str), "%d", pad);
122 _ao_center_text(PAD_X, VALUE_Y, &BIG_FONT, str);
126 _ao_lco_show_box(int16_t box)
130 _ao_center_text(BOX_X, LABEL_Y, &SMALL_FONT, "Bank");
131 snprintf(str, sizeof(str), "%d", box);
132 _ao_center_text(BOX_X, VALUE_Y, &BIG_FONT, str);
136 _ao_lco_show_voltage(uint16_t decivolts, const char *label)
140 PRINTD("voltage %d\n", decivolts);
141 _ao_center_text(WIDTH/2, LABEL_Y, &SMALL_FONT, label);
142 snprintf(str, sizeof(str), "%d.%d", decivolts / 10, decivolts % 10);
143 _ao_center_text(WIDTH/2, VALUE_Y, &BIG_FONT, str);
147 _ao_lco_batt_voltage(void)
149 struct ao_adc packet;
152 ao_adc_single_get(&packet);
153 decivolt = ao_battery_decivolt(packet.v_batt);
154 _ao_lco_show_voltage((uint16_t) decivolt, "LCO Battery");
155 ao_st7565_update(&fb);
159 _ao_lco_show_contrast(void)
162 uint8_t brightness = ao_st7565_get_brightness();
163 int16_t contrast = (int16_t) (brightness * CONTRAST_WIDTH / AO_LCO_MAX_CONTRAST);
165 _ao_center_text(WIDTH/2, LABEL_Y, &SMALL_FONT, "Contrast");
166 ao_rect(&fb, CONTRAST_X, CONTRAST_Y, contrast, CONTRAST_HEIGHT, AO_BLACK, AO_COPY);
167 snprintf(buf, sizeof(buf), "%d %%", brightness * 100 / AO_LCO_MAX_CONTRAST);
168 _ao_center_text(WIDTH/2, CONTRAST_VALUE_Y, &SMALL_FONT, buf);
172 _ao_lco_show_backlight(void)
175 int32_t backlight = ao_lco_get_backlight();
176 int16_t value = (int16_t) (backlight * BACKLIGHT_WIDTH / AO_LCO_MAX_BACKLIGHT);
178 _ao_center_text(WIDTH/2, LABEL_Y, &SMALL_FONT, "Backlight");
179 ao_rect(&fb, BACKLIGHT_X, BACKLIGHT_Y, value, BACKLIGHT_HEIGHT, AO_BLACK, AO_COPY);
180 snprintf(buf, sizeof(buf), "%ld %%", backlight * 100 / AO_LCO_MAX_BACKLIGHT);
181 _ao_center_text(WIDTH/2, BACKLIGHT_VALUE_Y, &SMALL_FONT, buf);
184 static int16_t info_y;
187 _ao_lco_info(const char *format, ...)
192 vsnprintf(buf, sizeof(buf), format, a);
194 ao_text(&fb, &SMALL_FONT, 0, info_y, buf, AO_BLACK, AO_COPY);
195 info_y += INFO_STEP_Y;
199 _ao_lco_show_info(void)
201 info_y = INFO_START_Y;
202 ao_logo_poly(&fb, &show_transform, AO_BLACK, AO_COPY);
203 _ao_lco_info("%s", ao_product);
204 _ao_lco_info("Serial: %d", ao_serial_number);
205 _ao_lco_info("Version: %s", ao_version);
206 _ao_lco_info("Callsign: %s", ao_config.callsign);
207 _ao_lco_info("Frequency: %ld.%03d",
208 ao_config.frequency / 1000,
209 (int) (ao_config.frequency % 1000));
213 _ao_lco_show_rssi(void)
217 snprintf(label, sizeof(label), "Bank %d RSSI", ao_lco_box);
218 width = ao_text_width(&SMALL_FONT, label);
219 ao_text(&fb, &SMALL_FONT, VALUE_LABEL_X - width / 2, LABEL_Y, label, AO_BLACK, AO_COPY);
220 if (!(ao_lco_valid[ao_lco_box] & AO_LCO_VALID_LAST))
221 strcpy(label, "---");
223 snprintf(label, sizeof(label), "%d", ao_radio_cmac_rssi);
224 width = ao_text_width(&VOLT_FONT, label);
225 ao_text(&fb, &VOLT_FONT, VALUE_LABEL_X - width / 2, VALUE_Y, label, AO_BLACK, AO_COPY);
229 _ao_lco_show_pad_battery(void)
232 snprintf(label, sizeof(label), "Bank %d Battery", ao_lco_box);
233 _ao_lco_show_voltage(ao_pad_query.battery, label);
239 ao_mutex_get(&ao_lco_display_mutex);
240 ao_rect(&fb, 0, 0, WIDTH, HEIGHT, AO_WHITE, AO_COPY);
241 switch (ao_lco_box) {
242 case AO_LCO_LCO_VOLTAGE:
243 _ao_lco_batt_voltage();
245 case AO_LCO_CONTRAST:
246 _ao_lco_show_contrast();
248 case AO_LCO_BACKLIGHT:
249 _ao_lco_show_backlight();
255 switch (ao_lco_pad) {
256 case AO_LCO_PAD_RSSI:
259 case AO_LCO_PAD_VOLTAGE:
260 _ao_lco_show_pad_battery();
263 _ao_lco_show_pad(ao_lco_pad);
264 _ao_lco_show_box(ao_lco_box);
265 ao_rect(&fb, SEP_X, 0, SEP_WIDTH, HEIGHT, AO_BLACK, AO_COPY);
269 ao_st7565_update(&fb);
270 ao_mutex_put(&ao_lco_display_mutex);
274 ao_lco_set_select(void)
277 ao_led_off(AO_LED_PAD);
278 ao_led_off(AO_LED_BOX);
280 switch (ao_lco_select_mode) {
281 case AO_LCO_SELECT_PAD:
282 ao_led_off(AO_LED_BOX);
283 ao_led_on(AO_LED_PAD);
285 case AO_LCO_SELECT_BOX:
286 ao_led_off(AO_LED_PAD);
287 ao_led_on(AO_LED_BOX);
297 ao_lco_set_contrast(int32_t contrast)
299 ao_st7565_set_brightness((uint8_t) contrast);
303 ao_lco_get_contrast(void)
305 return (int32_t) ao_st7565_get_brightness();
308 static uint16_t ao_backlight;
311 ao_lco_set_backlight(int32_t backlight)
313 ao_backlight = (uint16_t) backlight;
314 ao_pwm_set(AO_LCD_BL_PWM_CHAN, ao_backlight);
318 ao_lco_get_backlight(void)
320 return (int32_t) ao_backlight;
323 static struct ao_task ao_lco_drag_task;
326 ao_lco_drag_monitor(void)
328 AO_TICK_TYPE delay = ~0UL;
331 ao_beep_for(AO_BEEP_MID, AO_MS_TO_TICKS(200));
333 PRINTD("Drag monitor count %d delay %lu\n", ao_lco_drag_beep_count, (unsigned long) delay);
334 if (delay == (AO_TICK_TYPE) ~0)
335 ao_sleep(&ao_lco_drag_beep_count);
337 ao_sleep_for(&ao_lco_drag_beep_count, delay);
341 delay = ao_lco_drag_warn_check(now, delay);
342 delay = ao_lco_drag_beep_check(now, delay);
349 static struct ao_event event;
352 ao_event_get(&event);
353 PRINTE("event type %d unit %d value %ld\n",
354 event.type, event.unit, (long) event.value);
355 switch (event.type) {
356 case AO_EVENT_QUADRATURE:
357 switch (event.unit) {
358 case AO_QUADRATURE_SELECT:
360 switch (ao_lco_select_mode) {
361 case AO_LCO_SELECT_PAD:
362 ao_lco_step_pad((int8_t) event.value);
364 case AO_LCO_SELECT_BOX:
365 ao_lco_step_box((int8_t) event.value);
374 case AO_EVENT_BUTTON:
375 switch (event.unit) {
377 ao_lco_set_armed((uint8_t) event.value);
382 ao_lco_set_firing((uint8_t) event.value);
384 case AO_BUTTON_DRAG_SELECT:
386 ao_lco_toggle_drag();
388 case AO_BUTTON_DRAG_MODE:
390 ao_lco_drag_enable();
392 ao_lco_drag_disable();
394 case AO_BUTTON_ENCODER_SELECT:
397 ao_lco_select_mode = 1 - ao_lco_select_mode;
409 * Light up everything for a second at power on to let the user
410 * visually inspect the system for correct operation
413 ao_lco_display_test(void)
415 ao_led_on(AO_LEDS_AVAILABLE);
416 ao_rect(&fb, 0, 0, WIDTH, HEIGHT, AO_BLACK, AO_COPY);
417 ao_st7565_update(&fb);
418 ao_delay(AO_MS_TO_TICKS(1000));
419 ao_led_off(AO_LEDS_AVAILABLE);
422 static struct ao_task ao_lco_input_task;
423 static struct ao_task ao_lco_monitor_task;
424 static struct ao_task ao_lco_arm_warn_task;
425 static struct ao_task ao_lco_igniter_status_task;
427 static int16_t found_width;
429 static int16_t found_boxes[MAX_FOUND];
430 static uint8_t nfound;
433 ao_lco_search_start(void)
435 ao_rect(&fb, 0, 0, WIDTH, HEIGHT, AO_WHITE, AO_COPY);
436 ao_logo(&fb, &logo_transform, &LOGO_FONT, AO_BLACK, AO_COPY);
437 _ao_center_text(SCANNING_X, SCANNING_Y, &TINY_FONT, "Scanning...");
443 ao_lco_search_box_check(int16_t box)
446 ao_rect(&fb, SCAN_X, SCAN_Y, box, SCAN_HEIGHT, AO_BLACK, AO_COPY);
447 ao_st7565_update(&fb);
451 ao_lco_search_box_present(int16_t box)
455 int16_t box_top = FOUND_Y - TINY_FONT.ascent;
459 snprintf(str, sizeof(str), "%s%u", nfound ? ", " : "", box);
460 width = ao_text_width(&TINY_FONT, str);
461 while (found_width + width > FOUND_WIDTH || nfound == MAX_FOUND)
463 snprintf(str, sizeof(str), "%u, ", found_boxes[0]);
464 found_width -= ao_text_width(&TINY_FONT, str);
465 memmove(&found_boxes[0], &found_boxes[1], (nfound - 1) * sizeof (int16_t));
468 found_boxes[nfound++] = box;
470 ao_rect(&fb, FOUND_X, FOUND_Y - TINY_FONT.ascent, FOUND_WIDTH, HEIGHT - box_top, AO_WHITE, AO_COPY);
472 for (n = 0; n < nfound; n++) {
473 snprintf(str, sizeof(str), "%s%u", n ? ", " : "", found_boxes[n]);
474 int16_t next_x = ao_text(&fb, &TINY_FONT, x, FOUND_Y, str, AO_BLACK, AO_COPY);
477 found_width = x - FOUND_X;
481 ao_lco_search_done(void)
483 ao_st7565_update(&fb);
489 ao_lco_display_test();
491 ao_add_task(&ao_lco_input_task, ao_lco_input, "lco input");
492 ao_add_task(&ao_lco_arm_warn_task, ao_lco_arm_warn, "lco arm warn");
493 ao_add_task(&ao_lco_igniter_status_task, ao_lco_igniter_status, "lco igniter status");
494 ao_add_task(&ao_lco_drag_task, ao_lco_drag_monitor, "drag race");
500 ao_lco_set_debug(void)
502 uint32_t r = ao_cmd_decimal();
503 if (ao_cmd_status == ao_cmd_success){
504 ao_lco_debug = r & 1;
505 ao_lco_event_debug = (r & 2) >> 1;
509 const struct ao_cmds ao_lco_cmds[] = {
510 { ao_lco_set_debug, "D <0 off, 1 on>\0Debug" },
511 { ao_lco_search, "s\0Search for pad boxes" },
512 { ao_lco_pretend, "p\0Pretend there are lots of pad boxes" },
520 ao_add_task(&ao_lco_monitor_task, ao_lco_main, "lco monitor");
522 ao_cmd_register(&ao_lco_cmds[0]);