altos: check for valid flight number in ao_log_delete

[fw/altos] / src / ao_packet_slave.c

diff --git a/src/ao_packet_slave.c b/src/ao_packet_slave.c
index 9b78767f55282b4e77c0f28f806124728151fccc..39d04bbb2e8a70ca43450b9a7457f8991a1198b9 100644 (file)
--- a/src/ao_packet_slave.c
+++ b/src/ao_packet_slave.c
@@ -20,14 +20,11 @@
 void
 ao_packet_slave(void)
 {
-       uint8_t status;
-
        ao_radio_set_packet();
        ao_tx_packet.addr = ao_serial_number;
        ao_tx_packet.len = AO_PACKET_SYN;
        while (ao_packet_enable) {
-               status = ao_packet_recv();
-               if (status & AO_DMA_DONE) {
+               if (ao_packet_recv()) {
                        memcpy(&ao_tx_packet.callsign, &ao_rx_packet.packet.callsign, AO_MAX_CALLSIGN);
                        ao_packet_send();
                }
@@ -47,12 +44,13 @@ ao_packet_slave_stop(void)
 {
        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_recv_abort();
+                       ao_delay(AO_MS_TO_TICKS(10));
                }
+               ao_radio_get();
                ao_radio_set_telemetry();
+               ao_radio_put();
        }
 }