X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fdrivers%2Fao_lco_bits.c;h=ebe3d0cb2989b12ca59ca15fefd4ab2081a9dea7;hb=22b5d1a98a86ac4d2d0ef12565a01e3591f9afb9;hp=2821d1195cdd4e8b31d79567a1f21b823d51c5e1;hpb=bf7d2aaccd41837dd2e032023107616266e22a6d;p=fw%2Faltos

diff --git a/src/drivers/ao_lco_bits.c b/src/drivers/ao_lco_bits.c
index 2821d119..ebe3d0cb 100644
--- a/src/drivers/ao_lco_bits.c
+++ b/src/drivers/ao_lco_bits.c
@@ -18,7 +18,7 @@
 
 uint8_t		ao_lco_debug;
 
-uint8_t		ao_lco_pad;
+int8_t		ao_lco_pad;
 int16_t		ao_lco_box;
 
 uint8_t		ao_lco_armed;					/* arm active */
@@ -38,10 +38,7 @@ static uint8_t		ao_lco_channels[AO_PAD_MAX_BOXES];	/* pad channels available on
 static uint16_t		ao_lco_tick_offset[AO_PAD_MAX_BOXES];	/* 16 bit offset from local to remote tick count */
 static uint8_t		ao_lco_selected[AO_PAD_MAX_BOXES];	/* pads selected to fire */
 
-#define AO_LCO_VALID_LAST	1
-#define AO_LCO_VALID_EVER	2
-
-static uint8_t		ao_lco_valid[AO_PAD_MAX_BOXES];		/* AO_LCO_VALID bits per box */
+uint8_t		ao_lco_valid[AO_PAD_MAX_BOXES];		/* AO_LCO_VALID bits per box */
 
 static const AO_LED_TYPE	continuity_led[AO_LED_CONTINUITY_NUM] = {
 #ifdef AO_LED_CONTINUITY_0
@@ -142,10 +139,10 @@ ao_lco_igniter_status(void)
 }
 
 uint8_t
-ao_lco_pad_present(int16_t box, uint8_t pad)
+ao_lco_pad_present(int16_t box, int8_t pad)
 {
 	/* voltage measurement is always valid */
-	if (pad == AO_LCO_PAD_VOLTAGE)
+	if (ao_lco_pad_pseudo(pad))
 		return 1;
 	if (!ao_lco_channels[box])
 		return 0;
@@ -154,10 +151,10 @@ ao_lco_pad_present(int16_t box, uint8_t pad)
 	return (ao_lco_channels[box] >> (pad - 1)) & 1;
 }
 
-uint8_t
+int8_t
 ao_lco_pad_first(int16_t box)
 {
-	uint8_t	pad;
+	int8_t	pad;
 
 	for (pad = 1; pad <= AO_PAD_MAX_CHANNELS; pad++)
 		if (ao_lco_pad_present(box, pad))
@@ -193,10 +190,10 @@ ao_lco_update(void)
 
 	if (ao_lco_get_channels(ao_lco_box, &ao_pad_query) & AO_LCO_VALID_LAST) {
 		if (!(previous_valid & AO_LCO_VALID_EVER)) {
-			if (ao_lco_pad != AO_LCO_PAD_VOLTAGE)
+			if (!ao_lco_pad_pseudo(ao_lco_pad))
 				ao_lco_set_pad(ao_lco_pad_first(ao_lco_box));
 		}
-		if (ao_lco_pad == AO_LCO_PAD_VOLTAGE)
+		if (ao_lco_pad_pseudo(ao_lco_pad))
 			ao_lco_show();
 	}
 }
@@ -225,7 +222,7 @@ ao_lco_box_set_present(int16_t box)
 }
 
 void
-ao_lco_set_pad(uint8_t new_pad)
+ao_lco_set_pad(int8_t new_pad)
 {
 	ao_lco_pad = new_pad;
 	ao_lco_show();
@@ -305,14 +302,14 @@ ao_lco_step_pad(int8_t dir)
 		do {
 			new_pad += dir;
 			if (new_pad > AO_PAD_MAX_CHANNELS)
-				new_pad = AO_LCO_PAD_VOLTAGE;
-			if (new_pad < 0)
+				new_pad = AO_LCO_PAD_FIRST;
+			if (new_pad < AO_LCO_PAD_FIRST)
 				new_pad = AO_PAD_MAX_CHANNELS;
 			if (new_pad == ao_lco_pad)
 				break;
-		} while (!ao_lco_pad_present(ao_lco_box, (uint8_t) new_pad));
+		} while (!ao_lco_pad_present(ao_lco_box, (int8_t) new_pad));
 		PRINTD("New pad %d\n", new_pad);
-		ao_lco_set_pad((uint8_t) new_pad);
+		ao_lco_set_pad((int8_t) new_pad);
 		break;
 	}
 }
@@ -384,6 +381,26 @@ ao_lco_set_firing(uint8_t firing)
 	ao_wakeup(&ao_lco_armed);
 }
 
+#if 0
+static int16_t fake_boxes[] = {
+	1, 2, 3, 5, 8, 11, 13, 17, 19, 23, 29, 31, 37, 62, 97
+};
+#define ARRAYSIZE(a)	(sizeof(a) / sizeof((a)[0]))
+#define NFAKE ARRAYSIZE(fake_boxes)
+
+static bool
+is_fake(int16_t box)
+{
+	unsigned i;
+	for (i = 0; i < NFAKE; i++)
+		if (fake_boxes[i] == box)
+			return true;
+	return false;
+}
+#else
+#define is_fake(b)	false
+#endif
+
 void
 ao_lco_search(void)
 {
@@ -410,13 +427,13 @@ ao_lco_search(void)
 			ao_lco_tick_offset[box] = 0;
 			r = ao_lco_query((uint16_t) box, &ao_pad_query, &ao_lco_tick_offset[box]);
 			PRINTD("box %d result %d offset %d\n", box, r, ao_lco_tick_offset[box]);
-			if (r == AO_RADIO_CMAC_OK) {
+			if (r == AO_RADIO_CMAC_OK || is_fake(box)) {
 				++boxes;
 				ao_lco_box_set_present(box);
 #ifdef AO_LCO_SEARCH_API
 				ao_lco_search_box_present(box);
 #else
-				ao_lco_show_pad((uint8_t) (boxes % 10));
+				ao_lco_show_pad((int8_t) (boxes % 10));
 #endif
 				ao_delay(AO_MS_TO_TICKS(30));
 				break;
@@ -488,7 +505,7 @@ ao_lco_monitor(void)
 
 #if AO_LCO_DRAG
 
-uint8_t			ao_lco_drag_beep_count;
+int8_t			ao_lco_drag_beep_count;
 static uint8_t		ao_lco_drag_beep_on;
 static AO_TICK_TYPE	ao_lco_drag_beep_time;
 static AO_TICK_TYPE	ao_lco_drag_warn_time;
@@ -498,7 +515,7 @@ static AO_TICK_TYPE	ao_lco_drag_warn_time;
 
 /* Request 'beeps' additional drag race beeps */
 void
-ao_lco_drag_add_beeps(uint8_t beeps)
+ao_lco_drag_add_beeps(int8_t beeps)
 {
 	PRINTD("beep %d\n", beeps);
 	if (ao_lco_drag_beep_count == 0)
@@ -511,7 +528,7 @@ ao_lco_drag_add_beeps(uint8_t beeps)
 void
 ao_lco_toggle_drag(void)
 {
-	if (ao_lco_drag_race && ao_lco_pad != AO_LCO_PAD_VOLTAGE && !ao_lco_box_pseudo(ao_lco_box)) {
+	if (ao_lco_drag_race && !ao_lco_pad_pseudo(ao_lco_pad) && !ao_lco_box_pseudo(ao_lco_box)) {
 		ao_lco_selected[ao_lco_box] ^= (uint8_t) (1 << (ao_lco_pad - 1));
 		PRINTD("Toggle box %d pad %d (pads now %x) to drag race\n",
 		       ao_lco_pad, ao_lco_box, ao_lco_selected[ao_lco_box]);