| /* |
| * drivers/char/serial_tx3912.c |
| * |
| * Copyright (C) 2001 Steven J. Hill (sjhill@realitydiluted.com) |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License version 2 as |
| * published by the Free Software Foundation. |
| * |
| * Serial driver for TMPR3912/05 and PR31700 processors |
| */ |
| #include <linux/init.h> |
| #include <linux/config.h> |
| #include <linux/tty.h> |
| #include <linux/major.h> |
| #include <linux/console.h> |
| #include <linux/slab.h> |
| #include <linux/module.h> |
| #include <linux/serial.h> |
| #include <asm/io.h> |
| #include <asm/uaccess.h> |
| #include <asm/delay.h> |
| #include <asm/tx3912.h> |
| #include "serial_tx3912.h" |
| |
| /* |
| * Forward declarations for serial routines |
| */ |
| static void rs_disable_tx_interrupts (void * ptr); |
| static void rs_enable_tx_interrupts (void * ptr); |
| static void rs_disable_rx_interrupts (void * ptr); |
| static void rs_enable_rx_interrupts (void * ptr); |
| static int rs_get_CD (void * ptr); |
| static void rs_shutdown_port (void * ptr); |
| static int rs_set_real_termios (void *ptr); |
| static int rs_chars_in_buffer (void * ptr); |
| static void rs_hungup (void *ptr); |
| static void rs_close (void *ptr); |
| |
| /* |
| * Used by generic serial driver to access hardware |
| */ |
| static struct real_driver rs_real_driver = { |
| disable_tx_interrupts: rs_disable_tx_interrupts, |
| enable_tx_interrupts: rs_enable_tx_interrupts, |
| disable_rx_interrupts: rs_disable_rx_interrupts, |
| enable_rx_interrupts: rs_enable_rx_interrupts, |
| get_CD: rs_get_CD, |
| shutdown_port: rs_shutdown_port, |
| set_real_termios: rs_set_real_termios, |
| chars_in_buffer: rs_chars_in_buffer, |
| close: rs_close, |
| hungup: rs_hungup, |
| }; |
| |
| /* |
| * Structures and usage counts |
| */ |
| static struct tty_driver rs_driver, rs_callout_driver; |
| static struct tty_struct **rs_tty; |
| static struct termios **rs_termios; |
| static struct termios **rs_termios_locked; |
| static struct rs_port *rs_port; |
| static int rs_refcount; |
| static int rs_initialized; |
| |
| |
| /* |
| * Receive a character |
| */ |
| static inline void receive_char_pio(struct rs_port *port) |
| { |
| struct tty_struct *tty = port->gs.tty; |
| unsigned char ch; |
| int counter = 2048; |
| |
| /* While there are characters */ |
| while (counter > 0) { |
| if (!(inl(TX3912_UARTA_CTRL1) & TX3912_UART_CTRL1_RXHOLDFULL)) |
| break; |
| ch = inb(TX3912_UARTA_DATA); |
| if (tty->flip.count < TTY_FLIPBUF_SIZE) { |
| *tty->flip.char_buf_ptr++ = ch; |
| *tty->flip.flag_buf_ptr++ = 0; |
| tty->flip.count++; |
| } |
| udelay(1); |
| counter--; |
| } |
| |
| tty_flip_buffer_push(tty); |
| } |
| |
| /* |
| * Transmit a character |
| */ |
| static inline void transmit_char_pio(struct rs_port *port) |
| { |
| /* TX while bytes available */ |
| for (;;) { |
| if (!(inl(TX3912_UARTA_CTRL1) & TX3912_UART_CTRL1_EMPTY)) |
| break; |
| else if (port->x_char) { |
| outb(port->x_char, TX3912_UARTA_DATA); |
| port->icount.tx++; |
| port->x_char = 0; |
| } |
| else if (port->gs.xmit_cnt <= 0 || port->gs.tty->stopped || |
| port->gs.tty->hw_stopped) { |
| break; |
| } |
| else { |
| outb(port->gs.xmit_buf[port->gs.xmit_tail++], |
| TX3912_UARTA_DATA); |
| port->icount.tx++; |
| port->gs.xmit_tail &= SERIAL_XMIT_SIZE-1; |
| if (--port->gs.xmit_cnt <= 0) { |
| break; |
| } |
| } |
| udelay(10); |
| } |
| |
| if (port->gs.xmit_cnt <= 0 || port->gs.tty->stopped || |
| port->gs.tty->hw_stopped) { |
| rs_disable_tx_interrupts(port); |
| } |
| |
| if (port->gs.xmit_cnt <= port->gs.wakeup_chars) { |
| tty_wakeup(port->gs.tty); |
| rs_dprintk(TX3912_UART_DEBUG_TRANSMIT, "Waking up.... ldisc (%d)....\n", |
| port->gs.wakeup_chars); |
| } |
| } |
| |
| /* |
| * We don't have MSR |
| */ |
| static inline void check_modem_status(struct rs_port *port) |
| { |
| wake_up_interruptible(&port->gs.open_wait); |
| } |
| |
| /* |
| * RX interrupt handler |
| */ |
| static inline void rs_rx_interrupt(int irq, void *dev_id, struct pt_regs *regs) |
| { |
| unsigned long flags, status; |
| |
| save_and_cli(flags); |
| |
| rs_dprintk(TX3912_UART_DEBUG_INTERRUPTS, "rs_rx_interrupt..."); |
| |
| /* Get the interrupts */ |
| status = inl(TX3912_INT2_STATUS); |
| |
| /* Clear any interrupts we might be about to handle */ |
| outl(TX3912_INT2_UARTA_RX_BITS, TX3912_INT2_CLEAR); |
| |
| if(!rs_port || !rs_port->gs.tty) { |
| restore_flags(flags); |
| return; |
| } |
| |
| /* RX Receiver Holding Register Overrun */ |
| if(status & TX3912_INT2_UARTATXOVERRUNINT) { |
| rs_dprintk(TX3912_UART_DEBUG_INTERRUPTS, "overrun"); |
| rs_port->icount.overrun++; |
| } |
| |
| /* RX Frame Error */ |
| if(status & TX3912_INT2_UARTAFRAMEERRINT) { |
| rs_dprintk(TX3912_UART_DEBUG_INTERRUPTS, "frame error"); |
| rs_port->icount.frame++; |
| } |
| |
| /* Break signal received */ |
| if(status & TX3912_INT2_UARTABREAKINT) { |
| rs_dprintk(TX3912_UART_DEBUG_INTERRUPTS, "break"); |
| rs_port->icount.brk++; |
| } |
| |
| /* RX Parity Error */ |
| if(status & TX3912_INT2_UARTAPARITYINT) { |
| rs_dprintk(TX3912_UART_DEBUG_INTERRUPTS, "parity error"); |
| rs_port->icount.parity++; |
| } |
| |
| /* Byte received */ |
| if(status & TX3912_INT2_UARTARXINT) { |
| receive_char_pio(rs_port); |
| } |
| |
| restore_flags(flags); |
| |
| rs_dprintk(TX3912_UART_DEBUG_INTERRUPTS, "end.\n"); |
| } |
| |
| /* |
| * TX interrupt handler |
| */ |
| static inline void rs_tx_interrupt(int irq, void *dev_id, struct pt_regs *regs) |
| { |
| unsigned long flags, status; |
| |
| save_and_cli(flags); |
| |
| rs_dprintk(TX3912_UART_DEBUG_INTERRUPTS, "rs_tx_interrupt..."); |
| |
| /* Get the interrupts */ |
| status = inl(TX3912_INT2_STATUS); |
| |
| if(!rs_port || !rs_port->gs.tty) { |
| restore_flags(flags); |
| return; |
| } |
| |
| /* Clear interrupts */ |
| outl(TX3912_INT2_UARTA_TX_BITS, TX3912_INT2_CLEAR); |
| |
| /* TX holding register empty - transmit a byte */ |
| if(status & TX3912_INT2_UARTAEMPTYINT) { |
| transmit_char_pio(rs_port); |
| } |
| |
| /* TX Transmit Holding Register Overrun (shouldn't happen) */ |
| if(status & TX3912_INT2_UARTATXOVERRUNINT) { |
| printk( "rs_tx_interrupt: TX overrun\n"); |
| } |
| |
| restore_flags(flags); |
| |
| rs_dprintk(TX3912_UART_DEBUG_INTERRUPTS, "end.\n"); |
| } |
| |
| /* |
| * Here are the routines that actually interface with the generic driver |
| */ |
| static void rs_disable_tx_interrupts (void * ptr) |
| { |
| unsigned long flags; |
| |
| save_and_cli(flags); |
| |
| outl(inl(TX3912_INT2_ENABLE) & ~TX3912_INT2_UARTA_TX_BITS, |
| TX3912_INT2_ENABLE); |
| outl(TX3912_INT2_UARTA_TX_BITS, TX3912_INT2_CLEAR); |
| |
| restore_flags(flags); |
| } |
| |
| static void rs_enable_tx_interrupts (void * ptr) |
| { |
| unsigned long flags; |
| |
| save_and_cli(flags); |
| |
| outl(TX3912_INT2_UARTA_TX_BITS, TX3912_INT2_CLEAR); |
| outl(inl(TX3912_INT2_ENABLE) | TX3912_INT2_UARTA_TX_BITS, |
| TX3912_INT2_ENABLE); |
| transmit_char_pio(rs_port); |
| |
| restore_flags(flags); |
| } |
| |
| static void rs_disable_rx_interrupts (void * ptr) |
| { |
| unsigned long flags; |
| |
| save_and_cli(flags); |
| |
| outl(inl(TX3912_INT2_ENABLE) & ~TX3912_INT2_UARTA_RX_BITS, |
| TX3912_INT2_ENABLE); |
| outl(TX3912_INT2_UARTA_RX_BITS, TX3912_INT2_CLEAR); |
| |
| restore_flags(flags); |
| } |
| |
| static void rs_enable_rx_interrupts (void * ptr) |
| { |
| unsigned long flags; |
| |
| save_and_cli(flags); |
| |
| outl(inl(TX3912_INT2_ENABLE) | TX3912_INT2_UARTA_RX_BITS, |
| TX3912_INT2_ENABLE); |
| while (inl(TX3912_UARTA_CTRL1) & TX3912_UART_CTRL1_RXHOLDFULL) |
| inb(TX3912_UARTA_DATA); |
| outl(TX3912_INT2_UARTA_RX_BITS, TX3912_INT2_CLEAR); |
| |
| restore_flags(flags); |
| } |
| |
| /* |
| * We have no CD |
| */ |
| static int rs_get_CD (void * ptr) |
| { |
| return 1; |
| } |
| |
| /* |
| * Shut down the port |
| */ |
| static void rs_shutdown_port (void * ptr) |
| { |
| func_enter(); |
| rs_port->gs.flags &= ~GS_ACTIVE; |
| func_exit(); |
| } |
| |
| static int rs_set_real_termios (void *ptr) |
| { |
| unsigned int ctrl1 = 0; |
| unsigned int ctrl2 = 0; |
| |
| /* Set baud rate */ |
| switch (rs_port->gs.baud) { |
| case 0: |
| goto done; |
| case 1200: |
| ctrl2 = TX3912_UART_CTRL2_B1200; |
| break; |
| case 2400: |
| ctrl2 = TX3912_UART_CTRL2_B2400; |
| break; |
| case 4800: |
| ctrl2 = TX3912_UART_CTRL2_B4800; |
| break; |
| case 9600: |
| ctrl2 = TX3912_UART_CTRL2_B9600; |
| break; |
| case 19200: |
| ctrl2 = TX3912_UART_CTRL2_B19200; |
| break; |
| case 38400: |
| ctrl2 = TX3912_UART_CTRL2_B38400; |
| break; |
| case 57600: |
| ctrl2 = TX3912_UART_CTRL2_B57600; |
| break; |
| case 115200: |
| default: |
| ctrl2 = TX3912_UART_CTRL2_B115200; |
| break; |
| } |
| |
| /* Clear current UARTA settings */ |
| ctrl1 = inl(TX3912_UARTA_CTRL1) & 0xf000000f; |
| |
| /* Set parity */ |
| if(C_PARENB(rs_port->gs.tty)) { |
| if (!C_PARODD(rs_port->gs.tty)) |
| ctrl1 |= (TX3912_UART_CTRL1_ENPARITY | |
| TX3912_UART_CTRL1_EVENPARITY); |
| else |
| ctrl1 |= TX3912_UART_CTRL1_ENPARITY; |
| } |
| |
| /* Set data size */ |
| switch(rs_port->gs.tty->termios->c_cflag & CSIZE) { |
| case CS7: |
| ctrl1 |= TX3912_UART_CTRL1_BIT_7; |
| break; |
| case CS5: |
| case CS6: |
| printk(KERN_ERR "Data byte size unsupported. Defaulting to CS8\n"); |
| case CS8: |
| default: |
| ctrl1 &= ~TX3912_UART_CTRL1_BIT_7; |
| } |
| |
| /* Set stop bits */ |
| if(C_CSTOPB(rs_port->gs.tty)) |
| ctrl1 |= TX3912_UART_CTRL1_TWOSTOP; |
| |
| /* Write the control registers */ |
| outl(ctrl2, TX3912_UARTA_CTRL2); |
| outl(0, TX3912_UARTA_DMA_CTRL1); |
| outl(0, TX3912_UARTA_DMA_CTRL2); |
| outl(ctrl1, TX3912_UARTA_CTRL1); |
| |
| /* Loop until the UART is on */ |
| while(~inl(TX3912_UARTA_CTRL1) & TX3912_UART_CTRL1_UARTON); |
| |
| done: |
| func_exit(); |
| return 0; |
| } |
| |
| /* |
| * Anyone in the buffer? |
| */ |
| static int rs_chars_in_buffer (void * ptr) |
| { |
| return ((inl(TX3912_UARTA_CTRL1) & TX3912_UART_CTRL1_EMPTY) ? 0 : 1); |
| } |
| |
| /* |
| * Open the serial port |
| */ |
| static int rs_open(struct tty_struct * tty, struct file * filp) |
| { |
| int retval; |
| |
| func_enter(); |
| |
| if(!rs_initialized) { |
| return -EIO; |
| } |
| |
| if(MINOR(tty->device) - tty->driver.minor_start) { |
| return -ENODEV; |
| } |
| |
| rs_dprintk(TX3912_UART_DEBUG_OPEN, "Serial opening...\n"); |
| |
| tty->driver_data = rs_port; |
| rs_port->gs.tty = tty; |
| rs_port->gs.count++; |
| |
| /* |
| * Start up serial port |
| */ |
| retval = gs_init_port(&rs_port->gs); |
| rs_dprintk(TX3912_UART_DEBUG_OPEN, "Finished gs_init...\n"); |
| if(retval) { |
| rs_port->gs.count--; |
| return retval; |
| } |
| |
| rs_port->gs.flags |= GS_ACTIVE; |
| if(rs_port->gs.count == 1) { |
| MOD_INC_USE_COUNT; |
| } |
| |
| rs_enable_rx_interrupts(rs_port); |
| rs_enable_tx_interrupts(rs_port); |
| |
| retval = gs_block_til_ready(&rs_port->gs, filp); |
| if(retval) { |
| MOD_DEC_USE_COUNT; |
| rs_port->gs.count--; |
| return retval; |
| } |
| |
| if((rs_port->gs.count == 1) && |
| (rs_port->gs.flags & ASYNC_SPLIT_TERMIOS)) { |
| if (tty->driver.subtype == SERIAL_TYPE_NORMAL) |
| *tty->termios = rs_port->gs.normal_termios; |
| else |
| *tty->termios = rs_port->gs.callout_termios; |
| rs_set_real_termios(rs_port); |
| } |
| |
| rs_port->gs.session = current->session; |
| rs_port->gs.pgrp = current->pgrp; |
| func_exit(); |
| |
| return 0; |
| } |
| |
| /* |
| * Close the serial port |
| */ |
| static void rs_close(void *ptr) |
| { |
| func_enter(); |
| MOD_DEC_USE_COUNT; |
| func_exit(); |
| } |
| |
| /* |
| * Hang up the serial port |
| */ |
| static void rs_hungup(void *ptr) |
| { |
| func_enter(); |
| MOD_DEC_USE_COUNT; |
| func_exit(); |
| } |
| |
| /* |
| * Serial ioctl call |
| */ |
| static int rs_ioctl(struct tty_struct * tty, struct file * filp, |
| unsigned int cmd, unsigned long arg) |
| { |
| int ival, rc; |
| |
| rc = 0; |
| switch (cmd) { |
| case TIOCGSOFTCAR: |
| rc = put_user((tty->termios->c_cflag & CLOCAL) ? 1 : 0, |
| (unsigned int *) arg); |
| break; |
| case TIOCSSOFTCAR: |
| if ((rc = verify_area(VERIFY_READ, (void *) arg, |
| sizeof(int))) == 0) { |
| get_user(ival, (unsigned int *) arg); |
| tty->termios->c_cflag = |
| (tty->termios->c_cflag & ~CLOCAL) | |
| (ival ? CLOCAL : 0); |
| } |
| break; |
| case TIOCGSERIAL: |
| if ((rc = verify_area(VERIFY_WRITE, (void *) arg, |
| sizeof(struct serial_struct))) == 0) |
| rc = gs_getserial(&rs_port->gs, (struct serial_struct *) arg); |
| break; |
| case TIOCSSERIAL: |
| if ((rc = verify_area(VERIFY_READ, (void *) arg, |
| sizeof(struct serial_struct))) == 0) |
| rc = gs_setserial(&rs_port->gs, (struct serial_struct *) arg); |
| break; |
| default: |
| rc = -ENOIOCTLCMD; |
| break; |
| } |
| |
| return rc; |
| } |
| |
| /* |
| * Send xchar |
| */ |
| static void rs_send_xchar(struct tty_struct * tty, char ch) |
| { |
| func_enter(); |
| |
| rs_port->x_char = ch; |
| if (ch) { |
| rs_enable_tx_interrupts(tty); |
| } |
| |
| func_exit(); |
| } |
| |
| /* |
| * Throttle characters as directed by upper tty layer |
| */ |
| static void rs_throttle(struct tty_struct * tty) |
| { |
| #ifdef TX3912_UART_DEBUG_THROTTLE |
| char buf[64]; |
| |
| printk("throttle %s: %d....\n", tty_name(tty, buf), |
| tty->ldisc.chars_in_buffer(tty)); |
| #endif |
| |
| func_enter(); |
| |
| if (I_IXOFF(tty)) |
| rs_send_xchar(tty, STOP_CHAR(tty)); |
| |
| func_exit(); |
| } |
| |
| /* |
| * Un-throttle characters as directed by upper tty layer |
| */ |
| static void rs_unthrottle(struct tty_struct * tty) |
| { |
| #ifdef TX3912_UART_DEBUG_THROTTLE |
| char buf[64]; |
| |
| printk("unthrottle %s: %d....\n", tty_name(tty, buf), |
| tty->ldisc.chars_in_buffer(tty)); |
| #endif |
| |
| func_enter(); |
| |
| if (I_IXOFF(tty)) { |
| if (rs_port->x_char) |
| rs_port->x_char = 0; |
| else |
| rs_send_xchar(tty, START_CHAR(tty)); |
| } |
| |
| func_exit(); |
| } |
| |
| /* |
| * Initialize the serial port |
| */ |
| void __init tx3912_rs_init(void) |
| { |
| func_enter(); |
| rs_dprintk(TX3912_UART_DEBUG_INIT, "Initializing serial...\n"); |
| |
| /* Allocate critical structures */ |
| if(!(rs_tty = kmalloc(sizeof(struct tty_struct), GFP_KERNEL))) { |
| return; |
| } |
| if(!(rs_port = kmalloc(sizeof(struct rs_port), GFP_KERNEL))) { |
| kfree(rs_tty); |
| return; |
| } |
| if(!(rs_termios = kmalloc(sizeof(struct termios), GFP_KERNEL))) { |
| kfree(rs_port); |
| kfree(rs_tty); |
| return; |
| } |
| if(!(rs_termios_locked = kmalloc(sizeof(struct termios), GFP_KERNEL))) { |
| kfree(rs_termios); |
| kfree(rs_port); |
| kfree(rs_tty); |
| return; |
| } |
| |
| /* Zero out the structures */ |
| memset(rs_tty, 0, sizeof(struct tty_struct)); |
| memset(rs_port, 0, sizeof(struct rs_port)); |
| memset(rs_termios, 0, sizeof(struct termios)); |
| memset(rs_termios_locked, 0, sizeof(struct termios)); |
| memset(&rs_driver, 0, sizeof(rs_driver)); |
| memset(&rs_callout_driver, 0, sizeof(rs_callout_driver)); |
| |
| /* Fill in hardware specific port structure */ |
| rs_port->gs.callout_termios = tty_std_termios; |
| rs_port->gs.normal_termios = tty_std_termios; |
| rs_port->gs.magic = SERIAL_MAGIC; |
| rs_port->gs.close_delay = HZ/2; |
| rs_port->gs.closing_wait = 30 * HZ; |
| rs_port->gs.rd = &rs_real_driver; |
| #ifdef NEW_WRITE_LOCKING |
| rs_port->gs.port_write_sem = MUTEX; |
| #endif |
| #ifdef DECLARE_WAITQUEUE |
| init_waitqueue_head(&rs_port->gs.open_wait); |
| init_waitqueue_head(&rs_port->gs.close_wait); |
| #endif |
| |
| /* Fill in generic serial driver structures */ |
| rs_driver.magic = TTY_DRIVER_MAGIC; |
| rs_driver.driver_name = "serial"; |
| rs_driver.name = "ttyS"; |
| rs_driver.major = TTY_MAJOR; |
| rs_driver.minor_start = 64; |
| rs_driver.num = 1; |
| rs_driver.type = TTY_DRIVER_TYPE_SERIAL; |
| rs_driver.subtype = SERIAL_TYPE_NORMAL; |
| rs_driver.init_termios = tty_std_termios; |
| rs_driver.init_termios.c_cflag = B115200 | CS8 | CREAD | HUPCL | CLOCAL; |
| rs_driver.refcount = &rs_refcount; |
| rs_driver.table = rs_tty; |
| rs_driver.termios = rs_termios; |
| rs_driver.termios_locked = rs_termios_locked; |
| rs_driver.open = rs_open; |
| rs_driver.close = gs_close; |
| rs_driver.write = gs_write; |
| rs_driver.put_char = gs_put_char; |
| rs_driver.flush_chars = gs_flush_chars; |
| rs_driver.write_room = gs_write_room; |
| rs_driver.chars_in_buffer = gs_chars_in_buffer; |
| rs_driver.flush_buffer = gs_flush_buffer; |
| rs_driver.ioctl = rs_ioctl; |
| rs_driver.throttle = rs_throttle; |
| rs_driver.unthrottle = rs_unthrottle; |
| rs_driver.set_termios = gs_set_termios; |
| rs_driver.stop = gs_stop; |
| rs_driver.start = gs_start; |
| rs_driver.hangup = gs_hangup; |
| rs_callout_driver = rs_driver; |
| rs_callout_driver.name = "cua"; |
| rs_callout_driver.major = TTYAUX_MAJOR; |
| rs_callout_driver.subtype = SERIAL_TYPE_CALLOUT; |
| |
| /* Register serial and callout drivers */ |
| if(tty_register_driver(&rs_driver)) { |
| printk(KERN_ERR "Unable to register serial driver\n"); |
| goto error; |
| } |
| if(tty_register_driver(&rs_callout_driver)) { |
| tty_unregister_driver(&rs_driver); |
| printk(KERN_ERR "Unable to register callout driver\n"); |
| goto error; |
| } |
| |
| /* Assign IRQs */ |
| if(request_irq(2, rs_tx_interrupt, SA_SHIRQ, |
| "uarta_tx", rs_port)) { |
| printk(KERN_ERR "Cannot allocate IRQ for UARTA_TX.\n"); |
| goto error; |
| } |
| |
| if(request_irq(3, rs_rx_interrupt, SA_SHIRQ, |
| "uarta_rx", rs_port)) { |
| printk(KERN_ERR "Cannot allocate IRQ for UARTA_RX.\n"); |
| goto error; |
| } |
| |
| /* Enable the serial receive interrupt */ |
| rs_enable_rx_interrupts(rs_port); |
| |
| #ifndef CONFIG_SERIAL_TX3912_CONSOLE |
| /* Write the control registers */ |
| outl(TX3912_UART_CTRL2_B115200, TX3912_UARTA_CTRL2); |
| outl(0x00000000, TX3912_UARTA_DMA_CTRL1); |
| outl(0x00000000, TX3912_UARTA_DMA_CTRL2); |
| outl(inl(TX3912_UARTA_CTRL1) | TX3912_UART_CTRL1_ENUART, |
| TX3912_UARTA_CTRL1); |
| |
| /* Loop until the UART is on */ |
| while(~inl(TX3912_UARTA_CTRL1) & TX3912_UART_CTRL1_UARTON); |
| #endif |
| |
| rs_initialized = 1; |
| func_exit(); |
| return; |
| |
| error: |
| kfree(rs_termios_locked); |
| kfree(rs_termios); |
| kfree(rs_port); |
| kfree(rs_tty); |
| func_exit(); |
| } |
| |
| /* |
| * Begin serial console routines |
| */ |
| #ifdef CONFIG_SERIAL_TX3912_CONSOLE |
| void serial_outc(unsigned char c) |
| { |
| int i; |
| unsigned long int2; |
| |
| /* Disable UARTA_TX interrupts */ |
| int2 = inl(TX3912_INT2_ENABLE); |
| outl(inl(TX3912_INT2_ENABLE) & ~TX3912_INT2_UARTA_TX_BITS, |
| TX3912_INT2_ENABLE); |
| |
| /* Wait for UARTA_TX register to empty */ |
| i = 10000; |
| while(!(inl(TX3912_INT2_STATUS) & TX3912_INT2_UARTATXINT) && i--); |
| outl(TX3912_INT2_UARTA_TX_BITS, TX3912_INT2_CLEAR); |
| |
| /* Send the character */ |
| outl(c, TX3912_UARTA_DATA); |
| |
| /* Wait for UARTA_TX register to empty */ |
| i = 10000; |
| while(!(inl(TX3912_INT2_STATUS) & TX3912_INT2_UARTATXINT) && i--); |
| outl(TX3912_INT2_UARTA_TX_BITS, TX3912_INT2_CLEAR); |
| |
| /* Enable UARTA_TX interrupts */ |
| outl(int2, TX3912_INT2_ENABLE); |
| } |
| |
| static int serial_console_wait_key(struct console *co) |
| { |
| unsigned int int2, res; |
| |
| int2 = inl(TX3912_INT2_ENABLE); |
| outl(0, TX3912_INT2_ENABLE); |
| |
| while (!(inl(TX3912_UARTA_CTRL1) & TX3912_UART_CTRL1_RXHOLDFULL)); |
| res = inl(TX3912_UARTA_DATA); |
| udelay(10); |
| |
| outl(int2, TX3912_INT2_ENABLE); |
| return res; |
| } |
| |
| static void serial_console_write(struct console *co, const char *s, |
| unsigned count) |
| { |
| unsigned int i; |
| |
| for (i = 0; i < count; i++) { |
| if (*s == '\n') |
| serial_outc('\r'); |
| serial_outc(*s++); |
| } |
| } |
| |
| static kdev_t serial_console_device(struct console *c) |
| { |
| return MKDEV(TTY_MAJOR, 64 + c->index); |
| } |
| |
| static __init int serial_console_setup(struct console *co, char *options) |
| { |
| int baud = 115200; |
| int bits = 8; |
| int parity = 'n'; |
| char *s; |
| unsigned int ctrl1 = 0; |
| unsigned int ctrl2 = 0; |
| |
| if (options) { |
| baud = simple_strtoul(options, NULL, 10); |
| s = options; |
| while(*s >= '0' && *s <= '9') |
| s++; |
| if (*s) parity = *s++; |
| if (*s) bits = *s++ - '0'; |
| } |
| |
| switch(baud) { |
| case 1200: |
| ctrl2 = TX3912_UART_CTRL2_B1200; |
| break; |
| case 2400: |
| ctrl2 = TX3912_UART_CTRL2_B2400; |
| break; |
| case 4800: |
| ctrl2 = TX3912_UART_CTRL2_B4800; |
| break; |
| case 9600: |
| ctrl2 = TX3912_UART_CTRL2_B9600; |
| break; |
| case 19200: |
| ctrl2 = TX3912_UART_CTRL2_B19200; |
| break; |
| case 38400: |
| ctrl2 = TX3912_UART_CTRL2_B38400; |
| break; |
| case 57600: |
| ctrl2 = TX3912_UART_CTRL2_B57600; |
| break; |
| case 115200: |
| default: |
| ctrl2 = TX3912_UART_CTRL2_B115200; |
| break; |
| } |
| |
| switch(bits) { |
| case 7: |
| ctrl1 = TX3912_UART_CTRL1_BIT_7; |
| break; |
| default: |
| break; |
| } |
| |
| switch(parity) { |
| case 'o': case 'O': |
| ctrl1 |= TX3912_UART_CTRL1_ENPARITY; |
| break; |
| case 'e': case 'E': |
| ctrl1 |= (TX3912_UART_CTRL1_ENPARITY | |
| TX3912_UART_CTRL1_EVENPARITY); |
| break; |
| default: |
| break; |
| } |
| |
| /* Write the control registers */ |
| outl(ctrl2, TX3912_UARTA_CTRL2); |
| outl(0x00000000, TX3912_UARTA_DMA_CTRL1); |
| outl(0x00000000, TX3912_UARTA_DMA_CTRL2); |
| outl((ctrl1 | TX3912_UART_CTRL1_ENUART), TX3912_UARTA_CTRL1); |
| |
| /* Loop until the UART is on */ |
| while(~inl(TX3912_UARTA_CTRL1) & TX3912_UART_CTRL1_UARTON); |
| |
| return 0; |
| } |
| |
| static struct console sercons = { |
| name: "ttyS", |
| write: serial_console_write, |
| device: serial_console_device, |
| setup: serial_console_setup, |
| flags: CON_PRINTBUFFER, |
| index: -1 |
| }; |
| |
| void __init tx3912_console_init(void) |
| { |
| register_console(&sercons); |
| } |
| #endif |