altos: Abort radio harder when terminating packet mode.

[fw/altos] / src / ao_packet_master.c

diff --git a/src/ao_packet_master.c b/src/ao_packet_master.c
index 72bb908a671e4e2f790f1f6492c340627e43468a..50f5aeffc79101725df181261fe3408c801f6a4e 100644 (file)
--- a/src/ao_packet_master.c
+++ b/src/ao_packet_master.c
@@ -121,9 +121,13 @@ ao_packet_forward(void) __reentrant
                if (c == '\r') c = '\n';
                ao_packet_putchar(c);
        }
+
+       /* Wait for a second if there is any pending data */
+       for (c = 0; (ao_packet_tx_used || ao_tx_packet.len) && c < 10; c++)
+               ao_delay(AO_MS_TO_TICKS(100));
        ao_packet_enable = 0;
-       ao_radio_abort();
        while (ao_packet_echo_task.wchan || ao_packet_task.wchan) {
+               ao_radio_abort();
                ao_wake_task(&ao_packet_echo_task);
                ao_wake_task(&ao_packet_task);
                ao_yield();