command: Move command_task() to board specific code

Move the command_task() code from the generic code to the board
specific code.  This enables more flexibility in how the board
specific code processes input.

Signed-off-by: Kevin O'Connor <kevin@koconnor.net>

1 files changed, 16 insertions, 2 deletions

diff --git a/src/avr/serial.c b/src/avr/serial.c
index 3221b6f0..213b10ed 100644
--- a/src/avr/serial.c
+++ b/src/avr/serial.c
@@ -92,7 +92,7 @@ enable_tx_irq(void)
  ****************************************************************/
 
 // Return a buffer (and length) containing any incoming messages
-char *
+static char *
 console_get_input(uint8_t *plen)
 {
     *plen = readb(&receive_pos);
@@ -100,7 +100,7 @@ console_get_input(uint8_t *plen)
 }
 
 // Remove from the receive buffer the given number of bytes
-void
+static void
 console_pop_input(uint8_t len)
 {
     uint8_t copied = 0;
@@ -124,6 +124,20 @@ console_pop_input(uint8_t len)
     }
 }
 
+// Process any incoming commands
+void
+console_task(void)
+{
+    uint8_t buf_len, pop_count;
+    char *buf = console_get_input(&buf_len);
+    int8_t ret = command_find_block(buf, buf_len, &pop_count);
+    if (ret > 0)
+        command_dispatch(buf, pop_count);
+    if (ret)
+        console_pop_input(pop_count);
+}
+DECL_TASK(console_task);
+
 // Return an output buffer that the caller may fill with transmit messages
 char *
 console_get_output(uint8_t len)