Disable monitor mode before attempting radio test.

[fw/altos] / src / ao_telemetrum.c

diff --git a/src/ao_telemetrum.c b/src/ao_telemetrum.c
index a680ce19675180b0377887b33e0609d82169f5d8..990b0d77d0a17988b43cefe71b63499c1ccbabe8 100644 (file)
--- a/src/ao_telemetrum.c
+++ b/src/ao_telemetrum.c
@@ -17,12 +17,17 @@
 
 #include "ao.h"
 
+/* stub so as telemetrum doesn't have monitor mode */
+void
+ao_set_monitor(uint8_t monitoring)
+{
+       (void) monitoring;
+}
+
 void
 main(void)
 {
-       CLKCON = 0;
-       while (!(SLEEP & SLEEP_XOSC_STB))
-               ;
+       ao_clock_init();
 
        /* Turn on the red LED until the system is stable */
        ao_led_init(AO_LED_RED|AO_LED_GREEN);
@@ -42,8 +47,8 @@ main(void)
        ao_gps_report_init();
        ao_telemetry_init();
        ao_radio_init();
+       ao_packet_slave_init();
        ao_igniter_init();
-       ao_dbg_init();
        ao_config_init();
        ao_start_scheduler();
 }