altos: Start radio a fixed time after boost

[fw/altos] / src / core / ao_telemetry.c

diff --git a/src/core/ao_telemetry.c b/src/core/ao_telemetry.c
index 52ac94891adebd99f915cf97a20e95ddf171a18c..5a1b3d1d75ccfee1a72e6b2dc1a04553be26445a 100644 (file)
--- a/src/core/ao_telemetry.c
+++ b/src/core/ao_telemetry.c
@@ -283,6 +283,12 @@ ao_telemetry(void)
        while (!ao_flight_number)
                ao_sleep(&ao_flight_number);
 
+#if RADIO_DELAY_AFTER_BOOST
+       while (ao_flight_state < ao_flight_boost)
+               ao_sleep(&ao_flight_state);
+       ao_delay(AO_SEC_TO_TICKS(RADIO_DELAY_AFTER_BOOST));
+#endif
+
        telemetry.generic.serial = ao_serial_number;
        for (;;) {
                while (ao_telemetry_interval == 0)