static void irq_handler(void *arg)
{
int minor = (int)arg;
console_data *cd = &Console_Port_Data [minor];
volatile lm3s69xx_uart *uart = get_uart_regs(minor);
do {
char buf[LM3S69XX_UART_FIFO_DEPTH];
int i = 0;
uint32_t status = uart->fr;
while (((status & UARTFR_RXFE) == 0) && (i < LM3S69XX_UART_FIFO_DEPTH)) {
uint32_t d = uart->dr;
if ((d & UARTDR_ERROR_MSK) == 0) {
buf[i] = UARTDR_DATA_GET(d);
i++;
}
status = uart->fr;
}
if (i > 0)
rtems_termios_enqueue_raw_characters(cd->termios_data, buf, i);
} while (uart->mis != 0);
}
static int last_close(int major, int minor, void *arg)
{
volatile lm3s69xx_uart *uart = get_uart_regs(minor);
uart->im = 0;
return 0;
}
static void initialize(int minor)
{
volatile lm3s69xx_uart *uart = get_uart_regs(minor);
uart->ctl = 0;
uart->lcrh = UARTLCRH_WLEN(0x3) | UARTLCRH_FEN;
uart->ctl = UARTCTL_RXE | UARTCTL_TXE | UARTCTL_UARTEN;
}
static void write_polled(int minor, char c)
{
volatile lm3s69xx_uart *uart = get_uart_regs(minor);
while ((uart->fr & UARTFR_TXFF) != 0) {
/* Wait */
}
uart->dr = UARTDR_DATA(c);
}
static int read_polled(int minor)
{
volatile lm3s69xx_uart *uart = get_uart_regs(minor);
if ((uart->fr & UARTFR_RXFE) != 0) {
return -1;
} else {
return UARTDR_DATA(uart->dr);
}
}
static int first_open(int major, int minor, void *arg)
{
rtems_libio_open_close_args_t *oc = (rtems_libio_open_close_args_t *) arg;
struct rtems_termios_tty *tty = (struct rtems_termios_tty *) oc->iop->data1;
console_data *cd = &Console_Port_Data [minor];
volatile lm3s69xx_uart *uart = get_uart_regs(minor);
cd->termios_data = tty;
rtems_termios_set_initial_baud(tty, LM3S69XX_UART_BAUD);
/* Drain the RX FIFO. */
while ((uart->fr & UARTFR_RXFE) == 0)
(void)uart->dr;
uart->im = UARTI_RX | UARTI_RT;
return 0;
}
static void initialize(int minor)
{
const console_tbl *ct = Console_Port_Tbl[minor];
volatile lm3s69xx_uart *uart = get_uart_regs(minor);
unsigned int num = get_uart_number(minor);
lm3s69xx_syscon_enable_uart_clock(num, true);
uart->ctl &= ~UARTCTL_UARTEN;
uint32_t brd = get_baud_div(LM3S69XX_UART_BAUD);
uart->ibrd = brd / 64;
uart->fbrd = brd % 64;
uart->lcrh = UARTLCRH_WLEN(0x3) | UARTLCRH_FEN;
uart->cc = UARTCC_CS(0x0);
uart->ctl = UARTCTL_RXE | UARTCTL_TXE | UARTCTL_UARTEN;
int rv = rtems_interrupt_handler_install(ct->ulIntVector, "UART",
RTEMS_INTERRUPT_UNIQUE, irq_handler, (void *)minor);
assert(rv == RTEMS_SUCCESSFUL);
}
