altos: Baro-only (but record accel) for TM v1.2

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

diff --git a/src/core/ao_telemetry.c b/src/core/ao_telemetry.c
index 52ac94891adebd99f915cf97a20e95ddf171a18c..8385c6d038c9f48dc9862af73f299e8cf64a438b 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(DATA_TO_XDATA(&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)