mirror of
https://github.com/AuxXxilium/linux_dsm_epyc7002.git
synced 2024-11-25 17:40:54 +07:00
1c80f22f8d
Disintegrate asm/system.h for MN10300. Signed-off-by: David Howells <dhowells@redhat.com> cc: linux-am33-list@redhat.com
1711 lines
42 KiB
C
1711 lines
42 KiB
C
/* MN10300 On-chip serial port UART driver
|
|
*
|
|
* Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
|
|
* Written by David Howells (dhowells@redhat.com)
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public Licence
|
|
* as published by the Free Software Foundation; either version
|
|
* 2 of the Licence, or (at your option) any later version.
|
|
*/
|
|
|
|
static const char serial_name[] = "MN10300 Serial driver";
|
|
static const char serial_version[] = "mn10300_serial-1.0";
|
|
static const char serial_revdate[] = "2007-11-06";
|
|
|
|
#if defined(CONFIG_MN10300_TTYSM_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
|
|
#define SUPPORT_SYSRQ
|
|
#endif
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/serial.h>
|
|
#include <linux/circ_buf.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/signal.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/timer.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/tty_flip.h>
|
|
#include <linux/major.h>
|
|
#include <linux/string.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/slab.h>
|
|
#include <linux/init.h>
|
|
#include <linux/console.h>
|
|
#include <linux/sysrq.h>
|
|
|
|
#include <asm/io.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/bitops.h>
|
|
#include <asm/serial-regs.h>
|
|
#include <unit/timex.h>
|
|
#include "mn10300-serial.h"
|
|
|
|
#ifdef CONFIG_SMP
|
|
#undef GxICR
|
|
#define GxICR(X) CROSS_GxICR(X, 0)
|
|
#endif /* CONFIG_SMP */
|
|
|
|
#define kenter(FMT, ...) \
|
|
printk(KERN_DEBUG "-->%s(" FMT ")\n", __func__, ##__VA_ARGS__)
|
|
#define _enter(FMT, ...) \
|
|
no_printk(KERN_DEBUG "-->%s(" FMT ")\n", __func__, ##__VA_ARGS__)
|
|
#define kdebug(FMT, ...) \
|
|
printk(KERN_DEBUG "--- " FMT "\n", ##__VA_ARGS__)
|
|
#define _debug(FMT, ...) \
|
|
no_printk(KERN_DEBUG "--- " FMT "\n", ##__VA_ARGS__)
|
|
#define kproto(FMT, ...) \
|
|
printk(KERN_DEBUG "### MNSERIAL " FMT " ###\n", ##__VA_ARGS__)
|
|
#define _proto(FMT, ...) \
|
|
no_printk(KERN_DEBUG "### MNSERIAL " FMT " ###\n", ##__VA_ARGS__)
|
|
|
|
#ifndef CODMSB
|
|
/* c_cflag bit meaning */
|
|
#define CODMSB 004000000000 /* change Transfer bit-order */
|
|
#endif
|
|
|
|
#define NR_UARTS 3
|
|
|
|
#ifdef CONFIG_MN10300_TTYSM_CONSOLE
|
|
static void mn10300_serial_console_write(struct console *co,
|
|
const char *s, unsigned count);
|
|
static int __init mn10300_serial_console_setup(struct console *co,
|
|
char *options);
|
|
|
|
static struct uart_driver mn10300_serial_driver;
|
|
static struct console mn10300_serial_console = {
|
|
.name = "ttySM",
|
|
.write = mn10300_serial_console_write,
|
|
.device = uart_console_device,
|
|
.setup = mn10300_serial_console_setup,
|
|
.flags = CON_PRINTBUFFER,
|
|
.index = -1,
|
|
.data = &mn10300_serial_driver,
|
|
};
|
|
#endif
|
|
|
|
static struct uart_driver mn10300_serial_driver = {
|
|
.owner = NULL,
|
|
.driver_name = "mn10300-serial",
|
|
.dev_name = "ttySM",
|
|
.major = TTY_MAJOR,
|
|
.minor = 128,
|
|
.nr = NR_UARTS,
|
|
#ifdef CONFIG_MN10300_TTYSM_CONSOLE
|
|
.cons = &mn10300_serial_console,
|
|
#endif
|
|
};
|
|
|
|
static unsigned int mn10300_serial_tx_empty(struct uart_port *);
|
|
static void mn10300_serial_set_mctrl(struct uart_port *, unsigned int mctrl);
|
|
static unsigned int mn10300_serial_get_mctrl(struct uart_port *);
|
|
static void mn10300_serial_stop_tx(struct uart_port *);
|
|
static void mn10300_serial_start_tx(struct uart_port *);
|
|
static void mn10300_serial_send_xchar(struct uart_port *, char ch);
|
|
static void mn10300_serial_stop_rx(struct uart_port *);
|
|
static void mn10300_serial_enable_ms(struct uart_port *);
|
|
static void mn10300_serial_break_ctl(struct uart_port *, int ctl);
|
|
static int mn10300_serial_startup(struct uart_port *);
|
|
static void mn10300_serial_shutdown(struct uart_port *);
|
|
static void mn10300_serial_set_termios(struct uart_port *,
|
|
struct ktermios *new,
|
|
struct ktermios *old);
|
|
static const char *mn10300_serial_type(struct uart_port *);
|
|
static void mn10300_serial_release_port(struct uart_port *);
|
|
static int mn10300_serial_request_port(struct uart_port *);
|
|
static void mn10300_serial_config_port(struct uart_port *, int);
|
|
static int mn10300_serial_verify_port(struct uart_port *,
|
|
struct serial_struct *);
|
|
#ifdef CONFIG_CONSOLE_POLL
|
|
static void mn10300_serial_poll_put_char(struct uart_port *, unsigned char);
|
|
static int mn10300_serial_poll_get_char(struct uart_port *);
|
|
#endif
|
|
|
|
static const struct uart_ops mn10300_serial_ops = {
|
|
.tx_empty = mn10300_serial_tx_empty,
|
|
.set_mctrl = mn10300_serial_set_mctrl,
|
|
.get_mctrl = mn10300_serial_get_mctrl,
|
|
.stop_tx = mn10300_serial_stop_tx,
|
|
.start_tx = mn10300_serial_start_tx,
|
|
.send_xchar = mn10300_serial_send_xchar,
|
|
.stop_rx = mn10300_serial_stop_rx,
|
|
.enable_ms = mn10300_serial_enable_ms,
|
|
.break_ctl = mn10300_serial_break_ctl,
|
|
.startup = mn10300_serial_startup,
|
|
.shutdown = mn10300_serial_shutdown,
|
|
.set_termios = mn10300_serial_set_termios,
|
|
.type = mn10300_serial_type,
|
|
.release_port = mn10300_serial_release_port,
|
|
.request_port = mn10300_serial_request_port,
|
|
.config_port = mn10300_serial_config_port,
|
|
.verify_port = mn10300_serial_verify_port,
|
|
#ifdef CONFIG_CONSOLE_POLL
|
|
.poll_put_char = mn10300_serial_poll_put_char,
|
|
.poll_get_char = mn10300_serial_poll_get_char,
|
|
#endif
|
|
};
|
|
|
|
static irqreturn_t mn10300_serial_interrupt(int irq, void *dev_id);
|
|
|
|
/*
|
|
* the first on-chip serial port: ttySM0 (aka SIF0)
|
|
*/
|
|
#ifdef CONFIG_MN10300_TTYSM0
|
|
struct mn10300_serial_port mn10300_serial_port_sif0 = {
|
|
.uart.ops = &mn10300_serial_ops,
|
|
.uart.membase = (void __iomem *) &SC0CTR,
|
|
.uart.mapbase = (unsigned long) &SC0CTR,
|
|
.uart.iotype = UPIO_MEM,
|
|
.uart.irq = 0,
|
|
.uart.uartclk = 0, /* MN10300_IOCLK, */
|
|
.uart.fifosize = 1,
|
|
.uart.flags = UPF_BOOT_AUTOCONF,
|
|
.uart.line = 0,
|
|
.uart.type = PORT_MN10300,
|
|
.uart.lock =
|
|
__SPIN_LOCK_UNLOCKED(mn10300_serial_port_sif0.uart.lock),
|
|
.name = "ttySM0",
|
|
._iobase = &SC0CTR,
|
|
._control = &SC0CTR,
|
|
._status = (volatile u8 *)&SC0STR,
|
|
._intr = &SC0ICR,
|
|
._rxb = &SC0RXB,
|
|
._txb = &SC0TXB,
|
|
.rx_name = "ttySM0:Rx",
|
|
.tx_name = "ttySM0:Tx",
|
|
#if defined(CONFIG_MN10300_TTYSM0_TIMER8)
|
|
.tm_name = "ttySM0:Timer8",
|
|
._tmxmd = &TM8MD,
|
|
._tmxbr = &TM8BR,
|
|
._tmicr = &TM8ICR,
|
|
.tm_irq = TM8IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_16BIT,
|
|
#elif defined(CONFIG_MN10300_TTYSM0_TIMER0)
|
|
.tm_name = "ttySM0:Timer0",
|
|
._tmxmd = &TM0MD,
|
|
._tmxbr = (volatile u16 *)&TM0BR,
|
|
._tmicr = &TM0ICR,
|
|
.tm_irq = TM0IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_8BIT,
|
|
#elif defined(CONFIG_MN10300_TTYSM0_TIMER2)
|
|
.tm_name = "ttySM0:Timer2",
|
|
._tmxmd = &TM2MD,
|
|
._tmxbr = (volatile u16 *)&TM2BR,
|
|
._tmicr = &TM2ICR,
|
|
.tm_irq = TM2IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_8BIT,
|
|
#else
|
|
#error "Unknown config for ttySM0"
|
|
#endif
|
|
.rx_irq = SC0RXIRQ,
|
|
.tx_irq = SC0TXIRQ,
|
|
.rx_icr = &GxICR(SC0RXIRQ),
|
|
.tx_icr = &GxICR(SC0TXIRQ),
|
|
.clock_src = MNSCx_CLOCK_SRC_IOCLK,
|
|
.options = 0,
|
|
#ifdef CONFIG_GDBSTUB_ON_TTYSM0
|
|
.gdbstub = 1,
|
|
#endif
|
|
};
|
|
#endif /* CONFIG_MN10300_TTYSM0 */
|
|
|
|
/*
|
|
* the second on-chip serial port: ttySM1 (aka SIF1)
|
|
*/
|
|
#ifdef CONFIG_MN10300_TTYSM1
|
|
struct mn10300_serial_port mn10300_serial_port_sif1 = {
|
|
.uart.ops = &mn10300_serial_ops,
|
|
.uart.membase = (void __iomem *) &SC1CTR,
|
|
.uart.mapbase = (unsigned long) &SC1CTR,
|
|
.uart.iotype = UPIO_MEM,
|
|
.uart.irq = 0,
|
|
.uart.uartclk = 0, /* MN10300_IOCLK, */
|
|
.uart.fifosize = 1,
|
|
.uart.flags = UPF_BOOT_AUTOCONF,
|
|
.uart.line = 1,
|
|
.uart.type = PORT_MN10300,
|
|
.uart.lock =
|
|
__SPIN_LOCK_UNLOCKED(mn10300_serial_port_sif1.uart.lock),
|
|
.name = "ttySM1",
|
|
._iobase = &SC1CTR,
|
|
._control = &SC1CTR,
|
|
._status = (volatile u8 *)&SC1STR,
|
|
._intr = &SC1ICR,
|
|
._rxb = &SC1RXB,
|
|
._txb = &SC1TXB,
|
|
.rx_name = "ttySM1:Rx",
|
|
.tx_name = "ttySM1:Tx",
|
|
#if defined(CONFIG_MN10300_TTYSM1_TIMER9)
|
|
.tm_name = "ttySM1:Timer9",
|
|
._tmxmd = &TM9MD,
|
|
._tmxbr = &TM9BR,
|
|
._tmicr = &TM9ICR,
|
|
.tm_irq = TM9IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_16BIT,
|
|
#elif defined(CONFIG_MN10300_TTYSM1_TIMER3)
|
|
.tm_name = "ttySM1:Timer3",
|
|
._tmxmd = &TM3MD,
|
|
._tmxbr = (volatile u16 *)&TM3BR,
|
|
._tmicr = &TM3ICR,
|
|
.tm_irq = TM3IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_8BIT,
|
|
#elif defined(CONFIG_MN10300_TTYSM1_TIMER12)
|
|
.tm_name = "ttySM1/Timer12",
|
|
._tmxmd = &TM12MD,
|
|
._tmxbr = &TM12BR,
|
|
._tmicr = &TM12ICR,
|
|
.tm_irq = TM12IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_16BIT,
|
|
#else
|
|
#error "Unknown config for ttySM1"
|
|
#endif
|
|
.rx_irq = SC1RXIRQ,
|
|
.tx_irq = SC1TXIRQ,
|
|
.rx_icr = &GxICR(SC1RXIRQ),
|
|
.tx_icr = &GxICR(SC1TXIRQ),
|
|
.clock_src = MNSCx_CLOCK_SRC_IOCLK,
|
|
.options = 0,
|
|
#ifdef CONFIG_GDBSTUB_ON_TTYSM1
|
|
.gdbstub = 1,
|
|
#endif
|
|
};
|
|
#endif /* CONFIG_MN10300_TTYSM1 */
|
|
|
|
/*
|
|
* the third on-chip serial port: ttySM2 (aka SIF2)
|
|
*/
|
|
#ifdef CONFIG_MN10300_TTYSM2
|
|
struct mn10300_serial_port mn10300_serial_port_sif2 = {
|
|
.uart.ops = &mn10300_serial_ops,
|
|
.uart.membase = (void __iomem *) &SC2CTR,
|
|
.uart.mapbase = (unsigned long) &SC2CTR,
|
|
.uart.iotype = UPIO_MEM,
|
|
.uart.irq = 0,
|
|
.uart.uartclk = 0, /* MN10300_IOCLK, */
|
|
.uart.fifosize = 1,
|
|
.uart.flags = UPF_BOOT_AUTOCONF,
|
|
.uart.line = 2,
|
|
#ifdef CONFIG_MN10300_TTYSM2_CTS
|
|
.uart.type = PORT_MN10300_CTS,
|
|
#else
|
|
.uart.type = PORT_MN10300,
|
|
#endif
|
|
.uart.lock =
|
|
__SPIN_LOCK_UNLOCKED(mn10300_serial_port_sif2.uart.lock),
|
|
.name = "ttySM2",
|
|
._iobase = &SC2CTR,
|
|
._control = &SC2CTR,
|
|
._status = (volatile u8 *)&SC2STR,
|
|
._intr = &SC2ICR,
|
|
._rxb = &SC2RXB,
|
|
._txb = &SC2TXB,
|
|
.rx_name = "ttySM2:Rx",
|
|
.tx_name = "ttySM2:Tx",
|
|
#if defined(CONFIG_MN10300_TTYSM2_TIMER10)
|
|
.tm_name = "ttySM2/Timer10",
|
|
._tmxmd = &TM10MD,
|
|
._tmxbr = &TM10BR,
|
|
._tmicr = &TM10ICR,
|
|
.tm_irq = TM10IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_16BIT,
|
|
#elif defined(CONFIG_MN10300_TTYSM2_TIMER9)
|
|
.tm_name = "ttySM2/Timer9",
|
|
._tmxmd = &TM9MD,
|
|
._tmxbr = &TM9BR,
|
|
._tmicr = &TM9ICR,
|
|
.tm_irq = TM9IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_16BIT,
|
|
#elif defined(CONFIG_MN10300_TTYSM2_TIMER1)
|
|
.tm_name = "ttySM2/Timer1",
|
|
._tmxmd = &TM1MD,
|
|
._tmxbr = (volatile u16 *)&TM1BR,
|
|
._tmicr = &TM1ICR,
|
|
.tm_irq = TM1IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_8BIT,
|
|
#elif defined(CONFIG_MN10300_TTYSM2_TIMER3)
|
|
.tm_name = "ttySM2/Timer3",
|
|
._tmxmd = &TM3MD,
|
|
._tmxbr = (volatile u16 *)&TM3BR,
|
|
._tmicr = &TM3ICR,
|
|
.tm_irq = TM3IRQ,
|
|
.div_timer = MNSCx_DIV_TIMER_8BIT,
|
|
#else
|
|
#error "Unknown config for ttySM2"
|
|
#endif
|
|
.rx_irq = SC2RXIRQ,
|
|
.tx_irq = SC2TXIRQ,
|
|
.rx_icr = &GxICR(SC2RXIRQ),
|
|
.tx_icr = &GxICR(SC2TXIRQ),
|
|
.clock_src = MNSCx_CLOCK_SRC_IOCLK,
|
|
#ifdef CONFIG_MN10300_TTYSM2_CTS
|
|
.options = MNSCx_OPT_CTS,
|
|
#else
|
|
.options = 0,
|
|
#endif
|
|
#ifdef CONFIG_GDBSTUB_ON_TTYSM2
|
|
.gdbstub = 1,
|
|
#endif
|
|
};
|
|
#endif /* CONFIG_MN10300_TTYSM2 */
|
|
|
|
|
|
/*
|
|
* list of available serial ports
|
|
*/
|
|
struct mn10300_serial_port *mn10300_serial_ports[NR_UARTS + 1] = {
|
|
#ifdef CONFIG_MN10300_TTYSM0
|
|
[0] = &mn10300_serial_port_sif0,
|
|
#endif
|
|
#ifdef CONFIG_MN10300_TTYSM1
|
|
[1] = &mn10300_serial_port_sif1,
|
|
#endif
|
|
#ifdef CONFIG_MN10300_TTYSM2
|
|
[2] = &mn10300_serial_port_sif2,
|
|
#endif
|
|
[NR_UARTS] = NULL,
|
|
};
|
|
|
|
|
|
/*
|
|
* we abuse the serial ports' baud timers' interrupt lines to get the ability
|
|
* to deliver interrupts to userspace as we use the ports' interrupt lines to
|
|
* do virtual DMA on account of the ports having no hardware FIFOs
|
|
*
|
|
* we can generate an interrupt manually in the assembly stubs by writing to
|
|
* the enable and detect bits in the interrupt control register, so all we need
|
|
* to do here is disable the interrupt line
|
|
*
|
|
* note that we can't just leave the line enabled as the baud rate timer *also*
|
|
* generates interrupts
|
|
*/
|
|
static void mn10300_serial_mask_ack(unsigned int irq)
|
|
{
|
|
unsigned long flags;
|
|
u16 tmp;
|
|
|
|
flags = arch_local_cli_save();
|
|
GxICR(irq) = GxICR_LEVEL_6;
|
|
tmp = GxICR(irq); /* flush write buffer */
|
|
arch_local_irq_restore(flags);
|
|
}
|
|
|
|
static void mn10300_serial_chip_mask_ack(struct irq_data *d)
|
|
{
|
|
mn10300_serial_mask_ack(d->irq);
|
|
}
|
|
|
|
static void mn10300_serial_nop(struct irq_data *d)
|
|
{
|
|
}
|
|
|
|
static struct irq_chip mn10300_serial_pic = {
|
|
.name = "mnserial",
|
|
.irq_ack = mn10300_serial_chip_mask_ack,
|
|
.irq_mask = mn10300_serial_chip_mask_ack,
|
|
.irq_mask_ack = mn10300_serial_chip_mask_ack,
|
|
.irq_unmask = mn10300_serial_nop,
|
|
};
|
|
|
|
|
|
/*
|
|
* serial virtual DMA interrupt jump table
|
|
*/
|
|
struct mn10300_serial_int mn10300_serial_int_tbl[NR_IRQS];
|
|
|
|
static void mn10300_serial_dis_tx_intr(struct mn10300_serial_port *port)
|
|
{
|
|
unsigned long flags;
|
|
u16 x;
|
|
|
|
flags = arch_local_cli_save();
|
|
*port->tx_icr = NUM2GxICR_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL);
|
|
x = *port->tx_icr;
|
|
arch_local_irq_restore(flags);
|
|
}
|
|
|
|
static void mn10300_serial_en_tx_intr(struct mn10300_serial_port *port)
|
|
{
|
|
unsigned long flags;
|
|
u16 x;
|
|
|
|
flags = arch_local_cli_save();
|
|
*port->tx_icr =
|
|
NUM2GxICR_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL) | GxICR_ENABLE;
|
|
x = *port->tx_icr;
|
|
arch_local_irq_restore(flags);
|
|
}
|
|
|
|
static void mn10300_serial_dis_rx_intr(struct mn10300_serial_port *port)
|
|
{
|
|
unsigned long flags;
|
|
u16 x;
|
|
|
|
flags = arch_local_cli_save();
|
|
*port->rx_icr = NUM2GxICR_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL);
|
|
x = *port->rx_icr;
|
|
arch_local_irq_restore(flags);
|
|
}
|
|
|
|
/*
|
|
* multi-bit equivalent of test_and_clear_bit()
|
|
*/
|
|
static int mask_test_and_clear(volatile u8 *ptr, u8 mask)
|
|
{
|
|
u32 epsw;
|
|
asm volatile(" bclr %1,(%2) \n"
|
|
" mov epsw,%0 \n"
|
|
: "=d"(epsw) : "d"(mask), "a"(ptr)
|
|
: "cc", "memory");
|
|
return !(epsw & EPSW_FLAG_Z);
|
|
}
|
|
|
|
/*
|
|
* receive chars from the ring buffer for this serial port
|
|
* - must do break detection here (not done in the UART)
|
|
*/
|
|
static void mn10300_serial_receive_interrupt(struct mn10300_serial_port *port)
|
|
{
|
|
struct uart_icount *icount = &port->uart.icount;
|
|
struct tty_struct *tty = port->uart.state->port.tty;
|
|
unsigned ix;
|
|
int count;
|
|
u8 st, ch, push, status, overrun;
|
|
|
|
_enter("%s", port->name);
|
|
|
|
push = 0;
|
|
|
|
count = CIRC_CNT(port->rx_inp, port->rx_outp, MNSC_BUFFER_SIZE);
|
|
count = tty_buffer_request_room(tty, count);
|
|
if (count == 0) {
|
|
if (!tty->low_latency)
|
|
tty_flip_buffer_push(tty);
|
|
return;
|
|
}
|
|
|
|
try_again:
|
|
/* pull chars out of the hat */
|
|
ix = port->rx_outp;
|
|
if (ix == port->rx_inp) {
|
|
if (push && !tty->low_latency)
|
|
tty_flip_buffer_push(tty);
|
|
return;
|
|
}
|
|
|
|
ch = port->rx_buffer[ix++];
|
|
st = port->rx_buffer[ix++];
|
|
smp_rmb();
|
|
port->rx_outp = ix & (MNSC_BUFFER_SIZE - 1);
|
|
port->uart.icount.rx++;
|
|
|
|
st &= SC01STR_FEF | SC01STR_PEF | SC01STR_OEF;
|
|
status = 0;
|
|
overrun = 0;
|
|
|
|
/* the UART doesn't detect BREAK, so we have to do that ourselves
|
|
* - it starts as a framing error on a NUL character
|
|
* - then we count another two NUL characters before issuing TTY_BREAK
|
|
* - then we end on a normal char or one that has all the bottom bits
|
|
* zero and the top bits set
|
|
*/
|
|
switch (port->rx_brk) {
|
|
case 0:
|
|
/* not breaking at the moment */
|
|
break;
|
|
|
|
case 1:
|
|
if (st & SC01STR_FEF && ch == 0) {
|
|
port->rx_brk = 2;
|
|
goto try_again;
|
|
}
|
|
goto not_break;
|
|
|
|
case 2:
|
|
if (st & SC01STR_FEF && ch == 0) {
|
|
port->rx_brk = 3;
|
|
_proto("Rx Break Detected");
|
|
icount->brk++;
|
|
if (uart_handle_break(&port->uart))
|
|
goto ignore_char;
|
|
status |= 1 << TTY_BREAK;
|
|
goto insert;
|
|
}
|
|
goto not_break;
|
|
|
|
default:
|
|
if (st & (SC01STR_FEF | SC01STR_PEF | SC01STR_OEF))
|
|
goto try_again; /* still breaking */
|
|
|
|
port->rx_brk = 0; /* end of the break */
|
|
|
|
switch (ch) {
|
|
case 0xFF:
|
|
case 0xFE:
|
|
case 0xFC:
|
|
case 0xF8:
|
|
case 0xF0:
|
|
case 0xE0:
|
|
case 0xC0:
|
|
case 0x80:
|
|
case 0x00:
|
|
/* discard char at probable break end */
|
|
goto try_again;
|
|
}
|
|
break;
|
|
}
|
|
|
|
process_errors:
|
|
/* handle framing error */
|
|
if (st & SC01STR_FEF) {
|
|
if (ch == 0) {
|
|
/* framing error with NUL char is probably a BREAK */
|
|
port->rx_brk = 1;
|
|
goto try_again;
|
|
}
|
|
|
|
_proto("Rx Framing Error");
|
|
icount->frame++;
|
|
status |= 1 << TTY_FRAME;
|
|
}
|
|
|
|
/* handle parity error */
|
|
if (st & SC01STR_PEF) {
|
|
_proto("Rx Parity Error");
|
|
icount->parity++;
|
|
status = TTY_PARITY;
|
|
}
|
|
|
|
/* handle normal char */
|
|
if (status == 0) {
|
|
if (uart_handle_sysrq_char(&port->uart, ch))
|
|
goto ignore_char;
|
|
status = (1 << TTY_NORMAL);
|
|
}
|
|
|
|
/* handle overrun error */
|
|
if (st & SC01STR_OEF) {
|
|
if (port->rx_brk)
|
|
goto try_again;
|
|
|
|
_proto("Rx Overrun Error");
|
|
icount->overrun++;
|
|
overrun = 1;
|
|
}
|
|
|
|
insert:
|
|
status &= port->uart.read_status_mask;
|
|
|
|
if (!overrun && !(status & port->uart.ignore_status_mask)) {
|
|
int flag;
|
|
|
|
if (status & (1 << TTY_BREAK))
|
|
flag = TTY_BREAK;
|
|
else if (status & (1 << TTY_PARITY))
|
|
flag = TTY_PARITY;
|
|
else if (status & (1 << TTY_FRAME))
|
|
flag = TTY_FRAME;
|
|
else
|
|
flag = TTY_NORMAL;
|
|
|
|
tty_insert_flip_char(tty, ch, flag);
|
|
}
|
|
|
|
/* overrun is special, since it's reported immediately, and doesn't
|
|
* affect the current character
|
|
*/
|
|
if (overrun)
|
|
tty_insert_flip_char(tty, 0, TTY_OVERRUN);
|
|
|
|
count--;
|
|
if (count <= 0) {
|
|
if (!tty->low_latency)
|
|
tty_flip_buffer_push(tty);
|
|
return;
|
|
}
|
|
|
|
ignore_char:
|
|
push = 1;
|
|
goto try_again;
|
|
|
|
not_break:
|
|
port->rx_brk = 0;
|
|
goto process_errors;
|
|
}
|
|
|
|
/*
|
|
* handle an interrupt from the serial transmission "virtual DMA" driver
|
|
* - note: the interrupt routine will disable its own interrupts when the Tx
|
|
* buffer is empty
|
|
*/
|
|
static void mn10300_serial_transmit_interrupt(struct mn10300_serial_port *port)
|
|
{
|
|
_enter("%s", port->name);
|
|
|
|
if (!port->uart.state || !port->uart.state->port.tty) {
|
|
mn10300_serial_dis_tx_intr(port);
|
|
return;
|
|
}
|
|
|
|
if (uart_tx_stopped(&port->uart) ||
|
|
uart_circ_empty(&port->uart.state->xmit))
|
|
mn10300_serial_dis_tx_intr(port);
|
|
|
|
if (uart_circ_chars_pending(&port->uart.state->xmit) < WAKEUP_CHARS)
|
|
uart_write_wakeup(&port->uart);
|
|
}
|
|
|
|
/*
|
|
* deal with a change in the status of the CTS line
|
|
*/
|
|
static void mn10300_serial_cts_changed(struct mn10300_serial_port *port, u8 st)
|
|
{
|
|
u16 ctr;
|
|
|
|
port->tx_cts = st;
|
|
port->uart.icount.cts++;
|
|
|
|
/* flip the CTS state selector flag to interrupt when it changes
|
|
* back */
|
|
ctr = *port->_control;
|
|
ctr ^= SC2CTR_TWS;
|
|
*port->_control = ctr;
|
|
|
|
uart_handle_cts_change(&port->uart, st & SC2STR_CTS);
|
|
wake_up_interruptible(&port->uart.state->port.delta_msr_wait);
|
|
}
|
|
|
|
/*
|
|
* handle a virtual interrupt generated by the lower level "virtual DMA"
|
|
* routines (irq is the baud timer interrupt)
|
|
*/
|
|
static irqreturn_t mn10300_serial_interrupt(int irq, void *dev_id)
|
|
{
|
|
struct mn10300_serial_port *port = dev_id;
|
|
u8 st;
|
|
|
|
spin_lock(&port->uart.lock);
|
|
|
|
if (port->intr_flags) {
|
|
_debug("INT %s: %x", port->name, port->intr_flags);
|
|
|
|
if (mask_test_and_clear(&port->intr_flags, MNSCx_RX_AVAIL))
|
|
mn10300_serial_receive_interrupt(port);
|
|
|
|
if (mask_test_and_clear(&port->intr_flags,
|
|
MNSCx_TX_SPACE | MNSCx_TX_EMPTY))
|
|
mn10300_serial_transmit_interrupt(port);
|
|
}
|
|
|
|
/* the only modem control line amongst the whole lot is CTS on
|
|
* serial port 2 */
|
|
if (port->type == PORT_MN10300_CTS) {
|
|
st = *port->_status;
|
|
if ((port->tx_cts ^ st) & SC2STR_CTS)
|
|
mn10300_serial_cts_changed(port, st);
|
|
}
|
|
|
|
spin_unlock(&port->uart.lock);
|
|
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/*
|
|
* return indication of whether the hardware transmit buffer is empty
|
|
*/
|
|
static unsigned int mn10300_serial_tx_empty(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s", port->name);
|
|
|
|
return (*port->_status & (SC01STR_TXF | SC01STR_TBF)) ?
|
|
0 : TIOCSER_TEMT;
|
|
}
|
|
|
|
/*
|
|
* set the modem control lines (we don't have any)
|
|
*/
|
|
static void mn10300_serial_set_mctrl(struct uart_port *_port,
|
|
unsigned int mctrl)
|
|
{
|
|
struct mn10300_serial_port *port __attribute__ ((unused)) =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s,%x", port->name, mctrl);
|
|
}
|
|
|
|
/*
|
|
* get the modem control line statuses
|
|
*/
|
|
static unsigned int mn10300_serial_get_mctrl(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s", port->name);
|
|
|
|
if (port->type == PORT_MN10300_CTS && !(*port->_status & SC2STR_CTS))
|
|
return TIOCM_CAR | TIOCM_DSR;
|
|
|
|
return TIOCM_CAR | TIOCM_CTS | TIOCM_DSR;
|
|
}
|
|
|
|
/*
|
|
* stop transmitting characters
|
|
*/
|
|
static void mn10300_serial_stop_tx(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s", port->name);
|
|
|
|
/* disable the virtual DMA */
|
|
mn10300_serial_dis_tx_intr(port);
|
|
}
|
|
|
|
/*
|
|
* start transmitting characters
|
|
* - jump-start transmission if it has stalled
|
|
* - enable the serial Tx interrupt (used by the virtual DMA controller)
|
|
* - force an interrupt to happen if necessary
|
|
*/
|
|
static void mn10300_serial_start_tx(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
u16 x;
|
|
|
|
_enter("%s{%lu}",
|
|
port->name,
|
|
CIRC_CNT(&port->uart.state->xmit.head,
|
|
&port->uart.state->xmit.tail,
|
|
UART_XMIT_SIZE));
|
|
|
|
/* kick the virtual DMA controller */
|
|
arch_local_cli();
|
|
x = *port->tx_icr;
|
|
x |= GxICR_ENABLE;
|
|
|
|
if (*port->_status & SC01STR_TBF)
|
|
x &= ~(GxICR_REQUEST | GxICR_DETECT);
|
|
else
|
|
x |= GxICR_REQUEST | GxICR_DETECT;
|
|
|
|
_debug("CTR=%04hx ICR=%02hx STR=%04x TMD=%02hx TBR=%04hx ICR=%04hx",
|
|
*port->_control, *port->_intr, *port->_status,
|
|
*port->_tmxmd,
|
|
(port->div_timer == MNSCx_DIV_TIMER_8BIT) ?
|
|
*(volatile u8 *)port->_tmxbr : *port->_tmxbr,
|
|
*port->tx_icr);
|
|
|
|
*port->tx_icr = x;
|
|
x = *port->tx_icr;
|
|
arch_local_sti();
|
|
}
|
|
|
|
/*
|
|
* transmit a high-priority XON/XOFF character
|
|
*/
|
|
static void mn10300_serial_send_xchar(struct uart_port *_port, char ch)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s,%02x", port->name, ch);
|
|
|
|
if (likely(port->gdbstub)) {
|
|
port->tx_xchar = ch;
|
|
if (ch)
|
|
mn10300_serial_en_tx_intr(port);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* stop receiving characters
|
|
* - called whilst the port is being closed
|
|
*/
|
|
static void mn10300_serial_stop_rx(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
u16 ctr;
|
|
|
|
_enter("%s", port->name);
|
|
|
|
ctr = *port->_control;
|
|
ctr &= ~SC01CTR_RXE;
|
|
*port->_control = ctr;
|
|
|
|
mn10300_serial_dis_rx_intr(port);
|
|
}
|
|
|
|
/*
|
|
* enable modem status interrupts
|
|
*/
|
|
static void mn10300_serial_enable_ms(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
u16 ctr, cts;
|
|
|
|
_enter("%s", port->name);
|
|
|
|
if (port->type == PORT_MN10300_CTS) {
|
|
/* want to interrupt when CTS goes low if CTS is now high and
|
|
* vice versa
|
|
*/
|
|
port->tx_cts = *port->_status;
|
|
|
|
cts = (port->tx_cts & SC2STR_CTS) ?
|
|
SC2CTR_TWE : SC2CTR_TWE | SC2CTR_TWS;
|
|
|
|
ctr = *port->_control;
|
|
ctr &= ~SC2CTR_TWS;
|
|
ctr |= cts;
|
|
*port->_control = ctr;
|
|
|
|
mn10300_serial_en_tx_intr(port);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* transmit or cease transmitting a break signal
|
|
*/
|
|
static void mn10300_serial_break_ctl(struct uart_port *_port, int ctl)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s,%d", port->name, ctl);
|
|
|
|
if (ctl) {
|
|
/* tell the virtual DMA handler to assert BREAK */
|
|
port->tx_break = 1;
|
|
mn10300_serial_en_tx_intr(port);
|
|
} else {
|
|
port->tx_break = 0;
|
|
*port->_control &= ~SC01CTR_BKE;
|
|
mn10300_serial_en_tx_intr(port);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* grab the interrupts and enable the port for reception
|
|
*/
|
|
static int mn10300_serial_startup(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
struct mn10300_serial_int *pint;
|
|
|
|
_enter("%s{%d}", port->name, port->gdbstub);
|
|
|
|
if (unlikely(port->gdbstub))
|
|
return -EBUSY;
|
|
|
|
/* allocate an Rx buffer for the virtual DMA handler */
|
|
port->rx_buffer = kmalloc(MNSC_BUFFER_SIZE, GFP_KERNEL);
|
|
if (!port->rx_buffer)
|
|
return -ENOMEM;
|
|
|
|
port->rx_inp = port->rx_outp = 0;
|
|
|
|
/* finally, enable the device */
|
|
*port->_intr = SC01ICR_TI;
|
|
*port->_control |= SC01CTR_TXE | SC01CTR_RXE;
|
|
|
|
pint = &mn10300_serial_int_tbl[port->rx_irq];
|
|
pint->port = port;
|
|
pint->vdma = mn10300_serial_vdma_rx_handler;
|
|
pint = &mn10300_serial_int_tbl[port->tx_irq];
|
|
pint->port = port;
|
|
pint->vdma = mn10300_serial_vdma_tx_handler;
|
|
|
|
set_intr_level(port->rx_irq,
|
|
NUM2GxICR_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL));
|
|
set_intr_level(port->tx_irq,
|
|
NUM2GxICR_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL));
|
|
irq_set_chip(port->tm_irq, &mn10300_serial_pic);
|
|
|
|
if (request_irq(port->rx_irq, mn10300_serial_interrupt,
|
|
IRQF_DISABLED, port->rx_name, port) < 0)
|
|
goto error;
|
|
|
|
if (request_irq(port->tx_irq, mn10300_serial_interrupt,
|
|
IRQF_DISABLED, port->tx_name, port) < 0)
|
|
goto error2;
|
|
|
|
if (request_irq(port->tm_irq, mn10300_serial_interrupt,
|
|
IRQF_DISABLED, port->tm_name, port) < 0)
|
|
goto error3;
|
|
mn10300_serial_mask_ack(port->tm_irq);
|
|
|
|
return 0;
|
|
|
|
error3:
|
|
free_irq(port->tx_irq, port);
|
|
error2:
|
|
free_irq(port->rx_irq, port);
|
|
error:
|
|
kfree(port->rx_buffer);
|
|
port->rx_buffer = NULL;
|
|
return -EBUSY;
|
|
}
|
|
|
|
/*
|
|
* shutdown the port and release interrupts
|
|
*/
|
|
static void mn10300_serial_shutdown(struct uart_port *_port)
|
|
{
|
|
u16 x;
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s", port->name);
|
|
|
|
/* disable the serial port and its baud rate timer */
|
|
port->tx_break = 0;
|
|
*port->_control &= ~(SC01CTR_TXE | SC01CTR_RXE | SC01CTR_BKE);
|
|
*port->_tmxmd = 0;
|
|
|
|
if (port->rx_buffer) {
|
|
void *buf = port->rx_buffer;
|
|
port->rx_buffer = NULL;
|
|
kfree(buf);
|
|
}
|
|
|
|
/* disable all intrs */
|
|
free_irq(port->tm_irq, port);
|
|
free_irq(port->rx_irq, port);
|
|
free_irq(port->tx_irq, port);
|
|
|
|
arch_local_cli();
|
|
*port->rx_icr = NUM2GxICR_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL);
|
|
x = *port->rx_icr;
|
|
*port->tx_icr = NUM2GxICR_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL);
|
|
x = *port->tx_icr;
|
|
arch_local_sti();
|
|
}
|
|
|
|
/*
|
|
* this routine is called to set the UART divisor registers to match the
|
|
* specified baud rate for a serial port.
|
|
*/
|
|
static void mn10300_serial_change_speed(struct mn10300_serial_port *port,
|
|
struct ktermios *new,
|
|
struct ktermios *old)
|
|
{
|
|
unsigned long flags;
|
|
unsigned long ioclk = port->ioclk;
|
|
unsigned cflag;
|
|
int baud, bits, xdiv, tmp;
|
|
u16 tmxbr, scxctr;
|
|
u8 tmxmd, battempt;
|
|
u8 div_timer = port->div_timer;
|
|
|
|
_enter("%s{%lu}", port->name, ioclk);
|
|
|
|
/* byte size and parity */
|
|
cflag = new->c_cflag;
|
|
switch (cflag & CSIZE) {
|
|
case CS7: scxctr = SC01CTR_CLN_7BIT; bits = 9; break;
|
|
case CS8: scxctr = SC01CTR_CLN_8BIT; bits = 10; break;
|
|
default: scxctr = SC01CTR_CLN_8BIT; bits = 10; break;
|
|
}
|
|
|
|
if (cflag & CSTOPB) {
|
|
scxctr |= SC01CTR_STB_2BIT;
|
|
bits++;
|
|
}
|
|
|
|
if (cflag & PARENB) {
|
|
bits++;
|
|
if (cflag & PARODD)
|
|
scxctr |= SC01CTR_PB_ODD;
|
|
#ifdef CMSPAR
|
|
else if (cflag & CMSPAR)
|
|
scxctr |= SC01CTR_PB_FIXED0;
|
|
#endif
|
|
else
|
|
scxctr |= SC01CTR_PB_EVEN;
|
|
}
|
|
|
|
/* Determine divisor based on baud rate */
|
|
battempt = 0;
|
|
|
|
switch (port->uart.line) {
|
|
#ifdef CONFIG_MN10300_TTYSM0
|
|
case 0: /* ttySM0 */
|
|
#if defined(CONFIG_MN10300_TTYSM0_TIMER8)
|
|
scxctr |= SC0CTR_CK_TM8UFLOW_8;
|
|
#elif defined(CONFIG_MN10300_TTYSM0_TIMER0)
|
|
scxctr |= SC0CTR_CK_TM0UFLOW_8;
|
|
#elif defined(CONFIG_MN10300_TTYSM0_TIMER2)
|
|
scxctr |= SC0CTR_CK_TM2UFLOW_8;
|
|
#else
|
|
#error "Unknown config for ttySM0"
|
|
#endif
|
|
break;
|
|
#endif /* CONFIG_MN10300_TTYSM0 */
|
|
|
|
#ifdef CONFIG_MN10300_TTYSM1
|
|
case 1: /* ttySM1 */
|
|
#if defined(CONFIG_AM33_2) || defined(CONFIG_AM33_3)
|
|
#if defined(CONFIG_MN10300_TTYSM1_TIMER9)
|
|
scxctr |= SC1CTR_CK_TM9UFLOW_8;
|
|
#elif defined(CONFIG_MN10300_TTYSM1_TIMER3)
|
|
scxctr |= SC1CTR_CK_TM3UFLOW_8;
|
|
#else
|
|
#error "Unknown config for ttySM1"
|
|
#endif
|
|
#else /* CONFIG_AM33_2 || CONFIG_AM33_3 */
|
|
#if defined(CONFIG_MN10300_TTYSM1_TIMER12)
|
|
scxctr |= SC1CTR_CK_TM12UFLOW_8;
|
|
#else
|
|
#error "Unknown config for ttySM1"
|
|
#endif
|
|
#endif /* CONFIG_AM33_2 || CONFIG_AM33_3 */
|
|
break;
|
|
#endif /* CONFIG_MN10300_TTYSM1 */
|
|
|
|
#ifdef CONFIG_MN10300_TTYSM2
|
|
case 2: /* ttySM2 */
|
|
#if defined(CONFIG_AM33_2)
|
|
#if defined(CONFIG_MN10300_TTYSM2_TIMER10)
|
|
scxctr |= SC2CTR_CK_TM10UFLOW;
|
|
#else
|
|
#error "Unknown config for ttySM2"
|
|
#endif
|
|
#else /* CONFIG_AM33_2 */
|
|
#if defined(CONFIG_MN10300_TTYSM2_TIMER9)
|
|
scxctr |= SC2CTR_CK_TM9UFLOW_8;
|
|
#elif defined(CONFIG_MN10300_TTYSM2_TIMER1)
|
|
scxctr |= SC2CTR_CK_TM1UFLOW_8;
|
|
#elif defined(CONFIG_MN10300_TTYSM2_TIMER3)
|
|
scxctr |= SC2CTR_CK_TM3UFLOW_8;
|
|
#else
|
|
#error "Unknown config for ttySM2"
|
|
#endif
|
|
#endif /* CONFIG_AM33_2 */
|
|
break;
|
|
#endif /* CONFIG_MN10300_TTYSM2 */
|
|
|
|
default:
|
|
break;
|
|
}
|
|
|
|
try_alternative:
|
|
baud = uart_get_baud_rate(&port->uart, new, old, 0,
|
|
port->ioclk / 8);
|
|
|
|
_debug("ALT %d [baud %d]", battempt, baud);
|
|
|
|
if (!baud)
|
|
baud = 9600; /* B0 transition handled in rs_set_termios */
|
|
xdiv = 1;
|
|
if (baud == 134) {
|
|
baud = 269; /* 134 is really 134.5 */
|
|
xdiv = 2;
|
|
}
|
|
|
|
if (baud == 38400 &&
|
|
(port->uart.flags & UPF_SPD_MASK) == UPF_SPD_CUST
|
|
) {
|
|
_debug("CUSTOM %u", port->uart.custom_divisor);
|
|
|
|
if (div_timer == MNSCx_DIV_TIMER_16BIT) {
|
|
if (port->uart.custom_divisor <= 65535) {
|
|
tmxmd = TM8MD_SRC_IOCLK;
|
|
tmxbr = port->uart.custom_divisor;
|
|
port->uart.uartclk = ioclk;
|
|
goto timer_okay;
|
|
}
|
|
if (port->uart.custom_divisor / 8 <= 65535) {
|
|
tmxmd = TM8MD_SRC_IOCLK_8;
|
|
tmxbr = port->uart.custom_divisor / 8;
|
|
port->uart.custom_divisor = tmxbr * 8;
|
|
port->uart.uartclk = ioclk / 8;
|
|
goto timer_okay;
|
|
}
|
|
if (port->uart.custom_divisor / 32 <= 65535) {
|
|
tmxmd = TM8MD_SRC_IOCLK_32;
|
|
tmxbr = port->uart.custom_divisor / 32;
|
|
port->uart.custom_divisor = tmxbr * 32;
|
|
port->uart.uartclk = ioclk / 32;
|
|
goto timer_okay;
|
|
}
|
|
|
|
} else if (div_timer == MNSCx_DIV_TIMER_8BIT) {
|
|
if (port->uart.custom_divisor <= 255) {
|
|
tmxmd = TM2MD_SRC_IOCLK;
|
|
tmxbr = port->uart.custom_divisor;
|
|
port->uart.uartclk = ioclk;
|
|
goto timer_okay;
|
|
}
|
|
if (port->uart.custom_divisor / 8 <= 255) {
|
|
tmxmd = TM2MD_SRC_IOCLK_8;
|
|
tmxbr = port->uart.custom_divisor / 8;
|
|
port->uart.custom_divisor = tmxbr * 8;
|
|
port->uart.uartclk = ioclk / 8;
|
|
goto timer_okay;
|
|
}
|
|
if (port->uart.custom_divisor / 32 <= 255) {
|
|
tmxmd = TM2MD_SRC_IOCLK_32;
|
|
tmxbr = port->uart.custom_divisor / 32;
|
|
port->uart.custom_divisor = tmxbr * 32;
|
|
port->uart.uartclk = ioclk / 32;
|
|
goto timer_okay;
|
|
}
|
|
}
|
|
}
|
|
|
|
switch (div_timer) {
|
|
case MNSCx_DIV_TIMER_16BIT:
|
|
port->uart.uartclk = ioclk;
|
|
tmxmd = TM8MD_SRC_IOCLK;
|
|
tmxbr = tmp = (ioclk / (baud * xdiv) + 4) / 8 - 1;
|
|
if (tmp > 0 && tmp <= 65535)
|
|
goto timer_okay;
|
|
|
|
port->uart.uartclk = ioclk / 8;
|
|
tmxmd = TM8MD_SRC_IOCLK_8;
|
|
tmxbr = tmp = (ioclk / (baud * 8 * xdiv) + 4) / 8 - 1;
|
|
if (tmp > 0 && tmp <= 65535)
|
|
goto timer_okay;
|
|
|
|
port->uart.uartclk = ioclk / 32;
|
|
tmxmd = TM8MD_SRC_IOCLK_32;
|
|
tmxbr = tmp = (ioclk / (baud * 32 * xdiv) + 4) / 8 - 1;
|
|
if (tmp > 0 && tmp <= 65535)
|
|
goto timer_okay;
|
|
break;
|
|
|
|
case MNSCx_DIV_TIMER_8BIT:
|
|
port->uart.uartclk = ioclk;
|
|
tmxmd = TM2MD_SRC_IOCLK;
|
|
tmxbr = tmp = (ioclk / (baud * xdiv) + 4) / 8 - 1;
|
|
if (tmp > 0 && tmp <= 255)
|
|
goto timer_okay;
|
|
|
|
port->uart.uartclk = ioclk / 8;
|
|
tmxmd = TM2MD_SRC_IOCLK_8;
|
|
tmxbr = tmp = (ioclk / (baud * 8 * xdiv) + 4) / 8 - 1;
|
|
if (tmp > 0 && tmp <= 255)
|
|
goto timer_okay;
|
|
|
|
port->uart.uartclk = ioclk / 32;
|
|
tmxmd = TM2MD_SRC_IOCLK_32;
|
|
tmxbr = tmp = (ioclk / (baud * 32 * xdiv) + 4) / 8 - 1;
|
|
if (tmp > 0 && tmp <= 255)
|
|
goto timer_okay;
|
|
break;
|
|
|
|
default:
|
|
BUG();
|
|
return;
|
|
}
|
|
|
|
/* refuse to change to a baud rate we can't support */
|
|
_debug("CAN'T SUPPORT");
|
|
|
|
switch (battempt) {
|
|
case 0:
|
|
if (old) {
|
|
new->c_cflag &= ~CBAUD;
|
|
new->c_cflag |= (old->c_cflag & CBAUD);
|
|
battempt = 1;
|
|
goto try_alternative;
|
|
}
|
|
|
|
case 1:
|
|
/* as a last resort, if the quotient is zero, default to 9600
|
|
* bps */
|
|
new->c_cflag &= ~CBAUD;
|
|
new->c_cflag |= B9600;
|
|
battempt = 2;
|
|
goto try_alternative;
|
|
|
|
default:
|
|
/* hmmm... can't seem to support 9600 either
|
|
* - we could try iterating through the speeds we know about to
|
|
* find the lowest
|
|
*/
|
|
new->c_cflag &= ~CBAUD;
|
|
new->c_cflag |= B0;
|
|
|
|
if (div_timer == MNSCx_DIV_TIMER_16BIT)
|
|
tmxmd = TM8MD_SRC_IOCLK_32;
|
|
else if (div_timer == MNSCx_DIV_TIMER_8BIT)
|
|
tmxmd = TM2MD_SRC_IOCLK_32;
|
|
tmxbr = 1;
|
|
|
|
port->uart.uartclk = ioclk / 32;
|
|
break;
|
|
}
|
|
timer_okay:
|
|
|
|
_debug("UARTCLK: %u / %hu", port->uart.uartclk, tmxbr);
|
|
|
|
/* make the changes */
|
|
spin_lock_irqsave(&port->uart.lock, flags);
|
|
|
|
uart_update_timeout(&port->uart, new->c_cflag, baud);
|
|
|
|
/* set the timer to produce the required baud rate */
|
|
switch (div_timer) {
|
|
case MNSCx_DIV_TIMER_16BIT:
|
|
*port->_tmxmd = 0;
|
|
*port->_tmxbr = tmxbr;
|
|
*port->_tmxmd = TM8MD_INIT_COUNTER;
|
|
*port->_tmxmd = tmxmd | TM8MD_COUNT_ENABLE;
|
|
break;
|
|
|
|
case MNSCx_DIV_TIMER_8BIT:
|
|
*port->_tmxmd = 0;
|
|
*(volatile u8 *) port->_tmxbr = (u8) tmxbr;
|
|
*port->_tmxmd = TM2MD_INIT_COUNTER;
|
|
*port->_tmxmd = tmxmd | TM2MD_COUNT_ENABLE;
|
|
break;
|
|
}
|
|
|
|
/* CTS flow control flag and modem status interrupts */
|
|
scxctr &= ~(SC2CTR_TWE | SC2CTR_TWS);
|
|
|
|
if (port->type == PORT_MN10300_CTS && cflag & CRTSCTS) {
|
|
/* want to interrupt when CTS goes low if CTS is now
|
|
* high and vice versa
|
|
*/
|
|
port->tx_cts = *port->_status;
|
|
|
|
if (port->tx_cts & SC2STR_CTS)
|
|
scxctr |= SC2CTR_TWE;
|
|
else
|
|
scxctr |= SC2CTR_TWE | SC2CTR_TWS;
|
|
}
|
|
|
|
/* set up parity check flag */
|
|
port->uart.read_status_mask = (1 << TTY_NORMAL) | (1 << TTY_OVERRUN);
|
|
if (new->c_iflag & INPCK)
|
|
port->uart.read_status_mask |=
|
|
(1 << TTY_PARITY) | (1 << TTY_FRAME);
|
|
if (new->c_iflag & (BRKINT | PARMRK))
|
|
port->uart.read_status_mask |= (1 << TTY_BREAK);
|
|
|
|
/* characters to ignore */
|
|
port->uart.ignore_status_mask = 0;
|
|
if (new->c_iflag & IGNPAR)
|
|
port->uart.ignore_status_mask |=
|
|
(1 << TTY_PARITY) | (1 << TTY_FRAME);
|
|
if (new->c_iflag & IGNBRK) {
|
|
port->uart.ignore_status_mask |= (1 << TTY_BREAK);
|
|
/*
|
|
* If we're ignoring parity and break indicators,
|
|
* ignore overruns to (for real raw support).
|
|
*/
|
|
if (new->c_iflag & IGNPAR)
|
|
port->uart.ignore_status_mask |= (1 << TTY_OVERRUN);
|
|
}
|
|
|
|
/* Ignore all characters if CREAD is not set */
|
|
if ((new->c_cflag & CREAD) == 0)
|
|
port->uart.ignore_status_mask |= (1 << TTY_NORMAL);
|
|
|
|
scxctr |= *port->_control & (SC01CTR_TXE | SC01CTR_RXE | SC01CTR_BKE);
|
|
*port->_control = scxctr;
|
|
|
|
spin_unlock_irqrestore(&port->uart.lock, flags);
|
|
}
|
|
|
|
/*
|
|
* set the terminal I/O parameters
|
|
*/
|
|
static void mn10300_serial_set_termios(struct uart_port *_port,
|
|
struct ktermios *new,
|
|
struct ktermios *old)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s,%p,%p", port->name, new, old);
|
|
|
|
mn10300_serial_change_speed(port, new, old);
|
|
|
|
/* handle turning off CRTSCTS */
|
|
if (!(new->c_cflag & CRTSCTS)) {
|
|
u16 ctr = *port->_control;
|
|
ctr &= ~SC2CTR_TWE;
|
|
*port->_control = ctr;
|
|
}
|
|
|
|
/* change Transfer bit-order (LSB/MSB) */
|
|
if (new->c_cflag & CODMSB)
|
|
*port->_control |= SC01CTR_OD_MSBFIRST; /* MSB MODE */
|
|
else
|
|
*port->_control &= ~SC01CTR_OD_MSBFIRST; /* LSB MODE */
|
|
}
|
|
|
|
/*
|
|
* return description of port type
|
|
*/
|
|
static const char *mn10300_serial_type(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
if (port->uart.type == PORT_MN10300_CTS)
|
|
return "MN10300 SIF_CTS";
|
|
|
|
return "MN10300 SIF";
|
|
}
|
|
|
|
/*
|
|
* release I/O and memory regions in use by port
|
|
*/
|
|
static void mn10300_serial_release_port(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s", port->name);
|
|
|
|
release_mem_region((unsigned long) port->_iobase, 16);
|
|
}
|
|
|
|
/*
|
|
* request I/O and memory regions for port
|
|
*/
|
|
static int mn10300_serial_request_port(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s", port->name);
|
|
|
|
request_mem_region((unsigned long) port->_iobase, 16, port->name);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* configure the type and reserve the ports
|
|
*/
|
|
static void mn10300_serial_config_port(struct uart_port *_port, int type)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
|
|
_enter("%s", port->name);
|
|
|
|
port->uart.type = PORT_MN10300;
|
|
|
|
if (port->options & MNSCx_OPT_CTS)
|
|
port->uart.type = PORT_MN10300_CTS;
|
|
|
|
mn10300_serial_request_port(_port);
|
|
}
|
|
|
|
/*
|
|
* verify serial parameters are suitable for this port type
|
|
*/
|
|
static int mn10300_serial_verify_port(struct uart_port *_port,
|
|
struct serial_struct *ss)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
void *mapbase = (void *) (unsigned long) port->uart.mapbase;
|
|
|
|
_enter("%s", port->name);
|
|
|
|
/* these things may not be changed */
|
|
if (ss->irq != port->uart.irq ||
|
|
ss->port != port->uart.iobase ||
|
|
ss->io_type != port->uart.iotype ||
|
|
ss->iomem_base != mapbase ||
|
|
ss->iomem_reg_shift != port->uart.regshift ||
|
|
ss->hub6 != port->uart.hub6 ||
|
|
ss->xmit_fifo_size != port->uart.fifosize)
|
|
return -EINVAL;
|
|
|
|
/* type may be changed on a port that supports CTS */
|
|
if (ss->type != port->uart.type) {
|
|
if (!(port->options & MNSCx_OPT_CTS))
|
|
return -EINVAL;
|
|
|
|
if (ss->type != PORT_MN10300 &&
|
|
ss->type != PORT_MN10300_CTS)
|
|
return -EINVAL;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* initialise the MN10300 on-chip UARTs
|
|
*/
|
|
static int __init mn10300_serial_init(void)
|
|
{
|
|
struct mn10300_serial_port *port;
|
|
int ret, i;
|
|
|
|
printk(KERN_INFO "%s version %s (%s)\n",
|
|
serial_name, serial_version, serial_revdate);
|
|
|
|
#if defined(CONFIG_MN10300_TTYSM2) && defined(CONFIG_AM33_2)
|
|
{
|
|
int tmp;
|
|
SC2TIM = 8; /* make the baud base of timer 2 IOCLK/8 */
|
|
tmp = SC2TIM;
|
|
}
|
|
#endif
|
|
|
|
set_intr_stub(NUM2EXCEP_IRQ_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL),
|
|
mn10300_serial_vdma_interrupt);
|
|
|
|
ret = uart_register_driver(&mn10300_serial_driver);
|
|
if (!ret) {
|
|
for (i = 0 ; i < NR_PORTS ; i++) {
|
|
port = mn10300_serial_ports[i];
|
|
if (!port || port->gdbstub)
|
|
continue;
|
|
|
|
switch (port->clock_src) {
|
|
case MNSCx_CLOCK_SRC_IOCLK:
|
|
port->ioclk = MN10300_IOCLK;
|
|
break;
|
|
|
|
#ifdef MN10300_IOBCLK
|
|
case MNSCx_CLOCK_SRC_IOBCLK:
|
|
port->ioclk = MN10300_IOBCLK;
|
|
break;
|
|
#endif
|
|
default:
|
|
BUG();
|
|
}
|
|
|
|
ret = uart_add_one_port(&mn10300_serial_driver,
|
|
&port->uart);
|
|
|
|
if (ret < 0) {
|
|
_debug("ERROR %d", -ret);
|
|
break;
|
|
}
|
|
}
|
|
|
|
if (ret)
|
|
uart_unregister_driver(&mn10300_serial_driver);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
__initcall(mn10300_serial_init);
|
|
|
|
|
|
#ifdef CONFIG_MN10300_TTYSM_CONSOLE
|
|
|
|
/*
|
|
* print a string to the serial port without disturbing the real user of the
|
|
* port too much
|
|
* - the console must be locked by the caller
|
|
*/
|
|
static void mn10300_serial_console_write(struct console *co,
|
|
const char *s, unsigned count)
|
|
{
|
|
struct mn10300_serial_port *port;
|
|
unsigned i;
|
|
u16 scxctr, txicr, tmp;
|
|
u8 tmxmd;
|
|
|
|
port = mn10300_serial_ports[co->index];
|
|
|
|
/* firstly hijack the serial port from the "virtual DMA" controller */
|
|
arch_local_cli();
|
|
txicr = *port->tx_icr;
|
|
*port->tx_icr = NUM2GxICR_LEVEL(CONFIG_MN10300_SERIAL_IRQ_LEVEL);
|
|
tmp = *port->tx_icr;
|
|
arch_local_sti();
|
|
|
|
/* the transmitter may be disabled */
|
|
scxctr = *port->_control;
|
|
if (!(scxctr & SC01CTR_TXE)) {
|
|
/* restart the UART clock */
|
|
tmxmd = *port->_tmxmd;
|
|
|
|
switch (port->div_timer) {
|
|
case MNSCx_DIV_TIMER_16BIT:
|
|
*port->_tmxmd = 0;
|
|
*port->_tmxmd = TM8MD_INIT_COUNTER;
|
|
*port->_tmxmd = tmxmd | TM8MD_COUNT_ENABLE;
|
|
break;
|
|
|
|
case MNSCx_DIV_TIMER_8BIT:
|
|
*port->_tmxmd = 0;
|
|
*port->_tmxmd = TM2MD_INIT_COUNTER;
|
|
*port->_tmxmd = tmxmd | TM2MD_COUNT_ENABLE;
|
|
break;
|
|
}
|
|
|
|
/* enable the transmitter */
|
|
*port->_control = (scxctr & ~SC01CTR_BKE) | SC01CTR_TXE;
|
|
|
|
} else if (scxctr & SC01CTR_BKE) {
|
|
/* stop transmitting BREAK */
|
|
*port->_control = (scxctr & ~SC01CTR_BKE);
|
|
}
|
|
|
|
/* send the chars into the serial port (with LF -> LFCR conversion) */
|
|
for (i = 0; i < count; i++) {
|
|
char ch = *s++;
|
|
|
|
while (*port->_status & SC01STR_TBF)
|
|
continue;
|
|
*(u8 *) port->_txb = ch;
|
|
|
|
if (ch == 0x0a) {
|
|
while (*port->_status & SC01STR_TBF)
|
|
continue;
|
|
*(u8 *) port->_txb = 0xd;
|
|
}
|
|
}
|
|
|
|
/* can't let the transmitter be turned off if it's actually
|
|
* transmitting */
|
|
while (*port->_status & (SC01STR_TXF | SC01STR_TBF))
|
|
continue;
|
|
|
|
/* disable the transmitter if we re-enabled it */
|
|
if (!(scxctr & SC01CTR_TXE))
|
|
*port->_control = scxctr;
|
|
|
|
arch_local_cli();
|
|
*port->tx_icr = txicr;
|
|
tmp = *port->tx_icr;
|
|
arch_local_sti();
|
|
}
|
|
|
|
/*
|
|
* set up a serial port as a console
|
|
* - construct a cflag setting for the first rs_open()
|
|
* - initialize the serial port
|
|
* - return non-zero if we didn't find a serial port.
|
|
*/
|
|
static int __init mn10300_serial_console_setup(struct console *co,
|
|
char *options)
|
|
{
|
|
struct mn10300_serial_port *port;
|
|
int i, parity = 'n', baud = 9600, bits = 8, flow = 0;
|
|
|
|
for (i = 0 ; i < NR_PORTS ; i++) {
|
|
port = mn10300_serial_ports[i];
|
|
if (port && !port->gdbstub && port->uart.line == co->index)
|
|
goto found_device;
|
|
}
|
|
|
|
return -ENODEV;
|
|
|
|
found_device:
|
|
switch (port->clock_src) {
|
|
case MNSCx_CLOCK_SRC_IOCLK:
|
|
port->ioclk = MN10300_IOCLK;
|
|
break;
|
|
|
|
#ifdef MN10300_IOBCLK
|
|
case MNSCx_CLOCK_SRC_IOBCLK:
|
|
port->ioclk = MN10300_IOBCLK;
|
|
break;
|
|
#endif
|
|
default:
|
|
BUG();
|
|
}
|
|
|
|
if (options)
|
|
uart_parse_options(options, &baud, &parity, &bits, &flow);
|
|
|
|
return uart_set_options(&port->uart, co, baud, parity, bits, flow);
|
|
}
|
|
|
|
/*
|
|
* register console
|
|
*/
|
|
static int __init mn10300_serial_console_init(void)
|
|
{
|
|
register_console(&mn10300_serial_console);
|
|
return 0;
|
|
}
|
|
|
|
console_initcall(mn10300_serial_console_init);
|
|
#endif
|
|
|
|
#ifdef CONFIG_CONSOLE_POLL
|
|
/*
|
|
* Polled character reception for the kernel debugger
|
|
*/
|
|
static int mn10300_serial_poll_get_char(struct uart_port *_port)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
unsigned ix;
|
|
u8 st, ch;
|
|
|
|
_enter("%s", port->name);
|
|
|
|
do {
|
|
/* pull chars out of the hat */
|
|
ix = port->rx_outp;
|
|
if (ix == port->rx_inp)
|
|
return NO_POLL_CHAR;
|
|
|
|
ch = port->rx_buffer[ix++];
|
|
st = port->rx_buffer[ix++];
|
|
smp_rmb();
|
|
port->rx_outp = ix & (MNSC_BUFFER_SIZE - 1);
|
|
|
|
} while (st & (SC01STR_FEF | SC01STR_PEF | SC01STR_OEF));
|
|
|
|
return ch;
|
|
}
|
|
|
|
|
|
/*
|
|
* Polled character transmission for the kernel debugger
|
|
*/
|
|
static void mn10300_serial_poll_put_char(struct uart_port *_port,
|
|
unsigned char ch)
|
|
{
|
|
struct mn10300_serial_port *port =
|
|
container_of(_port, struct mn10300_serial_port, uart);
|
|
u8 intr, tmp;
|
|
|
|
/* wait for the transmitter to finish anything it might be doing (and
|
|
* this includes the virtual DMA handler, so it might take a while) */
|
|
while (*port->_status & (SC01STR_TBF | SC01STR_TXF))
|
|
continue;
|
|
|
|
/* disable the Tx ready interrupt */
|
|
intr = *port->_intr;
|
|
*port->_intr = intr & ~SC01ICR_TI;
|
|
tmp = *port->_intr;
|
|
|
|
if (ch == 0x0a) {
|
|
*(u8 *) port->_txb = 0x0d;
|
|
while (*port->_status & SC01STR_TBF)
|
|
continue;
|
|
}
|
|
|
|
*(u8 *) port->_txb = ch;
|
|
while (*port->_status & SC01STR_TBF)
|
|
continue;
|
|
|
|
/* restore the Tx interrupt flag */
|
|
*port->_intr = intr;
|
|
tmp = *port->_intr;
|
|
}
|
|
|
|
#endif /* CONFIG_CONSOLE_POLL */
|