Explorar el Código

Add flow control by firmware to serial_uart

core
tmk hace 10 años
padre
commit
6804a4516e
Se han modificado 1 ficheros con 19 adiciones y 0 borrados
  1. 19
    0
      protocol/serial_uart.c

+ 19
- 0
protocol/serial_uart.c Ver fichero

@@ -41,6 +41,22 @@ POSSIBILITY OF SUCH DAMAGE.
#include "serial.h"


#if defined(SERIAL_UART_RTS_LO) && defined(SERIAL_UART_RTS_HI)
// Buffer state
// Empty: RBUF_SPACE == RBUF_SIZE(head==tail)
// Last 1 space: RBUF_SPACE == 2
// Full: RBUF_SPACE == 1(last cell of rbuf be never used.)
#define RBUF_SPACE() (rbuf_head < rbuf_tail ? (rbuf_tail - rbuf_head) : (RBUF_SIZE - rbuf_head + rbuf_tail))
// allow to send
#define rbuf_check_rts_lo() do { if (RBUF_SPACE() > 2) SERIAL_UART_RTS_LO(); } while (0)
// prohibit to send
#define rbuf_check_rts_hi() do { if (RBUF_SPACE() <= 2) SERIAL_UART_RTS_HI(); } while (0)
#else
#define rbuf_check_rts_lo()
#define rbuf_check_rts_hi()
#endif


void serial_init(void)
{
SERIAL_UART_INIT();
@@ -61,6 +77,7 @@ uint8_t serial_recv(void)

data = rbuf[rbuf_tail];
rbuf_tail = (rbuf_tail + 1) % RBUF_SIZE;
rbuf_check_rts_lo();
return data;
}

@@ -73,6 +90,7 @@ int16_t serial_recv2(void)

data = rbuf[rbuf_tail];
rbuf_tail = (rbuf_tail + 1) % RBUF_SIZE;
rbuf_check_rts_lo();
return data;
}

@@ -90,4 +108,5 @@ ISR(SERIAL_UART_RXD_VECT)
rbuf[rbuf_head] = SERIAL_UART_DATA;
rbuf_head = next;
}
rbuf_check_rts_hi();
}