X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fcore%2Fao_telemetry.c;h=8385c6d038c9f48dc9862af73f299e8cf64a438b;hb=pwmin;hp=52ac94891adebd99f915cf97a20e95ddf171a18c;hpb=b4be63627e146c7c868b5b3468d34880a561cfba;p=fw%2Faltos diff --git a/src/core/ao_telemetry.c b/src/core/ao_telemetry.c index 52ac9489..8385c6d0 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(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)