Linux Audio

Check our new training course

Loading...
v6.2
   1// SPDX-License-Identifier: GPL-2.0
   2/*
   3 * Derived from many drivers using generic_serial interface,
   4 * especially serial_tx3912.c by Steven J. Hill and r39xx_serial.c
   5 * (was in Linux/VR tree) by Jim Pick.
   6 *
   7 *  Copyright (C) 1999 Harald Koerfgen
   8 *  Copyright (C) 2000 Jim Pick <jim@jimpick.com>
   9 *  Copyright (C) 2001 Steven J. Hill (sjhill@realitydiluted.com)
  10 *  Copyright (C) 2000-2002 Toshiba Corporation
  11 *
 
 
 
 
  12 *  Serial driver for TX3927/TX4927/TX4925/TX4938 internal SIO controller
  13 */
  14
 
 
 
 
  15#include <linux/module.h>
  16#include <linux/ioport.h>
  17#include <linux/init.h>
  18#include <linux/console.h>
  19#include <linux/delay.h>
  20#include <linux/platform_device.h>
  21#include <linux/pci.h>
  22#include <linux/serial_core.h>
  23#include <linux/serial.h>
  24#include <linux/tty.h>
  25#include <linux/tty_flip.h>
  26
  27#include <linux/io.h>
 
 
 
  28
  29#define PASS_LIMIT	256
  30
  31#if !defined(CONFIG_SERIAL_TXX9_STDSERIAL)
  32/* "ttyS" is used for standard serial driver */
  33#define TXX9_TTY_NAME "ttyTX"
  34#define TXX9_TTY_MINOR_START	196
  35#define TXX9_TTY_MAJOR	204
  36#else
  37/* acts like standard serial driver */
  38#define TXX9_TTY_NAME "ttyS"
  39#define TXX9_TTY_MINOR_START	64
  40#define TXX9_TTY_MAJOR	TTY_MAJOR
  41#endif
  42
  43/* flag aliases */
  44#define UPF_TXX9_HAVE_CTS_LINE	UPF_BUGGY_UART
  45#define UPF_TXX9_USE_SCLK	UPF_MAGIC_MULTIPLIER
  46
  47#ifdef CONFIG_PCI
  48/* support for Toshiba TC86C001 SIO */
  49#define ENABLE_SERIAL_TXX9_PCI
  50#endif
  51
  52/*
  53 * Number of serial ports
  54 */
  55#define UART_NR  CONFIG_SERIAL_TXX9_NR_UARTS
  56
 
 
 
 
 
  57#define TXX9_REGION_SIZE	0x24
  58
  59/* TXX9 Serial Registers */
  60#define TXX9_SILCR	0x00
  61#define TXX9_SIDICR	0x04
  62#define TXX9_SIDISR	0x08
  63#define TXX9_SICISR	0x0c
  64#define TXX9_SIFCR	0x10
  65#define TXX9_SIFLCR	0x14
  66#define TXX9_SIBGR	0x18
  67#define TXX9_SITFIFO	0x1c
  68#define TXX9_SIRFIFO	0x20
  69
  70/* SILCR : Line Control */
  71#define TXX9_SILCR_SCS_MASK	0x00000060
  72#define TXX9_SILCR_SCS_IMCLK	0x00000000
  73#define TXX9_SILCR_SCS_IMCLK_BG	0x00000020
  74#define TXX9_SILCR_SCS_SCLK	0x00000040
  75#define TXX9_SILCR_SCS_SCLK_BG	0x00000060
  76#define TXX9_SILCR_UEPS	0x00000010
  77#define TXX9_SILCR_UPEN	0x00000008
  78#define TXX9_SILCR_USBL_MASK	0x00000004
  79#define TXX9_SILCR_USBL_1BIT	0x00000000
  80#define TXX9_SILCR_USBL_2BIT	0x00000004
  81#define TXX9_SILCR_UMODE_MASK	0x00000003
  82#define TXX9_SILCR_UMODE_8BIT	0x00000000
  83#define TXX9_SILCR_UMODE_7BIT	0x00000001
  84
  85/* SIDICR : DMA/Int. Control */
  86#define TXX9_SIDICR_TDE	0x00008000
  87#define TXX9_SIDICR_RDE	0x00004000
  88#define TXX9_SIDICR_TIE	0x00002000
  89#define TXX9_SIDICR_RIE	0x00001000
  90#define TXX9_SIDICR_SPIE	0x00000800
  91#define TXX9_SIDICR_CTSAC	0x00000600
  92#define TXX9_SIDICR_STIE_MASK	0x0000003f
  93#define TXX9_SIDICR_STIE_OERS		0x00000020
  94#define TXX9_SIDICR_STIE_CTSS		0x00000010
  95#define TXX9_SIDICR_STIE_RBRKD	0x00000008
  96#define TXX9_SIDICR_STIE_TRDY		0x00000004
  97#define TXX9_SIDICR_STIE_TXALS	0x00000002
  98#define TXX9_SIDICR_STIE_UBRKD	0x00000001
  99
 100/* SIDISR : DMA/Int. Status */
 101#define TXX9_SIDISR_UBRK	0x00008000
 102#define TXX9_SIDISR_UVALID	0x00004000
 103#define TXX9_SIDISR_UFER	0x00002000
 104#define TXX9_SIDISR_UPER	0x00001000
 105#define TXX9_SIDISR_UOER	0x00000800
 106#define TXX9_SIDISR_ERI	0x00000400
 107#define TXX9_SIDISR_TOUT	0x00000200
 108#define TXX9_SIDISR_TDIS	0x00000100
 109#define TXX9_SIDISR_RDIS	0x00000080
 110#define TXX9_SIDISR_STIS	0x00000040
 111#define TXX9_SIDISR_RFDN_MASK	0x0000001f
 112
 113/* SICISR : Change Int. Status */
 114#define TXX9_SICISR_OERS	0x00000020
 115#define TXX9_SICISR_CTSS	0x00000010
 116#define TXX9_SICISR_RBRKD	0x00000008
 117#define TXX9_SICISR_TRDY	0x00000004
 118#define TXX9_SICISR_TXALS	0x00000002
 119#define TXX9_SICISR_UBRKD	0x00000001
 120
 121/* SIFCR : FIFO Control */
 122#define TXX9_SIFCR_SWRST	0x00008000
 123#define TXX9_SIFCR_RDIL_MASK	0x00000180
 124#define TXX9_SIFCR_RDIL_1	0x00000000
 125#define TXX9_SIFCR_RDIL_4	0x00000080
 126#define TXX9_SIFCR_RDIL_8	0x00000100
 127#define TXX9_SIFCR_RDIL_12	0x00000180
 128#define TXX9_SIFCR_RDIL_MAX	0x00000180
 129#define TXX9_SIFCR_TDIL_MASK	0x00000018
 
 130#define TXX9_SIFCR_TDIL_1	0x00000000
 131#define TXX9_SIFCR_TDIL_4	0x00000001
 132#define TXX9_SIFCR_TDIL_8	0x00000010
 133#define TXX9_SIFCR_TDIL_MAX	0x00000010
 134#define TXX9_SIFCR_TFRST	0x00000004
 135#define TXX9_SIFCR_RFRST	0x00000002
 136#define TXX9_SIFCR_FRSTE	0x00000001
 137#define TXX9_SIO_TX_FIFO	8
 138#define TXX9_SIO_RX_FIFO	16
 139
 140/* SIFLCR : Flow Control */
 141#define TXX9_SIFLCR_RCS	0x00001000
 142#define TXX9_SIFLCR_TES	0x00000800
 143#define TXX9_SIFLCR_RTSSC	0x00000200
 144#define TXX9_SIFLCR_RSDE	0x00000100
 145#define TXX9_SIFLCR_TSDE	0x00000080
 146#define TXX9_SIFLCR_RTSTL_MASK	0x0000001e
 147#define TXX9_SIFLCR_RTSTL_MAX	0x0000001e
 148#define TXX9_SIFLCR_TBRK	0x00000001
 149
 150/* SIBGR : Baudrate Control */
 151#define TXX9_SIBGR_BCLK_MASK	0x00000300
 152#define TXX9_SIBGR_BCLK_T0	0x00000000
 153#define TXX9_SIBGR_BCLK_T2	0x00000100
 154#define TXX9_SIBGR_BCLK_T4	0x00000200
 155#define TXX9_SIBGR_BCLK_T6	0x00000300
 156#define TXX9_SIBGR_BRD_MASK	0x000000ff
 157
 158static inline unsigned int sio_in(struct uart_port *up, int offset)
 159{
 160	switch (up->iotype) {
 161	default:
 162		return __raw_readl(up->membase + offset);
 163	case UPIO_PORT:
 164		return inl(up->iobase + offset);
 165	}
 166}
 167
 168static inline void
 169sio_out(struct uart_port *up, int offset, int value)
 170{
 171	switch (up->iotype) {
 172	default:
 173		__raw_writel(value, up->membase + offset);
 174		break;
 175	case UPIO_PORT:
 176		outl(value, up->iobase + offset);
 177		break;
 178	}
 179}
 180
 181static inline void
 182sio_mask(struct uart_port *up, int offset, unsigned int value)
 183{
 184	sio_out(up, offset, sio_in(up, offset) & ~value);
 185}
 186static inline void
 187sio_set(struct uart_port *up, int offset, unsigned int value)
 188{
 189	sio_out(up, offset, sio_in(up, offset) | value);
 190}
 191
 192static inline void
 193sio_quot_set(struct uart_port *up, int quot)
 194{
 195	quot >>= 1;
 196	if (quot < 256)
 197		sio_out(up, TXX9_SIBGR, quot | TXX9_SIBGR_BCLK_T0);
 198	else if (quot < (256 << 2))
 199		sio_out(up, TXX9_SIBGR, (quot >> 2) | TXX9_SIBGR_BCLK_T2);
 200	else if (quot < (256 << 4))
 201		sio_out(up, TXX9_SIBGR, (quot >> 4) | TXX9_SIBGR_BCLK_T4);
 202	else if (quot < (256 << 6))
 203		sio_out(up, TXX9_SIBGR, (quot >> 6) | TXX9_SIBGR_BCLK_T6);
 204	else
 205		sio_out(up, TXX9_SIBGR, 0xff | TXX9_SIBGR_BCLK_T6);
 206}
 207
 208static void serial_txx9_stop_tx(struct uart_port *up)
 209{
 
 
 
 
 
 
 210	sio_mask(up, TXX9_SIDICR, TXX9_SIDICR_TIE);
 211}
 212
 213static void serial_txx9_start_tx(struct uart_port *up)
 214{
 
 215	sio_set(up, TXX9_SIDICR, TXX9_SIDICR_TIE);
 216}
 217
 218static void serial_txx9_stop_rx(struct uart_port *up)
 219{
 220	up->read_status_mask &= ~TXX9_SIDISR_RDIS;
 
 221}
 222
 223static void serial_txx9_initialize(struct uart_port *up)
 224{
 
 
 
 
 
 
 225	unsigned int tmout = 10000;
 226
 227	sio_out(up, TXX9_SIFCR, TXX9_SIFCR_SWRST);
 228	/* TX4925 BUG WORKAROUND.  Accessing SIOC register
 229	 * immediately after soft reset causes bus error. */
 
 230	udelay(1);
 231	while ((sio_in(up, TXX9_SIFCR) & TXX9_SIFCR_SWRST) && --tmout)
 232		udelay(1);
 233	/* TX Int by FIFO Empty, RX Int by Receiving 1 char. */
 234	sio_set(up, TXX9_SIFCR,
 235		TXX9_SIFCR_TDIL_MAX | TXX9_SIFCR_RDIL_1);
 236	/* initial settings */
 237	sio_out(up, TXX9_SILCR,
 238		TXX9_SILCR_UMODE_8BIT | TXX9_SILCR_USBL_1BIT |
 239		((up->flags & UPF_TXX9_USE_SCLK) ?
 240		 TXX9_SILCR_SCS_SCLK_BG : TXX9_SILCR_SCS_IMCLK_BG));
 241	sio_quot_set(up, uart_get_divisor(up, 9600));
 242	sio_out(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSTL_MAX /* 15 */);
 243	sio_out(up, TXX9_SIDICR, 0);
 244}
 245
 246static inline void
 247receive_chars(struct uart_port *up, unsigned int *status)
 248{
 249	unsigned char ch;
 250	unsigned int disr = *status;
 251	int max_count = 256;
 252	char flag;
 253	unsigned int next_ignore_status_mask;
 254
 255	do {
 256		ch = sio_in(up, TXX9_SIRFIFO);
 257		flag = TTY_NORMAL;
 258		up->icount.rx++;
 259
 260		/* mask out RFDN_MASK bit added by previous overrun */
 261		next_ignore_status_mask =
 262			up->ignore_status_mask & ~TXX9_SIDISR_RFDN_MASK;
 263		if (unlikely(disr & (TXX9_SIDISR_UBRK | TXX9_SIDISR_UPER |
 264				     TXX9_SIDISR_UFER | TXX9_SIDISR_UOER))) {
 265			/*
 266			 * For statistics only
 267			 */
 268			if (disr & TXX9_SIDISR_UBRK) {
 269				disr &= ~(TXX9_SIDISR_UFER | TXX9_SIDISR_UPER);
 270				up->icount.brk++;
 271				/*
 272				 * We do the SysRQ and SAK checking
 273				 * here because otherwise the break
 274				 * may get masked by ignore_status_mask
 275				 * or read_status_mask.
 276				 */
 277				if (uart_handle_break(up))
 278					goto ignore_char;
 279			} else if (disr & TXX9_SIDISR_UPER)
 280				up->icount.parity++;
 281			else if (disr & TXX9_SIDISR_UFER)
 282				up->icount.frame++;
 283			if (disr & TXX9_SIDISR_UOER) {
 284				up->icount.overrun++;
 285				/*
 286				 * The receiver read buffer still hold
 287				 * a char which caused overrun.
 288				 * Ignore next char by adding RFDN_MASK
 289				 * to ignore_status_mask temporarily.
 290				 */
 291				next_ignore_status_mask |=
 292					TXX9_SIDISR_RFDN_MASK;
 293			}
 294
 295			/*
 296			 * Mask off conditions which should be ingored.
 297			 */
 298			disr &= up->read_status_mask;
 299
 300			if (disr & TXX9_SIDISR_UBRK) {
 301				flag = TTY_BREAK;
 302			} else if (disr & TXX9_SIDISR_UPER)
 303				flag = TTY_PARITY;
 304			else if (disr & TXX9_SIDISR_UFER)
 305				flag = TTY_FRAME;
 306		}
 307		if (uart_handle_sysrq_char(up, ch))
 308			goto ignore_char;
 309
 310		uart_insert_char(up, disr, TXX9_SIDISR_UOER, ch, flag);
 311
 312	ignore_char:
 313		up->ignore_status_mask = next_ignore_status_mask;
 314		disr = sio_in(up, TXX9_SIDISR);
 315	} while (!(disr & TXX9_SIDISR_UVALID) && (max_count-- > 0));
 316
 317	tty_flip_buffer_push(&up->state->port);
 318
 319	*status = disr;
 320}
 321
 322static inline void transmit_chars(struct uart_port *up)
 323{
 324	u8 ch;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 325
 326	uart_port_tx_limited(up, ch, TXX9_SIO_TX_FIFO,
 327		true,
 328		sio_out(up, TXX9_SITFIFO, ch),
 329		({}));
 
 330}
 331
 332static irqreturn_t serial_txx9_interrupt(int irq, void *dev_id)
 333{
 334	int pass_counter = 0;
 335	struct uart_port *up = dev_id;
 336	unsigned int status;
 337
 338	while (1) {
 339		spin_lock(&up->lock);
 340		status = sio_in(up, TXX9_SIDISR);
 341		if (!(sio_in(up, TXX9_SIDICR) & TXX9_SIDICR_TIE))
 342			status &= ~TXX9_SIDISR_TDIS;
 343		if (!(status & (TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS |
 344				TXX9_SIDISR_TOUT))) {
 345			spin_unlock(&up->lock);
 346			break;
 347		}
 348
 349		if (status & TXX9_SIDISR_RDIS)
 350			receive_chars(up, &status);
 351		if (status & TXX9_SIDISR_TDIS)
 352			transmit_chars(up);
 353		/* Clear TX/RX Int. Status */
 354		sio_mask(up, TXX9_SIDISR,
 355			 TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS |
 356			 TXX9_SIDISR_TOUT);
 357		spin_unlock(&up->lock);
 358
 359		if (pass_counter++ > PASS_LIMIT)
 360			break;
 361	}
 362
 363	return pass_counter ? IRQ_HANDLED : IRQ_NONE;
 364}
 365
 366static unsigned int serial_txx9_tx_empty(struct uart_port *up)
 367{
 
 368	unsigned long flags;
 369	unsigned int ret;
 370
 371	spin_lock_irqsave(&up->lock, flags);
 372	ret = (sio_in(up, TXX9_SICISR) & TXX9_SICISR_TXALS) ? TIOCSER_TEMT : 0;
 373	spin_unlock_irqrestore(&up->lock, flags);
 374
 375	return ret;
 376}
 377
 378static unsigned int serial_txx9_get_mctrl(struct uart_port *up)
 379{
 
 380	unsigned int ret;
 381
 382	/* no modem control lines */
 383	ret = TIOCM_CAR | TIOCM_DSR;
 384	ret |= (sio_in(up, TXX9_SIFLCR) & TXX9_SIFLCR_RTSSC) ? 0 : TIOCM_RTS;
 385	ret |= (sio_in(up, TXX9_SICISR) & TXX9_SICISR_CTSS) ? 0 : TIOCM_CTS;
 386
 387	return ret;
 388}
 389
 390static void serial_txx9_set_mctrl(struct uart_port *up, unsigned int mctrl)
 391{
 
 392
 393	if (mctrl & TIOCM_RTS)
 394		sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSSC);
 395	else
 396		sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSSC);
 397}
 398
 399static void serial_txx9_break_ctl(struct uart_port *up, int break_state)
 400{
 
 401	unsigned long flags;
 402
 403	spin_lock_irqsave(&up->lock, flags);
 404	if (break_state == -1)
 405		sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
 406	else
 407		sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
 408	spin_unlock_irqrestore(&up->lock, flags);
 409}
 410
 411#if defined(CONFIG_SERIAL_TXX9_CONSOLE) || defined(CONFIG_CONSOLE_POLL)
 412/*
 413 *	Wait for transmitter & holding register to empty
 414 */
 415static void wait_for_xmitr(struct uart_port *up)
 416{
 417	unsigned int tmout = 10000;
 418
 419	/* Wait up to 10ms for the character(s) to be sent. */
 420	while (--tmout &&
 421	       !(sio_in(up, TXX9_SICISR) & TXX9_SICISR_TXALS))
 422		udelay(1);
 423
 424	/* Wait up to 1s for flow control if necessary */
 425	if (up->flags & UPF_CONS_FLOW) {
 426		tmout = 1000000;
 427		while (--tmout &&
 428		       (sio_in(up, TXX9_SICISR) & TXX9_SICISR_CTSS))
 429			udelay(1);
 430	}
 431}
 432#endif
 433
 434#ifdef CONFIG_CONSOLE_POLL
 435/*
 436 * Console polling routines for writing and reading from the uart while
 437 * in an interrupt or debug context.
 438 */
 439
 440static int serial_txx9_get_poll_char(struct uart_port *up)
 441{
 442	unsigned int ier;
 443	unsigned char c;
 
 444
 445	/*
 446	 *	First save the IER then disable the interrupts
 447	 */
 448	ier = sio_in(up, TXX9_SIDICR);
 449	sio_out(up, TXX9_SIDICR, 0);
 450
 451	while (sio_in(up, TXX9_SIDISR) & TXX9_SIDISR_UVALID)
 452		;
 453
 454	c = sio_in(up, TXX9_SIRFIFO);
 455
 456	/*
 457	 *	Finally, clear RX interrupt status
 458	 *	and restore the IER
 459	 */
 460	sio_mask(up, TXX9_SIDISR, TXX9_SIDISR_RDIS);
 461	sio_out(up, TXX9_SIDICR, ier);
 462	return c;
 463}
 464
 465
 466static void serial_txx9_put_poll_char(struct uart_port *up, unsigned char c)
 467{
 468	unsigned int ier;
 
 469
 470	/*
 471	 *	First save the IER then disable the interrupts
 472	 */
 473	ier = sio_in(up, TXX9_SIDICR);
 474	sio_out(up, TXX9_SIDICR, 0);
 475
 476	wait_for_xmitr(up);
 477	/*
 478	 *	Send the character out.
 
 479	 */
 480	sio_out(up, TXX9_SITFIFO, c);
 
 
 
 
 481
 482	/*
 483	 *	Finally, wait for transmitter to become empty
 484	 *	and restore the IER
 485	 */
 486	wait_for_xmitr(up);
 487	sio_out(up, TXX9_SIDICR, ier);
 488}
 489
 490#endif /* CONFIG_CONSOLE_POLL */
 491
 492static int serial_txx9_startup(struct uart_port *up)
 493{
 
 494	unsigned long flags;
 495	int retval;
 496
 497	/*
 498	 * Clear the FIFO buffers and disable them.
 499	 * (they will be reenabled in set_termios())
 500	 */
 501	sio_set(up, TXX9_SIFCR,
 502		TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
 503	/* clear reset */
 504	sio_mask(up, TXX9_SIFCR,
 505		 TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
 506	sio_out(up, TXX9_SIDICR, 0);
 507
 508	/*
 509	 * Clear the interrupt registers.
 510	 */
 511	sio_out(up, TXX9_SIDISR, 0);
 512
 513	retval = request_irq(up->irq, serial_txx9_interrupt,
 514			     IRQF_SHARED, "serial_txx9", up);
 515	if (retval)
 516		return retval;
 517
 518	/*
 519	 * Now, initialize the UART
 520	 */
 521	spin_lock_irqsave(&up->lock, flags);
 522	serial_txx9_set_mctrl(up, up->mctrl);
 523	spin_unlock_irqrestore(&up->lock, flags);
 524
 525	/* Enable RX/TX */
 526	sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_RSDE | TXX9_SIFLCR_TSDE);
 527
 528	/*
 529	 * Finally, enable interrupts.
 530	 */
 531	sio_set(up, TXX9_SIDICR, TXX9_SIDICR_RIE);
 532
 533	return 0;
 534}
 535
 536static void serial_txx9_shutdown(struct uart_port *up)
 537{
 
 538	unsigned long flags;
 539
 540	/*
 541	 * Disable interrupts from this port
 542	 */
 543	sio_out(up, TXX9_SIDICR, 0);	/* disable all intrs */
 544
 545	spin_lock_irqsave(&up->lock, flags);
 546	serial_txx9_set_mctrl(up, up->mctrl);
 547	spin_unlock_irqrestore(&up->lock, flags);
 548
 549	/*
 550	 * Disable break condition
 551	 */
 552	sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
 553
 554#ifdef CONFIG_SERIAL_TXX9_CONSOLE
 555	if (up->cons && up->line == up->cons->index) {
 556		free_irq(up->irq, up);
 557		return;
 558	}
 559#endif
 560	/* reset FIFOs */
 561	sio_set(up, TXX9_SIFCR,
 562		TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
 563	/* clear reset */
 564	sio_mask(up, TXX9_SIFCR,
 565		 TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
 566
 567	/* Disable RX/TX */
 568	sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_RSDE | TXX9_SIFLCR_TSDE);
 569
 570	free_irq(up->irq, up);
 571}
 572
 573static void
 574serial_txx9_set_termios(struct uart_port *up, struct ktermios *termios,
 575			const struct ktermios *old)
 576{
 
 577	unsigned int cval, fcr = 0;
 578	unsigned long flags;
 579	unsigned int baud, quot;
 580
 581	/*
 582	 * We don't support modem control lines.
 583	 */
 584	termios->c_cflag &= ~(HUPCL | CMSPAR);
 585	termios->c_cflag |= CLOCAL;
 586
 587	cval = sio_in(up, TXX9_SILCR);
 588	/* byte size and parity */
 589	cval &= ~TXX9_SILCR_UMODE_MASK;
 590	switch (termios->c_cflag & CSIZE) {
 591	case CS7:
 592		cval |= TXX9_SILCR_UMODE_7BIT;
 593		break;
 594	default:
 595	case CS5:	/* not supported */
 596	case CS6:	/* not supported */
 597	case CS8:
 598		cval |= TXX9_SILCR_UMODE_8BIT;
 599		termios->c_cflag &= ~CSIZE;
 600		termios->c_cflag |= CS8;
 601		break;
 602	}
 603
 604	cval &= ~TXX9_SILCR_USBL_MASK;
 605	if (termios->c_cflag & CSTOPB)
 606		cval |= TXX9_SILCR_USBL_2BIT;
 607	else
 608		cval |= TXX9_SILCR_USBL_1BIT;
 609	cval &= ~(TXX9_SILCR_UPEN | TXX9_SILCR_UEPS);
 610	if (termios->c_cflag & PARENB)
 611		cval |= TXX9_SILCR_UPEN;
 612	if (!(termios->c_cflag & PARODD))
 613		cval |= TXX9_SILCR_UEPS;
 614
 615	/*
 616	 * Ask the core to calculate the divisor for us.
 617	 */
 618	baud = uart_get_baud_rate(up, termios, old, 0, up->uartclk/16/2);
 619	quot = uart_get_divisor(up, baud);
 620
 621	/* Set up FIFOs */
 622	/* TX Int by FIFO Empty, RX Int by Receiving 1 char. */
 623	fcr = TXX9_SIFCR_TDIL_MAX | TXX9_SIFCR_RDIL_1;
 624
 625	/*
 626	 * Ok, we're now changing the port state.  Do it with
 627	 * interrupts disabled.
 628	 */
 629	spin_lock_irqsave(&up->lock, flags);
 630
 631	/*
 632	 * Update the per-port timeout.
 633	 */
 634	uart_update_timeout(up, termios->c_cflag, baud);
 635
 636	up->read_status_mask = TXX9_SIDISR_UOER |
 637		TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS;
 638	if (termios->c_iflag & INPCK)
 639		up->read_status_mask |= TXX9_SIDISR_UFER | TXX9_SIDISR_UPER;
 640	if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK))
 641		up->read_status_mask |= TXX9_SIDISR_UBRK;
 642
 643	/*
 644	 * Characteres to ignore
 645	 */
 646	up->ignore_status_mask = 0;
 647	if (termios->c_iflag & IGNPAR)
 648		up->ignore_status_mask |= TXX9_SIDISR_UPER | TXX9_SIDISR_UFER;
 649	if (termios->c_iflag & IGNBRK) {
 650		up->ignore_status_mask |= TXX9_SIDISR_UBRK;
 651		/*
 652		 * If we're ignoring parity and break indicators,
 653		 * ignore overruns too (for real raw support).
 654		 */
 655		if (termios->c_iflag & IGNPAR)
 656			up->ignore_status_mask |= TXX9_SIDISR_UOER;
 657	}
 658
 659	/*
 660	 * ignore all characters if CREAD is not set
 661	 */
 662	if ((termios->c_cflag & CREAD) == 0)
 663		up->ignore_status_mask |= TXX9_SIDISR_RDIS;
 664
 665	/* CTS flow control flag */
 666	if ((termios->c_cflag & CRTSCTS) &&
 667	    (up->flags & UPF_TXX9_HAVE_CTS_LINE)) {
 668		sio_set(up, TXX9_SIFLCR,
 669			TXX9_SIFLCR_RCS | TXX9_SIFLCR_TES);
 670	} else {
 671		sio_mask(up, TXX9_SIFLCR,
 672			 TXX9_SIFLCR_RCS | TXX9_SIFLCR_TES);
 673	}
 674
 675	sio_out(up, TXX9_SILCR, cval);
 676	sio_quot_set(up, quot);
 677	sio_out(up, TXX9_SIFCR, fcr);
 678
 679	serial_txx9_set_mctrl(up, up->mctrl);
 680	spin_unlock_irqrestore(&up->lock, flags);
 681}
 682
 683static void
 684serial_txx9_pm(struct uart_port *port, unsigned int state,
 685	      unsigned int oldstate)
 686{
 687	/*
 688	 * If oldstate was -1 this is called from
 689	 * uart_configure_port().  In this case do not initialize the
 690	 * port now, because the port was already initialized (for
 691	 * non-console port) or should not be initialized here (for
 692	 * console port).  If we initialized the port here we lose
 693	 * serial console settings.
 694	 */
 695	if (state == 0 && oldstate != -1)
 696		serial_txx9_initialize(port);
 697}
 698
 699static int serial_txx9_request_resource(struct uart_port *up)
 700{
 701	unsigned int size = TXX9_REGION_SIZE;
 702	int ret = 0;
 703
 704	switch (up->iotype) {
 705	default:
 706		if (!up->mapbase)
 707			break;
 708
 709		if (!request_mem_region(up->mapbase, size, "serial_txx9")) {
 710			ret = -EBUSY;
 711			break;
 712		}
 713
 714		if (up->flags & UPF_IOREMAP) {
 715			up->membase = ioremap(up->mapbase, size);
 716			if (!up->membase) {
 717				release_mem_region(up->mapbase, size);
 718				ret = -ENOMEM;
 719			}
 720		}
 721		break;
 722
 723	case UPIO_PORT:
 724		if (!request_region(up->iobase, size, "serial_txx9"))
 725			ret = -EBUSY;
 726		break;
 727	}
 728	return ret;
 729}
 730
 731static void serial_txx9_release_resource(struct uart_port *up)
 732{
 733	unsigned int size = TXX9_REGION_SIZE;
 734
 735	switch (up->iotype) {
 736	default:
 737		if (!up->mapbase)
 738			break;
 739
 740		if (up->flags & UPF_IOREMAP) {
 741			iounmap(up->membase);
 742			up->membase = NULL;
 743		}
 744
 745		release_mem_region(up->mapbase, size);
 746		break;
 747
 748	case UPIO_PORT:
 749		release_region(up->iobase, size);
 750		break;
 751	}
 752}
 753
 754static void serial_txx9_release_port(struct uart_port *up)
 755{
 
 756	serial_txx9_release_resource(up);
 757}
 758
 759static int serial_txx9_request_port(struct uart_port *up)
 760{
 
 761	return serial_txx9_request_resource(up);
 762}
 763
 764static void serial_txx9_config_port(struct uart_port *up, int uflags)
 765{
 
 766	int ret;
 767
 768	/*
 769	 * Find the region that we can probe for.  This in turn
 770	 * tells us whether we can probe for the type of port.
 771	 */
 772	ret = serial_txx9_request_resource(up);
 773	if (ret < 0)
 774		return;
 775	up->type = PORT_TXX9;
 776	up->fifosize = TXX9_SIO_TX_FIFO;
 777
 778#ifdef CONFIG_SERIAL_TXX9_CONSOLE
 779	if (up->line == up->cons->index)
 780		return;
 781#endif
 782	serial_txx9_initialize(up);
 783}
 784
 785static const char *
 786serial_txx9_type(struct uart_port *port)
 787{
 788	return "txx9";
 789}
 790
 791static const struct uart_ops serial_txx9_pops = {
 792	.tx_empty	= serial_txx9_tx_empty,
 793	.set_mctrl	= serial_txx9_set_mctrl,
 794	.get_mctrl	= serial_txx9_get_mctrl,
 795	.stop_tx	= serial_txx9_stop_tx,
 796	.start_tx	= serial_txx9_start_tx,
 797	.stop_rx	= serial_txx9_stop_rx,
 
 798	.break_ctl	= serial_txx9_break_ctl,
 799	.startup	= serial_txx9_startup,
 800	.shutdown	= serial_txx9_shutdown,
 801	.set_termios	= serial_txx9_set_termios,
 802	.pm		= serial_txx9_pm,
 803	.type		= serial_txx9_type,
 804	.release_port	= serial_txx9_release_port,
 805	.request_port	= serial_txx9_request_port,
 806	.config_port	= serial_txx9_config_port,
 807#ifdef CONFIG_CONSOLE_POLL
 808	.poll_get_char	= serial_txx9_get_poll_char,
 809	.poll_put_char	= serial_txx9_put_poll_char,
 810#endif
 811};
 812
 813static struct uart_port serial_txx9_ports[UART_NR];
 814
 815static void __init serial_txx9_register_ports(struct uart_driver *drv,
 816					      struct device *dev)
 817{
 818	int i;
 819
 820	for (i = 0; i < UART_NR; i++) {
 821		struct uart_port *up = &serial_txx9_ports[i];
 822
 823		up->line = i;
 824		up->ops = &serial_txx9_pops;
 825		up->dev = dev;
 826		if (up->iobase || up->mapbase)
 827			uart_add_one_port(drv, up);
 828	}
 829}
 830
 831#ifdef CONFIG_SERIAL_TXX9_CONSOLE
 832
 833static void serial_txx9_console_putchar(struct uart_port *up, unsigned char ch)
 834{
 
 
 835	wait_for_xmitr(up);
 836	sio_out(up, TXX9_SITFIFO, ch);
 837}
 838
 839/*
 840 *	Print a string to the serial port trying not to disturb
 841 *	any possible real use of the port...
 842 *
 843 *	The console_lock must be held when we get here.
 844 */
 845static void
 846serial_txx9_console_write(struct console *co, const char *s, unsigned int count)
 847{
 848	struct uart_port *up = &serial_txx9_ports[co->index];
 849	unsigned int ier, flcr;
 850
 851	/*
 852	 *	First save the UER then disable the interrupts
 853	 */
 854	ier = sio_in(up, TXX9_SIDICR);
 855	sio_out(up, TXX9_SIDICR, 0);
 856	/*
 857	 *	Disable flow-control if enabled (and unnecessary)
 858	 */
 859	flcr = sio_in(up, TXX9_SIFLCR);
 860	if (!(up->flags & UPF_CONS_FLOW) && (flcr & TXX9_SIFLCR_TES))
 861		sio_out(up, TXX9_SIFLCR, flcr & ~TXX9_SIFLCR_TES);
 862
 863	uart_console_write(up, s, count, serial_txx9_console_putchar);
 864
 865	/*
 866	 *	Finally, wait for transmitter to become empty
 867	 *	and restore the IER
 868	 */
 869	wait_for_xmitr(up);
 870	sio_out(up, TXX9_SIFLCR, flcr);
 871	sio_out(up, TXX9_SIDICR, ier);
 872}
 873
 874static int __init serial_txx9_console_setup(struct console *co, char *options)
 875{
 876	struct uart_port *up;
 
 877	int baud = 9600;
 878	int bits = 8;
 879	int parity = 'n';
 880	int flow = 'n';
 881
 882	/*
 883	 * Check whether an invalid uart number has been specified, and
 884	 * if so, search for the first available port that does have
 885	 * console support.
 886	 */
 887	if (co->index >= UART_NR)
 888		co->index = 0;
 889	up = &serial_txx9_ports[co->index];
 890	if (!up->ops)
 
 891		return -ENODEV;
 892
 893	serial_txx9_initialize(up);
 894
 895	if (options)
 896		uart_parse_options(options, &baud, &parity, &bits, &flow);
 897
 898	return uart_set_options(up, co, baud, parity, bits, flow);
 899}
 900
 901static struct uart_driver serial_txx9_reg;
 902static struct console serial_txx9_console = {
 903	.name		= TXX9_TTY_NAME,
 904	.write		= serial_txx9_console_write,
 905	.device		= uart_console_device,
 906	.setup		= serial_txx9_console_setup,
 907	.flags		= CON_PRINTBUFFER,
 908	.index		= -1,
 909	.data		= &serial_txx9_reg,
 910};
 911
 912static int __init serial_txx9_console_init(void)
 913{
 914	register_console(&serial_txx9_console);
 915	return 0;
 916}
 917console_initcall(serial_txx9_console_init);
 918
 919#define SERIAL_TXX9_CONSOLE	&serial_txx9_console
 920#else
 921#define SERIAL_TXX9_CONSOLE	NULL
 922#endif
 923
 924static struct uart_driver serial_txx9_reg = {
 925	.owner			= THIS_MODULE,
 926	.driver_name		= "serial_txx9",
 927	.dev_name		= TXX9_TTY_NAME,
 928	.major			= TXX9_TTY_MAJOR,
 929	.minor			= TXX9_TTY_MINOR_START,
 930	.nr			= UART_NR,
 931	.cons			= SERIAL_TXX9_CONSOLE,
 932};
 933
 934int __init early_serial_txx9_setup(struct uart_port *port)
 935{
 936	if (port->line >= ARRAY_SIZE(serial_txx9_ports))
 937		return -ENODEV;
 938
 939	serial_txx9_ports[port->line] = *port;
 940	serial_txx9_ports[port->line].ops = &serial_txx9_pops;
 941	serial_txx9_ports[port->line].flags |=
 942		UPF_BOOT_AUTOCONF | UPF_FIXED_PORT;
 943	return 0;
 944}
 945
 946static DEFINE_MUTEX(serial_txx9_mutex);
 947
 948/**
 949 *	serial_txx9_register_port - register a serial port
 950 *	@port: serial port template
 951 *
 952 *	Configure the serial port specified by the request.
 953 *
 954 *	The port is then probed and if necessary the IRQ is autodetected
 955 *	If this fails an error is returned.
 956 *
 957 *	On success the port is ready to use and the line number is returned.
 958 */
 959static int serial_txx9_register_port(struct uart_port *port)
 960{
 961	int i;
 962	struct uart_port *uart;
 963	int ret = -ENOSPC;
 964
 965	mutex_lock(&serial_txx9_mutex);
 966	for (i = 0; i < UART_NR; i++) {
 967		uart = &serial_txx9_ports[i];
 968		if (uart_match_port(uart, port)) {
 969			uart_remove_one_port(&serial_txx9_reg, uart);
 970			break;
 971		}
 972	}
 973	if (i == UART_NR) {
 974		/* Find unused port */
 975		for (i = 0; i < UART_NR; i++) {
 976			uart = &serial_txx9_ports[i];
 977			if (!(uart->iobase || uart->mapbase))
 978				break;
 979		}
 980	}
 981	if (i < UART_NR) {
 982		uart->iobase = port->iobase;
 983		uart->membase = port->membase;
 984		uart->irq      = port->irq;
 985		uart->uartclk  = port->uartclk;
 986		uart->iotype   = port->iotype;
 987		uart->flags    = port->flags
 988			| UPF_BOOT_AUTOCONF | UPF_FIXED_PORT;
 989		uart->mapbase  = port->mapbase;
 990		if (port->dev)
 991			uart->dev = port->dev;
 992		ret = uart_add_one_port(&serial_txx9_reg, uart);
 993		if (ret == 0)
 994			ret = uart->line;
 995	}
 996	mutex_unlock(&serial_txx9_mutex);
 997	return ret;
 998}
 999
1000/**
1001 *	serial_txx9_unregister_port - remove a txx9 serial port at runtime
1002 *	@line: serial line number
1003 *
1004 *	Remove one serial port.  This may not be called from interrupt
1005 *	context.  We hand the port back to the our control.
1006 */
1007static void serial_txx9_unregister_port(int line)
1008{
1009	struct uart_port *uart = &serial_txx9_ports[line];
1010
1011	mutex_lock(&serial_txx9_mutex);
1012	uart_remove_one_port(&serial_txx9_reg, uart);
1013	uart->flags = 0;
1014	uart->type = PORT_UNKNOWN;
1015	uart->iobase = 0;
1016	uart->mapbase = 0;
1017	uart->membase = NULL;
1018	uart->dev = NULL;
1019	mutex_unlock(&serial_txx9_mutex);
1020}
1021
1022/*
1023 * Register a set of serial devices attached to a platform device.
1024 */
1025static int serial_txx9_probe(struct platform_device *dev)
1026{
1027	struct uart_port *p = dev_get_platdata(&dev->dev);
1028	struct uart_port port;
1029	int ret, i;
1030
1031	memset(&port, 0, sizeof(struct uart_port));
1032	for (i = 0; p && p->uartclk != 0; p++, i++) {
1033		port.iobase	= p->iobase;
1034		port.membase	= p->membase;
1035		port.irq	= p->irq;
1036		port.uartclk	= p->uartclk;
1037		port.iotype	= p->iotype;
1038		port.flags	= p->flags;
1039		port.mapbase	= p->mapbase;
1040		port.dev	= &dev->dev;
1041		port.has_sysrq	= IS_ENABLED(CONFIG_SERIAL_TXX9_CONSOLE);
1042		ret = serial_txx9_register_port(&port);
1043		if (ret < 0) {
1044			dev_err(&dev->dev, "unable to register port at index %d "
1045				"(IO%lx MEM%llx IRQ%d): %d\n", i,
1046				p->iobase, (unsigned long long)p->mapbase,
1047				p->irq, ret);
1048		}
1049	}
1050	return 0;
1051}
1052
1053/*
1054 * Remove serial ports registered against a platform device.
1055 */
1056static int serial_txx9_remove(struct platform_device *dev)
1057{
1058	int i;
1059
1060	for (i = 0; i < UART_NR; i++) {
1061		struct uart_port *up = &serial_txx9_ports[i];
1062
1063		if (up->dev == &dev->dev)
1064			serial_txx9_unregister_port(i);
1065	}
1066	return 0;
1067}
1068
1069#ifdef CONFIG_PM
1070static int serial_txx9_suspend(struct platform_device *dev, pm_message_t state)
1071{
1072	int i;
1073
1074	for (i = 0; i < UART_NR; i++) {
1075		struct uart_port *up = &serial_txx9_ports[i];
1076
1077		if (up->type != PORT_UNKNOWN && up->dev == &dev->dev)
1078			uart_suspend_port(&serial_txx9_reg, up);
1079	}
1080
1081	return 0;
1082}
1083
1084static int serial_txx9_resume(struct platform_device *dev)
1085{
1086	int i;
1087
1088	for (i = 0; i < UART_NR; i++) {
1089		struct uart_port *up = &serial_txx9_ports[i];
1090
1091		if (up->type != PORT_UNKNOWN && up->dev == &dev->dev)
1092			uart_resume_port(&serial_txx9_reg, up);
1093	}
1094
1095	return 0;
1096}
1097#endif
1098
1099static struct platform_driver serial_txx9_plat_driver = {
1100	.probe		= serial_txx9_probe,
1101	.remove		= serial_txx9_remove,
1102#ifdef CONFIG_PM
1103	.suspend	= serial_txx9_suspend,
1104	.resume		= serial_txx9_resume,
1105#endif
1106	.driver		= {
1107		.name	= "serial_txx9",
 
1108	},
1109};
1110
1111#ifdef ENABLE_SERIAL_TXX9_PCI
1112/*
1113 * Probe one serial board.  Unfortunately, there is no rhyme nor reason
1114 * to the arrangement of serial ports on a PCI card.
1115 */
1116static int
1117pciserial_txx9_init_one(struct pci_dev *dev, const struct pci_device_id *ent)
1118{
1119	struct uart_port port;
1120	int line;
1121	int rc;
1122
1123	rc = pci_enable_device(dev);
1124	if (rc)
1125		return rc;
1126
1127	memset(&port, 0, sizeof(port));
1128	port.ops = &serial_txx9_pops;
1129	port.flags |= UPF_TXX9_HAVE_CTS_LINE;
1130	port.uartclk = 66670000;
1131	port.irq = dev->irq;
1132	port.iotype = UPIO_PORT;
1133	port.iobase = pci_resource_start(dev, 1);
1134	port.dev = &dev->dev;
1135	line = serial_txx9_register_port(&port);
1136	if (line < 0) {
1137		printk(KERN_WARNING "Couldn't register serial port %s: %d\n", pci_name(dev), line);
1138		pci_disable_device(dev);
1139		return line;
1140	}
1141	pci_set_drvdata(dev, &serial_txx9_ports[line]);
1142
1143	return 0;
1144}
1145
1146static void pciserial_txx9_remove_one(struct pci_dev *dev)
1147{
1148	struct uart_port *up = pci_get_drvdata(dev);
1149
1150	if (up) {
1151		serial_txx9_unregister_port(up->line);
1152		pci_disable_device(dev);
1153	}
1154}
1155
1156#ifdef CONFIG_PM
1157static int pciserial_txx9_suspend_one(struct pci_dev *dev, pm_message_t state)
1158{
1159	struct uart_port *up = pci_get_drvdata(dev);
1160
1161	if (up)
1162		uart_suspend_port(&serial_txx9_reg, up);
1163	pci_save_state(dev);
1164	pci_set_power_state(dev, pci_choose_state(dev, state));
1165	return 0;
1166}
1167
1168static int pciserial_txx9_resume_one(struct pci_dev *dev)
1169{
1170	struct uart_port *up = pci_get_drvdata(dev);
1171
1172	pci_set_power_state(dev, PCI_D0);
1173	pci_restore_state(dev);
1174	if (up)
1175		uart_resume_port(&serial_txx9_reg, up);
1176	return 0;
1177}
1178#endif
1179
1180static const struct pci_device_id serial_txx9_pci_tbl[] = {
1181	{ PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC86C001_MISC) },
1182	{ 0, }
1183};
1184
1185static struct pci_driver serial_txx9_pci_driver = {
1186	.name		= "serial_txx9",
1187	.probe		= pciserial_txx9_init_one,
1188	.remove		= pciserial_txx9_remove_one,
1189#ifdef CONFIG_PM
1190	.suspend	= pciserial_txx9_suspend_one,
1191	.resume		= pciserial_txx9_resume_one,
1192#endif
1193	.id_table	= serial_txx9_pci_tbl,
1194};
1195
1196MODULE_DEVICE_TABLE(pci, serial_txx9_pci_tbl);
1197#endif /* ENABLE_SERIAL_TXX9_PCI */
1198
1199static struct platform_device *serial_txx9_plat_devs;
1200
1201static int __init serial_txx9_init(void)
1202{
1203	int ret;
1204
 
 
1205	ret = uart_register_driver(&serial_txx9_reg);
1206	if (ret)
1207		goto out;
1208
1209	serial_txx9_plat_devs = platform_device_alloc("serial_txx9", -1);
1210	if (!serial_txx9_plat_devs) {
1211		ret = -ENOMEM;
1212		goto unreg_uart_drv;
1213	}
1214
1215	ret = platform_device_add(serial_txx9_plat_devs);
1216	if (ret)
1217		goto put_dev;
1218
1219	serial_txx9_register_ports(&serial_txx9_reg,
1220				   &serial_txx9_plat_devs->dev);
1221
1222	ret = platform_driver_register(&serial_txx9_plat_driver);
1223	if (ret)
1224		goto del_dev;
1225
1226#ifdef ENABLE_SERIAL_TXX9_PCI
1227	ret = pci_register_driver(&serial_txx9_pci_driver);
1228	if (ret) {
1229		platform_driver_unregister(&serial_txx9_plat_driver);
1230	}
1231#endif
1232	if (ret == 0)
1233		goto out;
1234
1235 del_dev:
1236	platform_device_del(serial_txx9_plat_devs);
1237 put_dev:
1238	platform_device_put(serial_txx9_plat_devs);
1239 unreg_uart_drv:
1240	uart_unregister_driver(&serial_txx9_reg);
1241 out:
1242	return ret;
1243}
1244
1245static void __exit serial_txx9_exit(void)
1246{
1247	int i;
1248
1249#ifdef ENABLE_SERIAL_TXX9_PCI
1250	pci_unregister_driver(&serial_txx9_pci_driver);
1251#endif
1252	platform_driver_unregister(&serial_txx9_plat_driver);
1253	platform_device_unregister(serial_txx9_plat_devs);
1254	for (i = 0; i < UART_NR; i++) {
1255		struct uart_port *up = &serial_txx9_ports[i];
1256		if (up->iobase || up->mapbase)
1257			uart_remove_one_port(&serial_txx9_reg, up);
1258	}
1259
1260	uart_unregister_driver(&serial_txx9_reg);
1261}
1262
1263module_init(serial_txx9_init);
1264module_exit(serial_txx9_exit);
1265
1266MODULE_LICENSE("GPL");
1267MODULE_DESCRIPTION("TX39/49 serial driver");
1268
1269MODULE_ALIAS_CHARDEV_MAJOR(TXX9_TTY_MAJOR);
v3.15
 
   1/*
   2 * Derived from many drivers using generic_serial interface,
   3 * especially serial_tx3912.c by Steven J. Hill and r39xx_serial.c
   4 * (was in Linux/VR tree) by Jim Pick.
   5 *
   6 *  Copyright (C) 1999 Harald Koerfgen
   7 *  Copyright (C) 2000 Jim Pick <jim@jimpick.com>
   8 *  Copyright (C) 2001 Steven J. Hill (sjhill@realitydiluted.com)
   9 *  Copyright (C) 2000-2002 Toshiba Corporation
  10 *
  11 * This program is free software; you can redistribute it and/or modify
  12 * it under the terms of the GNU General Public License version 2 as
  13 * published by the Free Software Foundation.
  14 *
  15 *  Serial driver for TX3927/TX4927/TX4925/TX4938 internal SIO controller
  16 */
  17
  18#if defined(CONFIG_SERIAL_TXX9_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
  19#define SUPPORT_SYSRQ
  20#endif
  21
  22#include <linux/module.h>
  23#include <linux/ioport.h>
  24#include <linux/init.h>
  25#include <linux/console.h>
  26#include <linux/delay.h>
  27#include <linux/platform_device.h>
  28#include <linux/pci.h>
  29#include <linux/serial_core.h>
  30#include <linux/serial.h>
  31#include <linux/tty.h>
  32#include <linux/tty_flip.h>
  33
  34#include <asm/io.h>
  35
  36static char *serial_version = "1.11";
  37static char *serial_name = "TX39/49 Serial driver";
  38
  39#define PASS_LIMIT	256
  40
  41#if !defined(CONFIG_SERIAL_TXX9_STDSERIAL)
  42/* "ttyS" is used for standard serial driver */
  43#define TXX9_TTY_NAME "ttyTX"
  44#define TXX9_TTY_MINOR_START	196
  45#define TXX9_TTY_MAJOR	204
  46#else
  47/* acts like standard serial driver */
  48#define TXX9_TTY_NAME "ttyS"
  49#define TXX9_TTY_MINOR_START	64
  50#define TXX9_TTY_MAJOR	TTY_MAJOR
  51#endif
  52
  53/* flag aliases */
  54#define UPF_TXX9_HAVE_CTS_LINE	UPF_BUGGY_UART
  55#define UPF_TXX9_USE_SCLK	UPF_MAGIC_MULTIPLIER
  56
  57#ifdef CONFIG_PCI
  58/* support for Toshiba TC86C001 SIO */
  59#define ENABLE_SERIAL_TXX9_PCI
  60#endif
  61
  62/*
  63 * Number of serial ports
  64 */
  65#define UART_NR  CONFIG_SERIAL_TXX9_NR_UARTS
  66
  67struct uart_txx9_port {
  68	struct uart_port	port;
  69	/* No additional info for now */
  70};
  71
  72#define TXX9_REGION_SIZE	0x24
  73
  74/* TXX9 Serial Registers */
  75#define TXX9_SILCR	0x00
  76#define TXX9_SIDICR	0x04
  77#define TXX9_SIDISR	0x08
  78#define TXX9_SICISR	0x0c
  79#define TXX9_SIFCR	0x10
  80#define TXX9_SIFLCR	0x14
  81#define TXX9_SIBGR	0x18
  82#define TXX9_SITFIFO	0x1c
  83#define TXX9_SIRFIFO	0x20
  84
  85/* SILCR : Line Control */
  86#define TXX9_SILCR_SCS_MASK	0x00000060
  87#define TXX9_SILCR_SCS_IMCLK	0x00000000
  88#define TXX9_SILCR_SCS_IMCLK_BG	0x00000020
  89#define TXX9_SILCR_SCS_SCLK	0x00000040
  90#define TXX9_SILCR_SCS_SCLK_BG	0x00000060
  91#define TXX9_SILCR_UEPS	0x00000010
  92#define TXX9_SILCR_UPEN	0x00000008
  93#define TXX9_SILCR_USBL_MASK	0x00000004
  94#define TXX9_SILCR_USBL_1BIT	0x00000000
  95#define TXX9_SILCR_USBL_2BIT	0x00000004
  96#define TXX9_SILCR_UMODE_MASK	0x00000003
  97#define TXX9_SILCR_UMODE_8BIT	0x00000000
  98#define TXX9_SILCR_UMODE_7BIT	0x00000001
  99
 100/* SIDICR : DMA/Int. Control */
 101#define TXX9_SIDICR_TDE	0x00008000
 102#define TXX9_SIDICR_RDE	0x00004000
 103#define TXX9_SIDICR_TIE	0x00002000
 104#define TXX9_SIDICR_RIE	0x00001000
 105#define TXX9_SIDICR_SPIE	0x00000800
 106#define TXX9_SIDICR_CTSAC	0x00000600
 107#define TXX9_SIDICR_STIE_MASK	0x0000003f
 108#define TXX9_SIDICR_STIE_OERS		0x00000020
 109#define TXX9_SIDICR_STIE_CTSS		0x00000010
 110#define TXX9_SIDICR_STIE_RBRKD	0x00000008
 111#define TXX9_SIDICR_STIE_TRDY		0x00000004
 112#define TXX9_SIDICR_STIE_TXALS	0x00000002
 113#define TXX9_SIDICR_STIE_UBRKD	0x00000001
 114
 115/* SIDISR : DMA/Int. Status */
 116#define TXX9_SIDISR_UBRK	0x00008000
 117#define TXX9_SIDISR_UVALID	0x00004000
 118#define TXX9_SIDISR_UFER	0x00002000
 119#define TXX9_SIDISR_UPER	0x00001000
 120#define TXX9_SIDISR_UOER	0x00000800
 121#define TXX9_SIDISR_ERI	0x00000400
 122#define TXX9_SIDISR_TOUT	0x00000200
 123#define TXX9_SIDISR_TDIS	0x00000100
 124#define TXX9_SIDISR_RDIS	0x00000080
 125#define TXX9_SIDISR_STIS	0x00000040
 126#define TXX9_SIDISR_RFDN_MASK	0x0000001f
 127
 128/* SICISR : Change Int. Status */
 129#define TXX9_SICISR_OERS	0x00000020
 130#define TXX9_SICISR_CTSS	0x00000010
 131#define TXX9_SICISR_RBRKD	0x00000008
 132#define TXX9_SICISR_TRDY	0x00000004
 133#define TXX9_SICISR_TXALS	0x00000002
 134#define TXX9_SICISR_UBRKD	0x00000001
 135
 136/* SIFCR : FIFO Control */
 137#define TXX9_SIFCR_SWRST	0x00008000
 138#define TXX9_SIFCR_RDIL_MASK	0x00000180
 139#define TXX9_SIFCR_RDIL_1	0x00000000
 140#define TXX9_SIFCR_RDIL_4	0x00000080
 141#define TXX9_SIFCR_RDIL_8	0x00000100
 142#define TXX9_SIFCR_RDIL_12	0x00000180
 143#define TXX9_SIFCR_RDIL_MAX	0x00000180
 144#define TXX9_SIFCR_TDIL_MASK	0x00000018
 145#define TXX9_SIFCR_TDIL_MASK	0x00000018
 146#define TXX9_SIFCR_TDIL_1	0x00000000
 147#define TXX9_SIFCR_TDIL_4	0x00000001
 148#define TXX9_SIFCR_TDIL_8	0x00000010
 149#define TXX9_SIFCR_TDIL_MAX	0x00000010
 150#define TXX9_SIFCR_TFRST	0x00000004
 151#define TXX9_SIFCR_RFRST	0x00000002
 152#define TXX9_SIFCR_FRSTE	0x00000001
 153#define TXX9_SIO_TX_FIFO	8
 154#define TXX9_SIO_RX_FIFO	16
 155
 156/* SIFLCR : Flow Control */
 157#define TXX9_SIFLCR_RCS	0x00001000
 158#define TXX9_SIFLCR_TES	0x00000800
 159#define TXX9_SIFLCR_RTSSC	0x00000200
 160#define TXX9_SIFLCR_RSDE	0x00000100
 161#define TXX9_SIFLCR_TSDE	0x00000080
 162#define TXX9_SIFLCR_RTSTL_MASK	0x0000001e
 163#define TXX9_SIFLCR_RTSTL_MAX	0x0000001e
 164#define TXX9_SIFLCR_TBRK	0x00000001
 165
 166/* SIBGR : Baudrate Control */
 167#define TXX9_SIBGR_BCLK_MASK	0x00000300
 168#define TXX9_SIBGR_BCLK_T0	0x00000000
 169#define TXX9_SIBGR_BCLK_T2	0x00000100
 170#define TXX9_SIBGR_BCLK_T4	0x00000200
 171#define TXX9_SIBGR_BCLK_T6	0x00000300
 172#define TXX9_SIBGR_BRD_MASK	0x000000ff
 173
 174static inline unsigned int sio_in(struct uart_txx9_port *up, int offset)
 175{
 176	switch (up->port.iotype) {
 177	default:
 178		return __raw_readl(up->port.membase + offset);
 179	case UPIO_PORT:
 180		return inl(up->port.iobase + offset);
 181	}
 182}
 183
 184static inline void
 185sio_out(struct uart_txx9_port *up, int offset, int value)
 186{
 187	switch (up->port.iotype) {
 188	default:
 189		__raw_writel(value, up->port.membase + offset);
 190		break;
 191	case UPIO_PORT:
 192		outl(value, up->port.iobase + offset);
 193		break;
 194	}
 195}
 196
 197static inline void
 198sio_mask(struct uart_txx9_port *up, int offset, unsigned int value)
 199{
 200	sio_out(up, offset, sio_in(up, offset) & ~value);
 201}
 202static inline void
 203sio_set(struct uart_txx9_port *up, int offset, unsigned int value)
 204{
 205	sio_out(up, offset, sio_in(up, offset) | value);
 206}
 207
 208static inline void
 209sio_quot_set(struct uart_txx9_port *up, int quot)
 210{
 211	quot >>= 1;
 212	if (quot < 256)
 213		sio_out(up, TXX9_SIBGR, quot | TXX9_SIBGR_BCLK_T0);
 214	else if (quot < (256 << 2))
 215		sio_out(up, TXX9_SIBGR, (quot >> 2) | TXX9_SIBGR_BCLK_T2);
 216	else if (quot < (256 << 4))
 217		sio_out(up, TXX9_SIBGR, (quot >> 4) | TXX9_SIBGR_BCLK_T4);
 218	else if (quot < (256 << 6))
 219		sio_out(up, TXX9_SIBGR, (quot >> 6) | TXX9_SIBGR_BCLK_T6);
 220	else
 221		sio_out(up, TXX9_SIBGR, 0xff | TXX9_SIBGR_BCLK_T6);
 222}
 223
 224static struct uart_txx9_port *to_uart_txx9_port(struct uart_port *port)
 225{
 226	return container_of(port, struct uart_txx9_port, port);
 227}
 228
 229static void serial_txx9_stop_tx(struct uart_port *port)
 230{
 231	struct uart_txx9_port *up = to_uart_txx9_port(port);
 232	sio_mask(up, TXX9_SIDICR, TXX9_SIDICR_TIE);
 233}
 234
 235static void serial_txx9_start_tx(struct uart_port *port)
 236{
 237	struct uart_txx9_port *up = to_uart_txx9_port(port);
 238	sio_set(up, TXX9_SIDICR, TXX9_SIDICR_TIE);
 239}
 240
 241static void serial_txx9_stop_rx(struct uart_port *port)
 242{
 243	struct uart_txx9_port *up = to_uart_txx9_port(port);
 244	up->port.read_status_mask &= ~TXX9_SIDISR_RDIS;
 245}
 246
 247static void serial_txx9_enable_ms(struct uart_port *port)
 248{
 249	/* TXX9-SIO can not control DTR... */
 250}
 251
 252static void serial_txx9_initialize(struct uart_port *port)
 253{
 254	struct uart_txx9_port *up = to_uart_txx9_port(port);
 255	unsigned int tmout = 10000;
 256
 257	sio_out(up, TXX9_SIFCR, TXX9_SIFCR_SWRST);
 258	/* TX4925 BUG WORKAROUND.  Accessing SIOC register
 259	 * immediately after soft reset causes bus error. */
 260	mmiowb();
 261	udelay(1);
 262	while ((sio_in(up, TXX9_SIFCR) & TXX9_SIFCR_SWRST) && --tmout)
 263		udelay(1);
 264	/* TX Int by FIFO Empty, RX Int by Receiving 1 char. */
 265	sio_set(up, TXX9_SIFCR,
 266		TXX9_SIFCR_TDIL_MAX | TXX9_SIFCR_RDIL_1);
 267	/* initial settings */
 268	sio_out(up, TXX9_SILCR,
 269		TXX9_SILCR_UMODE_8BIT | TXX9_SILCR_USBL_1BIT |
 270		((up->port.flags & UPF_TXX9_USE_SCLK) ?
 271		 TXX9_SILCR_SCS_SCLK_BG : TXX9_SILCR_SCS_IMCLK_BG));
 272	sio_quot_set(up, uart_get_divisor(port, 9600));
 273	sio_out(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSTL_MAX /* 15 */);
 274	sio_out(up, TXX9_SIDICR, 0);
 275}
 276
 277static inline void
 278receive_chars(struct uart_txx9_port *up, unsigned int *status)
 279{
 280	unsigned char ch;
 281	unsigned int disr = *status;
 282	int max_count = 256;
 283	char flag;
 284	unsigned int next_ignore_status_mask;
 285
 286	do {
 287		ch = sio_in(up, TXX9_SIRFIFO);
 288		flag = TTY_NORMAL;
 289		up->port.icount.rx++;
 290
 291		/* mask out RFDN_MASK bit added by previous overrun */
 292		next_ignore_status_mask =
 293			up->port.ignore_status_mask & ~TXX9_SIDISR_RFDN_MASK;
 294		if (unlikely(disr & (TXX9_SIDISR_UBRK | TXX9_SIDISR_UPER |
 295				     TXX9_SIDISR_UFER | TXX9_SIDISR_UOER))) {
 296			/*
 297			 * For statistics only
 298			 */
 299			if (disr & TXX9_SIDISR_UBRK) {
 300				disr &= ~(TXX9_SIDISR_UFER | TXX9_SIDISR_UPER);
 301				up->port.icount.brk++;
 302				/*
 303				 * We do the SysRQ and SAK checking
 304				 * here because otherwise the break
 305				 * may get masked by ignore_status_mask
 306				 * or read_status_mask.
 307				 */
 308				if (uart_handle_break(&up->port))
 309					goto ignore_char;
 310			} else if (disr & TXX9_SIDISR_UPER)
 311				up->port.icount.parity++;
 312			else if (disr & TXX9_SIDISR_UFER)
 313				up->port.icount.frame++;
 314			if (disr & TXX9_SIDISR_UOER) {
 315				up->port.icount.overrun++;
 316				/*
 317				 * The receiver read buffer still hold
 318				 * a char which caused overrun.
 319				 * Ignore next char by adding RFDN_MASK
 320				 * to ignore_status_mask temporarily.
 321				 */
 322				next_ignore_status_mask |=
 323					TXX9_SIDISR_RFDN_MASK;
 324			}
 325
 326			/*
 327			 * Mask off conditions which should be ingored.
 328			 */
 329			disr &= up->port.read_status_mask;
 330
 331			if (disr & TXX9_SIDISR_UBRK) {
 332				flag = TTY_BREAK;
 333			} else if (disr & TXX9_SIDISR_UPER)
 334				flag = TTY_PARITY;
 335			else if (disr & TXX9_SIDISR_UFER)
 336				flag = TTY_FRAME;
 337		}
 338		if (uart_handle_sysrq_char(&up->port, ch))
 339			goto ignore_char;
 340
 341		uart_insert_char(&up->port, disr, TXX9_SIDISR_UOER, ch, flag);
 342
 343	ignore_char:
 344		up->port.ignore_status_mask = next_ignore_status_mask;
 345		disr = sio_in(up, TXX9_SIDISR);
 346	} while (!(disr & TXX9_SIDISR_UVALID) && (max_count-- > 0));
 347	spin_unlock(&up->port.lock);
 348	tty_flip_buffer_push(&up->port.state->port);
 349	spin_lock(&up->port.lock);
 350	*status = disr;
 351}
 352
 353static inline void transmit_chars(struct uart_txx9_port *up)
 354{
 355	struct circ_buf *xmit = &up->port.state->xmit;
 356	int count;
 357
 358	if (up->port.x_char) {
 359		sio_out(up, TXX9_SITFIFO, up->port.x_char);
 360		up->port.icount.tx++;
 361		up->port.x_char = 0;
 362		return;
 363	}
 364	if (uart_circ_empty(xmit) || uart_tx_stopped(&up->port)) {
 365		serial_txx9_stop_tx(&up->port);
 366		return;
 367	}
 368
 369	count = TXX9_SIO_TX_FIFO;
 370	do {
 371		sio_out(up, TXX9_SITFIFO, xmit->buf[xmit->tail]);
 372		xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
 373		up->port.icount.tx++;
 374		if (uart_circ_empty(xmit))
 375			break;
 376	} while (--count > 0);
 377
 378	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 379		uart_write_wakeup(&up->port);
 380
 381	if (uart_circ_empty(xmit))
 382		serial_txx9_stop_tx(&up->port);
 383}
 384
 385static irqreturn_t serial_txx9_interrupt(int irq, void *dev_id)
 386{
 387	int pass_counter = 0;
 388	struct uart_txx9_port *up = dev_id;
 389	unsigned int status;
 390
 391	while (1) {
 392		spin_lock(&up->port.lock);
 393		status = sio_in(up, TXX9_SIDISR);
 394		if (!(sio_in(up, TXX9_SIDICR) & TXX9_SIDICR_TIE))
 395			status &= ~TXX9_SIDISR_TDIS;
 396		if (!(status & (TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS |
 397				TXX9_SIDISR_TOUT))) {
 398			spin_unlock(&up->port.lock);
 399			break;
 400		}
 401
 402		if (status & TXX9_SIDISR_RDIS)
 403			receive_chars(up, &status);
 404		if (status & TXX9_SIDISR_TDIS)
 405			transmit_chars(up);
 406		/* Clear TX/RX Int. Status */
 407		sio_mask(up, TXX9_SIDISR,
 408			 TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS |
 409			 TXX9_SIDISR_TOUT);
 410		spin_unlock(&up->port.lock);
 411
 412		if (pass_counter++ > PASS_LIMIT)
 413			break;
 414	}
 415
 416	return pass_counter ? IRQ_HANDLED : IRQ_NONE;
 417}
 418
 419static unsigned int serial_txx9_tx_empty(struct uart_port *port)
 420{
 421	struct uart_txx9_port *up = to_uart_txx9_port(port);
 422	unsigned long flags;
 423	unsigned int ret;
 424
 425	spin_lock_irqsave(&up->port.lock, flags);
 426	ret = (sio_in(up, TXX9_SICISR) & TXX9_SICISR_TXALS) ? TIOCSER_TEMT : 0;
 427	spin_unlock_irqrestore(&up->port.lock, flags);
 428
 429	return ret;
 430}
 431
 432static unsigned int serial_txx9_get_mctrl(struct uart_port *port)
 433{
 434	struct uart_txx9_port *up = to_uart_txx9_port(port);
 435	unsigned int ret;
 436
 437	/* no modem control lines */
 438	ret = TIOCM_CAR | TIOCM_DSR;
 439	ret |= (sio_in(up, TXX9_SIFLCR) & TXX9_SIFLCR_RTSSC) ? 0 : TIOCM_RTS;
 440	ret |= (sio_in(up, TXX9_SICISR) & TXX9_SICISR_CTSS) ? 0 : TIOCM_CTS;
 441
 442	return ret;
 443}
 444
 445static void serial_txx9_set_mctrl(struct uart_port *port, unsigned int mctrl)
 446{
 447	struct uart_txx9_port *up = to_uart_txx9_port(port);
 448
 449	if (mctrl & TIOCM_RTS)
 450		sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSSC);
 451	else
 452		sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_RTSSC);
 453}
 454
 455static void serial_txx9_break_ctl(struct uart_port *port, int break_state)
 456{
 457	struct uart_txx9_port *up = to_uart_txx9_port(port);
 458	unsigned long flags;
 459
 460	spin_lock_irqsave(&up->port.lock, flags);
 461	if (break_state == -1)
 462		sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
 463	else
 464		sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
 465	spin_unlock_irqrestore(&up->port.lock, flags);
 466}
 467
 468#if defined(CONFIG_SERIAL_TXX9_CONSOLE) || defined(CONFIG_CONSOLE_POLL)
 469/*
 470 *	Wait for transmitter & holding register to empty
 471 */
 472static void wait_for_xmitr(struct uart_txx9_port *up)
 473{
 474	unsigned int tmout = 10000;
 475
 476	/* Wait up to 10ms for the character(s) to be sent. */
 477	while (--tmout &&
 478	       !(sio_in(up, TXX9_SICISR) & TXX9_SICISR_TXALS))
 479		udelay(1);
 480
 481	/* Wait up to 1s for flow control if necessary */
 482	if (up->port.flags & UPF_CONS_FLOW) {
 483		tmout = 1000000;
 484		while (--tmout &&
 485		       (sio_in(up, TXX9_SICISR) & TXX9_SICISR_CTSS))
 486			udelay(1);
 487	}
 488}
 489#endif
 490
 491#ifdef CONFIG_CONSOLE_POLL
 492/*
 493 * Console polling routines for writing and reading from the uart while
 494 * in an interrupt or debug context.
 495 */
 496
 497static int serial_txx9_get_poll_char(struct uart_port *port)
 498{
 499	unsigned int ier;
 500	unsigned char c;
 501	struct uart_txx9_port *up = to_uart_txx9_port(port);
 502
 503	/*
 504	 *	First save the IER then disable the interrupts
 505	 */
 506	ier = sio_in(up, TXX9_SIDICR);
 507	sio_out(up, TXX9_SIDICR, 0);
 508
 509	while (sio_in(up, TXX9_SIDISR) & TXX9_SIDISR_UVALID)
 510		;
 511
 512	c = sio_in(up, TXX9_SIRFIFO);
 513
 514	/*
 515	 *	Finally, clear RX interrupt status
 516	 *	and restore the IER
 517	 */
 518	sio_mask(up, TXX9_SIDISR, TXX9_SIDISR_RDIS);
 519	sio_out(up, TXX9_SIDICR, ier);
 520	return c;
 521}
 522
 523
 524static void serial_txx9_put_poll_char(struct uart_port *port, unsigned char c)
 525{
 526	unsigned int ier;
 527	struct uart_txx9_port *up = to_uart_txx9_port(port);
 528
 529	/*
 530	 *	First save the IER then disable the interrupts
 531	 */
 532	ier = sio_in(up, TXX9_SIDICR);
 533	sio_out(up, TXX9_SIDICR, 0);
 534
 535	wait_for_xmitr(up);
 536	/*
 537	 *	Send the character out.
 538	 *	If a LF, also do CR...
 539	 */
 540	sio_out(up, TXX9_SITFIFO, c);
 541	if (c == 10) {
 542		wait_for_xmitr(up);
 543		sio_out(up, TXX9_SITFIFO, 13);
 544	}
 545
 546	/*
 547	 *	Finally, wait for transmitter to become empty
 548	 *	and restore the IER
 549	 */
 550	wait_for_xmitr(up);
 551	sio_out(up, TXX9_SIDICR, ier);
 552}
 553
 554#endif /* CONFIG_CONSOLE_POLL */
 555
 556static int serial_txx9_startup(struct uart_port *port)
 557{
 558	struct uart_txx9_port *up = to_uart_txx9_port(port);
 559	unsigned long flags;
 560	int retval;
 561
 562	/*
 563	 * Clear the FIFO buffers and disable them.
 564	 * (they will be reenabled in set_termios())
 565	 */
 566	sio_set(up, TXX9_SIFCR,
 567		TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
 568	/* clear reset */
 569	sio_mask(up, TXX9_SIFCR,
 570		 TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
 571	sio_out(up, TXX9_SIDICR, 0);
 572
 573	/*
 574	 * Clear the interrupt registers.
 575	 */
 576	sio_out(up, TXX9_SIDISR, 0);
 577
 578	retval = request_irq(up->port.irq, serial_txx9_interrupt,
 579			     IRQF_SHARED, "serial_txx9", up);
 580	if (retval)
 581		return retval;
 582
 583	/*
 584	 * Now, initialize the UART
 585	 */
 586	spin_lock_irqsave(&up->port.lock, flags);
 587	serial_txx9_set_mctrl(&up->port, up->port.mctrl);
 588	spin_unlock_irqrestore(&up->port.lock, flags);
 589
 590	/* Enable RX/TX */
 591	sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_RSDE | TXX9_SIFLCR_TSDE);
 592
 593	/*
 594	 * Finally, enable interrupts.
 595	 */
 596	sio_set(up, TXX9_SIDICR, TXX9_SIDICR_RIE);
 597
 598	return 0;
 599}
 600
 601static void serial_txx9_shutdown(struct uart_port *port)
 602{
 603	struct uart_txx9_port *up = to_uart_txx9_port(port);
 604	unsigned long flags;
 605
 606	/*
 607	 * Disable interrupts from this port
 608	 */
 609	sio_out(up, TXX9_SIDICR, 0);	/* disable all intrs */
 610
 611	spin_lock_irqsave(&up->port.lock, flags);
 612	serial_txx9_set_mctrl(&up->port, up->port.mctrl);
 613	spin_unlock_irqrestore(&up->port.lock, flags);
 614
 615	/*
 616	 * Disable break condition
 617	 */
 618	sio_mask(up, TXX9_SIFLCR, TXX9_SIFLCR_TBRK);
 619
 620#ifdef CONFIG_SERIAL_TXX9_CONSOLE
 621	if (up->port.cons && up->port.line == up->port.cons->index) {
 622		free_irq(up->port.irq, up);
 623		return;
 624	}
 625#endif
 626	/* reset FIFOs */
 627	sio_set(up, TXX9_SIFCR,
 628		TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
 629	/* clear reset */
 630	sio_mask(up, TXX9_SIFCR,
 631		 TXX9_SIFCR_TFRST | TXX9_SIFCR_RFRST | TXX9_SIFCR_FRSTE);
 632
 633	/* Disable RX/TX */
 634	sio_set(up, TXX9_SIFLCR, TXX9_SIFLCR_RSDE | TXX9_SIFLCR_TSDE);
 635
 636	free_irq(up->port.irq, up);
 637}
 638
 639static void
 640serial_txx9_set_termios(struct uart_port *port, struct ktermios *termios,
 641		       struct ktermios *old)
 642{
 643	struct uart_txx9_port *up = to_uart_txx9_port(port);
 644	unsigned int cval, fcr = 0;
 645	unsigned long flags;
 646	unsigned int baud, quot;
 647
 648	/*
 649	 * We don't support modem control lines.
 650	 */
 651	termios->c_cflag &= ~(HUPCL | CMSPAR);
 652	termios->c_cflag |= CLOCAL;
 653
 654	cval = sio_in(up, TXX9_SILCR);
 655	/* byte size and parity */
 656	cval &= ~TXX9_SILCR_UMODE_MASK;
 657	switch (termios->c_cflag & CSIZE) {
 658	case CS7:
 659		cval |= TXX9_SILCR_UMODE_7BIT;
 660		break;
 661	default:
 662	case CS5:	/* not supported */
 663	case CS6:	/* not supported */
 664	case CS8:
 665		cval |= TXX9_SILCR_UMODE_8BIT;
 
 
 666		break;
 667	}
 668
 669	cval &= ~TXX9_SILCR_USBL_MASK;
 670	if (termios->c_cflag & CSTOPB)
 671		cval |= TXX9_SILCR_USBL_2BIT;
 672	else
 673		cval |= TXX9_SILCR_USBL_1BIT;
 674	cval &= ~(TXX9_SILCR_UPEN | TXX9_SILCR_UEPS);
 675	if (termios->c_cflag & PARENB)
 676		cval |= TXX9_SILCR_UPEN;
 677	if (!(termios->c_cflag & PARODD))
 678		cval |= TXX9_SILCR_UEPS;
 679
 680	/*
 681	 * Ask the core to calculate the divisor for us.
 682	 */
 683	baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16/2);
 684	quot = uart_get_divisor(port, baud);
 685
 686	/* Set up FIFOs */
 687	/* TX Int by FIFO Empty, RX Int by Receiving 1 char. */
 688	fcr = TXX9_SIFCR_TDIL_MAX | TXX9_SIFCR_RDIL_1;
 689
 690	/*
 691	 * Ok, we're now changing the port state.  Do it with
 692	 * interrupts disabled.
 693	 */
 694	spin_lock_irqsave(&up->port.lock, flags);
 695
 696	/*
 697	 * Update the per-port timeout.
 698	 */
 699	uart_update_timeout(port, termios->c_cflag, baud);
 700
 701	up->port.read_status_mask = TXX9_SIDISR_UOER |
 702		TXX9_SIDISR_TDIS | TXX9_SIDISR_RDIS;
 703	if (termios->c_iflag & INPCK)
 704		up->port.read_status_mask |= TXX9_SIDISR_UFER | TXX9_SIDISR_UPER;
 705	if (termios->c_iflag & (BRKINT | PARMRK))
 706		up->port.read_status_mask |= TXX9_SIDISR_UBRK;
 707
 708	/*
 709	 * Characteres to ignore
 710	 */
 711	up->port.ignore_status_mask = 0;
 712	if (termios->c_iflag & IGNPAR)
 713		up->port.ignore_status_mask |= TXX9_SIDISR_UPER | TXX9_SIDISR_UFER;
 714	if (termios->c_iflag & IGNBRK) {
 715		up->port.ignore_status_mask |= TXX9_SIDISR_UBRK;
 716		/*
 717		 * If we're ignoring parity and break indicators,
 718		 * ignore overruns too (for real raw support).
 719		 */
 720		if (termios->c_iflag & IGNPAR)
 721			up->port.ignore_status_mask |= TXX9_SIDISR_UOER;
 722	}
 723
 724	/*
 725	 * ignore all characters if CREAD is not set
 726	 */
 727	if ((termios->c_cflag & CREAD) == 0)
 728		up->port.ignore_status_mask |= TXX9_SIDISR_RDIS;
 729
 730	/* CTS flow control flag */
 731	if ((termios->c_cflag & CRTSCTS) &&
 732	    (up->port.flags & UPF_TXX9_HAVE_CTS_LINE)) {
 733		sio_set(up, TXX9_SIFLCR,
 734			TXX9_SIFLCR_RCS | TXX9_SIFLCR_TES);
 735	} else {
 736		sio_mask(up, TXX9_SIFLCR,
 737			 TXX9_SIFLCR_RCS | TXX9_SIFLCR_TES);
 738	}
 739
 740	sio_out(up, TXX9_SILCR, cval);
 741	sio_quot_set(up, quot);
 742	sio_out(up, TXX9_SIFCR, fcr);
 743
 744	serial_txx9_set_mctrl(&up->port, up->port.mctrl);
 745	spin_unlock_irqrestore(&up->port.lock, flags);
 746}
 747
 748static void
 749serial_txx9_pm(struct uart_port *port, unsigned int state,
 750	      unsigned int oldstate)
 751{
 752	/*
 753	 * If oldstate was -1 this is called from
 754	 * uart_configure_port().  In this case do not initialize the
 755	 * port now, because the port was already initialized (for
 756	 * non-console port) or should not be initialized here (for
 757	 * console port).  If we initialized the port here we lose
 758	 * serial console settings.
 759	 */
 760	if (state == 0 && oldstate != -1)
 761		serial_txx9_initialize(port);
 762}
 763
 764static int serial_txx9_request_resource(struct uart_txx9_port *up)
 765{
 766	unsigned int size = TXX9_REGION_SIZE;
 767	int ret = 0;
 768
 769	switch (up->port.iotype) {
 770	default:
 771		if (!up->port.mapbase)
 772			break;
 773
 774		if (!request_mem_region(up->port.mapbase, size, "serial_txx9")) {
 775			ret = -EBUSY;
 776			break;
 777		}
 778
 779		if (up->port.flags & UPF_IOREMAP) {
 780			up->port.membase = ioremap(up->port.mapbase, size);
 781			if (!up->port.membase) {
 782				release_mem_region(up->port.mapbase, size);
 783				ret = -ENOMEM;
 784			}
 785		}
 786		break;
 787
 788	case UPIO_PORT:
 789		if (!request_region(up->port.iobase, size, "serial_txx9"))
 790			ret = -EBUSY;
 791		break;
 792	}
 793	return ret;
 794}
 795
 796static void serial_txx9_release_resource(struct uart_txx9_port *up)
 797{
 798	unsigned int size = TXX9_REGION_SIZE;
 799
 800	switch (up->port.iotype) {
 801	default:
 802		if (!up->port.mapbase)
 803			break;
 804
 805		if (up->port.flags & UPF_IOREMAP) {
 806			iounmap(up->port.membase);
 807			up->port.membase = NULL;
 808		}
 809
 810		release_mem_region(up->port.mapbase, size);
 811		break;
 812
 813	case UPIO_PORT:
 814		release_region(up->port.iobase, size);
 815		break;
 816	}
 817}
 818
 819static void serial_txx9_release_port(struct uart_port *port)
 820{
 821	struct uart_txx9_port *up = to_uart_txx9_port(port);
 822	serial_txx9_release_resource(up);
 823}
 824
 825static int serial_txx9_request_port(struct uart_port *port)
 826{
 827	struct uart_txx9_port *up = to_uart_txx9_port(port);
 828	return serial_txx9_request_resource(up);
 829}
 830
 831static void serial_txx9_config_port(struct uart_port *port, int uflags)
 832{
 833	struct uart_txx9_port *up = to_uart_txx9_port(port);
 834	int ret;
 835
 836	/*
 837	 * Find the region that we can probe for.  This in turn
 838	 * tells us whether we can probe for the type of port.
 839	 */
 840	ret = serial_txx9_request_resource(up);
 841	if (ret < 0)
 842		return;
 843	port->type = PORT_TXX9;
 844	up->port.fifosize = TXX9_SIO_TX_FIFO;
 845
 846#ifdef CONFIG_SERIAL_TXX9_CONSOLE
 847	if (up->port.line == up->port.cons->index)
 848		return;
 849#endif
 850	serial_txx9_initialize(port);
 851}
 852
 853static const char *
 854serial_txx9_type(struct uart_port *port)
 855{
 856	return "txx9";
 857}
 858
 859static struct uart_ops serial_txx9_pops = {
 860	.tx_empty	= serial_txx9_tx_empty,
 861	.set_mctrl	= serial_txx9_set_mctrl,
 862	.get_mctrl	= serial_txx9_get_mctrl,
 863	.stop_tx	= serial_txx9_stop_tx,
 864	.start_tx	= serial_txx9_start_tx,
 865	.stop_rx	= serial_txx9_stop_rx,
 866	.enable_ms	= serial_txx9_enable_ms,
 867	.break_ctl	= serial_txx9_break_ctl,
 868	.startup	= serial_txx9_startup,
 869	.shutdown	= serial_txx9_shutdown,
 870	.set_termios	= serial_txx9_set_termios,
 871	.pm		= serial_txx9_pm,
 872	.type		= serial_txx9_type,
 873	.release_port	= serial_txx9_release_port,
 874	.request_port	= serial_txx9_request_port,
 875	.config_port	= serial_txx9_config_port,
 876#ifdef CONFIG_CONSOLE_POLL
 877	.poll_get_char	= serial_txx9_get_poll_char,
 878	.poll_put_char	= serial_txx9_put_poll_char,
 879#endif
 880};
 881
 882static struct uart_txx9_port serial_txx9_ports[UART_NR];
 883
 884static void __init serial_txx9_register_ports(struct uart_driver *drv,
 885					      struct device *dev)
 886{
 887	int i;
 888
 889	for (i = 0; i < UART_NR; i++) {
 890		struct uart_txx9_port *up = &serial_txx9_ports[i];
 891
 892		up->port.line = i;
 893		up->port.ops = &serial_txx9_pops;
 894		up->port.dev = dev;
 895		if (up->port.iobase || up->port.mapbase)
 896			uart_add_one_port(drv, &up->port);
 897	}
 898}
 899
 900#ifdef CONFIG_SERIAL_TXX9_CONSOLE
 901
 902static void serial_txx9_console_putchar(struct uart_port *port, int ch)
 903{
 904	struct uart_txx9_port *up = to_uart_txx9_port(port);
 905
 906	wait_for_xmitr(up);
 907	sio_out(up, TXX9_SITFIFO, ch);
 908}
 909
 910/*
 911 *	Print a string to the serial port trying not to disturb
 912 *	any possible real use of the port...
 913 *
 914 *	The console_lock must be held when we get here.
 915 */
 916static void
 917serial_txx9_console_write(struct console *co, const char *s, unsigned int count)
 918{
 919	struct uart_txx9_port *up = &serial_txx9_ports[co->index];
 920	unsigned int ier, flcr;
 921
 922	/*
 923	 *	First save the UER then disable the interrupts
 924	 */
 925	ier = sio_in(up, TXX9_SIDICR);
 926	sio_out(up, TXX9_SIDICR, 0);
 927	/*
 928	 *	Disable flow-control if enabled (and unnecessary)
 929	 */
 930	flcr = sio_in(up, TXX9_SIFLCR);
 931	if (!(up->port.flags & UPF_CONS_FLOW) && (flcr & TXX9_SIFLCR_TES))
 932		sio_out(up, TXX9_SIFLCR, flcr & ~TXX9_SIFLCR_TES);
 933
 934	uart_console_write(&up->port, s, count, serial_txx9_console_putchar);
 935
 936	/*
 937	 *	Finally, wait for transmitter to become empty
 938	 *	and restore the IER
 939	 */
 940	wait_for_xmitr(up);
 941	sio_out(up, TXX9_SIFLCR, flcr);
 942	sio_out(up, TXX9_SIDICR, ier);
 943}
 944
 945static int __init serial_txx9_console_setup(struct console *co, char *options)
 946{
 947	struct uart_port *port;
 948	struct uart_txx9_port *up;
 949	int baud = 9600;
 950	int bits = 8;
 951	int parity = 'n';
 952	int flow = 'n';
 953
 954	/*
 955	 * Check whether an invalid uart number has been specified, and
 956	 * if so, search for the first available port that does have
 957	 * console support.
 958	 */
 959	if (co->index >= UART_NR)
 960		co->index = 0;
 961	up = &serial_txx9_ports[co->index];
 962	port = &up->port;
 963	if (!port->ops)
 964		return -ENODEV;
 965
 966	serial_txx9_initialize(&up->port);
 967
 968	if (options)
 969		uart_parse_options(options, &baud, &parity, &bits, &flow);
 970
 971	return uart_set_options(port, co, baud, parity, bits, flow);
 972}
 973
 974static struct uart_driver serial_txx9_reg;
 975static struct console serial_txx9_console = {
 976	.name		= TXX9_TTY_NAME,
 977	.write		= serial_txx9_console_write,
 978	.device		= uart_console_device,
 979	.setup		= serial_txx9_console_setup,
 980	.flags		= CON_PRINTBUFFER,
 981	.index		= -1,
 982	.data		= &serial_txx9_reg,
 983};
 984
 985static int __init serial_txx9_console_init(void)
 986{
 987	register_console(&serial_txx9_console);
 988	return 0;
 989}
 990console_initcall(serial_txx9_console_init);
 991
 992#define SERIAL_TXX9_CONSOLE	&serial_txx9_console
 993#else
 994#define SERIAL_TXX9_CONSOLE	NULL
 995#endif
 996
 997static struct uart_driver serial_txx9_reg = {
 998	.owner			= THIS_MODULE,
 999	.driver_name		= "serial_txx9",
1000	.dev_name		= TXX9_TTY_NAME,
1001	.major			= TXX9_TTY_MAJOR,
1002	.minor			= TXX9_TTY_MINOR_START,
1003	.nr			= UART_NR,
1004	.cons			= SERIAL_TXX9_CONSOLE,
1005};
1006
1007int __init early_serial_txx9_setup(struct uart_port *port)
1008{
1009	if (port->line >= ARRAY_SIZE(serial_txx9_ports))
1010		return -ENODEV;
1011
1012	serial_txx9_ports[port->line].port = *port;
1013	serial_txx9_ports[port->line].port.ops = &serial_txx9_pops;
1014	serial_txx9_ports[port->line].port.flags |=
1015		UPF_BOOT_AUTOCONF | UPF_FIXED_PORT;
1016	return 0;
1017}
1018
1019static DEFINE_MUTEX(serial_txx9_mutex);
1020
1021/**
1022 *	serial_txx9_register_port - register a serial port
1023 *	@port: serial port template
1024 *
1025 *	Configure the serial port specified by the request.
1026 *
1027 *	The port is then probed and if necessary the IRQ is autodetected
1028 *	If this fails an error is returned.
1029 *
1030 *	On success the port is ready to use and the line number is returned.
1031 */
1032static int serial_txx9_register_port(struct uart_port *port)
1033{
1034	int i;
1035	struct uart_txx9_port *uart;
1036	int ret = -ENOSPC;
1037
1038	mutex_lock(&serial_txx9_mutex);
1039	for (i = 0; i < UART_NR; i++) {
1040		uart = &serial_txx9_ports[i];
1041		if (uart_match_port(&uart->port, port)) {
1042			uart_remove_one_port(&serial_txx9_reg, &uart->port);
1043			break;
1044		}
1045	}
1046	if (i == UART_NR) {
1047		/* Find unused port */
1048		for (i = 0; i < UART_NR; i++) {
1049			uart = &serial_txx9_ports[i];
1050			if (!(uart->port.iobase || uart->port.mapbase))
1051				break;
1052		}
1053	}
1054	if (i < UART_NR) {
1055		uart->port.iobase = port->iobase;
1056		uart->port.membase = port->membase;
1057		uart->port.irq      = port->irq;
1058		uart->port.uartclk  = port->uartclk;
1059		uart->port.iotype   = port->iotype;
1060		uart->port.flags    = port->flags
1061			| UPF_BOOT_AUTOCONF | UPF_FIXED_PORT;
1062		uart->port.mapbase  = port->mapbase;
1063		if (port->dev)
1064			uart->port.dev = port->dev;
1065		ret = uart_add_one_port(&serial_txx9_reg, &uart->port);
1066		if (ret == 0)
1067			ret = uart->port.line;
1068	}
1069	mutex_unlock(&serial_txx9_mutex);
1070	return ret;
1071}
1072
1073/**
1074 *	serial_txx9_unregister_port - remove a txx9 serial port at runtime
1075 *	@line: serial line number
1076 *
1077 *	Remove one serial port.  This may not be called from interrupt
1078 *	context.  We hand the port back to the our control.
1079 */
1080static void serial_txx9_unregister_port(int line)
1081{
1082	struct uart_txx9_port *uart = &serial_txx9_ports[line];
1083
1084	mutex_lock(&serial_txx9_mutex);
1085	uart_remove_one_port(&serial_txx9_reg, &uart->port);
1086	uart->port.flags = 0;
1087	uart->port.type = PORT_UNKNOWN;
1088	uart->port.iobase = 0;
1089	uart->port.mapbase = 0;
1090	uart->port.membase = NULL;
1091	uart->port.dev = NULL;
1092	mutex_unlock(&serial_txx9_mutex);
1093}
1094
1095/*
1096 * Register a set of serial devices attached to a platform device.
1097 */
1098static int serial_txx9_probe(struct platform_device *dev)
1099{
1100	struct uart_port *p = dev_get_platdata(&dev->dev);
1101	struct uart_port port;
1102	int ret, i;
1103
1104	memset(&port, 0, sizeof(struct uart_port));
1105	for (i = 0; p && p->uartclk != 0; p++, i++) {
1106		port.iobase	= p->iobase;
1107		port.membase	= p->membase;
1108		port.irq	= p->irq;
1109		port.uartclk	= p->uartclk;
1110		port.iotype	= p->iotype;
1111		port.flags	= p->flags;
1112		port.mapbase	= p->mapbase;
1113		port.dev	= &dev->dev;
 
1114		ret = serial_txx9_register_port(&port);
1115		if (ret < 0) {
1116			dev_err(&dev->dev, "unable to register port at index %d "
1117				"(IO%lx MEM%llx IRQ%d): %d\n", i,
1118				p->iobase, (unsigned long long)p->mapbase,
1119				p->irq, ret);
1120		}
1121	}
1122	return 0;
1123}
1124
1125/*
1126 * Remove serial ports registered against a platform device.
1127 */
1128static int serial_txx9_remove(struct platform_device *dev)
1129{
1130	int i;
1131
1132	for (i = 0; i < UART_NR; i++) {
1133		struct uart_txx9_port *up = &serial_txx9_ports[i];
1134
1135		if (up->port.dev == &dev->dev)
1136			serial_txx9_unregister_port(i);
1137	}
1138	return 0;
1139}
1140
1141#ifdef CONFIG_PM
1142static int serial_txx9_suspend(struct platform_device *dev, pm_message_t state)
1143{
1144	int i;
1145
1146	for (i = 0; i < UART_NR; i++) {
1147		struct uart_txx9_port *up = &serial_txx9_ports[i];
1148
1149		if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
1150			uart_suspend_port(&serial_txx9_reg, &up->port);
1151	}
1152
1153	return 0;
1154}
1155
1156static int serial_txx9_resume(struct platform_device *dev)
1157{
1158	int i;
1159
1160	for (i = 0; i < UART_NR; i++) {
1161		struct uart_txx9_port *up = &serial_txx9_ports[i];
1162
1163		if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
1164			uart_resume_port(&serial_txx9_reg, &up->port);
1165	}
1166
1167	return 0;
1168}
1169#endif
1170
1171static struct platform_driver serial_txx9_plat_driver = {
1172	.probe		= serial_txx9_probe,
1173	.remove		= serial_txx9_remove,
1174#ifdef CONFIG_PM
1175	.suspend	= serial_txx9_suspend,
1176	.resume		= serial_txx9_resume,
1177#endif
1178	.driver		= {
1179		.name	= "serial_txx9",
1180		.owner	= THIS_MODULE,
1181	},
1182};
1183
1184#ifdef ENABLE_SERIAL_TXX9_PCI
1185/*
1186 * Probe one serial board.  Unfortunately, there is no rhyme nor reason
1187 * to the arrangement of serial ports on a PCI card.
1188 */
1189static int
1190pciserial_txx9_init_one(struct pci_dev *dev, const struct pci_device_id *ent)
1191{
1192	struct uart_port port;
1193	int line;
1194	int rc;
1195
1196	rc = pci_enable_device(dev);
1197	if (rc)
1198		return rc;
1199
1200	memset(&port, 0, sizeof(port));
1201	port.ops = &serial_txx9_pops;
1202	port.flags |= UPF_TXX9_HAVE_CTS_LINE;
1203	port.uartclk = 66670000;
1204	port.irq = dev->irq;
1205	port.iotype = UPIO_PORT;
1206	port.iobase = pci_resource_start(dev, 1);
1207	port.dev = &dev->dev;
1208	line = serial_txx9_register_port(&port);
1209	if (line < 0) {
1210		printk(KERN_WARNING "Couldn't register serial port %s: %d\n", pci_name(dev), line);
1211		pci_disable_device(dev);
1212		return line;
1213	}
1214	pci_set_drvdata(dev, &serial_txx9_ports[line]);
1215
1216	return 0;
1217}
1218
1219static void pciserial_txx9_remove_one(struct pci_dev *dev)
1220{
1221	struct uart_txx9_port *up = pci_get_drvdata(dev);
1222
1223	if (up) {
1224		serial_txx9_unregister_port(up->port.line);
1225		pci_disable_device(dev);
1226	}
1227}
1228
1229#ifdef CONFIG_PM
1230static int pciserial_txx9_suspend_one(struct pci_dev *dev, pm_message_t state)
1231{
1232	struct uart_txx9_port *up = pci_get_drvdata(dev);
1233
1234	if (up)
1235		uart_suspend_port(&serial_txx9_reg, &up->port);
1236	pci_save_state(dev);
1237	pci_set_power_state(dev, pci_choose_state(dev, state));
1238	return 0;
1239}
1240
1241static int pciserial_txx9_resume_one(struct pci_dev *dev)
1242{
1243	struct uart_txx9_port *up = pci_get_drvdata(dev);
1244
1245	pci_set_power_state(dev, PCI_D0);
1246	pci_restore_state(dev);
1247	if (up)
1248		uart_resume_port(&serial_txx9_reg, &up->port);
1249	return 0;
1250}
1251#endif
1252
1253static const struct pci_device_id serial_txx9_pci_tbl[] = {
1254	{ PCI_DEVICE(PCI_VENDOR_ID_TOSHIBA_2, PCI_DEVICE_ID_TOSHIBA_TC86C001_MISC) },
1255	{ 0, }
1256};
1257
1258static struct pci_driver serial_txx9_pci_driver = {
1259	.name		= "serial_txx9",
1260	.probe		= pciserial_txx9_init_one,
1261	.remove		= pciserial_txx9_remove_one,
1262#ifdef CONFIG_PM
1263	.suspend	= pciserial_txx9_suspend_one,
1264	.resume		= pciserial_txx9_resume_one,
1265#endif
1266	.id_table	= serial_txx9_pci_tbl,
1267};
1268
1269MODULE_DEVICE_TABLE(pci, serial_txx9_pci_tbl);
1270#endif /* ENABLE_SERIAL_TXX9_PCI */
1271
1272static struct platform_device *serial_txx9_plat_devs;
1273
1274static int __init serial_txx9_init(void)
1275{
1276	int ret;
1277
1278 	printk(KERN_INFO "%s version %s\n", serial_name, serial_version);
1279
1280	ret = uart_register_driver(&serial_txx9_reg);
1281	if (ret)
1282		goto out;
1283
1284	serial_txx9_plat_devs = platform_device_alloc("serial_txx9", -1);
1285	if (!serial_txx9_plat_devs) {
1286		ret = -ENOMEM;
1287		goto unreg_uart_drv;
1288	}
1289
1290	ret = platform_device_add(serial_txx9_plat_devs);
1291	if (ret)
1292		goto put_dev;
1293
1294	serial_txx9_register_ports(&serial_txx9_reg,
1295				   &serial_txx9_plat_devs->dev);
1296
1297	ret = platform_driver_register(&serial_txx9_plat_driver);
1298	if (ret)
1299		goto del_dev;
1300
1301#ifdef ENABLE_SERIAL_TXX9_PCI
1302	ret = pci_register_driver(&serial_txx9_pci_driver);
 
 
 
1303#endif
1304	if (ret == 0)
1305		goto out;
1306
1307 del_dev:
1308	platform_device_del(serial_txx9_plat_devs);
1309 put_dev:
1310	platform_device_put(serial_txx9_plat_devs);
1311 unreg_uart_drv:
1312	uart_unregister_driver(&serial_txx9_reg);
1313 out:
1314	return ret;
1315}
1316
1317static void __exit serial_txx9_exit(void)
1318{
1319	int i;
1320
1321#ifdef ENABLE_SERIAL_TXX9_PCI
1322	pci_unregister_driver(&serial_txx9_pci_driver);
1323#endif
1324	platform_driver_unregister(&serial_txx9_plat_driver);
1325	platform_device_unregister(serial_txx9_plat_devs);
1326	for (i = 0; i < UART_NR; i++) {
1327		struct uart_txx9_port *up = &serial_txx9_ports[i];
1328		if (up->port.iobase || up->port.mapbase)
1329			uart_remove_one_port(&serial_txx9_reg, &up->port);
1330	}
1331
1332	uart_unregister_driver(&serial_txx9_reg);
1333}
1334
1335module_init(serial_txx9_init);
1336module_exit(serial_txx9_exit);
1337
1338MODULE_LICENSE("GPL");
1339MODULE_DESCRIPTION("TX39/49 serial driver");
1340
1341MODULE_ALIAS_CHARDEV_MAJOR(TXX9_TTY_MAJOR);