X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fao_packet_slave.c;h=d7cafa680d5a7a470de654ae3eae73ed8743afd6;hp=eb456dab48b98bcf72af2ad4badfbeb90eeee596;hb=0d10e25766b96f5660e213115cf27b71ff164405;hpb=2d41358c80f2eb8b6e98d699149bb941a6671475

diff --git a/src/ao_packet_slave.c b/src/ao_packet_slave.c
index eb456dab..d7cafa68 100644
--- a/src/ao_packet_slave.c
+++ b/src/ao_packet_slave.c
@@ -20,7 +20,6 @@
 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) {
@@ -38,8 +37,10 @@ ao_packet_slave(void)
 void
 ao_packet_slave_start(void)
 {
-	ao_packet_enable = 1;
-	ao_add_task(&ao_packet_task, ao_packet_slave, "slave");
+	if (!ao_packet_enable) {
+		ao_packet_enable = 1;
+		ao_add_task(&ao_packet_task, ao_packet_slave, "slave");
+	}
 }
 
 void
@@ -51,17 +52,15 @@ ao_packet_slave_stop(void)
 			ao_radio_recv_abort();
 			ao_delay(AO_MS_TO_TICKS(10));
 		}
-		ao_radio_get();
-		ao_radio_set_telemetry();
-		ao_radio_put();
 	}
 }
 
 void
-ao_packet_slave_init(void)
+ao_packet_slave_init(uint8_t enable)
 {
 	ao_add_stdio(ao_packet_pollchar,
 		     ao_packet_putchar,
 		     NULL);
-	ao_packet_slave_start();
+	if (enable)
+		ao_packet_slave_start();
 }