Disable monitor mode before attempting radio test.

[fw/altos] / src / ao_packet_slave.c

diff --git a/src/ao_packet_slave.c b/src/ao_packet_slave.c
index ba5ad1c1d13e6f0ca2cb4069454cb5fdf66d721e..122c4da0588148ffb18d9b8daacc5a553cdbcfca 100644 (file)
--- a/src/ao_packet_slave.c
+++ b/src/ao_packet_slave.c
@@ -40,13 +40,15 @@ ao_packet_slave_start(void)
 void
 ao_packet_slave_stop(void)
 {
-       ao_packet_enable = 0;
-       ao_radio_abort();
-       while (ao_packet_task.wchan) {
-               ao_wake_task(&ao_packet_task);
-               ao_yield();
+       if (ao_packet_enable) {
+               ao_packet_enable = 0;
+               ao_radio_abort();
+               while (ao_packet_task.wchan) {
+                       ao_wake_task(&ao_packet_task);
+                       ao_yield();
+               }
+               ao_radio_set_telemetry();
        }
-       ao_radio_set_telemetry();
 }
 
 void