X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Flpc%2Fao_serial_lpc.c;h=c04246990cf41652bf3788a6e3ec0352d0df15d5;hb=f5218e2544dcb659aec6c3adee50d61cab1bba3a;hp=4ecaa175f0cc69f6da06bab4330bed758ee5d3d3;hpb=9e8f6ba8b779cd9635f82d6da5f113715c3ee4c7;p=fw%2Faltos

diff --git a/src/lpc/ao_serial_lpc.c b/src/lpc/ao_serial_lpc.c
index 4ecaa175..c0424699 100644
--- a/src/lpc/ao_serial_lpc.c
+++ b/src/lpc/ao_serial_lpc.c
@@ -20,7 +20,10 @@
 
 struct ao_fifo	ao_usart_rx_fifo;
 struct ao_fifo	ao_usart_tx_fifo;
-uint8_t		ao_usart_tx_started;
+uint8_t		ao_usart_tx_avail;
+uint8_t		ao_usart_tx_avail_min;
+
+#define LPC_USART_TX_FIFO_SIZE	16
 
 void
 ao_debug_out(char c)
@@ -35,9 +38,10 @@ ao_debug_out(char c)
 static void
 _ao_serial_tx_start(void)
 {
-	if (!ao_fifo_empty(ao_usart_tx_fifo) & !ao_usart_tx_started)
-	{
-		ao_usart_tx_started = 1;
+	if (!ao_fifo_empty(ao_usart_tx_fifo) && ao_usart_tx_avail) {
+		ao_usart_tx_avail--;
+		if (ao_usart_tx_avail < ao_usart_tx_avail_min)
+			ao_usart_tx_avail_min = ao_usart_tx_avail;
 		ao_fifo_remove(ao_usart_tx_fifo, lpc_usart.rbr_thr);
 	}
 }
@@ -56,7 +60,7 @@ lpc_usart_isr(void)
 			ao_wakeup(&ao_stdin_ready);
 	}
 	if (lpc_usart.lsr & (1 << LPC_USART_LSR_THRE)) {
-		ao_usart_tx_started = 0;
+		ao_usart_tx_avail = LPC_USART_TX_FIFO_SIZE;
 		_ao_serial_tx_start();
 		ao_wakeup(&ao_usart_tx_fifo);
 	}
@@ -162,6 +166,9 @@ ao_serial_init(void)
 			 (1 << LPC_USART_FCR_TXFIFORES) |
 			 (LPC_USART_FCR_RXTL_1 << LPC_USART_FCR_RXTL));
 
+	ao_usart_tx_avail = LPC_USART_TX_FIFO_SIZE;
+	ao_usart_tx_avail_min = LPC_USART_TX_FIFO_SIZE;
+
 	/* 8 n 1 */
 	lpc_usart.lcr = ((LPC_USART_LCR_WLS_8 << LPC_USART_LCR_WLS) |
 			 (LPC_USART_LCR_SBS_1 << LPC_USART_LCR_SBS) |