Merge branch 'master' of ssh://git.gag.com/scm/git/fw/altos

[fw/altos] / src / drivers / ao_lco.c

diff --git a/src/drivers/ao_lco.c b/src/drivers/ao_lco.c
index 6b270042521cb0d0e0f6e224b6438ce93b069b09..5f5db572c31eb29aa1596d00f34f502e5c8039fd 100644 (file)
--- a/src/drivers/ao_lco.c
+++ b/src/drivers/ao_lco.c
@@ -34,19 +34,16 @@
 #define AO_LCO_DRAG_RACE_START_TIME    AO_SEC_TO_TICKS(5)
 #define AO_LCO_DRAG_RACE_STOP_TIME     AO_SEC_TO_TICKS(2)
 
-#define AO_LCO_VALID_LAST      1
-#define AO_LCO_VALID_EVER      2
+#define AO_LCO_BOX_DRAG                0x1000
 
 /* UI values */
 static uint16_t        ao_lco_fire_tick;
 static uint8_t ao_lco_fire_down;
 
-#define AO_LCO_BOX_DRAG                0x1000
-
 static uint8_t ao_lco_display_mutex;
 
 void
-ao_lco_set_pad(uint8_t pad)
+ao_lco_show_pad(uint8_t pad)
 {
        ao_mutex_get(&ao_lco_display_mutex);
        ao_seven_segment_set(AO_LCO_PAD_DIGIT, pad | (ao_lco_drag_race << 4));
@@ -71,7 +68,7 @@ ao_lco_set_pad(uint8_t pad)
                                 (0 << 6))
 
 void
-ao_lco_set_box(uint16_t box)
+ao_lco_show_box(uint16_t box)
 {
        ao_mutex_get(&ao_lco_display_mutex);
        if (box == AO_LCO_BOX_DRAG) {
@@ -84,8 +81,8 @@ ao_lco_set_box(uint16_t box)
        ao_mutex_put(&ao_lco_display_mutex);
 }
 
-void
-ao_lco_set_voltage(uint16_t decivolts)
+static void
+ao_lco_show_voltage(uint16_t decivolts)
 {
        uint8_t tens, ones, tenths;
 
@@ -100,16 +97,16 @@ ao_lco_set_voltage(uint16_t decivolts)
 }
 
 void
-ao_lco_set_display(void)
+ao_lco_show(void)
 {
-       if (ao_lco_pad == 0 && ao_lco_box != AO_LCO_BOX_DRAG) {
-               ao_lco_set_voltage(ao_pad_query.battery);
+       if (ao_lco_pad == AO_LCO_PAD_VOLTAGE && ao_lco_box != AO_LCO_BOX_DRAG) {
+               ao_lco_show_voltage(ao_pad_query.battery);
        } else {
                if (ao_lco_box == AO_LCO_BOX_DRAG)
-                       ao_lco_set_pad(ao_lco_drag_race);
+                       ao_lco_show_pad(ao_lco_drag_race);
                else
-                       ao_lco_set_pad(ao_lco_pad);
-               ao_lco_set_box(ao_lco_box);
+                       ao_lco_show_pad(ao_lco_pad);
+               ao_lco_show_box(ao_lco_box);
        }
 }
 
@@ -210,13 +207,7 @@ ao_lco_step_box(int8_t dir)
                if (new_box == ao_lco_box)
                        break;
        } while (!ao_lco_box_present(new_box));
-       if (ao_lco_box != new_box) {
-               ao_lco_box = new_box;
-               ao_lco_pad = 1;
-               if (ao_lco_box != AO_LCO_BOX_DRAG)
-                       ao_lco_channels[ao_lco_box] = 0;
-               ao_lco_set_display();
-       }
+       ao_lco_set_box(new_box);
 }
 
 static void
@@ -299,7 +290,7 @@ ao_lco_batt_voltage(void)
 
        ao_adc_single_get(&packet);
        decivolt = ao_battery_decivolt(packet.v_batt);
-       ao_lco_set_voltage(decivolt);
+       ao_lco_show_voltage(decivolt);
        ao_delay(AO_MS_TO_TICKS(1000));
 }
 #endif
@@ -328,12 +319,12 @@ ao_lco_main(void)
 void
 ao_lco_set_debug(void)
 {
-       ao_cmd_decimal();
+       uint16_t r  = ao_cmd_decimal();
        if (ao_cmd_status == ao_cmd_success)
-               ao_lco_debug = ao_cmd_lex_i != 0;
+               ao_lco_debug = r != 0;
 }
 
-__code struct ao_cmds ao_lco_cmds[] = {
+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" },
        { 0, NULL }