altos: Don't init packet slave on TD. Make slave start optional

[fw/altos] / src / ao_packet_slave.c

diff --git a/src/ao_packet_slave.c b/src/ao_packet_slave.c
index 39d04bbb2e8a70ca43450b9a7457f8991a1198b9..e40ddfec4a2ec2917c36e1843bf77e5c7f02c08e 100644 (file)
--- a/src/ao_packet_slave.c
+++ b/src/ao_packet_slave.c
@@ -26,6 +26,9 @@ ao_packet_slave(void)
        while (ao_packet_enable) {
                if (ao_packet_recv()) {
                        memcpy(&ao_tx_packet.callsign, &ao_rx_packet.packet.callsign, AO_MAX_CALLSIGN);
+#if HAS_FLIGHT
+                       ao_flight_force_idle = TRUE;
+#endif
                        ao_packet_send();
                }
        }
@@ -55,9 +58,11 @@ ao_packet_slave_stop(void)
 }
 
 void
-ao_packet_slave_init(void)
+ao_packet_slave_init(uint8_t enable)
 {
        ao_add_stdio(ao_packet_pollchar,
                     ao_packet_putchar,
                     NULL);
+       if (enable)
+               ao_packet_slave_start();
 }