void
ao_packet_slave(void)
{
- ao_radio_set_packet();
ao_tx_packet.addr = ao_serial_number;
ao_tx_packet.len = AO_PACKET_SYN;
while (ao_packet_enable) {
- ao_packet_recv();
- ao_packet_send();
+ 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();
+ }
}
ao_exit();
}
{
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_set_telemetry();
}
}
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();
}