58 lines
1.6 KiB
C
58 lines
1.6 KiB
C
|
/*
|
||
|
|
* COM1 NS16550 support
|
||
|
|
* originally from linux source (arch/ppc/boot/ns16550.c)
|
||
|
|
* modified to use CFG_ISA_MEM and new defines
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <config.h>
|
||
|
|
#include "ns16550.h"
|
||
|
|
|
||
|
|
typedef struct NS16550 *NS16550_t;
|
||
|
|
|
||
|
|
const NS16550_t COM_PORTS[] =
|
||
|
|
{ (NS16550_t) ((CFG_EUMB_ADDR) + 0x4500),
|
||
|
|
(NS16550_t) ((CFG_EUMB_ADDR) + 0x4600) };
|
||
|
|
|
||
|
|
volatile struct NS16550 *NS16550_init (int chan, int baud_divisor)
|
||
|
|
{
|
||
|
|
volatile struct NS16550 *com_port;
|
||
|
|
|
||
|
|
com_port = (struct NS16550 *) COM_PORTS[chan];
|
||
|
|
com_port->ier = 0x00;
|
||
|
|
com_port->lcr = LCR_BKSE; /* Access baud rate */
|
||
|
|
com_port->dll = baud_divisor & 0xff; /* 9600 baud */
|
||
|
|
com_port->dlm = (baud_divisor >> 8) & 0xff;
|
||
|
|
com_port->lcr = LCR_8N1; /* 8 data, 1 stop, no parity */
|
||
|
|
com_port->mcr = MCR_RTS; /* RTS/DTR */
|
||
|
|
com_port->fcr = FCR_FIFO_EN | FCR_RXSR | FCR_TXSR; /* Clear & enable FIFOs */
|
||
|
|
return (com_port);
|
||
|
|
}
|
||
|
|
|
||
|
|
void NS16550_reinit (volatile struct NS16550 *com_port, int baud_divisor)
|
||
|
|
{
|
||
|
|
com_port->ier = 0x00;
|
||
|
|
com_port->lcr = LCR_BKSE; /* Access baud rate */
|
||
|
|
com_port->dll = baud_divisor & 0xff; /* 9600 baud */
|
||
|
|
com_port->dlm = (baud_divisor >> 8) & 0xff;
|
||
|
|
com_port->lcr = LCR_8N1; /* 8 data, 1 stop, no parity */
|
||
|
|
com_port->mcr = MCR_RTS; /* RTS/DTR */
|
||
|
|
com_port->fcr = FCR_FIFO_EN | FCR_RXSR | FCR_TXSR; /* Clear & enable FIFOs */
|
||
|
|
}
|
||
|
|
|
||
|
|
void NS16550_putc (volatile struct NS16550 *com_port, unsigned char c)
|
||
|
|
{
|
||
|
|
while ((com_port->lsr & LSR_THRE) == 0);
|
||
|
|
com_port->thr = c;
|
||
|
|
}
|
||
|
|
|
||
|
|
unsigned char NS16550_getc (volatile struct NS16550 *com_port)
|
||
|
|
{
|
||
|
|
while ((com_port->lsr & LSR_DR) == 0);
|
||
|
|
return (com_port->rbr);
|
||
|
|
}
|
||
|
|
|
||
|
|
int NS16550_tstc (volatile struct NS16550 *com_port)
|
||
|
|
{
|
||
|
|
return ((com_port->lsr & LSR_DR) != 0);
|
||
|
|
}
|