|  | /* | 
|  | * A library of polled 16550 serial routines.  These are intended to | 
|  | * be used to support progress messages, xmon, kgdb, etc. on a | 
|  | * variety of platforms. | 
|  | * | 
|  | * Adapted from lots of code ripped from the arch/ppc/boot/ polled | 
|  | * 16550 support. | 
|  | * | 
|  | * Author: Matt Porter <mporter@mvista.com> | 
|  | * | 
|  | * 2002-2003 (c) MontaVista Software, Inc.  This file is licensed under | 
|  | * the terms of the GNU General Public License version 2.  This program | 
|  | * is licensed "as is" without any warranty of any kind, whether express | 
|  | * or implied. | 
|  | */ | 
|  |  | 
|  | #include <linux/types.h> | 
|  | #include <linux/serial.h> | 
|  | #include <linux/tty.h>		/* For linux/serial_core.h */ | 
|  | #include <linux/serial_core.h> | 
|  | #include <linux/serialP.h> | 
|  | #include <linux/serial_reg.h> | 
|  | #include <asm/machdep.h> | 
|  | #include <asm/serial.h> | 
|  | #include <asm/io.h> | 
|  |  | 
|  | #define SERIAL_BAUD	9600 | 
|  |  | 
|  | /* SERIAL_PORT_DFNS is defined in <asm/serial.h> */ | 
|  | #ifndef SERIAL_PORT_DFNS | 
|  | #define SERIAL_PORT_DFNS | 
|  | #endif | 
|  |  | 
|  | static struct serial_state rs_table[RS_TABLE_SIZE] = { | 
|  | SERIAL_PORT_DFNS	/* defined in <asm/serial.h> */ | 
|  | }; | 
|  |  | 
|  | static void (*serial_outb)(unsigned long, unsigned char); | 
|  | static unsigned long (*serial_inb)(unsigned long); | 
|  |  | 
|  | static int shift; | 
|  |  | 
|  | unsigned long direct_inb(unsigned long addr) | 
|  | { | 
|  | return readb((void __iomem *)addr); | 
|  | } | 
|  |  | 
|  | void direct_outb(unsigned long addr, unsigned char val) | 
|  | { | 
|  | writeb(val, (void __iomem *)addr); | 
|  | } | 
|  |  | 
|  | unsigned long io_inb(unsigned long port) | 
|  | { | 
|  | return inb(port); | 
|  | } | 
|  |  | 
|  | void io_outb(unsigned long port, unsigned char val) | 
|  | { | 
|  | outb(val, port); | 
|  | } | 
|  |  | 
|  | unsigned long serial_init(int chan, void *ignored) | 
|  | { | 
|  | unsigned long com_port; | 
|  | unsigned char lcr, dlm; | 
|  |  | 
|  | /* We need to find out which type io we're expecting.  If it's | 
|  | * 'SERIAL_IO_PORT', we get an offset from the isa_io_base. | 
|  | * If it's 'SERIAL_IO_MEM', we can the exact location.  -- Tom */ | 
|  | switch (rs_table[chan].io_type) { | 
|  | case SERIAL_IO_PORT: | 
|  | com_port = rs_table[chan].port; | 
|  | serial_outb = io_outb; | 
|  | serial_inb = io_inb; | 
|  | break; | 
|  | case SERIAL_IO_MEM: | 
|  | com_port = (unsigned long)rs_table[chan].iomem_base; | 
|  | serial_outb = direct_outb; | 
|  | serial_inb = direct_inb; | 
|  | break; | 
|  | default: | 
|  | /* We can't deal with it. */ | 
|  | return -1; | 
|  | } | 
|  |  | 
|  | /* How far apart the registers are. */ | 
|  | shift = rs_table[chan].iomem_reg_shift; | 
|  |  | 
|  | /* save the LCR */ | 
|  | lcr = serial_inb(com_port + (UART_LCR << shift)); | 
|  |  | 
|  | /* Access baud rate */ | 
|  | serial_outb(com_port + (UART_LCR << shift), UART_LCR_DLAB); | 
|  | dlm = serial_inb(com_port + (UART_DLM << shift)); | 
|  |  | 
|  | /* | 
|  | * Test if serial port is unconfigured | 
|  | * We assume that no-one uses less than 110 baud or | 
|  | * less than 7 bits per character these days. | 
|  | *  -- paulus. | 
|  | */ | 
|  | if ((dlm <= 4) && (lcr & 2)) { | 
|  | /* port is configured, put the old LCR back */ | 
|  | serial_outb(com_port + (UART_LCR << shift), lcr); | 
|  | } | 
|  | else { | 
|  | /* Input clock. */ | 
|  | serial_outb(com_port + (UART_DLL << shift), | 
|  | (rs_table[chan].baud_base / SERIAL_BAUD) & 0xFF); | 
|  | serial_outb(com_port + (UART_DLM << shift), | 
|  | (rs_table[chan].baud_base / SERIAL_BAUD) >> 8); | 
|  | /* 8 data, 1 stop, no parity */ | 
|  | serial_outb(com_port + (UART_LCR << shift), 0x03); | 
|  | /* RTS/DTR */ | 
|  | serial_outb(com_port + (UART_MCR << shift), 0x03); | 
|  |  | 
|  | /* Clear & enable FIFOs */ | 
|  | serial_outb(com_port + (UART_FCR << shift), 0x07); | 
|  | } | 
|  |  | 
|  | return (com_port); | 
|  | } | 
|  |  | 
|  | void | 
|  | serial_putc(unsigned long com_port, unsigned char c) | 
|  | { | 
|  | while ((serial_inb(com_port + (UART_LSR << shift)) & UART_LSR_THRE) == 0) | 
|  | ; | 
|  | serial_outb(com_port, c); | 
|  | } | 
|  |  | 
|  | unsigned char | 
|  | serial_getc(unsigned long com_port) | 
|  | { | 
|  | while ((serial_inb(com_port + (UART_LSR << shift)) & UART_LSR_DR) == 0) | 
|  | ; | 
|  | return serial_inb(com_port); | 
|  | } | 
|  |  | 
|  | int | 
|  | serial_tstc(unsigned long com_port) | 
|  | { | 
|  | return ((serial_inb(com_port + (UART_LSR << shift)) & UART_LSR_DR) != 0); | 
|  | } | 
|  |  | 
|  | void | 
|  | serial_close(unsigned long com_port) | 
|  | { | 
|  | } | 
|  |  | 
|  | void | 
|  | gen550_init(int i, struct uart_port *serial_req) | 
|  | { | 
|  | rs_table[i].io_type = serial_req->iotype; | 
|  | rs_table[i].port = serial_req->iobase; | 
|  | rs_table[i].iomem_base = serial_req->membase; | 
|  | rs_table[i].iomem_reg_shift = serial_req->regshift; | 
|  | rs_table[i].baud_base = serial_req->uartclk ? serial_req->uartclk / 16 : BASE_BAUD; | 
|  | } | 
|  |  | 
|  | #ifdef CONFIG_SERIAL_TEXT_DEBUG | 
|  | void | 
|  | gen550_progress(char *s, unsigned short hex) | 
|  | { | 
|  | volatile unsigned int progress_debugport; | 
|  | volatile char c; | 
|  |  | 
|  | progress_debugport = serial_init(0, NULL); | 
|  |  | 
|  | serial_putc(progress_debugport, '\r'); | 
|  |  | 
|  | while ((c = *s++) != 0) | 
|  | serial_putc(progress_debugport, c); | 
|  |  | 
|  | serial_putc(progress_debugport, '\n'); | 
|  | serial_putc(progress_debugport, '\r'); | 
|  | } | 
|  | #endif /* CONFIG_SERIAL_TEXT_DEBUG */ |