diff options
-rw-r--r-- | src/core/ao_telemetry.c | 6 |
1 files changed, 6 insertions, 0 deletions
diff --git a/src/core/ao_telemetry.c b/src/core/ao_telemetry.c index 52ac9489..5a1b3d1d 100644 --- 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) |