Add radio carrier command

1 files changed, 22 insertions, 1 deletions

diff --git a/src/ao_radio.c b/src/ao_radio.c
index 2dfa9279..55a0c297 100644
--- a/src/ao_radio.c
+++ b/src/ao_radio.c
@@ -430,9 +430,29 @@ void
 ao_radio_rdf_abort(void)
 {
 	if (ao_radio_rdf_running)
-		ao_radio_abort(AO_DMA_ABORTED);
+		ao_radio_abort();
 }
 
+/* Output carrier */
+void
+ao_radio_test(void)
+{
+	ao_config_get();
+	ao_mutex_get(&ao_radio_mutex);
+	ao_radio_idle();
+	printf ("Hit a character to stop..."); flush();
+	RFST = RFST_STX;
+	getchar();
+	ao_radio_idle();
+	ao_mutex_put(&ao_radio_mutex);
+	putchar('\n');
+}
+
+__code struct ao_cmds ao_radio_cmds[] = {
+	{ 'C',	ao_radio_test,	"C                                  Radio carrier test" },
+	{ 0,	ao_radio_test,	NULL },
+};
+
 void
 ao_radio_init(void)
 {
@@ -442,4 +462,5 @@ ao_radio_init(void)
 	ao_radio_set_telemetry();
 	ao_radio_dma_done = 1;
 	ao_radio_dma = ao_dma_alloc(&ao_radio_dma_done);
+	ao_cmd_register(&ao_radio_cmds[0]);
 }