X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fao_packet_slave.c;h=39d04bbb2e8a70ca43450b9a7457f8991a1198b9;hp=3040d781091fd88c0956f6258879938ec3dcbb4b;hb=484b44e81b655f1ecb48256095382a56d2839bae;hpb=07213dc34fa20470a4b36a327a83d75b0f010ebb

diff --git a/src/ao_packet_slave.c b/src/ao_packet_slave.c
index 3040d781..39d04bbb 100644
--- a/src/ao_packet_slave.c
+++ b/src/ao_packet_slave.c
@@ -44,12 +44,13 @@ ao_packet_slave_stop(void)
 {
 	if (ao_packet_enable) {
 		ao_packet_enable = 0;
-		ao_radio_recv_abort();
 		while (ao_packet_task.wchan) {
-			ao_wake_task(&ao_packet_task);
-			ao_yield();
+			ao_radio_recv_abort();
+			ao_delay(AO_MS_TO_TICKS(10));
 		}
+		ao_radio_get();
 		ao_radio_set_telemetry();
+		ao_radio_put();
 	}
 }