ao_wakeup(&ao_usart1_tx_fifo);
}
+static __pdata serial_echo;
+
char
ao_serial_getchar(void) __critical
{
while (ao_fifo_empty(ao_usart1_rx_fifo))
ao_sleep(&ao_usart1_rx_fifo);
ao_fifo_remove(ao_usart1_rx_fifo, c);
+ if (serial_echo) {
+ 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)
{
}
}
+static void
+monitor_serial(void)
+{
+ ao_cmd_hex();
+ 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 },
};
+static const struct {
+ uint8_t baud;
+ uint8_t gcr;
+} ao_serial_speeds[] = {
+ /* [AO_SERIAL_SPEED_4800] = */ {
+ /* .baud = */ 163,
+ /* .gcr = */ (7 << UxGCR_BAUD_E_SHIFT) | UxGCR_ORDER_LSB
+ },
+ /* [AO_SERIAL_SPEED_57600] = */ {
+ /* .baud = */ 59,
+ /* .gcr = */ (11 << UxGCR_BAUD_E_SHIFT) | UxGCR_ORDER_LSB
+ },
+};
+
+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;
+}
+
void
ao_serial_init(void)
{
U1CSR = (UxCSR_MODE_UART | UxCSR_RE);
/* Pick a 4800 baud rate */
- U1BAUD = 163; /* 4800 */
- U1GCR = 7 << UxGCR_BAUD_E_SHIFT; /* 4800 */
+ ao_serial_set_speed(AO_SERIAL_SPEED_4800);
/* Reasonable serial parameters */
U1UCR = (UxUCR_FLUSH |