diff --git a/lib/uart1.c b/lib/uart1.c index 672c795e4..b5bd78011 100644 --- a/lib/uart1.c +++ b/lib/uart1.c @@ -65,8 +65,9 @@ void uart1_putc(char c) { u1_head += 1; if (u1_head >= sizeof(u1_tx_buf)) u1_head = 0; - if (u1_head == u1_tail) /* drop chars when no room */ - return; + if (u1_head == u1_tail) { /* drop chars when no room */ + if (u1_head) { u1_head -=1; } else { u1_head = sizeof(u1_tx_buf); } + } enable_irq(UART1); } }