altos: Ensure low-rate telem packets interleave with sensor telem packets

[fw/altos] / src / ao_telemetry.c

diff --git a/src/ao_telemetry.c b/src/ao_telemetry.c
index 603a67913b9bd829e76c47ea4990824a7ea8d0f5..172b6f1756f47654ba5602d67d0990f6112f7258 100644 (file)
--- a/src/ao_telemetry.c
+++ b/src/ao_telemetry.c
@@ -194,13 +194,13 @@ ao_telemetry_set_interval(uint16_t interval)
 {
        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);