X-Git-Url: https://git.gag.com/?p=fw%2Faltos;a=blobdiff_plain;f=src%2Fao_packet_slave.c;h=3c4ffb92d26837f5216fbbe1a0a8739447098ed7;hp=ba5ad1c1d13e6f0ca2cb4069454cb5fdf66d721e;hb=e7dc7fab787df63a4de72c8450e94092eb04d7db;hpb=ca5d323a3d206050d95f52a61e92c69e1f54e7b5

diff --git a/src/ao_packet_slave.c b/src/ao_packet_slave.c
index ba5ad1c1..3c4ffb92 100644
--- a/src/ao_packet_slave.c
+++ b/src/ao_packet_slave.c
@@ -20,12 +20,15 @@
 void
 ao_packet_slave(void)
 {
+	uint8_t	status;
+
 	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();
+		status = ao_packet_recv();
+		if (status & AO_DMA_DONE)
+			ao_packet_send();
 	}
 	ao_exit();
 }
@@ -33,26 +36,50 @@ 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
 ao_packet_slave_stop(void)
 {
-	ao_packet_enable = 0;
-	ao_radio_abort();
-	while (ao_packet_task.wchan) {
-		ao_wake_task(&ao_packet_task);
-		ao_yield();
+	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_set_telemetry();
 	}
-	ao_radio_set_telemetry();
 }
 
+#ifdef PACKET_HAS_SLAVE_CMD
+void
+ao_packet_slave_control(void)
+{
+	ao_cmd_hex();
+	if (ao_cmd_lex_i)
+		ao_packet_slave_start();
+	else
+		ao_packet_slave_stop();
+}
+
+__code struct ao_cmds ao_packet_slave_cmds[] = {
+	{ 's',	ao_packet_slave_control,	"s <enable>                         Remote packet link slave" },
+	{ 0,	ao_packet_slave_control,	NULL },
+};
+#endif
+
 void
 ao_packet_slave_init(void)
 {
 	ao_add_stdio(ao_packet_pollchar,
 		     ao_packet_putchar,
-		     ao_packet_flush);
+		     NULL);
+#ifdef PACKET_HAS_SLAVE_CMD
+	ao_cmd_register(&ao_packet_slave_cmds[0]);
+#endif
 }