X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fdrivers%2Fao_lco.c;h=5f5db572c31eb29aa1596d00f34f502e5c8039fd;hp=6b270042521cb0d0e0f6e224b6438ce93b069b09;hb=0686a7b8aec524d81bda4c572549a3a068ce0eed;hpb=c48d4b60da8b23bf358e6c14d7332d3a360c2d2f

diff --git a/src/drivers/ao_lco.c b/src/drivers/ao_lco.c
index 6b270042..5f5db572 100644
--- 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 }