diff options
Diffstat (limited to 'src/avr/usbserial.c')
| -rw-r--r-- | src/avr/usbserial.c | 18 |
1 files changed, 16 insertions, 2 deletions
diff --git a/src/avr/usbserial.c b/src/avr/usbserial.c index 3b14ea0a..78ef719e 100644 --- a/src/avr/usbserial.c +++ b/src/avr/usbserial.c @@ -22,7 +22,7 @@ usbserial_init(void) DECL_INIT(usbserial_init); // Return a buffer (and length) containing any incoming messages -char * +static char * console_get_input(uint8_t *plen) { for (;;) { @@ -38,7 +38,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 needcopy = receive_pos - len; @@ -47,6 +47,20 @@ console_pop_input(uint8_t len) receive_pos = needcopy; } +// 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) |