ao_sleep(&ao_usart1_rx_fifo);
ao_fifo_remove(ao_usart1_rx_fifo, c);
if (serial_echo) {
- printf("%02x\n", (uint8_t) c);
+ printf("%02x\n", ((int) c) & 0xff);
flush();
}
return c;
ao_serial_tx1_start();
}
+static void
+ao_serial_drain(void) __critical
+{
+ while (!ao_fifo_empty(ao_usart1_tx_fifo))
+ ao_sleep(&ao_usart1_tx_fifo);
+}
+
static void
send_serial(void)
{
serial_echo = ao_cmd_lex_i != 0;
}
+static void
+serial_baud(void)
+{
+ ao_cmd_hex();
+ ao_serial_set_speed(ao_cmd_lex_i);
+}
+
__code struct ao_cmds ao_serial_cmds[] = {
{ 'S', send_serial, "S <data> Send data to serial line" },
{ 'M', monitor_serial, "M <enable> Monitor serial data" },
+ { 'B', serial_baud, "B <0 = 4800, 1 = 57600> Set serial baud rate" },
{ 0, send_serial, NULL },
};
void
ao_serial_set_speed(uint8_t speed)
{
+ ao_serial_drain();
+ if (speed > AO_SERIAL_SPEED_57600)
+ return;
U1BAUD = ao_serial_speeds[speed].baud;
U1GCR = ao_serial_speeds[speed].gcr;
}