implement static test start and stop protocol for telefiretwo+telebt

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

diff --git a/src/drivers/ao_lco.c b/src/drivers/ao_lco.c
index e2039604e81190832ed6ea618755aa04270de3ad..e1806ca394f95815c84838b3f4fafdefd07d9538 100644 (file)
--- a/src/drivers/ao_lco.c
+++ b/src/drivers/ao_lco.c
@@ -3,7 +3,8 @@
  *
  * This program is free software; you can redistribute it and/or modify
  * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; version 2 of the License.
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
  *
  * This program is distributed in the hope that it will be useful, but
  * WITHOUT ANY WARRANTY; without even the implied warranty of
@@ -39,6 +40,9 @@ static uint8_t        ao_lco_debug;
 #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
+
 static uint8_t ao_lco_min_box, ao_lco_max_box;
 static uint8_t ao_lco_selected[AO_PAD_MAX_BOXES];
 static uint8_t ao_lco_valid[AO_PAD_MAX_BOXES];
@@ -488,10 +492,10 @@ ao_lco_get_channels(uint8_t box, struct ao_pad_query *query)
        r = ao_lco_query(box, query, &ao_lco_tick_offset[box]);
        if (r == AO_RADIO_CMAC_OK) {
                ao_lco_channels[box] = query->channels;
-               ao_lco_valid[box] = 1;
+               ao_lco_valid[box] = AO_LCO_VALID_LAST | AO_LCO_VALID_EVER;
        } else
-               ao_lco_valid[box] = 0;
-       PRINTD("ao_lco_get_channels(%d) rssi %d valid %d ret %d\n", box, ao_radio_cmac_rssi, ao_lco_valid[box], r);
+               ao_lco_valid[box] &= ~AO_LCO_VALID_LAST;
+       PRINTD("ao_lco_get_channels(%d) rssi %d valid %d ret %d offset %d\n", box, ao_radio_cmac_rssi, ao_lco_valid[box], r, ao_lco_tick_offset[box]);
        ao_wakeup(&ao_pad_query);
        return ao_lco_valid[box];
 }
@@ -502,8 +506,8 @@ ao_lco_update(void)
        if (ao_lco_box != AO_LCO_BOX_DRAG) {
                uint8_t previous_valid = ao_lco_valid[ao_lco_box];
 
-               if (ao_lco_get_channels(ao_lco_box, &ao_pad_query)) {
-                       if (!previous_valid) {
+               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 != 0)
                                        ao_lco_pad = ao_lco_pad_first(ao_lco_box);
                                ao_lco_set_display();
@@ -537,7 +541,6 @@ ao_lco_box_set_present(uint8_t box)
 static void
 ao_lco_search(void)
 {
-       uint16_t        tick_offset;
        int8_t          r;
        int8_t          try;
        uint8_t         box;
@@ -549,9 +552,9 @@ ao_lco_search(void)
                if ((box % 10) == 0)
                        ao_lco_set_box(box);
                for (try = 0; try < 3; try++) {
-                       tick_offset = 0;
-                       r = ao_lco_query(box, &ao_pad_query, &tick_offset);
-                       PRINTD("box %d result %d\n", box, r);
+                       ao_lco_tick_offset[box] = 0;
+                       r = ao_lco_query(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) {
                                ++boxes;
                                ao_lco_box_set_present(box);
@@ -585,7 +588,7 @@ ao_lco_igniter_status(void)
                        for (c = 0; c < AO_LED_CONTINUITY_NUM; c++)
                                ao_led_off(continuity_led[c]);
                } else {
-                       if (!ao_lco_valid[ao_lco_box]) {
+                       if (!(ao_lco_valid[ao_lco_box] & AO_LCO_VALID_LAST)) {
                                ao_led_on(AO_LED_RED);
                                ao_led_off(AO_LED_GREEN|AO_LED_AMBER);
                                continue;
@@ -658,7 +661,7 @@ ao_lco_monitor(void)
                       ao_lco_armed, ao_lco_firing);
 
                if (ao_lco_armed && ao_lco_firing) {
-                       ao_lco_ignite();
+                       ao_lco_ignite(AO_PAD_FIRE);
                } else {
                        ao_lco_update();
                        if (ao_lco_armed) {
@@ -666,8 +669,10 @@ ao_lco_monitor(void)
                                        if (ao_lco_selected[box]) {
                                                PRINTD("Arming box %d pads %x\n",
                                                       box, ao_lco_selected[box]);
-                                               if (ao_lco_valid[box])
+                                               if (ao_lco_valid[box] & AO_LCO_VALID_EVER) {
                                                        ao_lco_arm(box, ao_lco_selected[box], ao_lco_tick_offset[box]);
+                                                       ao_delay(AO_MS_TO_TICKS(10));
+                                               }
                                        }
                                }
                        }