mirror of
https://github.com/FEX-Emu/linux.git
synced 2024-12-30 13:38:40 +00:00
a88487c79b
The below is the patch to replace blindly all possible places, including Jack's fixes. Signed-off-by: Takashi Iwai <tiwai@suse.de> (Reviewed and checked rather than blindly added) Signed-off-by: Alan Cox <alan@redhat.com> Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>
1966 lines
48 KiB
C
1966 lines
48 KiB
C
#warning This driver is deprecated. Check Kconfig for details.
|
|
/*
|
|
* mcfserial.c -- serial driver for ColdFire internal UARTS.
|
|
*
|
|
* Copyright (C) 1999-2003 Greg Ungerer <gerg@snapgear.com>
|
|
* Copyright (c) 2000-2001 Lineo, Inc. <www.lineo.com>
|
|
* Copyright (C) 2001-2002 SnapGear Inc. <www.snapgear.com>
|
|
*
|
|
* Based on code from 68332serial.c which was:
|
|
*
|
|
* Copyright (C) 1995 David S. Miller (davem@caip.rutgers.edu)
|
|
* Copyright (C) 1998 TSHG
|
|
* Copyright (c) 1999 Rt-Control Inc. <jeff@uclinux.org>
|
|
*
|
|
* Changes:
|
|
* 08/07/2003 Daniele Bellucci <bellucda@tiscali.it>
|
|
* some cleanups in mcfrs_write.
|
|
*
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/errno.h>
|
|
#include <linux/signal.h>
|
|
#include <linux/sched.h>
|
|
#include <linux/timer.h>
|
|
#include <linux/wait.h>
|
|
#include <linux/interrupt.h>
|
|
#include <linux/tty.h>
|
|
#include <linux/tty_flip.h>
|
|
#include <linux/string.h>
|
|
#include <linux/fcntl.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/serial.h>
|
|
#include <linux/serialP.h>
|
|
#include <linux/console.h>
|
|
#include <linux/init.h>
|
|
#include <linux/bitops.h>
|
|
#include <linux/delay.h>
|
|
|
|
#include <asm/io.h>
|
|
#include <asm/irq.h>
|
|
#include <asm/system.h>
|
|
#include <asm/delay.h>
|
|
#include <asm/coldfire.h>
|
|
#include <asm/mcfsim.h>
|
|
#include <asm/mcfuart.h>
|
|
#include <asm/nettel.h>
|
|
#include <asm/uaccess.h>
|
|
#include "mcfserial.h"
|
|
|
|
struct timer_list mcfrs_timer_struct;
|
|
|
|
/*
|
|
* Default console baud rate, we use this as the default
|
|
* for all ports so init can just open /dev/console and
|
|
* keep going. Perhaps one day the cflag settings for the
|
|
* console can be used instead.
|
|
*/
|
|
#if defined(CONFIG_HW_FEITH)
|
|
#define CONSOLE_BAUD_RATE 38400
|
|
#define DEFAULT_CBAUD B38400
|
|
#elif defined(CONFIG_MOD5272) || defined(CONFIG_M5208EVB) || \
|
|
defined(CONFIG_M5329EVB) || defined(CONFIG_GILBARCO)
|
|
#define CONSOLE_BAUD_RATE 115200
|
|
#define DEFAULT_CBAUD B115200
|
|
#elif defined(CONFIG_ARNEWSH) || defined(CONFIG_FREESCALE) || \
|
|
defined(CONFIG_senTec) || defined(CONFIG_SNEHA) || defined(CONFIG_AVNET)
|
|
#define CONSOLE_BAUD_RATE 19200
|
|
#define DEFAULT_CBAUD B19200
|
|
#endif
|
|
|
|
#ifndef CONSOLE_BAUD_RATE
|
|
#define CONSOLE_BAUD_RATE 9600
|
|
#define DEFAULT_CBAUD B9600
|
|
#endif
|
|
|
|
int mcfrs_console_inited = 0;
|
|
int mcfrs_console_port = -1;
|
|
int mcfrs_console_baud = CONSOLE_BAUD_RATE;
|
|
int mcfrs_console_cbaud = DEFAULT_CBAUD;
|
|
|
|
/*
|
|
* Driver data structures.
|
|
*/
|
|
static struct tty_driver *mcfrs_serial_driver;
|
|
|
|
/* number of characters left in xmit buffer before we ask for more */
|
|
#define WAKEUP_CHARS 256
|
|
|
|
/* Debugging...
|
|
*/
|
|
#undef SERIAL_DEBUG_OPEN
|
|
#undef SERIAL_DEBUG_FLOW
|
|
|
|
#if defined(CONFIG_M523x) || defined(CONFIG_M527x) || defined(CONFIG_M528x) || \
|
|
defined(CONFIG_M520x) || defined(CONFIG_M532x)
|
|
#define IRQBASE (MCFINT_VECBASE+MCFINT_UART0)
|
|
#else
|
|
#define IRQBASE 73
|
|
#endif
|
|
|
|
/*
|
|
* Configuration table, UARTs to look for at startup.
|
|
*/
|
|
static struct mcf_serial mcfrs_table[] = {
|
|
{ /* ttyS0 */
|
|
.magic = 0,
|
|
.addr = (volatile unsigned char *) (MCF_MBAR+MCFUART_BASE1),
|
|
.irq = IRQBASE,
|
|
.flags = ASYNC_BOOT_AUTOCONF,
|
|
},
|
|
#ifdef MCFUART_BASE2
|
|
{ /* ttyS1 */
|
|
.magic = 0,
|
|
.addr = (volatile unsigned char *) (MCF_MBAR+MCFUART_BASE2),
|
|
.irq = IRQBASE+1,
|
|
.flags = ASYNC_BOOT_AUTOCONF,
|
|
},
|
|
#endif
|
|
#ifdef MCFUART_BASE3
|
|
{ /* ttyS2 */
|
|
.magic = 0,
|
|
.addr = (volatile unsigned char *) (MCF_MBAR+MCFUART_BASE3),
|
|
.irq = IRQBASE+2,
|
|
.flags = ASYNC_BOOT_AUTOCONF,
|
|
},
|
|
#endif
|
|
#ifdef MCFUART_BASE4
|
|
{ /* ttyS3 */
|
|
.magic = 0,
|
|
.addr = (volatile unsigned char *) (MCF_MBAR+MCFUART_BASE4),
|
|
.irq = IRQBASE+3,
|
|
.flags = ASYNC_BOOT_AUTOCONF,
|
|
},
|
|
#endif
|
|
};
|
|
|
|
|
|
#define NR_PORTS (sizeof(mcfrs_table) / sizeof(struct mcf_serial))
|
|
|
|
/*
|
|
* This is used to figure out the divisor speeds and the timeouts.
|
|
*/
|
|
static int mcfrs_baud_table[] = {
|
|
0, 50, 75, 110, 134, 150, 200, 300, 600, 1200, 1800, 2400, 4800,
|
|
9600, 19200, 38400, 57600, 115200, 230400, 460800, 0
|
|
};
|
|
#define MCFRS_BAUD_TABLE_SIZE \
|
|
(sizeof(mcfrs_baud_table)/sizeof(mcfrs_baud_table[0]))
|
|
|
|
|
|
#ifdef CONFIG_MAGIC_SYSRQ
|
|
/*
|
|
* Magic system request keys. Used for debugging...
|
|
*/
|
|
extern int magic_sysrq_key(int ch);
|
|
#endif
|
|
|
|
|
|
/*
|
|
* Forware declarations...
|
|
*/
|
|
static void mcfrs_change_speed(struct mcf_serial *info);
|
|
static void mcfrs_wait_until_sent(struct tty_struct *tty, int timeout);
|
|
|
|
|
|
static inline int serial_paranoia_check(struct mcf_serial *info,
|
|
char *name, const char *routine)
|
|
{
|
|
#ifdef SERIAL_PARANOIA_CHECK
|
|
static const char badmagic[] =
|
|
"MCFRS(warning): bad magic number for serial struct %s in %s\n";
|
|
static const char badinfo[] =
|
|
"MCFRS(warning): null mcf_serial for %s in %s\n";
|
|
|
|
if (!info) {
|
|
printk(badinfo, name, routine);
|
|
return 1;
|
|
}
|
|
if (info->magic != SERIAL_MAGIC) {
|
|
printk(badmagic, name, routine);
|
|
return 1;
|
|
}
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Sets or clears DTR and RTS on the requested line.
|
|
*/
|
|
static void mcfrs_setsignals(struct mcf_serial *info, int dtr, int rts)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned long flags;
|
|
|
|
#if 0
|
|
printk("%s(%d): mcfrs_setsignals(info=%x,dtr=%d,rts=%d)\n",
|
|
__FILE__, __LINE__, info, dtr, rts);
|
|
#endif
|
|
|
|
local_irq_save(flags);
|
|
if (dtr >= 0) {
|
|
#ifdef MCFPP_DTR0
|
|
if (info->line)
|
|
mcf_setppdata(MCFPP_DTR1, (dtr ? 0 : MCFPP_DTR1));
|
|
else
|
|
mcf_setppdata(MCFPP_DTR0, (dtr ? 0 : MCFPP_DTR0));
|
|
#endif
|
|
}
|
|
if (rts >= 0) {
|
|
uartp = info->addr;
|
|
if (rts) {
|
|
info->sigs |= TIOCM_RTS;
|
|
uartp[MCFUART_UOP1] = MCFUART_UOP_RTS;
|
|
} else {
|
|
info->sigs &= ~TIOCM_RTS;
|
|
uartp[MCFUART_UOP0] = MCFUART_UOP_RTS;
|
|
}
|
|
}
|
|
local_irq_restore(flags);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* Gets values of serial signals.
|
|
*/
|
|
static int mcfrs_getsignals(struct mcf_serial *info)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned long flags;
|
|
int sigs;
|
|
#if defined(CONFIG_NETtel) && defined(CONFIG_M5307)
|
|
unsigned short ppdata;
|
|
#endif
|
|
|
|
#if 0
|
|
printk("%s(%d): mcfrs_getsignals(info=%x)\n", __FILE__, __LINE__);
|
|
#endif
|
|
|
|
local_irq_save(flags);
|
|
uartp = info->addr;
|
|
sigs = (uartp[MCFUART_UIPR] & MCFUART_UIPR_CTS) ? 0 : TIOCM_CTS;
|
|
sigs |= (info->sigs & TIOCM_RTS);
|
|
|
|
#ifdef MCFPP_DCD0
|
|
{
|
|
unsigned int ppdata;
|
|
ppdata = mcf_getppdata();
|
|
if (info->line == 0) {
|
|
sigs |= (ppdata & MCFPP_DCD0) ? 0 : TIOCM_CD;
|
|
sigs |= (ppdata & MCFPP_DTR0) ? 0 : TIOCM_DTR;
|
|
} else if (info->line == 1) {
|
|
sigs |= (ppdata & MCFPP_DCD1) ? 0 : TIOCM_CD;
|
|
sigs |= (ppdata & MCFPP_DTR1) ? 0 : TIOCM_DTR;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
local_irq_restore(flags);
|
|
return(sigs);
|
|
}
|
|
|
|
/*
|
|
* ------------------------------------------------------------
|
|
* mcfrs_stop() and mcfrs_start()
|
|
*
|
|
* This routines are called before setting or resetting tty->stopped.
|
|
* They enable or disable transmitter interrupts, as necessary.
|
|
* ------------------------------------------------------------
|
|
*/
|
|
static void mcfrs_stop(struct tty_struct *tty)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
unsigned long flags;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_stop"))
|
|
return;
|
|
|
|
local_irq_save(flags);
|
|
uartp = info->addr;
|
|
info->imr &= ~MCFUART_UIR_TXREADY;
|
|
uartp[MCFUART_UIMR] = info->imr;
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
static void mcfrs_start(struct tty_struct *tty)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
unsigned long flags;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_start"))
|
|
return;
|
|
|
|
local_irq_save(flags);
|
|
if (info->xmit_cnt && info->xmit_buf) {
|
|
uartp = info->addr;
|
|
info->imr |= MCFUART_UIR_TXREADY;
|
|
uartp[MCFUART_UIMR] = info->imr;
|
|
}
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
/*
|
|
* ----------------------------------------------------------------------
|
|
*
|
|
* Here starts the interrupt handling routines. All of the following
|
|
* subroutines are declared as inline and are folded into
|
|
* mcfrs_interrupt(). They were separated out for readability's sake.
|
|
*
|
|
* Note: mcfrs_interrupt() is a "fast" interrupt, which means that it
|
|
* runs with interrupts turned off. People who may want to modify
|
|
* mcfrs_interrupt() should try to keep the interrupt handler as fast as
|
|
* possible. After you are done making modifications, it is not a bad
|
|
* idea to do:
|
|
*
|
|
* gcc -S -DKERNEL -Wall -Wstrict-prototypes -O6 -fomit-frame-pointer serial.c
|
|
*
|
|
* and look at the resulting assemble code in serial.s.
|
|
*
|
|
* - Ted Ts'o (tytso@mit.edu), 7-Mar-93
|
|
* -----------------------------------------------------------------------
|
|
*/
|
|
|
|
static inline void receive_chars(struct mcf_serial *info)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
struct tty_struct *tty = info->port.tty;
|
|
unsigned char status, ch, flag;
|
|
|
|
if (!tty)
|
|
return;
|
|
|
|
uartp = info->addr;
|
|
|
|
while ((status = uartp[MCFUART_USR]) & MCFUART_USR_RXREADY) {
|
|
ch = uartp[MCFUART_URB];
|
|
info->stats.rx++;
|
|
|
|
#ifdef CONFIG_MAGIC_SYSRQ
|
|
if (mcfrs_console_inited && (info->line == mcfrs_console_port)) {
|
|
if (magic_sysrq_key(ch))
|
|
continue;
|
|
}
|
|
#endif
|
|
|
|
flag = TTY_NORMAL;
|
|
if (status & MCFUART_USR_RXERR) {
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETERR;
|
|
if (status & MCFUART_USR_RXBREAK) {
|
|
info->stats.rxbreak++;
|
|
flag = TTY_BREAK;
|
|
} else if (status & MCFUART_USR_RXPARITY) {
|
|
info->stats.rxparity++;
|
|
flag = TTY_PARITY;
|
|
} else if (status & MCFUART_USR_RXOVERRUN) {
|
|
info->stats.rxoverrun++;
|
|
flag = TTY_OVERRUN;
|
|
} else if (status & MCFUART_USR_RXFRAMING) {
|
|
info->stats.rxframing++;
|
|
flag = TTY_FRAME;
|
|
}
|
|
}
|
|
tty_insert_flip_char(tty, ch, flag);
|
|
}
|
|
tty_schedule_flip(tty);
|
|
return;
|
|
}
|
|
|
|
static inline void transmit_chars(struct mcf_serial *info)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
|
|
uartp = info->addr;
|
|
|
|
if (info->x_char) {
|
|
/* Send special char - probably flow control */
|
|
uartp[MCFUART_UTB] = info->x_char;
|
|
info->x_char = 0;
|
|
info->stats.tx++;
|
|
}
|
|
|
|
if ((info->xmit_cnt <= 0) || info->port.tty->stopped) {
|
|
info->imr &= ~MCFUART_UIR_TXREADY;
|
|
uartp[MCFUART_UIMR] = info->imr;
|
|
return;
|
|
}
|
|
|
|
while (uartp[MCFUART_USR] & MCFUART_USR_TXREADY) {
|
|
uartp[MCFUART_UTB] = info->xmit_buf[info->xmit_tail++];
|
|
info->xmit_tail = info->xmit_tail & (SERIAL_XMIT_SIZE-1);
|
|
info->stats.tx++;
|
|
if (--info->xmit_cnt <= 0)
|
|
break;
|
|
}
|
|
|
|
if (info->xmit_cnt < WAKEUP_CHARS)
|
|
schedule_work(&info->tqueue);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* This is the serial driver's generic interrupt routine
|
|
*/
|
|
irqreturn_t mcfrs_interrupt(int irq, void *dev_id)
|
|
{
|
|
struct mcf_serial *info;
|
|
unsigned char isr;
|
|
|
|
info = &mcfrs_table[(irq - IRQBASE)];
|
|
isr = info->addr[MCFUART_UISR] & info->imr;
|
|
|
|
if (isr & MCFUART_UIR_RXREADY)
|
|
receive_chars(info);
|
|
if (isr & MCFUART_UIR_TXREADY)
|
|
transmit_chars(info);
|
|
return IRQ_HANDLED;
|
|
}
|
|
|
|
/*
|
|
* -------------------------------------------------------------------
|
|
* Here ends the serial interrupt routines.
|
|
* -------------------------------------------------------------------
|
|
*/
|
|
|
|
static void mcfrs_offintr(struct work_struct *work)
|
|
{
|
|
struct mcf_serial *info = container_of(work, struct mcf_serial, tqueue);
|
|
struct tty_struct *tty = info->port.tty;
|
|
|
|
if (tty)
|
|
tty_wakeup(tty);
|
|
}
|
|
|
|
|
|
/*
|
|
* Change of state on a DCD line.
|
|
*/
|
|
void mcfrs_modem_change(struct mcf_serial *info, int dcd)
|
|
{
|
|
if (info->count == 0)
|
|
return;
|
|
|
|
if (info->flags & ASYNC_CHECK_CD) {
|
|
if (dcd)
|
|
wake_up_interruptible(&info->open_wait);
|
|
else
|
|
schedule_work(&info->tqueue_hangup);
|
|
}
|
|
}
|
|
|
|
|
|
#ifdef MCFPP_DCD0
|
|
|
|
unsigned short mcfrs_ppstatus;
|
|
|
|
/*
|
|
* This subroutine is called when the RS_TIMER goes off. It is used
|
|
* to monitor the state of the DCD lines - since they have no edge
|
|
* sensors and interrupt generators.
|
|
*/
|
|
static void mcfrs_timer(void)
|
|
{
|
|
unsigned int ppstatus, dcdval, i;
|
|
|
|
ppstatus = mcf_getppdata() & (MCFPP_DCD0 | MCFPP_DCD1);
|
|
|
|
if (ppstatus != mcfrs_ppstatus) {
|
|
for (i = 0; (i < 2); i++) {
|
|
dcdval = (i ? MCFPP_DCD1 : MCFPP_DCD0);
|
|
if ((ppstatus & dcdval) != (mcfrs_ppstatus & dcdval)) {
|
|
mcfrs_modem_change(&mcfrs_table[i],
|
|
((ppstatus & dcdval) ? 0 : 1));
|
|
}
|
|
}
|
|
}
|
|
mcfrs_ppstatus = ppstatus;
|
|
|
|
/* Re-arm timer */
|
|
mcfrs_timer_struct.expires = jiffies + HZ/25;
|
|
add_timer(&mcfrs_timer_struct);
|
|
}
|
|
|
|
#endif /* MCFPP_DCD0 */
|
|
|
|
|
|
/*
|
|
* This routine is called from the scheduler tqueue when the interrupt
|
|
* routine has signalled that a hangup has occurred. The path of
|
|
* hangup processing is:
|
|
*
|
|
* serial interrupt routine -> (scheduler tqueue) ->
|
|
* do_serial_hangup() -> tty->hangup() -> mcfrs_hangup()
|
|
*
|
|
*/
|
|
static void do_serial_hangup(struct work_struct *work)
|
|
{
|
|
struct mcf_serial *info = container_of(work, struct mcf_serial, tqueue_hangup);
|
|
struct tty_struct *tty = info->port.tty;
|
|
|
|
if (tty)
|
|
tty_hangup(tty);
|
|
}
|
|
|
|
static int startup(struct mcf_serial * info)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned long flags;
|
|
|
|
if (info->flags & ASYNC_INITIALIZED)
|
|
return 0;
|
|
|
|
if (!info->xmit_buf) {
|
|
info->xmit_buf = (unsigned char *) __get_free_page(GFP_KERNEL);
|
|
if (!info->xmit_buf)
|
|
return -ENOMEM;
|
|
}
|
|
|
|
local_irq_save(flags);
|
|
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("starting up ttyS%d (irq %d)...\n", info->line, info->irq);
|
|
#endif
|
|
|
|
/*
|
|
* Reset UART, get it into known state...
|
|
*/
|
|
uartp = info->addr;
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETRX; /* reset RX */
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETTX; /* reset TX */
|
|
mcfrs_setsignals(info, 1, 1);
|
|
|
|
if (info->port.tty)
|
|
clear_bit(TTY_IO_ERROR, &info->port.tty->flags);
|
|
info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
|
|
|
|
/*
|
|
* and set the speed of the serial port
|
|
*/
|
|
mcfrs_change_speed(info);
|
|
|
|
/*
|
|
* Lastly enable the UART transmitter and receiver, and
|
|
* interrupt enables.
|
|
*/
|
|
info->imr = MCFUART_UIR_RXREADY;
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_RXENABLE | MCFUART_UCR_TXENABLE;
|
|
uartp[MCFUART_UIMR] = info->imr;
|
|
|
|
info->flags |= ASYNC_INITIALIZED;
|
|
local_irq_restore(flags);
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* This routine will shutdown a serial port; interrupts are disabled, and
|
|
* DTR is dropped if the hangup on close termio flag is on.
|
|
*/
|
|
static void shutdown(struct mcf_serial * info)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned long flags;
|
|
|
|
if (!(info->flags & ASYNC_INITIALIZED))
|
|
return;
|
|
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("Shutting down serial port %d (irq %d)....\n", info->line,
|
|
info->irq);
|
|
#endif
|
|
|
|
local_irq_save(flags);
|
|
|
|
uartp = info->addr;
|
|
uartp[MCFUART_UIMR] = 0; /* mask all interrupts */
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETRX; /* reset RX */
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETTX; /* reset TX */
|
|
|
|
if (!info->port.tty || (info->port.tty->termios->c_cflag & HUPCL))
|
|
mcfrs_setsignals(info, 0, 0);
|
|
|
|
if (info->xmit_buf) {
|
|
free_page((unsigned long) info->xmit_buf);
|
|
info->xmit_buf = 0;
|
|
}
|
|
|
|
if (info->port.tty)
|
|
set_bit(TTY_IO_ERROR, &info->port.tty->flags);
|
|
|
|
info->flags &= ~ASYNC_INITIALIZED;
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
|
|
/*
|
|
* This routine is called to set the UART divisor registers to match
|
|
* the specified baud rate for a serial port.
|
|
*/
|
|
static void mcfrs_change_speed(struct mcf_serial *info)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned int baudclk, cflag;
|
|
unsigned long flags;
|
|
unsigned char mr1, mr2;
|
|
int i;
|
|
#ifdef CONFIG_M5272
|
|
unsigned int fraction;
|
|
#endif
|
|
|
|
if (!info->port.tty || !info->port.tty->termios)
|
|
return;
|
|
cflag = info->port.tty->termios->c_cflag;
|
|
if (info->addr == 0)
|
|
return;
|
|
|
|
#if 0
|
|
printk("%s(%d): mcfrs_change_speed()\n", __FILE__, __LINE__);
|
|
#endif
|
|
|
|
i = cflag & CBAUD;
|
|
if (i & CBAUDEX) {
|
|
i &= ~CBAUDEX;
|
|
if (i < 1 || i > 4)
|
|
info->port.tty->termios->c_cflag &= ~CBAUDEX;
|
|
else
|
|
i += 15;
|
|
}
|
|
if (i == 0) {
|
|
mcfrs_setsignals(info, 0, -1);
|
|
return;
|
|
}
|
|
|
|
/* compute the baudrate clock */
|
|
#ifdef CONFIG_M5272
|
|
/*
|
|
* For the MCF5272, also compute the baudrate fraction.
|
|
*/
|
|
baudclk = (MCF_BUSCLK / mcfrs_baud_table[i]) / 32;
|
|
fraction = MCF_BUSCLK - (baudclk * 32 * mcfrs_baud_table[i]);
|
|
fraction *= 16;
|
|
fraction /= (32 * mcfrs_baud_table[i]);
|
|
#else
|
|
baudclk = ((MCF_BUSCLK / mcfrs_baud_table[i]) + 16) / 32;
|
|
#endif
|
|
|
|
info->baud = mcfrs_baud_table[i];
|
|
|
|
mr1 = MCFUART_MR1_RXIRQRDY | MCFUART_MR1_RXERRCHAR;
|
|
mr2 = 0;
|
|
|
|
switch (cflag & CSIZE) {
|
|
case CS5: mr1 |= MCFUART_MR1_CS5; break;
|
|
case CS6: mr1 |= MCFUART_MR1_CS6; break;
|
|
case CS7: mr1 |= MCFUART_MR1_CS7; break;
|
|
case CS8:
|
|
default: mr1 |= MCFUART_MR1_CS8; break;
|
|
}
|
|
|
|
if (cflag & PARENB) {
|
|
if (cflag & CMSPAR) {
|
|
if (cflag & PARODD)
|
|
mr1 |= MCFUART_MR1_PARITYMARK;
|
|
else
|
|
mr1 |= MCFUART_MR1_PARITYSPACE;
|
|
} else {
|
|
if (cflag & PARODD)
|
|
mr1 |= MCFUART_MR1_PARITYODD;
|
|
else
|
|
mr1 |= MCFUART_MR1_PARITYEVEN;
|
|
}
|
|
} else {
|
|
mr1 |= MCFUART_MR1_PARITYNONE;
|
|
}
|
|
|
|
if (cflag & CSTOPB)
|
|
mr2 |= MCFUART_MR2_STOP2;
|
|
else
|
|
mr2 |= MCFUART_MR2_STOP1;
|
|
|
|
if (cflag & CRTSCTS) {
|
|
mr1 |= MCFUART_MR1_RXRTS;
|
|
mr2 |= MCFUART_MR2_TXCTS;
|
|
}
|
|
|
|
if (cflag & CLOCAL)
|
|
info->flags &= ~ASYNC_CHECK_CD;
|
|
else
|
|
info->flags |= ASYNC_CHECK_CD;
|
|
|
|
uartp = info->addr;
|
|
|
|
local_irq_save(flags);
|
|
#if 0
|
|
printk("%s(%d): mr1=%x mr2=%x baudclk=%x\n", __FILE__, __LINE__,
|
|
mr1, mr2, baudclk);
|
|
#endif
|
|
/*
|
|
Note: pg 12-16 of MCF5206e User's Manual states that a
|
|
software reset should be performed prior to changing
|
|
UMR1,2, UCSR, UACR, bit 7
|
|
*/
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETRX; /* reset RX */
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETTX; /* reset TX */
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETMRPTR; /* reset MR pointer */
|
|
uartp[MCFUART_UMR] = mr1;
|
|
uartp[MCFUART_UMR] = mr2;
|
|
uartp[MCFUART_UBG1] = (baudclk & 0xff00) >> 8; /* set msb byte */
|
|
uartp[MCFUART_UBG2] = (baudclk & 0xff); /* set lsb byte */
|
|
#ifdef CONFIG_M5272
|
|
uartp[MCFUART_UFPD] = (fraction & 0xf); /* set fraction */
|
|
#endif
|
|
uartp[MCFUART_UCSR] = MCFUART_UCSR_RXCLKTIMER | MCFUART_UCSR_TXCLKTIMER;
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_RXENABLE | MCFUART_UCR_TXENABLE;
|
|
mcfrs_setsignals(info, 1, -1);
|
|
local_irq_restore(flags);
|
|
return;
|
|
}
|
|
|
|
static void mcfrs_flush_chars(struct tty_struct *tty)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
unsigned long flags;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_flush_chars"))
|
|
return;
|
|
|
|
uartp = (volatile unsigned char *) info->addr;
|
|
|
|
/*
|
|
* re-enable receiver interrupt
|
|
*/
|
|
local_irq_save(flags);
|
|
if ((!(info->imr & MCFUART_UIR_RXREADY)) &&
|
|
(info->flags & ASYNC_INITIALIZED) ) {
|
|
info->imr |= MCFUART_UIR_RXREADY;
|
|
uartp[MCFUART_UIMR] = info->imr;
|
|
}
|
|
local_irq_restore(flags);
|
|
|
|
if (info->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped ||
|
|
!info->xmit_buf)
|
|
return;
|
|
|
|
/* Enable transmitter */
|
|
local_irq_save(flags);
|
|
info->imr |= MCFUART_UIR_TXREADY;
|
|
uartp[MCFUART_UIMR] = info->imr;
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
static int mcfrs_write(struct tty_struct * tty,
|
|
const unsigned char *buf, int count)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
unsigned long flags;
|
|
int c, total = 0;
|
|
|
|
#if 0
|
|
printk("%s(%d): mcfrs_write(tty=%x,buf=%x,count=%d)\n",
|
|
__FILE__, __LINE__, (int)tty, (int)buf, count);
|
|
#endif
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_write"))
|
|
return 0;
|
|
|
|
if (!tty || !info->xmit_buf)
|
|
return 0;
|
|
|
|
local_save_flags(flags);
|
|
while (1) {
|
|
local_irq_disable();
|
|
c = min(count, (int) min(((int)SERIAL_XMIT_SIZE) - info->xmit_cnt - 1,
|
|
((int)SERIAL_XMIT_SIZE) - info->xmit_head));
|
|
local_irq_restore(flags);
|
|
|
|
if (c <= 0)
|
|
break;
|
|
|
|
memcpy(info->xmit_buf + info->xmit_head, buf, c);
|
|
|
|
local_irq_disable();
|
|
info->xmit_head = (info->xmit_head + c) & (SERIAL_XMIT_SIZE-1);
|
|
info->xmit_cnt += c;
|
|
local_irq_restore(flags);
|
|
|
|
buf += c;
|
|
count -= c;
|
|
total += c;
|
|
}
|
|
|
|
local_irq_disable();
|
|
uartp = info->addr;
|
|
info->imr |= MCFUART_UIR_TXREADY;
|
|
uartp[MCFUART_UIMR] = info->imr;
|
|
local_irq_restore(flags);
|
|
|
|
return total;
|
|
}
|
|
|
|
static int mcfrs_write_room(struct tty_struct *tty)
|
|
{
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
int ret;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_write_room"))
|
|
return 0;
|
|
ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
|
|
if (ret < 0)
|
|
ret = 0;
|
|
return ret;
|
|
}
|
|
|
|
static int mcfrs_chars_in_buffer(struct tty_struct *tty)
|
|
{
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_chars_in_buffer"))
|
|
return 0;
|
|
return info->xmit_cnt;
|
|
}
|
|
|
|
static void mcfrs_flush_buffer(struct tty_struct *tty)
|
|
{
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
unsigned long flags;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_flush_buffer"))
|
|
return;
|
|
|
|
local_irq_save(flags);
|
|
info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
|
|
local_irq_restore(flags);
|
|
|
|
tty_wakeup(tty);
|
|
}
|
|
|
|
/*
|
|
* ------------------------------------------------------------
|
|
* mcfrs_throttle()
|
|
*
|
|
* This routine is called by the upper-layer tty layer to signal that
|
|
* incoming characters should be throttled.
|
|
* ------------------------------------------------------------
|
|
*/
|
|
static void mcfrs_throttle(struct tty_struct * tty)
|
|
{
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
#ifdef SERIAL_DEBUG_THROTTLE
|
|
char buf[64];
|
|
|
|
printk("throttle %s: %d....\n", tty_name(tty, buf),
|
|
tty->ldisc.chars_in_buffer(tty));
|
|
#endif
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_throttle"))
|
|
return;
|
|
|
|
if (I_IXOFF(tty))
|
|
info->x_char = STOP_CHAR(tty);
|
|
|
|
/* Turn off RTS line (do this atomic) */
|
|
}
|
|
|
|
static void mcfrs_unthrottle(struct tty_struct * tty)
|
|
{
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
#ifdef SERIAL_DEBUG_THROTTLE
|
|
char buf[64];
|
|
|
|
printk("unthrottle %s: %d....\n", tty_name(tty, buf),
|
|
tty->ldisc.chars_in_buffer(tty));
|
|
#endif
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_unthrottle"))
|
|
return;
|
|
|
|
if (I_IXOFF(tty)) {
|
|
if (info->x_char)
|
|
info->x_char = 0;
|
|
else
|
|
info->x_char = START_CHAR(tty);
|
|
}
|
|
|
|
/* Assert RTS line (do this atomic) */
|
|
}
|
|
|
|
/*
|
|
* ------------------------------------------------------------
|
|
* mcfrs_ioctl() and friends
|
|
* ------------------------------------------------------------
|
|
*/
|
|
|
|
static int get_serial_info(struct mcf_serial * info,
|
|
struct serial_struct * retinfo)
|
|
{
|
|
struct serial_struct tmp;
|
|
|
|
if (!retinfo)
|
|
return -EFAULT;
|
|
memset(&tmp, 0, sizeof(tmp));
|
|
tmp.type = info->type;
|
|
tmp.line = info->line;
|
|
tmp.port = (unsigned int) info->addr;
|
|
tmp.irq = info->irq;
|
|
tmp.flags = info->flags;
|
|
tmp.baud_base = info->baud_base;
|
|
tmp.close_delay = info->close_delay;
|
|
tmp.closing_wait = info->closing_wait;
|
|
tmp.custom_divisor = info->custom_divisor;
|
|
return copy_to_user(retinfo,&tmp,sizeof(*retinfo)) ? -EFAULT : 0;
|
|
}
|
|
|
|
static int set_serial_info(struct mcf_serial * info,
|
|
struct serial_struct * new_info)
|
|
{
|
|
struct serial_struct new_serial;
|
|
struct mcf_serial old_info;
|
|
int retval = 0;
|
|
|
|
if (!new_info)
|
|
return -EFAULT;
|
|
if (copy_from_user(&new_serial,new_info,sizeof(new_serial)))
|
|
return -EFAULT;
|
|
old_info = *info;
|
|
|
|
if (!capable(CAP_SYS_ADMIN)) {
|
|
if ((new_serial.baud_base != info->baud_base) ||
|
|
(new_serial.type != info->type) ||
|
|
(new_serial.close_delay != info->close_delay) ||
|
|
((new_serial.flags & ~ASYNC_USR_MASK) !=
|
|
(info->flags & ~ASYNC_USR_MASK)))
|
|
return -EPERM;
|
|
info->flags = ((info->flags & ~ASYNC_USR_MASK) |
|
|
(new_serial.flags & ASYNC_USR_MASK));
|
|
info->custom_divisor = new_serial.custom_divisor;
|
|
goto check_and_exit;
|
|
}
|
|
|
|
if (info->count > 1)
|
|
return -EBUSY;
|
|
|
|
/*
|
|
* OK, past this point, all the error checking has been done.
|
|
* At this point, we start making changes.....
|
|
*/
|
|
|
|
info->baud_base = new_serial.baud_base;
|
|
info->flags = ((info->flags & ~ASYNC_FLAGS) |
|
|
(new_serial.flags & ASYNC_FLAGS));
|
|
info->type = new_serial.type;
|
|
info->close_delay = new_serial.close_delay;
|
|
info->closing_wait = new_serial.closing_wait;
|
|
|
|
check_and_exit:
|
|
retval = startup(info);
|
|
return retval;
|
|
}
|
|
|
|
/*
|
|
* get_lsr_info - get line status register info
|
|
*
|
|
* Purpose: Let user call ioctl() to get info when the UART physically
|
|
* is emptied. On bus types like RS485, the transmitter must
|
|
* release the bus after transmitting. This must be done when
|
|
* the transmit shift register is empty, not be done when the
|
|
* transmit holding register is empty. This functionality
|
|
* allows an RS485 driver to be written in user space.
|
|
*/
|
|
static int get_lsr_info(struct mcf_serial * info, unsigned int *value)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned long flags;
|
|
unsigned char status;
|
|
|
|
local_irq_save(flags);
|
|
uartp = info->addr;
|
|
status = (uartp[MCFUART_USR] & MCFUART_USR_TXEMPTY) ? TIOCSER_TEMT : 0;
|
|
local_irq_restore(flags);
|
|
|
|
return put_user(status,value);
|
|
}
|
|
|
|
/*
|
|
* This routine sends a break character out the serial port.
|
|
*/
|
|
static void send_break( struct mcf_serial * info, int duration)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned long flags;
|
|
|
|
if (!info->addr)
|
|
return;
|
|
set_current_state(TASK_INTERRUPTIBLE);
|
|
uartp = info->addr;
|
|
|
|
local_irq_save(flags);
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDBREAKSTART;
|
|
schedule_timeout(duration);
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDBREAKSTOP;
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
static int mcfrs_tiocmget(struct tty_struct *tty, struct file *file)
|
|
{
|
|
struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_ioctl"))
|
|
return -ENODEV;
|
|
if (tty->flags & (1 << TTY_IO_ERROR))
|
|
return -EIO;
|
|
|
|
return mcfrs_getsignals(info);
|
|
}
|
|
|
|
static int mcfrs_tiocmset(struct tty_struct *tty, struct file *file,
|
|
unsigned int set, unsigned int clear)
|
|
{
|
|
struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
|
|
int rts = -1, dtr = -1;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_ioctl"))
|
|
return -ENODEV;
|
|
if (tty->flags & (1 << TTY_IO_ERROR))
|
|
return -EIO;
|
|
|
|
if (set & TIOCM_RTS)
|
|
rts = 1;
|
|
if (set & TIOCM_DTR)
|
|
dtr = 1;
|
|
if (clear & TIOCM_RTS)
|
|
rts = 0;
|
|
if (clear & TIOCM_DTR)
|
|
dtr = 0;
|
|
|
|
mcfrs_setsignals(info, dtr, rts);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int mcfrs_ioctl(struct tty_struct *tty, struct file * file,
|
|
unsigned int cmd, unsigned long arg)
|
|
{
|
|
struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
|
|
int retval, error;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_ioctl"))
|
|
return -ENODEV;
|
|
|
|
if ((cmd != TIOCGSERIAL) && (cmd != TIOCSSERIAL) &&
|
|
(cmd != TIOCSERCONFIG) && (cmd != TIOCSERGWILD) &&
|
|
(cmd != TIOCSERSWILD) && (cmd != TIOCSERGSTRUCT)) {
|
|
if (tty->flags & (1 << TTY_IO_ERROR))
|
|
return -EIO;
|
|
}
|
|
|
|
switch (cmd) {
|
|
case TCSBRK: /* SVID version: non-zero arg --> no break */
|
|
retval = tty_check_change(tty);
|
|
if (retval)
|
|
return retval;
|
|
tty_wait_until_sent(tty, 0);
|
|
if (!arg)
|
|
send_break(info, HZ/4); /* 1/4 second */
|
|
return 0;
|
|
case TCSBRKP: /* support for POSIX tcsendbreak() */
|
|
retval = tty_check_change(tty);
|
|
if (retval)
|
|
return retval;
|
|
tty_wait_until_sent(tty, 0);
|
|
send_break(info, arg ? arg*(HZ/10) : HZ/4);
|
|
return 0;
|
|
case TIOCGSERIAL:
|
|
if (access_ok(VERIFY_WRITE, (void *) arg,
|
|
sizeof(struct serial_struct)))
|
|
return get_serial_info(info,
|
|
(struct serial_struct *) arg);
|
|
return -EFAULT;
|
|
case TIOCSSERIAL:
|
|
return set_serial_info(info,
|
|
(struct serial_struct *) arg);
|
|
case TIOCSERGETLSR: /* Get line status register */
|
|
if (access_ok(VERIFY_WRITE, (void *) arg,
|
|
sizeof(unsigned int)))
|
|
return get_lsr_info(info, (unsigned int *) arg);
|
|
return -EFAULT;
|
|
case TIOCSERGSTRUCT:
|
|
error = copy_to_user((struct mcf_serial *) arg,
|
|
info, sizeof(struct mcf_serial));
|
|
if (error)
|
|
return -EFAULT;
|
|
return 0;
|
|
|
|
#ifdef TIOCSET422
|
|
case TIOCSET422: {
|
|
unsigned int val;
|
|
get_user(val, (unsigned int *) arg);
|
|
mcf_setpa(MCFPP_PA11, (val ? 0 : MCFPP_PA11));
|
|
break;
|
|
}
|
|
case TIOCGET422: {
|
|
unsigned int val;
|
|
val = (mcf_getpa() & MCFPP_PA11) ? 0 : 1;
|
|
put_user(val, (unsigned int *) arg);
|
|
break;
|
|
}
|
|
#endif
|
|
|
|
default:
|
|
return -ENOIOCTLCMD;
|
|
}
|
|
return 0;
|
|
}
|
|
|
|
static void mcfrs_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
|
|
{
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
|
|
if (tty->termios->c_cflag == old_termios->c_cflag)
|
|
return;
|
|
|
|
mcfrs_change_speed(info);
|
|
|
|
if ((old_termios->c_cflag & CRTSCTS) &&
|
|
!(tty->termios->c_cflag & CRTSCTS)) {
|
|
tty->hw_stopped = 0;
|
|
mcfrs_setsignals(info, -1, 1);
|
|
#if 0
|
|
mcfrs_start(tty);
|
|
#endif
|
|
}
|
|
}
|
|
|
|
/*
|
|
* ------------------------------------------------------------
|
|
* mcfrs_close()
|
|
*
|
|
* This routine is called when the serial port gets closed. First, we
|
|
* wait for the last remaining data to be sent. Then, we unlink its
|
|
* S structure from the interrupt chain if necessary, and we free
|
|
* that IRQ if nothing is left in the chain.
|
|
* ------------------------------------------------------------
|
|
*/
|
|
static void mcfrs_close(struct tty_struct *tty, struct file * filp)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
struct mcf_serial *info = (struct mcf_serial *)tty->driver_data;
|
|
unsigned long flags;
|
|
|
|
if (!info || serial_paranoia_check(info, tty->name, "mcfrs_close"))
|
|
return;
|
|
|
|
local_irq_save(flags);
|
|
|
|
if (tty_hung_up_p(filp)) {
|
|
local_irq_restore(flags);
|
|
return;
|
|
}
|
|
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("mcfrs_close ttyS%d, count = %d\n", info->line, info->count);
|
|
#endif
|
|
if ((tty->count == 1) && (info->count != 1)) {
|
|
/*
|
|
* Uh, oh. tty->count is 1, which means that the tty
|
|
* structure will be freed. Info->count should always
|
|
* be one in these conditions. If it's greater than
|
|
* one, we've got real problems, since it means the
|
|
* serial port won't be shutdown.
|
|
*/
|
|
printk("MCFRS: bad serial port count; tty->count is 1, "
|
|
"info->count is %d\n", info->count);
|
|
info->count = 1;
|
|
}
|
|
if (--info->count < 0) {
|
|
printk("MCFRS: bad serial port count for ttyS%d: %d\n",
|
|
info->line, info->count);
|
|
info->count = 0;
|
|
}
|
|
if (info->count) {
|
|
local_irq_restore(flags);
|
|
return;
|
|
}
|
|
info->flags |= ASYNC_CLOSING;
|
|
|
|
/*
|
|
* Now we wait for the transmit buffer to clear; and we notify
|
|
* the line discipline to only process XON/XOFF characters.
|
|
*/
|
|
tty->closing = 1;
|
|
if (info->closing_wait != ASYNC_CLOSING_WAIT_NONE)
|
|
tty_wait_until_sent(tty, info->closing_wait);
|
|
|
|
/*
|
|
* At this point we stop accepting input. To do this, we
|
|
* disable the receive line status interrupts, and tell the
|
|
* interrupt driver to stop checking the data ready bit in the
|
|
* line status register.
|
|
*/
|
|
info->imr &= ~MCFUART_UIR_RXREADY;
|
|
uartp = info->addr;
|
|
uartp[MCFUART_UIMR] = info->imr;
|
|
|
|
#if 0
|
|
/* FIXME: do we need to keep this enabled for console?? */
|
|
if (mcfrs_console_inited && (mcfrs_console_port == info->line)) {
|
|
/* Do not disable the UART */ ;
|
|
} else
|
|
#endif
|
|
shutdown(info);
|
|
mcfrs_flush_buffer(tty);
|
|
tty_ldisc_flush(tty);
|
|
|
|
tty->closing = 0;
|
|
info->event = 0;
|
|
info->port.tty = NULL;
|
|
#if 0
|
|
if (tty->ldisc.num != ldiscs[N_TTY].num) {
|
|
if (tty->ldisc.close)
|
|
(tty->ldisc.close)(tty);
|
|
tty->ldisc = ldiscs[N_TTY];
|
|
tty->termios->c_line = N_TTY;
|
|
if (tty->ldisc.open)
|
|
(tty->ldisc.open)(tty);
|
|
}
|
|
#endif
|
|
if (info->blocked_open) {
|
|
if (info->close_delay) {
|
|
msleep_interruptible(jiffies_to_msecs(info->close_delay));
|
|
}
|
|
wake_up_interruptible(&info->open_wait);
|
|
}
|
|
info->flags &= ~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING);
|
|
wake_up_interruptible(&info->close_wait);
|
|
local_irq_restore(flags);
|
|
}
|
|
|
|
/*
|
|
* mcfrs_wait_until_sent() --- wait until the transmitter is empty
|
|
*/
|
|
static void
|
|
mcfrs_wait_until_sent(struct tty_struct *tty, int timeout)
|
|
{
|
|
#ifdef CONFIG_M5272
|
|
#define MCF5272_FIFO_SIZE 25 /* fifo size + shift reg */
|
|
|
|
struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
|
|
volatile unsigned char *uartp;
|
|
unsigned long orig_jiffies, fifo_time, char_time, fifo_cnt;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_wait_until_sent"))
|
|
return;
|
|
|
|
orig_jiffies = jiffies;
|
|
|
|
/*
|
|
* Set the check interval to be 1/5 of the approximate time
|
|
* to send the entire fifo, and make it at least 1. The check
|
|
* interval should also be less than the timeout.
|
|
*
|
|
* Note: we have to use pretty tight timings here to satisfy
|
|
* the NIST-PCTS.
|
|
*/
|
|
lock_kernel();
|
|
|
|
fifo_time = (MCF5272_FIFO_SIZE * HZ * 10) / info->baud;
|
|
char_time = fifo_time / 5;
|
|
if (char_time == 0)
|
|
char_time = 1;
|
|
if (timeout && timeout < char_time)
|
|
char_time = timeout;
|
|
|
|
/*
|
|
* Clamp the timeout period at 2 * the time to empty the
|
|
* fifo. Just to be safe, set the minimum at .5 seconds.
|
|
*/
|
|
fifo_time *= 2;
|
|
if (fifo_time < (HZ/2))
|
|
fifo_time = HZ/2;
|
|
if (!timeout || timeout > fifo_time)
|
|
timeout = fifo_time;
|
|
|
|
/*
|
|
* Account for the number of bytes in the UART
|
|
* transmitter FIFO plus any byte being shifted out.
|
|
*/
|
|
uartp = (volatile unsigned char *) info->addr;
|
|
for (;;) {
|
|
fifo_cnt = (uartp[MCFUART_UTF] & MCFUART_UTF_TXB);
|
|
if ((uartp[MCFUART_USR] & (MCFUART_USR_TXREADY|
|
|
MCFUART_USR_TXEMPTY)) ==
|
|
MCFUART_USR_TXREADY)
|
|
fifo_cnt++;
|
|
if (fifo_cnt == 0)
|
|
break;
|
|
msleep_interruptible(jiffies_to_msecs(char_time));
|
|
if (signal_pending(current))
|
|
break;
|
|
if (timeout && time_after(jiffies, orig_jiffies + timeout))
|
|
break;
|
|
}
|
|
unlock_kernel();
|
|
#else
|
|
/*
|
|
* For the other coldfire models, assume all data has been sent
|
|
*/
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* mcfrs_hangup() --- called by tty_hangup() when a hangup is signaled.
|
|
*/
|
|
void mcfrs_hangup(struct tty_struct *tty)
|
|
{
|
|
struct mcf_serial * info = (struct mcf_serial *)tty->driver_data;
|
|
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_hangup"))
|
|
return;
|
|
|
|
mcfrs_flush_buffer(tty);
|
|
shutdown(info);
|
|
info->event = 0;
|
|
info->count = 0;
|
|
info->flags &= ~ASYNC_NORMAL_ACTIVE;
|
|
info->port.tty = NULL;
|
|
wake_up_interruptible(&info->open_wait);
|
|
}
|
|
|
|
/*
|
|
* ------------------------------------------------------------
|
|
* mcfrs_open() and friends
|
|
* ------------------------------------------------------------
|
|
*/
|
|
static int block_til_ready(struct tty_struct *tty, struct file * filp,
|
|
struct mcf_serial *info)
|
|
{
|
|
DECLARE_WAITQUEUE(wait, current);
|
|
int retval;
|
|
int do_clocal = 0;
|
|
|
|
/*
|
|
* If the device is in the middle of being closed, then block
|
|
* until it's done, and then try again.
|
|
*/
|
|
if (info->flags & ASYNC_CLOSING) {
|
|
interruptible_sleep_on(&info->close_wait);
|
|
#ifdef SERIAL_DO_RESTART
|
|
if (info->flags & ASYNC_HUP_NOTIFY)
|
|
return -EAGAIN;
|
|
else
|
|
return -ERESTARTSYS;
|
|
#else
|
|
return -EAGAIN;
|
|
#endif
|
|
}
|
|
|
|
/*
|
|
* If non-blocking mode is set, or the port is not enabled,
|
|
* then make the check up front and then exit.
|
|
*/
|
|
if ((filp->f_flags & O_NONBLOCK) ||
|
|
(tty->flags & (1 << TTY_IO_ERROR))) {
|
|
info->flags |= ASYNC_NORMAL_ACTIVE;
|
|
return 0;
|
|
}
|
|
|
|
if (tty->termios->c_cflag & CLOCAL)
|
|
do_clocal = 1;
|
|
|
|
/*
|
|
* Block waiting for the carrier detect and the line to become
|
|
* free (i.e., not in use by the callout). While we are in
|
|
* this loop, info->count is dropped by one, so that
|
|
* mcfrs_close() knows when to free things. We restore it upon
|
|
* exit, either normal or abnormal.
|
|
*/
|
|
retval = 0;
|
|
add_wait_queue(&info->open_wait, &wait);
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("block_til_ready before block: ttyS%d, count = %d\n",
|
|
info->line, info->count);
|
|
#endif
|
|
info->count--;
|
|
info->blocked_open++;
|
|
while (1) {
|
|
local_irq_disable();
|
|
mcfrs_setsignals(info, 1, 1);
|
|
local_irq_enable();
|
|
current->state = TASK_INTERRUPTIBLE;
|
|
if (tty_hung_up_p(filp) ||
|
|
!(info->flags & ASYNC_INITIALIZED)) {
|
|
#ifdef SERIAL_DO_RESTART
|
|
if (info->flags & ASYNC_HUP_NOTIFY)
|
|
retval = -EAGAIN;
|
|
else
|
|
retval = -ERESTARTSYS;
|
|
#else
|
|
retval = -EAGAIN;
|
|
#endif
|
|
break;
|
|
}
|
|
if (!(info->flags & ASYNC_CLOSING) &&
|
|
(do_clocal || (mcfrs_getsignals(info) & TIOCM_CD)))
|
|
break;
|
|
if (signal_pending(current)) {
|
|
retval = -ERESTARTSYS;
|
|
break;
|
|
}
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("block_til_ready blocking: ttyS%d, count = %d\n",
|
|
info->line, info->count);
|
|
#endif
|
|
schedule();
|
|
}
|
|
current->state = TASK_RUNNING;
|
|
remove_wait_queue(&info->open_wait, &wait);
|
|
if (!tty_hung_up_p(filp))
|
|
info->count++;
|
|
info->blocked_open--;
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("block_til_ready after blocking: ttyS%d, count = %d\n",
|
|
info->line, info->count);
|
|
#endif
|
|
if (retval)
|
|
return retval;
|
|
info->flags |= ASYNC_NORMAL_ACTIVE;
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* This routine is called whenever a serial port is opened. It
|
|
* enables interrupts for a serial port, linking in its structure into
|
|
* the IRQ chain. It also performs the serial-specific
|
|
* initialization for the tty structure.
|
|
*/
|
|
int mcfrs_open(struct tty_struct *tty, struct file * filp)
|
|
{
|
|
struct mcf_serial *info;
|
|
int retval, line;
|
|
|
|
line = tty->index;
|
|
if ((line < 0) || (line >= NR_PORTS))
|
|
return -ENODEV;
|
|
info = mcfrs_table + line;
|
|
if (serial_paranoia_check(info, tty->name, "mcfrs_open"))
|
|
return -ENODEV;
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("mcfrs_open %s, count = %d\n", tty->name, info->count);
|
|
#endif
|
|
info->count++;
|
|
tty->driver_data = info;
|
|
info->port.tty = tty;
|
|
|
|
/*
|
|
* Start up serial port
|
|
*/
|
|
retval = startup(info);
|
|
if (retval)
|
|
return retval;
|
|
|
|
retval = block_til_ready(tty, filp, info);
|
|
if (retval) {
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("mcfrs_open returning after block_til_ready with %d\n",
|
|
retval);
|
|
#endif
|
|
return retval;
|
|
}
|
|
|
|
#ifdef SERIAL_DEBUG_OPEN
|
|
printk("mcfrs_open %s successful...\n", tty->name);
|
|
#endif
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Based on the line number set up the internal interrupt stuff.
|
|
*/
|
|
static void mcfrs_irqinit(struct mcf_serial *info)
|
|
{
|
|
#if defined(CONFIG_M5272)
|
|
volatile unsigned long *icrp;
|
|
volatile unsigned long *portp;
|
|
volatile unsigned char *uartp;
|
|
|
|
uartp = info->addr;
|
|
icrp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_ICR2);
|
|
|
|
switch (info->line) {
|
|
case 0:
|
|
*icrp = 0xe0000000;
|
|
break;
|
|
case 1:
|
|
*icrp = 0x0e000000;
|
|
break;
|
|
default:
|
|
printk("MCFRS: don't know how to handle UART %d interrupt?\n",
|
|
info->line);
|
|
return;
|
|
}
|
|
|
|
/* Enable the output lines for the serial ports */
|
|
portp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_PBCNT);
|
|
*portp = (*portp & ~0x000000ff) | 0x00000055;
|
|
portp = (volatile unsigned long *) (MCF_MBAR + MCFSIM_PDCNT);
|
|
*portp = (*portp & ~0x000003fc) | 0x000002a8;
|
|
#elif defined(CONFIG_M523x) || defined(CONFIG_M527x) || defined(CONFIG_M528x)
|
|
volatile unsigned char *icrp, *uartp;
|
|
volatile unsigned long *imrp;
|
|
|
|
uartp = info->addr;
|
|
|
|
icrp = (volatile unsigned char *) (MCF_MBAR + MCFICM_INTC0 +
|
|
MCFINTC_ICR0 + MCFINT_UART0 + info->line);
|
|
*icrp = 0x30 + info->line; /* level 6, line based priority */
|
|
|
|
imrp = (volatile unsigned long *) (MCF_MBAR + MCFICM_INTC0 +
|
|
MCFINTC_IMRL);
|
|
*imrp &= ~((1 << (info->irq - MCFINT_VECBASE)) | 1);
|
|
#if defined(CONFIG_M527x)
|
|
{
|
|
/*
|
|
* External Pin Mask Setting & Enable External Pin for Interface
|
|
* mrcbis@aliceposta.it
|
|
*/
|
|
u16 *serpin_enable_mask;
|
|
serpin_enable_mask = (u16 *) (MCF_IPSBAR + MCF_GPIO_PAR_UART);
|
|
if (info->line == 0)
|
|
*serpin_enable_mask |= UART0_ENABLE_MASK;
|
|
else if (info->line == 1)
|
|
*serpin_enable_mask |= UART1_ENABLE_MASK;
|
|
else if (info->line == 2)
|
|
*serpin_enable_mask |= UART2_ENABLE_MASK;
|
|
}
|
|
#endif
|
|
#if defined(CONFIG_M528x)
|
|
/* make sure PUAPAR is set for UART0 and UART1 */
|
|
if (info->line < 2) {
|
|
volatile unsigned char *portp = (volatile unsigned char *) (MCF_MBAR + MCF5282_GPIO_PUAPAR);
|
|
*portp |= (0x03 << (info->line * 2));
|
|
}
|
|
#endif
|
|
#elif defined(CONFIG_M520x)
|
|
volatile unsigned char *icrp, *uartp;
|
|
volatile unsigned long *imrp;
|
|
|
|
uartp = info->addr;
|
|
|
|
icrp = (volatile unsigned char *) (MCF_MBAR + MCFICM_INTC0 +
|
|
MCFINTC_ICR0 + MCFINT_UART0 + info->line);
|
|
*icrp = 0x03;
|
|
|
|
imrp = (volatile unsigned long *) (MCF_MBAR + MCFICM_INTC0 +
|
|
MCFINTC_IMRL);
|
|
*imrp &= ~((1 << (info->irq - MCFINT_VECBASE)) | 1);
|
|
if (info->line < 2) {
|
|
unsigned short *uart_par;
|
|
uart_par = (unsigned short *)(MCF_IPSBAR + MCF_GPIO_PAR_UART);
|
|
if (info->line == 0)
|
|
*uart_par |= MCF_GPIO_PAR_UART_PAR_UTXD0
|
|
| MCF_GPIO_PAR_UART_PAR_URXD0;
|
|
else if (info->line == 1)
|
|
*uart_par |= MCF_GPIO_PAR_UART_PAR_UTXD1
|
|
| MCF_GPIO_PAR_UART_PAR_URXD1;
|
|
} else if (info->line == 2) {
|
|
unsigned char *feci2c_par;
|
|
feci2c_par = (unsigned char *)(MCF_IPSBAR + MCF_GPIO_PAR_FECI2C);
|
|
*feci2c_par &= ~0x0F;
|
|
*feci2c_par |= MCF_GPIO_PAR_FECI2C_PAR_SCL_UTXD2
|
|
| MCF_GPIO_PAR_FECI2C_PAR_SDA_URXD2;
|
|
}
|
|
#elif defined(CONFIG_M532x)
|
|
volatile unsigned char *uartp;
|
|
uartp = info->addr;
|
|
switch (info->line) {
|
|
case 0:
|
|
MCF_INTC0_ICR26 = 0x3;
|
|
MCF_INTC0_CIMR = 26;
|
|
/* GPIO initialization */
|
|
MCF_GPIO_PAR_UART |= 0x000F;
|
|
break;
|
|
case 1:
|
|
MCF_INTC0_ICR27 = 0x3;
|
|
MCF_INTC0_CIMR = 27;
|
|
/* GPIO initialization */
|
|
MCF_GPIO_PAR_UART |= 0x0FF0;
|
|
break;
|
|
case 2:
|
|
MCF_INTC0_ICR28 = 0x3;
|
|
MCF_INTC0_CIMR = 28;
|
|
/* GPIOs also must be initalized, depends on board */
|
|
break;
|
|
}
|
|
#else
|
|
volatile unsigned char *icrp, *uartp;
|
|
|
|
switch (info->line) {
|
|
case 0:
|
|
icrp = (volatile unsigned char *) (MCF_MBAR + MCFSIM_UART1ICR);
|
|
*icrp = /*MCFSIM_ICR_AUTOVEC |*/ MCFSIM_ICR_LEVEL6 |
|
|
MCFSIM_ICR_PRI1;
|
|
mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_UART1);
|
|
break;
|
|
case 1:
|
|
icrp = (volatile unsigned char *) (MCF_MBAR + MCFSIM_UART2ICR);
|
|
*icrp = /*MCFSIM_ICR_AUTOVEC |*/ MCFSIM_ICR_LEVEL6 |
|
|
MCFSIM_ICR_PRI2;
|
|
mcf_setimr(mcf_getimr() & ~MCFSIM_IMR_UART2);
|
|
break;
|
|
default:
|
|
printk("MCFRS: don't know how to handle UART %d interrupt?\n",
|
|
info->line);
|
|
return;
|
|
}
|
|
|
|
uartp = info->addr;
|
|
uartp[MCFUART_UIVR] = info->irq;
|
|
#endif
|
|
|
|
/* Clear mask, so no surprise interrupts. */
|
|
uartp[MCFUART_UIMR] = 0;
|
|
|
|
if (request_irq(info->irq, mcfrs_interrupt, IRQF_DISABLED,
|
|
"ColdFire UART", NULL)) {
|
|
printk("MCFRS: Unable to attach ColdFire UART %d interrupt "
|
|
"vector=%d\n", info->line, info->irq);
|
|
}
|
|
|
|
return;
|
|
}
|
|
|
|
|
|
char *mcfrs_drivername = "ColdFire internal UART serial driver version 1.00\n";
|
|
|
|
|
|
/*
|
|
* Serial stats reporting...
|
|
*/
|
|
int mcfrs_readproc(char *page, char **start, off_t off, int count,
|
|
int *eof, void *data)
|
|
{
|
|
struct mcf_serial *info;
|
|
char str[20];
|
|
int len, sigs, i;
|
|
|
|
len = sprintf(page, mcfrs_drivername);
|
|
for (i = 0; (i < NR_PORTS); i++) {
|
|
info = &mcfrs_table[i];
|
|
len += sprintf((page + len), "%d: port:%x irq=%d baud:%d ",
|
|
i, (unsigned int) info->addr, info->irq, info->baud);
|
|
if (info->stats.rx || info->stats.tx)
|
|
len += sprintf((page + len), "tx:%d rx:%d ",
|
|
info->stats.tx, info->stats.rx);
|
|
if (info->stats.rxframing)
|
|
len += sprintf((page + len), "fe:%d ",
|
|
info->stats.rxframing);
|
|
if (info->stats.rxparity)
|
|
len += sprintf((page + len), "pe:%d ",
|
|
info->stats.rxparity);
|
|
if (info->stats.rxbreak)
|
|
len += sprintf((page + len), "brk:%d ",
|
|
info->stats.rxbreak);
|
|
if (info->stats.rxoverrun)
|
|
len += sprintf((page + len), "oe:%d ",
|
|
info->stats.rxoverrun);
|
|
|
|
str[0] = str[1] = 0;
|
|
if ((sigs = mcfrs_getsignals(info))) {
|
|
if (sigs & TIOCM_RTS)
|
|
strcat(str, "|RTS");
|
|
if (sigs & TIOCM_CTS)
|
|
strcat(str, "|CTS");
|
|
if (sigs & TIOCM_DTR)
|
|
strcat(str, "|DTR");
|
|
if (sigs & TIOCM_CD)
|
|
strcat(str, "|CD");
|
|
}
|
|
|
|
len += sprintf((page + len), "%s\n", &str[1]);
|
|
}
|
|
|
|
return(len);
|
|
}
|
|
|
|
|
|
/* Finally, routines used to initialize the serial driver. */
|
|
|
|
static void show_serial_version(void)
|
|
{
|
|
printk(mcfrs_drivername);
|
|
}
|
|
|
|
static const struct tty_operations mcfrs_ops = {
|
|
.open = mcfrs_open,
|
|
.close = mcfrs_close,
|
|
.write = mcfrs_write,
|
|
.flush_chars = mcfrs_flush_chars,
|
|
.write_room = mcfrs_write_room,
|
|
.chars_in_buffer = mcfrs_chars_in_buffer,
|
|
.flush_buffer = mcfrs_flush_buffer,
|
|
.ioctl = mcfrs_ioctl,
|
|
.throttle = mcfrs_throttle,
|
|
.unthrottle = mcfrs_unthrottle,
|
|
.set_termios = mcfrs_set_termios,
|
|
.stop = mcfrs_stop,
|
|
.start = mcfrs_start,
|
|
.hangup = mcfrs_hangup,
|
|
.read_proc = mcfrs_readproc,
|
|
.wait_until_sent = mcfrs_wait_until_sent,
|
|
.tiocmget = mcfrs_tiocmget,
|
|
.tiocmset = mcfrs_tiocmset,
|
|
};
|
|
|
|
/* mcfrs_init inits the driver */
|
|
static int __init
|
|
mcfrs_init(void)
|
|
{
|
|
struct mcf_serial *info;
|
|
unsigned long flags;
|
|
int i;
|
|
|
|
/* Setup base handler, and timer table. */
|
|
#ifdef MCFPP_DCD0
|
|
init_timer(&mcfrs_timer_struct);
|
|
mcfrs_timer_struct.function = mcfrs_timer;
|
|
mcfrs_timer_struct.data = 0;
|
|
mcfrs_timer_struct.expires = jiffies + HZ/25;
|
|
add_timer(&mcfrs_timer_struct);
|
|
mcfrs_ppstatus = mcf_getppdata() & (MCFPP_DCD0 | MCFPP_DCD1);
|
|
#endif
|
|
mcfrs_serial_driver = alloc_tty_driver(NR_PORTS);
|
|
if (!mcfrs_serial_driver)
|
|
return -ENOMEM;
|
|
|
|
show_serial_version();
|
|
|
|
/* Initialize the tty_driver structure */
|
|
mcfrs_serial_driver->owner = THIS_MODULE;
|
|
mcfrs_serial_driver->name = "ttyS";
|
|
mcfrs_serial_driver->driver_name = "mcfserial";
|
|
mcfrs_serial_driver->major = TTY_MAJOR;
|
|
mcfrs_serial_driver->minor_start = 64;
|
|
mcfrs_serial_driver->type = TTY_DRIVER_TYPE_SERIAL;
|
|
mcfrs_serial_driver->subtype = SERIAL_TYPE_NORMAL;
|
|
mcfrs_serial_driver->init_termios = tty_std_termios;
|
|
|
|
mcfrs_serial_driver->init_termios.c_cflag =
|
|
mcfrs_console_cbaud | CS8 | CREAD | HUPCL | CLOCAL;
|
|
mcfrs_serial_driver->flags = TTY_DRIVER_REAL_RAW;
|
|
|
|
tty_set_operations(mcfrs_serial_driver, &mcfrs_ops);
|
|
|
|
if (tty_register_driver(mcfrs_serial_driver)) {
|
|
printk("MCFRS: Couldn't register serial driver\n");
|
|
put_tty_driver(mcfrs_serial_driver);
|
|
return(-EBUSY);
|
|
}
|
|
|
|
local_irq_save(flags);
|
|
|
|
/*
|
|
* Configure all the attached serial ports.
|
|
*/
|
|
for (i = 0, info = mcfrs_table; (i < NR_PORTS); i++, info++) {
|
|
info->magic = SERIAL_MAGIC;
|
|
info->line = i;
|
|
info->port.tty = NULL;
|
|
info->custom_divisor = 16;
|
|
info->close_delay = 50;
|
|
info->closing_wait = 3000;
|
|
info->x_char = 0;
|
|
info->event = 0;
|
|
info->count = 0;
|
|
info->blocked_open = 0;
|
|
INIT_WORK(&info->tqueue, mcfrs_offintr);
|
|
INIT_WORK(&info->tqueue_hangup, do_serial_hangup);
|
|
init_waitqueue_head(&info->open_wait);
|
|
init_waitqueue_head(&info->close_wait);
|
|
|
|
info->imr = 0;
|
|
mcfrs_setsignals(info, 0, 0);
|
|
mcfrs_irqinit(info);
|
|
|
|
printk("ttyS%d at 0x%04x (irq = %d)", info->line,
|
|
(unsigned int) info->addr, info->irq);
|
|
printk(" is a builtin ColdFire UART\n");
|
|
}
|
|
|
|
local_irq_restore(flags);
|
|
return 0;
|
|
}
|
|
|
|
module_init(mcfrs_init);
|
|
|
|
/****************************************************************************/
|
|
/* Serial Console */
|
|
/****************************************************************************/
|
|
|
|
/*
|
|
* Quick and dirty UART initialization, for console output.
|
|
*/
|
|
|
|
void mcfrs_init_console(void)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned int clk;
|
|
|
|
/*
|
|
* Reset UART, get it into known state...
|
|
*/
|
|
uartp = (volatile unsigned char *) (MCF_MBAR +
|
|
(mcfrs_console_port ? MCFUART_BASE2 : MCFUART_BASE1));
|
|
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETRX; /* reset RX */
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETTX; /* reset TX */
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_CMDRESETMRPTR; /* reset MR pointer */
|
|
|
|
/*
|
|
* Set port for defined baud , 8 data bits, 1 stop bit, no parity.
|
|
*/
|
|
uartp[MCFUART_UMR] = MCFUART_MR1_PARITYNONE | MCFUART_MR1_CS8;
|
|
uartp[MCFUART_UMR] = MCFUART_MR2_STOP1;
|
|
|
|
#ifdef CONFIG_M5272
|
|
{
|
|
/*
|
|
* For the MCF5272, also compute the baudrate fraction.
|
|
*/
|
|
int fraction = MCF_BUSCLK - (clk * 32 * mcfrs_console_baud);
|
|
fraction *= 16;
|
|
fraction /= (32 * mcfrs_console_baud);
|
|
uartp[MCFUART_UFPD] = (fraction & 0xf); /* set fraction */
|
|
clk = (MCF_BUSCLK / mcfrs_console_baud) / 32;
|
|
}
|
|
#else
|
|
clk = ((MCF_BUSCLK / mcfrs_console_baud) + 16) / 32; /* set baud */
|
|
#endif
|
|
|
|
uartp[MCFUART_UBG1] = (clk & 0xff00) >> 8; /* set msb baud */
|
|
uartp[MCFUART_UBG2] = (clk & 0xff); /* set lsb baud */
|
|
uartp[MCFUART_UCSR] = MCFUART_UCSR_RXCLKTIMER | MCFUART_UCSR_TXCLKTIMER;
|
|
uartp[MCFUART_UCR] = MCFUART_UCR_RXENABLE | MCFUART_UCR_TXENABLE;
|
|
|
|
mcfrs_console_inited++;
|
|
return;
|
|
}
|
|
|
|
|
|
/*
|
|
* Setup for console. Argument comes from the boot command line.
|
|
*/
|
|
|
|
int mcfrs_console_setup(struct console *cp, char *arg)
|
|
{
|
|
int i, n = CONSOLE_BAUD_RATE;
|
|
|
|
if (!cp)
|
|
return(-1);
|
|
|
|
if (!strncmp(cp->name, "ttyS", 4))
|
|
mcfrs_console_port = cp->index;
|
|
else if (!strncmp(cp->name, "cua", 3))
|
|
mcfrs_console_port = cp->index;
|
|
else
|
|
return(-1);
|
|
|
|
if (arg)
|
|
n = simple_strtoul(arg,NULL,0);
|
|
for (i = 0; i < MCFRS_BAUD_TABLE_SIZE; i++)
|
|
if (mcfrs_baud_table[i] == n)
|
|
break;
|
|
if (i < MCFRS_BAUD_TABLE_SIZE) {
|
|
mcfrs_console_baud = n;
|
|
mcfrs_console_cbaud = 0;
|
|
if (i > 15) {
|
|
mcfrs_console_cbaud |= CBAUDEX;
|
|
i -= 15;
|
|
}
|
|
mcfrs_console_cbaud |= i;
|
|
}
|
|
mcfrs_init_console(); /* make sure baud rate changes */
|
|
return(0);
|
|
}
|
|
|
|
|
|
static struct tty_driver *mcfrs_console_device(struct console *c, int *index)
|
|
{
|
|
*index = c->index;
|
|
return mcfrs_serial_driver;
|
|
}
|
|
|
|
|
|
/*
|
|
* Output a single character, using UART polled mode.
|
|
* This is used for console output.
|
|
*/
|
|
|
|
int mcfrs_put_char(char ch)
|
|
{
|
|
volatile unsigned char *uartp;
|
|
unsigned long flags;
|
|
int i;
|
|
|
|
uartp = (volatile unsigned char *) (MCF_MBAR +
|
|
(mcfrs_console_port ? MCFUART_BASE2 : MCFUART_BASE1));
|
|
|
|
local_irq_save(flags);
|
|
for (i = 0; (i < 0x10000); i++) {
|
|
if (uartp[MCFUART_USR] & MCFUART_USR_TXREADY)
|
|
break;
|
|
}
|
|
if (i < 0x10000) {
|
|
uartp[MCFUART_UTB] = ch;
|
|
for (i = 0; (i < 0x10000); i++)
|
|
if (uartp[MCFUART_USR] & MCFUART_USR_TXEMPTY)
|
|
break;
|
|
}
|
|
if (i >= 0x10000)
|
|
mcfrs_init_console(); /* try and get it back */
|
|
local_irq_restore(flags);
|
|
|
|
return 1;
|
|
}
|
|
|
|
|
|
/*
|
|
* rs_console_write is registered for printk output.
|
|
*/
|
|
|
|
void mcfrs_console_write(struct console *cp, const char *p, unsigned len)
|
|
{
|
|
if (!mcfrs_console_inited)
|
|
mcfrs_init_console();
|
|
while (len-- > 0) {
|
|
if (*p == '\n')
|
|
mcfrs_put_char('\r');
|
|
mcfrs_put_char(*p++);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* declare our consoles
|
|
*/
|
|
|
|
struct console mcfrs_console = {
|
|
.name = "ttyS",
|
|
.write = mcfrs_console_write,
|
|
.device = mcfrs_console_device,
|
|
.setup = mcfrs_console_setup,
|
|
.flags = CON_PRINTBUFFER,
|
|
.index = -1,
|
|
};
|
|
|
|
static int __init mcfrs_console_init(void)
|
|
{
|
|
register_console(&mcfrs_console);
|
|
return 0;
|
|
}
|
|
|
|
console_initcall(mcfrs_console_init);
|
|
|
|
/****************************************************************************/
|