Stop log dumping at flight end. Print 'end' at end of log.

[fw/altos] / ao_serial.c

diff --git a/ao_serial.c b/ao_serial.c
index 215a301d0f32e25ef3163894a54b9253423cb1f3..ce11694002162ea5b70ab650c25f2c6dc14cae5f 100644 (file)
--- a/ao_serial.c
+++ b/ao_serial.c
@@ -17,30 +17,9 @@
 
 #include "ao.h"
 
-#define SERIAL_FIFO    32
-
-struct ao_fifo {
-       uint8_t insert;
-       uint8_t remove;
-       uint8_t fifo[SERIAL_FIFO];
-};
-
 volatile __xdata struct ao_fifo        ao_usart1_rx_fifo;
 volatile __xdata struct ao_fifo        ao_usart1_tx_fifo;
 
-#define ao_fifo_insert(f,c) do { \
-       (f).fifo[(f).insert] = (c); \
-       (f).insert = ((f).insert + 1) & (SERIAL_FIFO-1); \
-} while(0)
-
-#define ao_fifo_remove(f,c) do {\
-       c = (f).fifo[(f).remove]; \
-       (f).remove = ((f).remove + 1) & (SERIAL_FIFO-1); \
-} while(0)
-
-#define ao_fifo_full(f)        ((((f).insert + 1) & (SERIAL_FIFO-1)) == (f).remove)
-#define ao_fifo_empty(f)       ((f).insert == (f).remove)
-
 void
 ao_serial_rx1_isr(void) interrupt 3
 {
@@ -71,10 +50,10 @@ ao_serial_tx1_isr(void) interrupt 14
        ao_wakeup(&ao_usart1_tx_fifo);
 }
 
-uint8_t
+char
 ao_serial_getchar(void) __critical
 {
-       uint8_t c;
+       char    c;
        while (ao_fifo_empty(ao_usart1_rx_fifo))
                ao_sleep(&ao_usart1_rx_fifo);
        ao_fifo_remove(ao_usart1_rx_fifo, c);
@@ -82,7 +61,7 @@ ao_serial_getchar(void) __critical
 }
 
 void
-ao_serial_putchar(uint8_t c) __critical
+ao_serial_putchar(char c) __critical
 {
        while (ao_fifo_full(ao_usart1_tx_fifo))
                ao_sleep(&ao_usart1_tx_fifo);
@@ -90,6 +69,21 @@ ao_serial_putchar(uint8_t c) __critical
        ao_serial_tx1_start();
 }
 
+static void
+send_serial(void)
+{
+       ao_cmd_white();
+       while (ao_cmd_lex_c != '\n') {
+               ao_serial_putchar(ao_cmd_lex_c);
+               ao_cmd_lex();
+       }
+}
+
+__code struct ao_cmds ao_serial_cmds[] = {
+       { 'S', send_serial,             "S <data>                           Send data to serial line" },
+       { 0, send_serial, NULL },
+};
+
 void
 ao_serial_init(void)
 {
@@ -120,4 +114,6 @@ ao_serial_init(void)
 
        IEN0 |= IEN0_URX1IE;
        IEN2 |= IEN2_UTX1IE;
+
+       ao_cmd_register(&ao_serial_cmds[0]);
 }