fix uart recv in non-intr mode

[aversive.git] / modules / comm / uart / uart_recv9_nowait.c

diff --git a/modules/comm/uart/uart_recv9_nowait.c b/modules/comm/uart/uart_recv9_nowait.c
index 8c626a2..3cded5c 100644 (file)
--- a/modules/comm/uart/uart_recv9_nowait.c
+++ b/modules/comm/uart/uart_recv9_nowait.c
@@ -31,13 +31,23 @@ int uart_9bits_recv_nowait(uint8_t num)
        char elt = 0;
        uint8_t flags;
        
-       IRQ_LOCK(flags);
-       if( CIRBUF_GET_LEN(&g_rx_fifo[num]) >= 2) {
-               cirbuf_get_buf_tail(&g_rx_fifo[num], (char *)&elt, 2);
-               cirbuf_del_buf_tail(&g_rx_fifo[num], 2);
+       /* if interrupt mode is off, we have to check the status
+        * register */
+       if (!(*uart_regs[num].ucsrb & (1 << RXCIE))) {
+               if ( !(*uart_regs[num].ucsra & (1 << RXC)) )
+                       return -1;
+               return uart_get_udr_9bits(num);
+       }
+       /* else check the fifo */
+       else {
+               IRQ_LOCK(flags);
+               if( CIRBUF_GET_LEN(&g_rx_fifo[num]) >= 2) {
+                       cirbuf_get_buf_tail(&g_rx_fifo[num], (char *)&elt, 2);
+                       cirbuf_del_buf_tail(&g_rx_fifo[num], 2);
+                       IRQ_UNLOCK(flags);
+                       return (int)elt;
+               }
                IRQ_UNLOCK(flags);
-               return (int)elt;
+               return -1;
        }
-       IRQ_UNLOCK(flags);
-       return (-1);
 }