drivers/tty/serial/serial_txx9.c

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