X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Ftelelco-v2.0%2Fao_lco_v2.c;h=1238d72f01dae3316ab352d00d47ad558fe12fce;hb=HEAD;hp=428b1a7c9594566814ff49865e14540b1b50ca12;hpb=c6e57291d91f1f6c4de5c54a5cfd3eef66d9f830;p=fw%2Faltos diff --git a/src/telelco-v2.0/ao_lco_v2.c b/src/telelco-v2.0/ao_lco_v2.c index 428b1a7c..5f7352d7 100644 --- a/src/telelco-v2.0/ao_lco_v2.c +++ b/src/telelco-v2.0/ao_lco_v2.c @@ -33,16 +33,19 @@ /* UI values */ static uint8_t ao_lco_select_mode; +static uint8_t ao_lco_event_debug; + +#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) #define AO_LCO_SELECT_PAD 0 #define AO_LCO_SELECT_BOX 1 static uint8_t ao_lco_display_mutex; void -ao_lco_show_pad(uint8_t pad) +ao_lco_show_pad(int8_t pad) { ao_mutex_get(&ao_lco_display_mutex); - ao_seven_segment_set(AO_LCO_PAD_DIGIT, pad | (ao_lco_drag_race << 4)); + ao_seven_segment_set(AO_LCO_PAD_DIGIT, (uint8_t) (pad | (ao_lco_drag_race << 4))); ao_mutex_put(&ao_lco_display_mutex); } @@ -64,47 +67,78 @@ ao_lco_show_pad(uint8_t pad) (0 << 6)) void -ao_lco_show_box(uint16_t box) +ao_lco_show_box(int16_t box) { ao_mutex_get(&ao_lco_display_mutex); - ao_seven_segment_set(AO_LCO_BOX_DIGIT_1, box % 10 | (ao_lco_drag_race << 4)); - ao_seven_segment_set(AO_LCO_BOX_DIGIT_10, box / 10 | (ao_lco_drag_race << 4)); + ao_seven_segment_set(AO_LCO_BOX_DIGIT_1, (uint8_t) (box % 10 | (ao_lco_drag_race << 4))); + ao_seven_segment_set(AO_LCO_BOX_DIGIT_10, (uint8_t) (box / 10 | (ao_lco_drag_race << 4))); ao_mutex_put(&ao_lco_display_mutex); } static void -ao_lco_show_voltage(uint16_t decivolts) +ao_lco_show_value(uint16_t value, uint8_t point) { - uint8_t tens, ones, tenths; + uint8_t hundreds, tens, ones; - PRINTD("voltage %d\n", decivolts); - tenths = decivolts % 10; - ones = (decivolts / 10) % 10; - tens = (decivolts / 100) % 10; + PRINTD("value %d\n", value); + ones = (uint8_t) (value % 10); + tens = (uint8_t) ((value / 10) % 10); + hundreds = (uint8_t) ((value / 100) % 10); + switch (point) { + case 2: + hundreds |= 0x10; + break; + case 1: + tens |= 0x10; + break; + case 0: + ones |= 0x10; + break; + default: + break; + } ao_mutex_get(&ao_lco_display_mutex); - ao_seven_segment_set(AO_LCO_PAD_DIGIT, tenths); - ao_seven_segment_set(AO_LCO_BOX_DIGIT_1, ones | 0x10); - ao_seven_segment_set(AO_LCO_BOX_DIGIT_10, tens); + ao_seven_segment_set(AO_LCO_PAD_DIGIT, ones); + ao_seven_segment_set(AO_LCO_BOX_DIGIT_1, tens); + ao_seven_segment_set(AO_LCO_BOX_DIGIT_10, hundreds); ao_mutex_put(&ao_lco_display_mutex); } -void -ao_lco_show(void) +static void +ao_lco_show_lco_voltage(void) { - if (ao_lco_pad == AO_LCO_PAD_VOLTAGE) { - ao_lco_show_voltage(ao_pad_query.battery); - } else { - ao_lco_show_pad(ao_lco_pad); - ao_lco_show_box(ao_lco_box); - } + struct ao_adc packet; + int16_t decivolt; + + ao_adc_single_get(&packet); + decivolt = ao_battery_decivolt(packet.v_batt); + ao_lco_show_value((uint16_t) decivolt, 1); } -uint8_t -ao_lco_box_present(uint16_t box) +void +ao_lco_show(void) { - if (box >= AO_PAD_MAX_BOXES) - return 0; - return (ao_lco_box_mask[AO_LCO_MASK_ID(box)] >> AO_LCO_MASK_SHIFT(box)) & 1; + switch (ao_lco_box) { + case AO_LCO_LCO_VOLTAGE: + ao_lco_show_lco_voltage(); + break; + default: + switch (ao_lco_pad) { + case AO_LCO_PAD_VOLTAGE: + ao_lco_show_value(ao_pad_query.battery, 1); + break; + case AO_LCO_PAD_RSSI: + if (!(ao_lco_valid[ao_lco_box] & AO_LCO_VALID_LAST)) + ao_lco_show_value(888, 0); + else + ao_lco_show_value((uint16_t) (-ao_radio_cmac_rssi), 0); + break; + default: + ao_lco_show_pad(ao_lco_pad); + ao_lco_show_box(ao_lco_box); + break; + } + } } static void @@ -129,40 +163,23 @@ ao_lco_set_select(void) } } -static void -ao_lco_step_box(int8_t dir) -{ - int16_t new_box = ao_lco_box; - - do { - new_box += dir; - if (new_box > ao_lco_max_box) - new_box = ao_lco_min_box; - else if (new_box < ao_lco_min_box) - new_box = ao_lco_max_box; - if (new_box == ao_lco_box) - break; - } while (!ao_lco_box_present(new_box)); - ao_lco_set_box(new_box); -} - static struct ao_task ao_lco_drag_task; static void ao_lco_drag_monitor(void) { - uint16_t delay = ~0; - uint16_t now; + AO_TICK_TYPE delay = ~0UL; + AO_TICK_TYPE now; ao_beep_for(AO_BEEP_MID, AO_MS_TO_TICKS(200)); for (;;) { - PRINTD("Drag monitor count %d delay %d\n", ao_lco_drag_beep_count, delay); - if (delay == (uint16_t) ~0) + PRINTD("Drag monitor count %d delay %lu\n", ao_lco_drag_beep_count, (unsigned long) delay); + if (delay == (AO_TICK_TYPE) ~0) ao_sleep(&ao_lco_drag_beep_count); else ao_sleep_for(&ao_lco_drag_beep_count, delay); - delay = ~0; + delay = ~0UL; now = ao_time(); delay = ao_lco_drag_warn_check(now, delay); delay = ao_lco_drag_beep_check(now, delay); @@ -176,8 +193,8 @@ ao_lco_input(void) for (;;) { ao_event_get(&event); - PRINTD("event type %d unit %d value %d\n", - event.type, event.unit, event.value); + PRINTE("event type %d unit %d value %ld\n", + event.type, event.unit, (long) event.value); switch (event.type) { case AO_EVENT_QUADRATURE: switch (event.unit) { @@ -200,12 +217,12 @@ ao_lco_input(void) case AO_EVENT_BUTTON: switch (event.unit) { case AO_BUTTON_ARM: - ao_lco_set_armed(event.value); + ao_lco_set_armed((uint8_t) event.value); ao_lco_set_select(); break; case AO_BUTTON_FIRE: if (ao_lco_armed) - ao_lco_set_firing(event.value); + ao_lco_set_firing((uint8_t) event.value); break; case AO_BUTTON_DRAG_SELECT: if (event.value) @@ -236,27 +253,22 @@ ao_lco_input(void) * visually inspect the system for correct operation */ static void -ao_lco_display_test() +ao_lco_display_test(void) { ao_mutex_get(&ao_lco_display_mutex); ao_seven_segment_set(AO_LCO_PAD_DIGIT, 8 | 0x10); ao_seven_segment_set(AO_LCO_BOX_DIGIT_1, 8 | 0x10); ao_seven_segment_set(AO_LCO_BOX_DIGIT_10, 8 | 0x10); ao_mutex_put(&ao_lco_display_mutex); - ao_led_on(LEDS_AVAILABLE); + ao_led_on(AO_LEDS_AVAILABLE); ao_delay(AO_MS_TO_TICKS(1000)); - ao_led_off(LEDS_AVAILABLE); + ao_led_off(AO_LEDS_AVAILABLE); } static void ao_lco_batt_voltage(void) { - struct ao_adc packet; - int16_t decivolt; - - ao_adc_single_get(&packet); - decivolt = ao_battery_decivolt(packet.v_batt); - ao_lco_show_voltage(decivolt); + ao_lco_show_lco_voltage(); ao_delay(AO_MS_TO_TICKS(1000)); } @@ -279,17 +291,20 @@ ao_lco_main(void) } #if DEBUG -void +static void ao_lco_set_debug(void) { - ao_cmd_decimal(); - if (ao_cmd_status == ao_cmd_success) - ao_lco_debug = ao_cmd_lex_i != 0; + uint32_t r = ao_cmd_decimal(); + if (ao_cmd_status == ao_cmd_success){ + ao_lco_debug = r & 1; + ao_lco_event_debug = (r & 2) >> 1; + } } const struct ao_cmds ao_lco_cmds[] = { { ao_lco_set_debug, "D <0 off, 1 on>\0Debug" }, { ao_lco_search, "s\0Search for pad boxes" }, + { ao_lco_pretend, "p\0Pretend there are lots of pad boxes" }, { 0, NULL } }; #endif