{
ao_telemetry_interval = interval;
ao_telemetry_config_max = AO_SEC_TO_TICKS(1) / interval;
- ao_telemetry_config_cur = 0;
+ ao_telemetry_config_cur = 1;
#if HAS_GPS
- ao_telemetry_loc_cur = 0;
- if (ao_telemetry_config_max - 1 > ao_telemetry_loc_cur)
+ ao_telemetry_loc_cur = 1;
+ if (ao_telemetry_config_max > ao_telemetry_loc_cur)
ao_telemetry_loc_cur++;
ao_telemetry_sat_cur = ao_telemetry_loc_cur;
- if (ao_telemetry_config_max - 1 > ao_telemetry_sat_cur)
+ if (ao_telemetry_config_max > ao_telemetry_sat_cur)
ao_telemetry_sat_cur++;
#endif
ao_wakeup(&telemetry);