altos: Pull igniter pins low as soon as possible at boot time

[fw/altos] / src / ao_packet_master.c

diff --git a/src/ao_packet_master.c b/src/ao_packet_master.c
index d03899d1336e40c0d8b7a4309c6b7206decb1674..e721ffba39c948a0d17a5fc35cf45ccfec664eea 100644 (file)
--- a/src/ao_packet_master.c
+++ b/src/ao_packet_master.c
@@ -18,15 +18,14 @@
 #include "ao.h"
 
 static char
-ao_packet_getchar(void)
+ao_packet_getchar(void) __critical
 {
        char c;
-       while ((c = ao_packet_pollchar()) == AO_READ_AGAIN)
-       {
+       while ((c = ao_packet_pollchar()) == AO_READ_AGAIN) {
                if (!ao_packet_enable)
                        break;
                if (ao_packet_master_sleeping)
-                       ao_wake_task(&ao_packet_task);
+                       ao_wakeup(&ao_packet_master_sleeping);
                flush();
                ao_sleep(&ao_stdin_ready);
        }
@@ -36,10 +35,10 @@ ao_packet_getchar(void)
 static void
 ao_packet_echo(void) __reentrant
 {
-       uint8_t c;
+       char    c;
        while (ao_packet_enable) {
                c = ao_packet_getchar();
-               if (ao_packet_enable)
+               if (c != AO_READ_AGAIN)
                        putchar(c);
        }
        ao_exit();
@@ -75,28 +74,27 @@ ao_packet_master_check_busy(void)
 void
 ao_packet_master(void)
 {
-       uint8_t status;
-
-       ao_radio_set_packet();
+       ao_config_get();
        ao_tx_packet.addr = ao_serial_number;
        ao_tx_packet.len = AO_PACKET_SYN;
        ao_packet_master_time = ao_time();
        ao_packet_master_delay = AO_PACKET_MASTER_DELAY_SHORT;
        while (ao_packet_enable) {
+               memcpy(ao_tx_packet.callsign, ao_config.callsign, AO_MAX_CALLSIGN);
                ao_packet_send();
                if (ao_tx_packet.len)
                        ao_packet_master_busy();
                ao_packet_master_check_busy();
                ao_alarm(ao_packet_master_delay);
-               status = ao_packet_recv();
-               if (status & AO_DMA_DONE) {
+               if (ao_packet_recv()) {
                        /* if we can transmit data, do so */
                        if (ao_packet_tx_used && ao_tx_packet.len == 0)
                                continue;
                        if (ao_rx_packet.packet.len)
                                ao_packet_master_busy();
                        ao_packet_master_sleeping = 1;
-                       ao_delay(ao_packet_master_delay);
+                       ao_alarm(ao_packet_master_delay);
+                       ao_sleep(&ao_packet_master_sleeping);
                        ao_packet_master_sleeping = 0;
                }
        }
@@ -118,20 +116,23 @@ 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_wake_task(&ao_packet_echo_task);
-               ao_wake_task(&ao_packet_task);
-               ao_yield();
+               ao_radio_recv_abort();
+               ao_wakeup(&ao_stdin_ready);
+               ao_delay(AO_MS_TO_TICKS(10));
        }
 }
 
 
 
 __code struct ao_cmds ao_packet_master_cmds[] = {
-       { 'p',  ao_packet_forward,      "p                                  Remote packet link." },
-       { 0,    ao_packet_forward,      NULL },
+       { ao_packet_forward,    "p\0Remote packet link." },
+       { 0,    NULL },
 };
 
 void