X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fao_packet_slave.c;h=4c947fbffed989f324f24b98f08107ad6ef80a4a;hp=ba5ad1c1d13e6f0ca2cb4069454cb5fdf66d721e;hb=901fce5fe3e2762406079ecaa787612b5ed4b34a;hpb=0b483233118673cbc2cda1be6acd379df82bc95a

diff --git a/src/ao_packet_slave.c b/src/ao_packet_slave.c
index ba5ad1c1..4c947fbf 100644
--- 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
@@ -54,5 +56,5 @@ ao_packet_slave_init(void)
 {
 	ao_add_stdio(ao_packet_pollchar,
 		     ao_packet_putchar,
-		     ao_packet_flush);
+		     NULL);
 }