altos: Fix ability to disable telemetry by setting interval to 0

For non-zero telemetry intervals, the radio code limits the value
based on the data rate. However, a zero interval means that telemetry
should be entirely disabled, so that value should be left alone when
checking.

Signed-off-by: Keith Packard <keithp@keithp.com>

diff --git a/src/kernel/ao_telemetry.c b/src/kernel/ao_telemetry.c
index 56bd715e7b690d15a800f677db7b87b37897e5af..27306a344c27a0cdb27b7e2bf19789e1fef4c97f 100644 (file)
--- a/src/kernel/ao_telemetry.c
+++ b/src/kernel/ao_telemetry.c
@@ -518,7 +518,7 @@ ao_telemetry_set_interval(uint16_t interval)
        };
 
        ao_telemetry_desired_interval = interval;
-       if (interval < min_interval[ao_config.radio_rate])
+       if (interval && interval < min_interval[ao_config.radio_rate])
                interval = min_interval[ao_config.radio_rate];
 #endif
        ao_telemetry_interval = interval;