drivers/serial/8250.c

   1 /*
   2  *  linux/drivers/char/8250.c
   3  *
   4  *  Driver for 8250/16550-type serial ports
   5  *
   6  *  Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
   7  *
   8  *  Copyright (C) 2001 Russell King.
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  *  $Id: 8250.c,v 1.90 2002/07/28 10:03:27 rmk Exp $
  16  *
  17  * A note about mapbase / membase
  18  *
  19  *  mapbase is the physical address of the IO port.
  20  *  membase is an 'ioremapped' cookie.
  21  */
  22
  23 #if defined(CONFIG_SERIAL_8250_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
  24 #define SUPPORT_SYSRQ
  25 #endif
  26
  27 #include <linux/module.h>
  28 #include <linux/moduleparam.h>
  29 #include <linux/ioport.h>
  30 #include <linux/init.h>
  31 #include <linux/console.h>
  32 #include <linux/sysrq.h>
  33 #include <linux/delay.h>
  34 #include <linux/platform_device.h>
  35 #include <linux/tty.h>
  36 #include <linux/tty_flip.h>
  37 #include <linux/serial_reg.h>
  38 #include <linux/serial_core.h>
  39 #include <linux/serial.h>
  40 #include <linux/serial_8250.h>
  41 #include <linux/nmi.h>
  42 #include <linux/mutex.h>
  43
  44 #include <asm/io.h>
  45 #include <asm/irq.h>
  46
  47 #include "8250.h"
  48
  49 /*
  50  * Configuration:
  51  *   share_irqs - whether we pass IRQF_SHARED to request_irq().  This option
  52  *                is unsafe when used on edge-triggered interrupts.
  53  */
  54 static unsigned int share_irqs = SERIAL8250_SHARE_IRQS;
  55
  56 static unsigned int nr_uarts = CONFIG_SERIAL_8250_RUNTIME_UARTS;
  57
  58 /*
  59  * Debugging.
  60  */
  61 #if 0
  62 #define DEBUG_AUTOCONF(fmt...)  printk(fmt)
  63 #else
  64 #define DEBUG_AUTOCONF(fmt...)  do { } while (0)
  65 #endif
  66
  67 #if 0
  68 #define DEBUG_INTR(fmt...)      printk(fmt)
  69 #else
  70 #define DEBUG_INTR(fmt...)      do { } while (0)
  71 #endif
  72
  73 #define PASS_LIMIT      256
  74
  75 /*
  76  * We default to IRQ0 for the "no irq" hack.   Some
  77  * machine types want others as well - they're free
  78  * to redefine this in their header file.
  79  */
  80 #define is_real_interrupt(irq)  ((irq) != 0)
  81
  82 #ifdef CONFIG_SERIAL_8250_DETECT_IRQ
  83 #define CONFIG_SERIAL_DETECT_IRQ 1
  84 #endif
  85 #ifdef CONFIG_SERIAL_8250_MANY_PORTS
  86 #define CONFIG_SERIAL_MANY_PORTS 1
  87 #endif
  88
  89 /*
  90  * HUB6 is always on.  This will be removed once the header
  91  * files have been cleaned.
  92  */
  93 #define CONFIG_HUB6 1
  94
  95 #include <asm/serial.h>
  96
  97 /*
  98  * SERIAL_PORT_DFNS tells us about built-in ports that have no
  99  * standard enumeration mechanism.   Platforms that can find all
 100  * serial ports via mechanisms like ACPI or PCI need not supply it.
 101  */
 102 #ifndef SERIAL_PORT_DFNS
 103 #define SERIAL_PORT_DFNS
 104 #endif
 105
 106 static const struct old_serial_port old_serial_port[] = {
 107         SERIAL_PORT_DFNS /* defined in asm/serial.h */
 108 };
 109
 110 #define UART_NR CONFIG_SERIAL_8250_NR_UARTS
 111
 112 #ifdef CONFIG_SERIAL_8250_RSA
 113
 114 #define PORT_RSA_MAX 4
 115 static unsigned long probe_rsa[PORT_RSA_MAX];
 116 static unsigned int probe_rsa_count;
 117 #endif /* CONFIG_SERIAL_8250_RSA  */
 118
 119 struct uart_8250_port {
 120         struct uart_port        port;
 121         struct timer_list       timer;          /* "no irq" timer */
 122         struct list_head        list;           /* ports on this IRQ */
 123         unsigned short          capabilities;   /* port capabilities */
 124         unsigned short          bugs;           /* port bugs */
 125         unsigned int            tx_loadsz;      /* transmit fifo load size */
 126         unsigned char           acr;
 127         unsigned char           ier;
 128         unsigned char           lcr;
 129         unsigned char           mcr;
 130         unsigned char           mcr_mask;       /* mask of user bits */
 131         unsigned char           mcr_force;      /* mask of forced bits */
 132         unsigned char           lsr_break_flag;
 133
 134         /*
 135          * We provide a per-port pm hook.
 136          */
 137         void                    (*pm)(struct uart_port *port,
 138                                       unsigned int state, unsigned int old);
 139 };
 140
 141 struct irq_info {
 142         spinlock_t              lock;
 143         struct list_head        *head;
 144 };
 145
 146 static struct irq_info irq_lists[NR_IRQS];
 147
 148 /*
 149  * Here we define the default xmit fifo size used for each type of UART.
 150  */
 151 static const struct serial8250_config uart_config[] = {
 152         [PORT_UNKNOWN] = {
 153                 .name           = "unknown",
 154                 .fifo_size      = 1,
 155                 .tx_loadsz      = 1,
 156         },
 157         [PORT_8250] = {
 158                 .name           = "8250",
 159                 .fifo_size      = 1,
 160                 .tx_loadsz      = 1,
 161         },
 162         [PORT_16450] = {
 163                 .name           = "16450",
 164                 .fifo_size      = 1,
 165                 .tx_loadsz      = 1,
 166         },
 167         [PORT_16550] = {
 168                 .name           = "16550",
 169                 .fifo_size      = 1,
 170                 .tx_loadsz      = 1,
 171         },
 172         [PORT_16550A] = {
 173                 .name           = "16550A",
 174                 .fifo_size      = 16,
 175                 .tx_loadsz      = 16,
 176                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
 177                 .flags          = UART_CAP_FIFO,
 178         },
 179         [PORT_CIRRUS] = {
 180                 .name           = "Cirrus",
 181                 .fifo_size      = 1,
 182                 .tx_loadsz      = 1,
 183         },
 184         [PORT_16650] = {
 185                 .name           = "ST16650",
 186                 .fifo_size      = 1,
 187                 .tx_loadsz      = 1,
 188                 .flags          = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
 189         },
 190         [PORT_16650V2] = {
 191                 .name           = "ST16650V2",
 192                 .fifo_size      = 32,
 193                 .tx_loadsz      = 16,
 194                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
 195                                   UART_FCR_T_TRIG_00,
 196                 .flags          = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
 197         },
 198         [PORT_16750] = {
 199                 .name           = "TI16750",
 200                 .fifo_size      = 64,
 201                 .tx_loadsz      = 64,
 202                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10 |
 203                                   UART_FCR7_64BYTE,
 204                 .flags          = UART_CAP_FIFO | UART_CAP_SLEEP | UART_CAP_AFE,
 205         },
 206         [PORT_STARTECH] = {
 207                 .name           = "Startech",
 208                 .fifo_size      = 1,
 209                 .tx_loadsz      = 1,
 210         },
 211         [PORT_16C950] = {
 212                 .name           = "16C950/954",
 213                 .fifo_size      = 128,
 214                 .tx_loadsz      = 128,
 215                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
 216                 .flags          = UART_CAP_FIFO,
 217         },
 218         [PORT_16654] = {
 219                 .name           = "ST16654",
 220                 .fifo_size      = 64,
 221                 .tx_loadsz      = 32,
 222                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
 223                                   UART_FCR_T_TRIG_10,
 224                 .flags          = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
 225         },
 226         [PORT_16850] = {
 227                 .name           = "XR16850",
 228                 .fifo_size      = 128,
 229                 .tx_loadsz      = 128,
 230                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
 231                 .flags          = UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
 232         },
 233         [PORT_RSA] = {
 234                 .name           = "RSA",
 235                 .fifo_size      = 2048,
 236                 .tx_loadsz      = 2048,
 237                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_11,
 238                 .flags          = UART_CAP_FIFO,
 239         },
 240         [PORT_NS16550A] = {
 241                 .name           = "NS16550A",
 242                 .fifo_size      = 16,
 243                 .tx_loadsz      = 16,
 244                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
 245                 .flags          = UART_CAP_FIFO | UART_NATSEMI,
 246         },
 247         [PORT_XSCALE] = {
 248                 .name           = "XScale",
 249                 .fifo_size      = 32,
 250                 .tx_loadsz      = 32,
 251                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
 252                 .flags          = UART_CAP_FIFO | UART_CAP_UUE,
 253         },
 254         [PORT_RM9000] = {
 255                 .name           = "RM9000",
 256                 .fifo_size      = 16,
 257                 .tx_loadsz      = 16,
 258                 .fcr            = UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
 259                 .flags          = UART_CAP_FIFO,
 260         },
 261 };
 262
 263 #if defined (CONFIG_SERIAL_8250_AU1X00)
 264
 265 /* Au1x00 UART hardware has a weird register layout */
 266 static const u8 au_io_in_map[] = {
 267         [UART_RX]  = 0,
 268         [UART_IER] = 2,
 269         [UART_IIR] = 3,
 270         [UART_LCR] = 5,
 271         [UART_MCR] = 6,
 272         [UART_LSR] = 7,
 273         [UART_MSR] = 8,
 274 };
 275
 276 static const u8 au_io_out_map[] = {
 277         [UART_TX]  = 1,
 278         [UART_IER] = 2,
 279         [UART_FCR] = 4,
 280         [UART_LCR] = 5,
 281         [UART_MCR] = 6,
 282 };
 283
 284 /* sane hardware needs no mapping */
 285 static inline int map_8250_in_reg(struct uart_8250_port *up, int offset)
 286 {
 287         if (up->port.iotype != UPIO_AU)
 288                 return offset;
 289         return au_io_in_map[offset];
 290 }
 291
 292 static inline int map_8250_out_reg(struct uart_8250_port *up, int offset)
 293 {
 294         if (up->port.iotype != UPIO_AU)
 295                 return offset;
 296         return au_io_out_map[offset];
 297 }
 298
 299 #elif defined (CONFIG_SERIAL_8250_RM9K)
 300
 301 static const u8
 302         regmap_in[8] = {
 303                 [UART_RX]       = 0x00,
 304                 [UART_IER]      = 0x0c,
 305                 [UART_IIR]      = 0x14,
 306                 [UART_LCR]      = 0x1c,
 307                 [UART_MCR]      = 0x20,
 308                 [UART_LSR]      = 0x24,
 309                 [UART_MSR]      = 0x28,
 310                 [UART_SCR]      = 0x2c
 311         },
 312         regmap_out[8] = {
 313                 [UART_TX]       = 0x04,
 314                 [UART_IER]      = 0x0c,
 315                 [UART_FCR]      = 0x18,
 316                 [UART_LCR]      = 0x1c,
 317                 [UART_MCR]      = 0x20,
 318                 [UART_LSR]      = 0x24,
 319                 [UART_MSR]      = 0x28,
 320                 [UART_SCR]      = 0x2c
 321         };
 322
 323 static inline int map_8250_in_reg(struct uart_8250_port *up, int offset)
 324 {
 325         if (up->port.iotype != UPIO_RM9000)
 326                 return offset;
 327         return regmap_in[offset];
 328 }
 329
 330 static inline int map_8250_out_reg(struct uart_8250_port *up, int offset)
 331 {
 332         if (up->port.iotype != UPIO_RM9000)
 333                 return offset;
 334         return regmap_out[offset];
 335 }
 336
 337 #else
 338
 339 /* sane hardware needs no mapping */
 340 #define map_8250_in_reg(up, offset) (offset)
 341 #define map_8250_out_reg(up, offset) (offset)
 342
 343 #endif
 344
 345 static unsigned int serial_in(struct uart_8250_port *up, int offset)
 346 {
 347         unsigned int tmp;
 348         offset = map_8250_in_reg(up, offset) << up->port.regshift;
 349
 350         switch (up->port.iotype) {
 351         case UPIO_HUB6:
 352                 outb(up->port.hub6 - 1 + offset, up->port.iobase);
 353                 return inb(up->port.iobase + 1);
 354
 355         case UPIO_MEM:
 356         case UPIO_DWAPB:
 357                 return readb(up->port.membase + offset);
 358
 359         case UPIO_RM9000:
 360         case UPIO_MEM32:
 361                 return readl(up->port.membase + offset);
 362
 363 #ifdef CONFIG_SERIAL_8250_AU1X00
 364         case UPIO_AU:
 365                 return __raw_readl(up->port.membase + offset);
 366 #endif
 367
 368         case UPIO_TSI:
 369                 if (offset == UART_IIR) {
 370                         tmp = readl(up->port.membase + (UART_IIR & ~3));
 371                         return (tmp >> 16) & 0xff; /* UART_IIR % 4 == 2 */
 372                 } else
 373                         return readb(up->port.membase + offset);
 374
 375         default:
 376                 return inb(up->port.iobase + offset);
 377         }
 378 }
 379
 380 static void
 381 serial_out(struct uart_8250_port *up, int offset, int value)
 382 {
 383         /* Save the offset before it's remapped */
 384         int save_offset = offset;
 385         offset = map_8250_out_reg(up, offset) << up->port.regshift;
 386
 387         switch (up->port.iotype) {
 388         case UPIO_HUB6:
 389                 outb(up->port.hub6 - 1 + offset, up->port.iobase);
 390                 outb(value, up->port.iobase + 1);
 391                 break;
 392
 393         case UPIO_MEM:
 394                 writeb(value, up->port.membase + offset);
 395                 break;
 396
 397         case UPIO_RM9000:
 398         case UPIO_MEM32:
 399                 writel(value, up->port.membase + offset);
 400                 break;
 401
 402 #ifdef CONFIG_SERIAL_8250_AU1X00
 403         case UPIO_AU:
 404                 __raw_writel(value, up->port.membase + offset);
 405                 break;
 406 #endif
 407         case UPIO_TSI:
 408                 if (!((offset == UART_IER) && (value & UART_IER_UUE)))
 409                         writeb(value, up->port.membase + offset);
 410                 break;
 411
 412         case UPIO_DWAPB:
 413                 /* Save the LCR value so it can be re-written when a
 414                  * Busy Detect interrupt occurs. */
 415                 if (save_offset == UART_LCR)
 416                         up->lcr = value;
 417                 writeb(value, up->port.membase + offset);
 418                 /* Read the IER to ensure any interrupt is cleared before
 419                  * returning from ISR. */
 420                 if (save_offset == UART_TX || save_offset == UART_IER)
 421                         value = serial_in(up, UART_IER);
 422                 break;
 423
 424         default:
 425                 outb(value, up->port.iobase + offset);
 426         }
 427 }
 428
 429 static void
 430 serial_out_sync(struct uart_8250_port *up, int offset, int value)
 431 {
 432         switch (up->port.iotype) {
 433         case UPIO_MEM:
 434         case UPIO_MEM32:
 435 #ifdef CONFIG_SERIAL_8250_AU1X00
 436         case UPIO_AU:
 437 #endif
 438         case UPIO_DWAPB:
 439                 serial_out(up, offset, value);
 440                 serial_in(up, UART_LCR);        /* safe, no side-effects */
 441                 break;
 442         default:
 443                 serial_out(up, offset, value);
 444         }
 445 }
 446
 447 /*
 448  * We used to support using pause I/O for certain machines.  We
 449  * haven't supported this for a while, but just in case it's badly
 450  * needed for certain old 386 machines, I've left these #define's
 451  * in....
 452  */
 453 #define serial_inp(up, offset)          serial_in(up, offset)
 454 #define serial_outp(up, offset, value)  serial_out(up, offset, value)
 455
 456 /* Uart divisor latch read */
 457 static inline int _serial_dl_read(struct uart_8250_port *up)
 458 {
 459         return serial_inp(up, UART_DLL) | serial_inp(up, UART_DLM) << 8;
 460 }
 461
 462 /* Uart divisor latch write */
 463 static inline void _serial_dl_write(struct uart_8250_port *up, int value)
 464 {
 465         serial_outp(up, UART_DLL, value & 0xff);
 466         serial_outp(up, UART_DLM, value >> 8 & 0xff);
 467 }
 468
 469 #if defined (CONFIG_SERIAL_8250_AU1X00)
 470 /* Au1x00 haven't got a standard divisor latch */
 471 static int serial_dl_read(struct uart_8250_port *up)
 472 {
 473         if (up->port.iotype == UPIO_AU)
 474                 return __raw_readl(up->port.membase + 0x28);
 475         else
 476                 return _serial_dl_read(up);
 477 }
 478
 479 static void serial_dl_write(struct uart_8250_port *up, int value)
 480 {
 481         if (up->port.iotype == UPIO_AU)
 482                 __raw_writel(value, up->port.membase + 0x28);
 483         else
 484                 _serial_dl_write(up, value);
 485 }
 486 #elif defined (CONFIG_SERIAL_8250_RM9K)
 487 static int serial_dl_read(struct uart_8250_port *up)
 488 {
 489         return  (up->port.iotype == UPIO_RM9000) ?
 490                 (((__raw_readl(up->port.membase + 0x10) << 8) |
 491                 (__raw_readl(up->port.membase + 0x08) & 0xff)) & 0xffff) :
 492                 _serial_dl_read(up);
 493 }
 494
 495 static void serial_dl_write(struct uart_8250_port *up, int value)
 496 {
 497         if (up->port.iotype == UPIO_RM9000) {
 498                 __raw_writel(value, up->port.membase + 0x08);
 499                 __raw_writel(value >> 8, up->port.membase + 0x10);
 500         } else {
 501                 _serial_dl_write(up, value);
 502         }
 503 }
 504 #else
 505 #define serial_dl_read(up) _serial_dl_read(up)
 506 #define serial_dl_write(up, value) _serial_dl_write(up, value)
 507 #endif
 508
 509 /*
 510  * For the 16C950
 511  */
 512 static void serial_icr_write(struct uart_8250_port *up, int offset, int value)
 513 {
 514         serial_out(up, UART_SCR, offset);
 515         serial_out(up, UART_ICR, value);
 516 }
 517
 518 static unsigned int serial_icr_read(struct uart_8250_port *up, int offset)
 519 {
 520         unsigned int value;
 521
 522         serial_icr_write(up, UART_ACR, up->acr | UART_ACR_ICRRD);
 523         serial_out(up, UART_SCR, offset);
 524         value = serial_in(up, UART_ICR);
 525         serial_icr_write(up, UART_ACR, up->acr);
 526
 527         return value;
 528 }
 529
 530 /*
 531  * FIFO support.
 532  */
 533 static inline void serial8250_clear_fifos(struct uart_8250_port *p)
 534 {
 535         if (p->capabilities & UART_CAP_FIFO) {
 536                 serial_outp(p, UART_FCR, UART_FCR_ENABLE_FIFO);
 537                 serial_outp(p, UART_FCR, UART_FCR_ENABLE_FIFO |
 538                                UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
 539                 serial_outp(p, UART_FCR, 0);
 540         }
 541 }
 542
 543 /*
 544  * IER sleep support.  UARTs which have EFRs need the "extended
 545  * capability" bit enabled.  Note that on XR16C850s, we need to
 546  * reset LCR to write to IER.
 547  */
 548 static inline void serial8250_set_sleep(struct uart_8250_port *p, int sleep)
 549 {
 550         if (p->capabilities & UART_CAP_SLEEP) {
 551                 if (p->capabilities & UART_CAP_EFR) {
 552                         serial_outp(p, UART_LCR, 0xBF);
 553                         serial_outp(p, UART_EFR, UART_EFR_ECB);
 554                         serial_outp(p, UART_LCR, 0);
 555                 }
 556                 serial_outp(p, UART_IER, sleep ? UART_IERX_SLEEP : 0);
 557                 if (p->capabilities & UART_CAP_EFR) {
 558                         serial_outp(p, UART_LCR, 0xBF);
 559                         serial_outp(p, UART_EFR, 0);
 560                         serial_outp(p, UART_LCR, 0);
 561                 }
 562         }
 563 }
 564
 565 #ifdef CONFIG_SERIAL_8250_RSA
 566 /*
 567  * Attempts to turn on the RSA FIFO.  Returns zero on failure.
 568  * We set the port uart clock rate if we succeed.
 569  */
 570 static int __enable_rsa(struct uart_8250_port *up)
 571 {
 572         unsigned char mode;
 573         int result;
 574
 575         mode = serial_inp(up, UART_RSA_MSR);
 576         result = mode & UART_RSA_MSR_FIFO;
 577
 578         if (!result) {
 579                 serial_outp(up, UART_RSA_MSR, mode | UART_RSA_MSR_FIFO);
 580                 mode = serial_inp(up, UART_RSA_MSR);
 581                 result = mode & UART_RSA_MSR_FIFO;
 582         }
 583
 584         if (result)
 585                 up->port.uartclk = SERIAL_RSA_BAUD_BASE * 16;
 586
 587         return result;
 588 }
 589
 590 static void enable_rsa(struct uart_8250_port *up)
 591 {
 592         if (up->port.type == PORT_RSA) {
 593                 if (up->port.uartclk != SERIAL_RSA_BAUD_BASE * 16) {
 594                         spin_lock_irq(&up->port.lock);
 595                         __enable_rsa(up);
 596                         spin_unlock_irq(&up->port.lock);
 597                 }
 598                 if (up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16)
 599                         serial_outp(up, UART_RSA_FRR, 0);
 600         }
 601 }
 602
 603 /*
 604  * Attempts to turn off the RSA FIFO.  Returns zero on failure.
 605  * It is unknown why interrupts were disabled in here.  However,
 606  * the caller is expected to preserve this behaviour by grabbing
 607  * the spinlock before calling this function.
 608  */
 609 static void disable_rsa(struct uart_8250_port *up)
 610 {
 611         unsigned char mode;
 612         int result;
 613
 614         if (up->port.type == PORT_RSA &&
 615             up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16) {
 616                 spin_lock_irq(&up->port.lock);
 617
 618                 mode = serial_inp(up, UART_RSA_MSR);
 619                 result = !(mode & UART_RSA_MSR_FIFO);
 620
 621                 if (!result) {
 622                         serial_outp(up, UART_RSA_MSR, mode & ~UART_RSA_MSR_FIFO);
 623                         mode = serial_inp(up, UART_RSA_MSR);
 624                         result = !(mode & UART_RSA_MSR_FIFO);
 625                 }
 626
 627                 if (result)
 628                         up->port.uartclk = SERIAL_RSA_BAUD_BASE_LO * 16;
 629                 spin_unlock_irq(&up->port.lock);
 630         }
 631 }
 632 #endif /* CONFIG_SERIAL_8250_RSA */
 633
 634 /*
 635  * This is a quickie test to see how big the FIFO is.
 636  * It doesn't work at all the time, more's the pity.
 637  */
 638 static int size_fifo(struct uart_8250_port *up)
 639 {
 640         unsigned char old_fcr, old_mcr, old_lcr;
 641         unsigned short old_dl;
 642         int count;
 643
 644         old_lcr = serial_inp(up, UART_LCR);
 645         serial_outp(up, UART_LCR, 0);
 646         old_fcr = serial_inp(up, UART_FCR);
 647         old_mcr = serial_inp(up, UART_MCR);
 648         serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO |
 649                     UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
 650         serial_outp(up, UART_MCR, UART_MCR_LOOP);
 651         serial_outp(up, UART_LCR, UART_LCR_DLAB);
 652         old_dl = serial_dl_read(up);
 653         serial_dl_write(up, 0x0001);
 654         serial_outp(up, UART_LCR, 0x03);
 655         for (count = 0; count < 256; count++)
 656                 serial_outp(up, UART_TX, count);
 657         mdelay(20);/* FIXME - schedule_timeout */
 658         for (count = 0; (serial_inp(up, UART_LSR) & UART_LSR_DR) &&
 659              (count < 256); count++)
 660                 serial_inp(up, UART_RX);
 661         serial_outp(up, UART_FCR, old_fcr);
 662         serial_outp(up, UART_MCR, old_mcr);
 663         serial_outp(up, UART_LCR, UART_LCR_DLAB);
 664         serial_dl_write(up, old_dl);
 665         serial_outp(up, UART_LCR, old_lcr);
 666
 667         return count;
 668 }
 669
 670 /*
 671  * Read UART ID using the divisor method - set DLL and DLM to zero
 672  * and the revision will be in DLL and device type in DLM.  We
 673  * preserve the device state across this.
 674  */
 675 static unsigned int autoconfig_read_divisor_id(struct uart_8250_port *p)
 676 {
 677         unsigned char old_dll, old_dlm, old_lcr;
 678         unsigned int id;
 679
 680         old_lcr = serial_inp(p, UART_LCR);
 681         serial_outp(p, UART_LCR, UART_LCR_DLAB);
 682
 683         old_dll = serial_inp(p, UART_DLL);
 684         old_dlm = serial_inp(p, UART_DLM);
 685
 686         serial_outp(p, UART_DLL, 0);
 687         serial_outp(p, UART_DLM, 0);
 688
 689         id = serial_inp(p, UART_DLL) | serial_inp(p, UART_DLM) << 8;
 690
 691         serial_outp(p, UART_DLL, old_dll);
 692         serial_outp(p, UART_DLM, old_dlm);
 693         serial_outp(p, UART_LCR, old_lcr);
 694
 695         return id;
 696 }
 697
 698 /*
 699  * This is a helper routine to autodetect StarTech/Exar/Oxsemi UART's.
 700  * When this function is called we know it is at least a StarTech
 701  * 16650 V2, but it might be one of several StarTech UARTs, or one of
 702  * its clones.  (We treat the broken original StarTech 16650 V1 as a
 703  * 16550, and why not?  Startech doesn't seem to even acknowledge its
 704  * existence.)
 705  *
 706  * What evil have men's minds wrought...
 707  */
 708 static void autoconfig_has_efr(struct uart_8250_port *up)
 709 {
 710         unsigned int id1, id2, id3, rev;
 711
 712         /*
 713          * Everything with an EFR has SLEEP
 714          */
 715         up->capabilities |= UART_CAP_EFR | UART_CAP_SLEEP;
 716
 717         /*
 718          * First we check to see if it's an Oxford Semiconductor UART.
 719          *
 720          * If we have to do this here because some non-National
 721          * Semiconductor clone chips lock up if you try writing to the
 722          * LSR register (which serial_icr_read does)
 723          */
 724
 725         /*
 726          * Check for Oxford Semiconductor 16C950.
 727          *
 728          * EFR [4] must be set else this test fails.
 729          *
 730          * This shouldn't be necessary, but Mike Hudson (Exoray@isys.ca)
 731          * claims that it's needed for 952 dual UART's (which are not
 732          * recommended for new designs).
 733          */
 734         up->acr = 0;
 735         serial_out(up, UART_LCR, 0xBF);
 736         serial_out(up, UART_EFR, UART_EFR_ECB);
 737         serial_out(up, UART_LCR, 0x00);
 738         id1 = serial_icr_read(up, UART_ID1);
 739         id2 = serial_icr_read(up, UART_ID2);
 740         id3 = serial_icr_read(up, UART_ID3);
 741         rev = serial_icr_read(up, UART_REV);
 742
 743         DEBUG_AUTOCONF("950id=%02x:%02x:%02x:%02x ", id1, id2, id3, rev);
 744
 745         if (id1 == 0x16 && id2 == 0xC9 &&
 746             (id3 == 0x50 || id3 == 0x52 || id3 == 0x54)) {
 747                 up->port.type = PORT_16C950;
 748
 749                 /*
 750                  * Enable work around for the Oxford Semiconductor 952 rev B
 751                  * chip which causes it to seriously miscalculate baud rates
 752                  * when DLL is 0.
 753                  */
 754                 if (id3 == 0x52 && rev == 0x01)
 755                         up->bugs |= UART_BUG_QUOT;
 756                 return;
 757         }
 758
 759         /*
 760          * We check for a XR16C850 by setting DLL and DLM to 0, and then
 761          * reading back DLL and DLM.  The chip type depends on the DLM
 762          * value read back:
 763          *  0x10 - XR16C850 and the DLL contains the chip revision.
 764          *  0x12 - XR16C2850.
 765          *  0x14 - XR16C854.
 766          */
 767         id1 = autoconfig_read_divisor_id(up);
 768         DEBUG_AUTOCONF("850id=%04x ", id1);
 769
 770         id2 = id1 >> 8;
 771         if (id2 == 0x10 || id2 == 0x12 || id2 == 0x14) {
 772                 up->port.type = PORT_16850;
 773                 return;
 774         }
 775
 776         /*
 777          * It wasn't an XR16C850.
 778          *
 779          * We distinguish between the '654 and the '650 by counting
 780          * how many bytes are in the FIFO.  I'm using this for now,
 781          * since that's the technique that was sent to me in the
 782          * serial driver update, but I'm not convinced this works.
 783          * I've had problems doing this in the past.  -TYT
 784          */
 785         if (size_fifo(up) == 64)
 786                 up->port.type = PORT_16654;
 787         else
 788                 up->port.type = PORT_16650V2;
 789 }
 790
 791 /*
 792  * We detected a chip without a FIFO.  Only two fall into
 793  * this category - the original 8250 and the 16450.  The
 794  * 16450 has a scratch register (accessible with LCR=0)
 795  */
 796 static void autoconfig_8250(struct uart_8250_port *up)
 797 {
 798         unsigned char scratch, status1, status2;
 799
 800         up->port.type = PORT_8250;
 801
 802         scratch = serial_in(up, UART_SCR);
 803         serial_outp(up, UART_SCR, 0xa5);
 804         status1 = serial_in(up, UART_SCR);
 805         serial_outp(up, UART_SCR, 0x5a);
 806         status2 = serial_in(up, UART_SCR);
 807         serial_outp(up, UART_SCR, scratch);
 808
 809         if (status1 == 0xa5 && status2 == 0x5a)
 810                 up->port.type = PORT_16450;
 811 }
 812
 813 static int broken_efr(struct uart_8250_port *up)
 814 {
 815         /*
 816          * Exar ST16C2550 "A2" devices incorrectly detect as
 817          * having an EFR, and report an ID of 0x0201.  See
 818          * http://www.exar.com/info.php?pdf=dan180_oct2004.pdf
 819          */
 820         if (autoconfig_read_divisor_id(up) == 0x0201 && size_fifo(up) == 16)
 821                 return 1;
 822
 823         return 0;
 824 }
 825
 826 /*
 827  * We know that the chip has FIFOs.  Does it have an EFR?  The
 828  * EFR is located in the same register position as the IIR and
 829  * we know the top two bits of the IIR are currently set.  The
 830  * EFR should contain zero.  Try to read the EFR.
 831  */
 832 static void autoconfig_16550a(struct uart_8250_port *up)
 833 {
 834         unsigned char status1, status2;
 835         unsigned int iersave;
 836
 837         up->port.type = PORT_16550A;
 838         up->capabilities |= UART_CAP_FIFO;
 839
 840         /*
 841          * Check for presence of the EFR when DLAB is set.
 842          * Only ST16C650V1 UARTs pass this test.
 843          */
 844         serial_outp(up, UART_LCR, UART_LCR_DLAB);
 845         if (serial_in(up, UART_EFR) == 0) {
 846                 serial_outp(up, UART_EFR, 0xA8);
 847                 if (serial_in(up, UART_EFR) != 0) {
 848                         DEBUG_AUTOCONF("EFRv1 ");
 849                         up->port.type = PORT_16650;
 850                         up->capabilities |= UART_CAP_EFR | UART_CAP_SLEEP;
 851                 } else {
 852                         DEBUG_AUTOCONF("Motorola 8xxx DUART ");
 853                 }
 854                 serial_outp(up, UART_EFR, 0);
 855                 return;
 856         }
 857
 858         /*
 859          * Maybe it requires 0xbf to be written to the LCR.
 860          * (other ST16C650V2 UARTs, TI16C752A, etc)
 861          */
 862         serial_outp(up, UART_LCR, 0xBF);
 863         if (serial_in(up, UART_EFR) == 0 && !broken_efr(up)) {
 864                 DEBUG_AUTOCONF("EFRv2 ");
 865                 autoconfig_has_efr(up);
 866                 return;
 867         }
 868
 869         /*
 870          * Check for a National Semiconductor SuperIO chip.
 871          * Attempt to switch to bank 2, read the value of the LOOP bit
 872          * from EXCR1. Switch back to bank 0, change it in MCR. Then
 873          * switch back to bank 2, read it from EXCR1 again and check
 874          * it's changed. If so, set baud_base in EXCR2 to 921600. -- dwmw2
 875          */
 876         serial_outp(up, UART_LCR, 0);
 877         status1 = serial_in(up, UART_MCR);
 878         serial_outp(up, UART_LCR, 0xE0);
 879         status2 = serial_in(up, 0x02); /* EXCR1 */
 880
 881         if (!((status2 ^ status1) & UART_MCR_LOOP)) {
 882                 serial_outp(up, UART_LCR, 0);
 883                 serial_outp(up, UART_MCR, status1 ^ UART_MCR_LOOP);
 884                 serial_outp(up, UART_LCR, 0xE0);
 885                 status2 = serial_in(up, 0x02); /* EXCR1 */
 886                 serial_outp(up, UART_LCR, 0);
 887                 serial_outp(up, UART_MCR, status1);
 888
 889                 if ((status2 ^ status1) & UART_MCR_LOOP) {
 890                         unsigned short quot;
 891
 892                         serial_outp(up, UART_LCR, 0xE0);
 893
 894                         quot = serial_dl_read(up);
 895                         quot <<= 3;
 896
 897                         status1 = serial_in(up, 0x04); /* EXCR2 */
 898                         status1 &= ~0xB0; /* Disable LOCK, mask out PRESL[01] */
 899                         status1 |= 0x10;  /* 1.625 divisor for baud_base --> 921600 */
 900                         serial_outp(up, 0x04, status1);
 901
 902                         serial_dl_write(up, quot);
 903
 904                         serial_outp(up, UART_LCR, 0);
 905
 906                         up->port.uartclk = 921600*16;
 907                         up->port.type = PORT_NS16550A;
 908                         up->capabilities |= UART_NATSEMI;
 909                         return;
 910                 }
 911         }
 912
 913         /*
 914          * No EFR.  Try to detect a TI16750, which only sets bit 5 of
 915          * the IIR when 64 byte FIFO mode is enabled when DLAB is set.
 916          * Try setting it with and without DLAB set.  Cheap clones
 917          * set bit 5 without DLAB set.
 918          */
 919         serial_outp(up, UART_LCR, 0);
 920         serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR7_64BYTE);
 921         status1 = serial_in(up, UART_IIR) >> 5;
 922         serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
 923         serial_outp(up, UART_LCR, UART_LCR_DLAB);
 924         serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR7_64BYTE);
 925         status2 = serial_in(up, UART_IIR) >> 5;
 926         serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
 927         serial_outp(up, UART_LCR, 0);
 928
 929         DEBUG_AUTOCONF("iir1=%d iir2=%d ", status1, status2);
 930
 931         if (status1 == 6 && status2 == 7) {
 932                 up->port.type = PORT_16750;
 933                 up->capabilities |= UART_CAP_AFE | UART_CAP_SLEEP;
 934                 return;
 935         }
 936
 937         /*
 938          * Try writing and reading the UART_IER_UUE bit (b6).
 939          * If it works, this is probably one of the Xscale platform's
 940          * internal UARTs.
 941          * We're going to explicitly set the UUE bit to 0 before
 942          * trying to write and read a 1 just to make sure it's not
 943          * already a 1 and maybe locked there before we even start start.
 944          */
 945         iersave = serial_in(up, UART_IER);
 946         serial_outp(up, UART_IER, iersave & ~UART_IER_UUE);
 947         if (!(serial_in(up, UART_IER) & UART_IER_UUE)) {
 948                 /*
 949                  * OK it's in a known zero state, try writing and reading
 950                  * without disturbing the current state of the other bits.
 951                  */
 952                 serial_outp(up, UART_IER, iersave | UART_IER_UUE);
 953                 if (serial_in(up, UART_IER) & UART_IER_UUE) {
 954                         /*
 955                          * It's an Xscale.
 956                          * We'll leave the UART_IER_UUE bit set to 1 (enabled).
 957                          */
 958                         DEBUG_AUTOCONF("Xscale ");
 959                         up->port.type = PORT_XSCALE;
 960                         up->capabilities |= UART_CAP_UUE;
 961                         return;
 962                 }
 963         } else {
 964                 /*
 965                  * If we got here we couldn't force the IER_UUE bit to 0.
 966                  * Log it and continue.
 967                  */
 968                 DEBUG_AUTOCONF("Couldn't force IER_UUE to 0 ");
 969         }
 970         serial_outp(up, UART_IER, iersave);
 971 }
 972
 973 /*
 974  * This routine is called by rs_init() to initialize a specific serial
 975  * port.  It determines what type of UART chip this serial port is
 976  * using: 8250, 16450, 16550, 16550A.  The important question is
 977  * whether or not this UART is a 16550A or not, since this will
 978  * determine whether or not we can use its FIFO features or not.
 979  */
 980 static void autoconfig(struct uart_8250_port *up, unsigned int probeflags)
 981 {
 982         unsigned char status1, scratch, scratch2, scratch3;
 983         unsigned char save_lcr, save_mcr;
 984         unsigned long flags;
 985
 986         if (!up->port.iobase && !up->port.mapbase && !up->port.membase)
 987                 return;
 988
 989         DEBUG_AUTOCONF("ttyS%d: autoconf (0x%04x, 0x%p): ",
 990                         up->port.line, up->port.iobase, up->port.membase);
 991
 992         /*
 993          * We really do need global IRQs disabled here - we're going to
 994          * be frobbing the chips IRQ enable register to see if it exists.
 995          */
 996         spin_lock_irqsave(&up->port.lock, flags);
 997
 998         up->capabilities = 0;
 999         up->bugs = 0;
1000
1001         if (!(up->port.flags & UPF_BUGGY_UART)) {
1002                 /*
1003                  * Do a simple existence test first; if we fail this,
1004                  * there's no point trying anything else.
1005                  *
1006                  * 0x80 is used as a nonsense port to prevent against
1007                  * false positives due to ISA bus float.  The
1008                  * assumption is that 0x80 is a non-existent port;
1009                  * which should be safe since include/asm/io.h also
1010                  * makes this assumption.
1011                  *
1012                  * Note: this is safe as long as MCR bit 4 is clear
1013                  * and the device is in "PC" mode.
1014                  */
1015                 scratch = serial_inp(up, UART_IER);
1016                 serial_outp(up, UART_IER, 0);
1017 #ifdef __i386__
1018                 outb(0xff, 0x080);
1019 #endif
1020                 /*
1021                  * Mask out IER[7:4] bits for test as some UARTs (e.g. TL
1022                  * 16C754B) allow only to modify them if an EFR bit is set.
1023                  */
1024                 scratch2 = serial_inp(up, UART_IER) & 0x0f;
1025                 serial_outp(up, UART_IER, 0x0F);
1026 #ifdef __i386__
1027                 outb(0, 0x080);
1028 #endif
1029                 scratch3 = serial_inp(up, UART_IER) & 0x0f;
1030                 serial_outp(up, UART_IER, scratch);
1031                 if (scratch2 != 0 || scratch3 != 0x0F) {
1032                         /*
1033                          * We failed; there's nothing here
1034                          */
1035                         DEBUG_AUTOCONF("IER test failed (%02x, %02x) ",
1036                                        scratch2, scratch3);
1037                         goto out;
1038                 }
1039         }
1040
1041         save_mcr = serial_in(up, UART_MCR);
1042         save_lcr = serial_in(up, UART_LCR);
1043
1044         /*
1045          * Check to see if a UART is really there.  Certain broken
1046          * internal modems based on the Rockwell chipset fail this
1047          * test, because they apparently don't implement the loopback
1048          * test mode.  So this test is skipped on the COM 1 through
1049          * COM 4 ports.  This *should* be safe, since no board
1050          * manufacturer would be stupid enough to design a board
1051          * that conflicts with COM 1-4 --- we hope!
1052          */
1053         if (!(up->port.flags & UPF_SKIP_TEST)) {
1054                 serial_outp(up, UART_MCR, UART_MCR_LOOP | 0x0A);
1055                 status1 = serial_inp(up, UART_MSR) & 0xF0;
1056                 serial_outp(up, UART_MCR, save_mcr);
1057                 if (status1 != 0x90) {
1058                         DEBUG_AUTOCONF("LOOP test failed (%02x) ",
1059                                        status1);
1060                         goto out;
1061                 }
1062         }
1063
1064         /*
1065          * We're pretty sure there's a port here.  Lets find out what
1066          * type of port it is.  The IIR top two bits allows us to find
1067          * out if it's 8250 or 16450, 16550, 16550A or later.  This
1068          * determines what we test for next.
1069          *
1070          * We also initialise the EFR (if any) to zero for later.  The
1071          * EFR occupies the same register location as the FCR and IIR.
1072          */
1073         serial_outp(up, UART_LCR, 0xBF);
1074         serial_outp(up, UART_EFR, 0);
1075         serial_outp(up, UART_LCR, 0);
1076
1077         serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
1078         scratch = serial_in(up, UART_IIR) >> 6;
1079
1080         DEBUG_AUTOCONF("iir=%d ", scratch);
1081
1082         switch (scratch) {
1083         case 0:
1084                 autoconfig_8250(up);
1085                 break;
1086         case 1:
1087                 up->port.type = PORT_UNKNOWN;
1088                 break;
1089         case 2:
1090                 up->port.type = PORT_16550;
1091                 break;
1092         case 3:
1093                 autoconfig_16550a(up);
1094                 break;
1095         }
1096
1097 #ifdef CONFIG_SERIAL_8250_RSA
1098         /*
1099          * Only probe for RSA ports if we got the region.
1100          */
1101         if (up->port.type == PORT_16550A && probeflags & PROBE_RSA) {
1102                 int i;
1103
1104                 for (i = 0 ; i < probe_rsa_count; ++i) {
1105                         if (probe_rsa[i] == up->port.iobase &&
1106                             __enable_rsa(up)) {
1107                                 up->port.type = PORT_RSA;
1108                                 break;
1109                         }
1110                 }
1111         }
1112 #endif
1113
1114 #ifdef CONFIG_SERIAL_8250_AU1X00
1115         /* if access method is AU, it is a 16550 with a quirk */
1116         if (up->port.type == PORT_16550A && up->port.iotype == UPIO_AU)
1117                 up->bugs |= UART_BUG_NOMSR;
1118 #endif
1119
1120         serial_outp(up, UART_LCR, save_lcr);
1121
1122         if (up->capabilities != uart_config[up->port.type].flags) {
1123                 printk(KERN_WARNING
1124                        "ttyS%d: detected caps %08x should be %08x\n",
1125                         up->port.line, up->capabilities,
1126                         uart_config[up->port.type].flags);
1127         }
1128
1129         up->port.fifosize = uart_config[up->port.type].fifo_size;
1130         up->capabilities = uart_config[up->port.type].flags;
1131         up->tx_loadsz = uart_config[up->port.type].tx_loadsz;
1132
1133         if (up->port.type == PORT_UNKNOWN)
1134                 goto out;
1135
1136         /*
1137          * Reset the UART.
1138          */
1139 #ifdef CONFIG_SERIAL_8250_RSA
1140         if (up->port.type == PORT_RSA)
1141                 serial_outp(up, UART_RSA_FRR, 0);
1142 #endif
1143         serial_outp(up, UART_MCR, save_mcr);
1144         serial8250_clear_fifos(up);
1145         serial_in(up, UART_RX);
1146         if (up->capabilities & UART_CAP_UUE)
1147                 serial_outp(up, UART_IER, UART_IER_UUE);
1148         else
1149                 serial_outp(up, UART_IER, 0);
1150
1151  out:
1152         spin_unlock_irqrestore(&up->port.lock, flags);
1153         DEBUG_AUTOCONF("type=%s\n", uart_config[up->port.type].name);
1154 }
1155
1156 static void autoconfig_irq(struct uart_8250_port *up)
1157 {
1158         unsigned char save_mcr, save_ier;
1159         unsigned char save_ICP = 0;
1160         unsigned int ICP = 0;
1161         unsigned long irqs;
1162         int irq;
1163
1164         if (up->port.flags & UPF_FOURPORT) {
1165                 ICP = (up->port.iobase & 0xfe0) | 0x1f;
1166                 save_ICP = inb_p(ICP);
1167                 outb_p(0x80, ICP);
1168                 (void) inb_p(ICP);
1169         }
1170
1171         /* forget possible initially masked and pending IRQ */
1172         probe_irq_off(probe_irq_on());
1173         save_mcr = serial_inp(up, UART_MCR);
1174         save_ier = serial_inp(up, UART_IER);
1175         serial_outp(up, UART_MCR, UART_MCR_OUT1 | UART_MCR_OUT2);
1176
1177         irqs = probe_irq_on();
1178         serial_outp(up, UART_MCR, 0);
1179         udelay (10);
1180         if (up->port.flags & UPF_FOURPORT)  {
1181                 serial_outp(up, UART_MCR,
1182                             UART_MCR_DTR | UART_MCR_RTS);
1183         } else {
1184                 serial_outp(up, UART_MCR,
1185                             UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2);
1186         }
1187         serial_outp(up, UART_IER, 0x0f);        /* enable all intrs */
1188         (void)serial_inp(up, UART_LSR);
1189         (void)serial_inp(up, UART_RX);
1190         (void)serial_inp(up, UART_IIR);
1191         (void)serial_inp(up, UART_MSR);
1192         serial_outp(up, UART_TX, 0xFF);
1193         udelay (20);
1194         irq = probe_irq_off(irqs);
1195
1196         serial_outp(up, UART_MCR, save_mcr);
1197         serial_outp(up, UART_IER, save_ier);
1198
1199         if (up->port.flags & UPF_FOURPORT)
1200                 outb_p(save_ICP, ICP);
1201
1202         up->port.irq = (irq > 0) ? irq : 0;
1203 }
1204
1205 static inline void __stop_tx(struct uart_8250_port *p)
1206 {
1207         if (p->ier & UART_IER_THRI) {
1208                 p->ier &= ~UART_IER_THRI;
1209                 serial_out(p, UART_IER, p->ier);
1210         }
1211 }
1212
1213 static void serial8250_stop_tx(struct uart_port *port)
1214 {
1215         struct uart_8250_port *up = (struct uart_8250_port *)port;
1216
1217         __stop_tx(up);
1218
1219         /*
1220          * We really want to stop the transmitter from sending.
1221          */
1222         if (up->port.type == PORT_16C950) {
1223                 up->acr |= UART_ACR_TXDIS;
1224                 serial_icr_write(up, UART_ACR, up->acr);
1225         }
1226 }
1227
1228 static void transmit_chars(struct uart_8250_port *up);
1229
1230 static void serial8250_start_tx(struct uart_port *port)
1231 {
1232         struct uart_8250_port *up = (struct uart_8250_port *)port;
1233
1234         if (!(up->ier & UART_IER_THRI)) {
1235                 up->ier |= UART_IER_THRI;
1236                 serial_out(up, UART_IER, up->ier);
1237
1238                 if (up->bugs & UART_BUG_TXEN) {
1239                         unsigned char lsr, iir;
1240                         lsr = serial_in(up, UART_LSR);
1241                         iir = serial_in(up, UART_IIR) & 0x0f;
1242                         if ((up->port.type == PORT_RM9000) ?
1243                                 (lsr & UART_LSR_THRE &&
1244                                 (iir == UART_IIR_NO_INT || iir == UART_IIR_THRI)) :
1245                                 (lsr & UART_LSR_TEMT && iir & UART_IIR_NO_INT))
1246                                 transmit_chars(up);
1247                 }
1248         }
1249
1250         /*
1251          * Re-enable the transmitter if we disabled it.
1252          */
1253         if (up->port.type == PORT_16C950 && up->acr & UART_ACR_TXDIS) {
1254                 up->acr &= ~UART_ACR_TXDIS;
1255                 serial_icr_write(up, UART_ACR, up->acr);
1256         }
1257 }
1258
1259 static void serial8250_stop_rx(struct uart_port *port)
1260 {
1261         struct uart_8250_port *up = (struct uart_8250_port *)port;
1262
1263         up->ier &= ~UART_IER_RLSI;
1264         up->port.read_status_mask &= ~UART_LSR_DR;
1265         serial_out(up, UART_IER, up->ier);
1266 }
1267
1268 static void serial8250_enable_ms(struct uart_port *port)
1269 {
1270         struct uart_8250_port *up = (struct uart_8250_port *)port;
1271
1272         /* no MSR capabilities */
1273         if (up->bugs & UART_BUG_NOMSR)
1274                 return;
1275
1276         up->ier |= UART_IER_MSI;
1277         serial_out(up, UART_IER, up->ier);
1278 }
1279
1280 static void
1281 receive_chars(struct uart_8250_port *up, unsigned int *status)
1282 {
1283         struct tty_struct *tty = up->port.info->tty;
1284         unsigned char ch, lsr = *status;
1285         int max_count = 256;
1286         char flag;
1287
1288         do {
1289                 ch = serial_inp(up, UART_RX);
1290                 flag = TTY_NORMAL;
1291                 up->port.icount.rx++;
1292
1293 #ifdef CONFIG_SERIAL_8250_CONSOLE
1294                 /*
1295                  * Recover the break flag from console xmit
1296                  */
1297                 if (up->port.line == up->port.cons->index) {
1298                         lsr |= up->lsr_break_flag;
1299                         up->lsr_break_flag = 0;
1300                 }
1301 #endif
1302
1303                 if (unlikely(lsr & (UART_LSR_BI | UART_LSR_PE |
1304                                     UART_LSR_FE | UART_LSR_OE))) {
1305                         /*
1306                          * For statistics only
1307                          */
1308                         if (lsr & UART_LSR_BI) {
1309                                 lsr &= ~(UART_LSR_FE | UART_LSR_PE);
1310                                 up->port.icount.brk++;
1311                                 /*
1312                                  * We do the SysRQ and SAK checking
1313                                  * here because otherwise the break
1314                                  * may get masked by ignore_status_mask
1315                                  * or read_status_mask.
1316                                  */
1317                                 if (uart_handle_break(&up->port))
1318                                         goto ignore_char;
1319                         } else if (lsr & UART_LSR_PE)
1320                                 up->port.icount.parity++;
1321                         else if (lsr & UART_LSR_FE)
1322                                 up->port.icount.frame++;
1323                         if (lsr & UART_LSR_OE)
1324                                 up->port.icount.overrun++;
1325
1326                         /*
1327                          * Mask off conditions which should be ignored.
1328                          */
1329                         lsr &= up->port.read_status_mask;
1330
1331                         if (lsr & UART_LSR_BI) {
1332                                 DEBUG_INTR("handling break....");
1333                                 flag = TTY_BREAK;
1334                         } else if (lsr & UART_LSR_PE)
1335                                 flag = TTY_PARITY;
1336                         else if (lsr & UART_LSR_FE)
1337                                 flag = TTY_FRAME;
1338                 }
1339                 if (uart_handle_sysrq_char(&up->port, ch))
1340                         goto ignore_char;
1341
1342                 uart_insert_char(&up->port, lsr, UART_LSR_OE, ch, flag);
1343
1344         ignore_char:
1345                 lsr = serial_inp(up, UART_LSR);
1346         } while ((lsr & UART_LSR_DR) && (max_count-- > 0));
1347         spin_unlock(&up->port.lock);
1348         tty_flip_buffer_push(tty);
1349         spin_lock(&up->port.lock);
1350         *status = lsr;
1351 }
1352
1353 static void transmit_chars(struct uart_8250_port *up)
1354 {
1355         struct circ_buf *xmit = &up->port.info->xmit;
1356         int count;
1357
1358         if (up->port.x_char) {
1359                 serial_outp(up, UART_TX, up->port.x_char);
1360                 up->port.icount.tx++;
1361                 up->port.x_char = 0;
1362                 return;
1363         }
1364         if (uart_tx_stopped(&up->port)) {
1365                 serial8250_stop_tx(&up->port);
1366                 return;
1367         }
1368         if (uart_circ_empty(xmit)) {
1369                 __stop_tx(up);
1370                 return;
1371         }
1372
1373         count = up->tx_loadsz;
1374         do {
1375                 serial_out(up, UART_TX, xmit->buf[xmit->tail]);
1376                 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
1377                 up->port.icount.tx++;
1378                 if (uart_circ_empty(xmit))
1379                         break;
1380         } while (--count > 0);
1381
1382         if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
1383                 uart_write_wakeup(&up->port);
1384
1385         DEBUG_INTR("THRE...");
1386
1387         if (uart_circ_empty(xmit))
1388                 __stop_tx(up);
1389 }
1390
1391 static unsigned int check_modem_status(struct uart_8250_port *up)
1392 {
1393         unsigned int status = serial_in(up, UART_MSR);
1394
1395         if (status & UART_MSR_ANY_DELTA && up->ier & UART_IER_MSI &&
1396             up->port.info != NULL) {
1397                 if (status & UART_MSR_TERI)
1398                         up->port.icount.rng++;
1399                 if (status & UART_MSR_DDSR)
1400                         up->port.icount.dsr++;
1401                 if (status & UART_MSR_DDCD)
1402                         uart_handle_dcd_change(&up->port, status & UART_MSR_DCD);
1403                 if (status & UART_MSR_DCTS)
1404                         uart_handle_cts_change(&up->port, status & UART_MSR_CTS);
1405
1406                 wake_up_interruptible(&up->port.info->delta_msr_wait);
1407         }
1408
1409         return status;
1410 }
1411
1412 /*
1413  * This handles the interrupt from one port.
1414  */
1415 static inline void
1416 serial8250_handle_port(struct uart_8250_port *up)
1417 {
1418         unsigned int status;
1419         unsigned long flags;
1420
1421         spin_lock_irqsave(&up->port.lock, flags);
1422
1423         status = serial_inp(up, UART_LSR);
1424
1425         DEBUG_INTR("status = %x...", status);
1426
1427         if (status & UART_LSR_DR)
1428                 receive_chars(up, &status);
1429         check_modem_status(up);
1430         if (status & UART_LSR_THRE)
1431                 transmit_chars(up);
1432
1433         spin_unlock_irqrestore(&up->port.lock, flags);
1434 }
1435
1436 /*
1437  * This is the serial driver's interrupt routine.
1438  *
1439  * Arjan thinks the old way was overly complex, so it got simplified.
1440  * Alan disagrees, saying that need the complexity to handle the weird
1441  * nature of ISA shared interrupts.  (This is a special exception.)
1442  *
1443  * In order to handle ISA shared interrupts properly, we need to check
1444  * that all ports have been serviced, and therefore the ISA interrupt
1445  * line has been de-asserted.
1446  *
1447  * This means we need to loop through all ports. checking that they
1448  * don't have an interrupt pending.
1449  */
1450 static irqreturn_t serial8250_interrupt(int irq, void *dev_id)
1451 {
1452         struct irq_info *i = dev_id;
1453         struct list_head *l, *end = NULL;
1454         int pass_counter = 0, handled = 0;
1455
1456         DEBUG_INTR("serial8250_interrupt(%d)...", irq);
1457
1458         spin_lock(&i->lock);
1459
1460         l = i->head;
1461         do {
1462                 struct uart_8250_port *up;
1463                 unsigned int iir;
1464
1465                 up = list_entry(l, struct uart_8250_port, list);
1466
1467                 iir = serial_in(up, UART_IIR);
1468                 if (!(iir & UART_IIR_NO_INT)) {
1469                         serial8250_handle_port(up);
1470
1471                         handled = 1;
1472
1473                         end = NULL;
1474                 } else if (up->port.iotype == UPIO_DWAPB &&
1475                           (iir & UART_IIR_BUSY) == UART_IIR_BUSY) {
1476                         /* The DesignWare APB UART has an Busy Detect (0x07)
1477                          * interrupt meaning an LCR write attempt occured while the
1478                          * UART was busy. The interrupt must be cleared by reading
1479                          * the UART status register (USR) and the LCR re-written. */
1480                         unsigned int status;
1481                         status = *(volatile u32 *)up->port.private_data;
1482                         serial_out(up, UART_LCR, up->lcr);
1483
1484                         handled = 1;
1485
1486                         end = NULL;
1487                 } else if (end == NULL)
1488                         end = l;
1489
1490                 l = l->next;
1491
1492                 if (l == i->head && pass_counter++ > PASS_LIMIT) {
1493                         /* If we hit this, we're dead. */
1494                         printk(KERN_ERR "serial8250: too much work for "
1495                                 "irq%d\n", irq);
1496                         break;
1497                 }
1498         } while (l != end);
1499
1500         spin_unlock(&i->lock);
1501
1502         DEBUG_INTR("end.\n");
1503
1504 #ifdef CONFIG_ARCH_OMAP15XX
1505         return IRQ_HANDLED;     /* FIXME: iir status not ready on 1510 */
1506 #else
1507         return IRQ_RETVAL(handled);
1508 #endif
1509 }
1510
1511 /*
1512  * To support ISA shared interrupts, we need to have one interrupt
1513  * handler that ensures that the IRQ line has been deasserted
1514  * before returning.  Failing to do this will result in the IRQ
1515  * line being stuck active, and, since ISA irqs are edge triggered,
1516  * no more IRQs will be seen.
1517  */
1518 static void serial_do_unlink(struct irq_info *i, struct uart_8250_port *up)
1519 {
1520         spin_lock_irq(&i->lock);
1521
1522         if (!list_empty(i->head)) {
1523                 if (i->head == &up->list)
1524                         i->head = i->head->next;
1525                 list_del(&up->list);
1526         } else {
1527                 BUG_ON(i->head != &up->list);
1528                 i->head = NULL;
1529         }
1530
1531         spin_unlock_irq(&i->lock);
1532 }
1533
1534 static int serial_link_irq_chain(struct uart_8250_port *up)
1535 {
1536         struct irq_info *i = irq_lists + up->port.irq;
1537         int ret, irq_flags = up->port.flags & UPF_SHARE_IRQ ? IRQF_SHARED : 0;
1538
1539         spin_lock_irq(&i->lock);
1540
1541         if (i->head) {
1542                 list_add(&up->list, i->head);
1543                 spin_unlock_irq(&i->lock);
1544
1545                 ret = 0;
1546         } else {
1547                 INIT_LIST_HEAD(&up->list);
1548                 i->head = &up->list;
1549                 spin_unlock_irq(&i->lock);
1550
1551                 ret = request_irq(up->port.irq, serial8250_interrupt,
1552                                   irq_flags, "serial", i);
1553                 if (ret < 0)
1554                         serial_do_unlink(i, up);
1555         }
1556
1557         return ret;
1558 }
1559
1560 static void serial_unlink_irq_chain(struct uart_8250_port *up)
1561 {
1562         struct irq_info *i = irq_lists + up->port.irq;
1563
1564         BUG_ON(i->head == NULL);
1565
1566         if (list_empty(i->head))
1567                 free_irq(up->port.irq, i);
1568
1569         serial_do_unlink(i, up);
1570 }
1571
1572 /* Base timer interval for polling */
1573 static inline int poll_timeout(int timeout)
1574 {
1575         return timeout > 6 ? (timeout / 2 - 2) : 1;
1576 }
1577
1578 /*
1579  * This function is used to handle ports that do not have an
1580  * interrupt.  This doesn't work very well for 16450's, but gives
1581  * barely passable results for a 16550A.  (Although at the expense
1582  * of much CPU overhead).
1583  */
1584 static void serial8250_timeout(unsigned long data)
1585 {
1586         struct uart_8250_port *up = (struct uart_8250_port *)data;
1587         unsigned int iir;
1588
1589         iir = serial_in(up, UART_IIR);
1590         if (!(iir & UART_IIR_NO_INT))
1591                 serial8250_handle_port(up);
1592         mod_timer(&up->timer, jiffies + poll_timeout(up->port.timeout));
1593 }
1594
1595 static void serial8250_backup_timeout(unsigned long data)
1596 {
1597         struct uart_8250_port *up = (struct uart_8250_port *)data;
1598         unsigned int iir, ier = 0;
1599
1600         /*
1601          * Must disable interrupts or else we risk racing with the interrupt
1602          * based handler.
1603          */
1604         if (is_real_interrupt(up->port.irq)) {
1605                 ier = serial_in(up, UART_IER);
1606                 serial_out(up, UART_IER, 0);
1607         }
1608
1609         iir = serial_in(up, UART_IIR);
1610
1611         /*
1612          * This should be a safe test for anyone who doesn't trust the
1613          * IIR bits on their UART, but it's specifically designed for
1614          * the "Diva" UART used on the management processor on many HP
1615          * ia64 and parisc boxes.
1616          */
1617         if ((iir & UART_IIR_NO_INT) && (up->ier & UART_IER_THRI) &&
1618             (!uart_circ_empty(&up->port.info->xmit) || up->port.x_char) &&
1619             (serial_in(up, UART_LSR) & UART_LSR_THRE)) {
1620                 iir &= ~(UART_IIR_ID | UART_IIR_NO_INT);
1621                 iir |= UART_IIR_THRI;
1622         }
1623
1624         if (!(iir & UART_IIR_NO_INT))
1625                 serial8250_handle_port(up);
1626
1627         if (is_real_interrupt(up->port.irq))
1628                 serial_out(up, UART_IER, ier);
1629
1630         /* Standard timer interval plus 0.2s to keep the port running */
1631         mod_timer(&up->timer, jiffies + poll_timeout(up->port.timeout) + HZ/5);
1632 }
1633
1634 static unsigned int serial8250_tx_empty(struct uart_port *port)
1635 {
1636         struct uart_8250_port *up = (struct uart_8250_port *)port;
1637         unsigned long flags;
1638         unsigned int ret;
1639
1640         spin_lock_irqsave(&up->port.lock, flags);
1641         ret = serial_in(up, UART_LSR) & UART_LSR_TEMT ? TIOCSER_TEMT : 0;
1642         spin_unlock_irqrestore(&up->port.lock, flags);
1643
1644         return ret;
1645 }
1646
1647 static unsigned int serial8250_get_mctrl(struct uart_port *port)
1648 {
1649         struct uart_8250_port *up = (struct uart_8250_port *)port;
1650         unsigned int status;
1651         unsigned int ret;
1652
1653         status = check_modem_status(up);
1654
1655         ret = 0;
1656         if (status & UART_MSR_DCD)
1657                 ret |= TIOCM_CAR;
1658         if (status & UART_MSR_RI)
1659                 ret |= TIOCM_RNG;
1660         if (status & UART_MSR_DSR)
1661                 ret |= TIOCM_DSR;
1662         if (status & UART_MSR_CTS)
1663                 ret |= TIOCM_CTS;
1664         return ret;
1665 }
1666
1667 static void serial8250_set_mctrl(struct uart_port *port, unsigned int mctrl)
1668 {
1669         struct uart_8250_port *up = (struct uart_8250_port *)port;
1670         unsigned char mcr = 0;
1671
1672         if (mctrl & TIOCM_RTS)
1673                 mcr |= UART_MCR_RTS;
1674         if (mctrl & TIOCM_DTR)
1675                 mcr |= UART_MCR_DTR;
1676         if (mctrl & TIOCM_OUT1)
1677                 mcr |= UART_MCR_OUT1;
1678         if (mctrl & TIOCM_OUT2)
1679                 mcr |= UART_MCR_OUT2;
1680         if (mctrl & TIOCM_LOOP)
1681                 mcr |= UART_MCR_LOOP;
1682
1683         mcr = (mcr & up->mcr_mask) | up->mcr_force | up->mcr;
1684
1685         serial_out(up, UART_MCR, mcr);
1686 }
1687
1688 static void serial8250_break_ctl(struct uart_port *port, int break_state)
1689 {
1690         struct uart_8250_port *up = (struct uart_8250_port *)port;
1691         unsigned long flags;
1692
1693         spin_lock_irqsave(&up->port.lock, flags);
1694         if (break_state == -1)
1695                 up->lcr |= UART_LCR_SBC;
1696         else
1697                 up->lcr &= ~UART_LCR_SBC;
1698         serial_out(up, UART_LCR, up->lcr);
1699         spin_unlock_irqrestore(&up->port.lock, flags);
1700 }
1701
1702 #define BOTH_EMPTY (UART_LSR_TEMT | UART_LSR_THRE)
1703
1704 /*
1705  *      Wait for transmitter & holding register to empty
1706  */
1707 static inline void wait_for_xmitr(struct uart_8250_port *up, int bits)
1708 {
1709         unsigned int status, tmout = 10000;
1710
1711         /* Wait up to 10ms for the character(s) to be sent. */
1712         do {
1713                 status = serial_in(up, UART_LSR);
1714
1715                 if (status & UART_LSR_BI)
1716                         up->lsr_break_flag = UART_LSR_BI;
1717
1718                 if (--tmout == 0)
1719                         break;
1720                 udelay(1);
1721         } while ((status & bits) != bits);
1722
1723         /* Wait up to 1s for flow control if necessary */
1724         if (up->port.flags & UPF_CONS_FLOW) {
1725                 tmout = 1000000;
1726                 while (!(serial_in(up, UART_MSR) & UART_MSR_CTS) && --tmout) {
1727                         udelay(1);
1728                         touch_nmi_watchdog();
1729                 }
1730         }
1731 }
1732
1733 static int serial8250_startup(struct uart_port *port)
1734 {
1735         struct uart_8250_port *up = (struct uart_8250_port *)port;
1736         unsigned long flags;
1737         unsigned char lsr, iir;
1738         int retval;
1739
1740         up->capabilities = uart_config[up->port.type].flags;
1741         up->mcr = 0;
1742
1743         if (up->port.type == PORT_16C950) {
1744                 /* Wake up and initialize UART */
1745                 up->acr = 0;
1746                 serial_outp(up, UART_LCR, 0xBF);
1747                 serial_outp(up, UART_EFR, UART_EFR_ECB);
1748                 serial_outp(up, UART_IER, 0);
1749                 serial_outp(up, UART_LCR, 0);
1750                 serial_icr_write(up, UART_CSR, 0); /* Reset the UART */
1751                 serial_outp(up, UART_LCR, 0xBF);
1752                 serial_outp(up, UART_EFR, UART_EFR_ECB);
1753                 serial_outp(up, UART_LCR, 0);
1754         }
1755
1756 #ifdef CONFIG_SERIAL_8250_RSA
1757         /*
1758          * If this is an RSA port, see if we can kick it up to the
1759          * higher speed clock.
1760          */
1761         enable_rsa(up);
1762 #endif
1763
1764         /*
1765          * Clear the FIFO buffers and disable them.
1766          * (they will be reenabled in set_termios())
1767          */
1768         serial8250_clear_fifos(up);
1769
1770         /*
1771          * Clear the interrupt registers.
1772          */
1773         (void) serial_inp(up, UART_LSR);
1774         (void) serial_inp(up, UART_RX);
1775         (void) serial_inp(up, UART_IIR);
1776         (void) serial_inp(up, UART_MSR);
1777
1778         /*
1779          * At this point, there's no way the LSR could still be 0xff;
1780          * if it is, then bail out, because there's likely no UART
1781          * here.
1782          */
1783         if (!(up->port.flags & UPF_BUGGY_UART) &&
1784             (serial_inp(up, UART_LSR) == 0xff)) {
1785                 printk("ttyS%d: LSR safety check engaged!\n", up->port.line);
1786                 return -ENODEV;
1787         }
1788
1789         /*
1790          * For a XR16C850, we need to set the trigger levels
1791          */
1792         if (up->port.type == PORT_16850) {
1793                 unsigned char fctr;
1794
1795                 serial_outp(up, UART_LCR, 0xbf);
1796
1797                 fctr = serial_inp(up, UART_FCTR) & ~(UART_FCTR_RX|UART_FCTR_TX);
1798                 serial_outp(up, UART_FCTR, fctr | UART_FCTR_TRGD | UART_FCTR_RX);
1799                 serial_outp(up, UART_TRG, UART_TRG_96);
1800                 serial_outp(up, UART_FCTR, fctr | UART_FCTR_TRGD | UART_FCTR_TX);
1801                 serial_outp(up, UART_TRG, UART_TRG_96);
1802
1803                 serial_outp(up, UART_LCR, 0);
1804         }
1805
1806         if (is_real_interrupt(up->port.irq)) {
1807                 /*
1808                  * Test for UARTs that do not reassert THRE when the
1809                  * transmitter is idle and the interrupt has already
1810                  * been cleared.  Real 16550s should always reassert
1811                  * this interrupt whenever the transmitter is idle and
1812                  * the interrupt is enabled.  Delays are necessary to
1813                  * allow register changes to become visible.
1814                  */
1815                 spin_lock_irqsave(&up->port.lock, flags);
1816
1817                 wait_for_xmitr(up, UART_LSR_THRE);
1818                 serial_out_sync(up, UART_IER, UART_IER_THRI);
1819                 udelay(1); /* allow THRE to set */
1820                 serial_in(up, UART_IIR);
1821                 serial_out(up, UART_IER, 0);
1822                 serial_out_sync(up, UART_IER, UART_IER_THRI);
1823                 udelay(1); /* allow a working UART time to re-assert THRE */
1824                 iir = serial_in(up, UART_IIR);
1825                 serial_out(up, UART_IER, 0);
1826
1827                 spin_unlock_irqrestore(&up->port.lock, flags);
1828
1829                 /*
1830                  * If the interrupt is not reasserted, setup a timer to
1831                  * kick the UART on a regular basis.
1832                  */
1833                 if (iir & UART_IIR_NO_INT) {
1834                         pr_debug("ttyS%d - using backup timer\n", port->line);
1835                         up->timer.function = serial8250_backup_timeout;
1836                         up->timer.data = (unsigned long)up;
1837                         mod_timer(&up->timer, jiffies +
1838                                   poll_timeout(up->port.timeout) + HZ/5);
1839                 }
1840         }
1841
1842         /*
1843          * If the "interrupt" for this port doesn't correspond with any
1844          * hardware interrupt, we use a timer-based system.  The original
1845          * driver used to do this with IRQ0.
1846          */
1847         if (!is_real_interrupt(up->port.irq)) {
1848                 up->timer.data = (unsigned long)up;
1849                 mod_timer(&up->timer, jiffies + poll_timeout(up->port.timeout));
1850         } else {
1851                 retval = serial_link_irq_chain(up);
1852                 if (retval)
1853                         return retval;
1854         }
1855
1856         /*
1857          * Now, initialize the UART
1858          */
1859         serial_outp(up, UART_LCR, UART_LCR_WLEN8);
1860
1861         spin_lock_irqsave(&up->port.lock, flags);
1862         if (up->port.flags & UPF_FOURPORT) {
1863                 if (!is_real_interrupt(up->port.irq))
1864                         up->port.mctrl |= TIOCM_OUT1;
1865         } else
1866                 /*
1867                  * Most PC uarts need OUT2 raised to enable interrupts.
1868                  */
1869                 if (is_real_interrupt(up->port.irq))
1870                         up->port.mctrl |= TIOCM_OUT2;
1871
1872         serial8250_set_mctrl(&up->port, up->port.mctrl);
1873
1874         /*
1875          * Do a quick test to see if we receive an
1876          * interrupt when we enable the TX irq.
1877          */
1878         serial_outp(up, UART_IER, UART_IER_THRI);
1879         lsr = serial_in(up, UART_LSR);
1880         iir = serial_in(up, UART_IIR);
1881         serial_outp(up, UART_IER, 0);
1882
1883         if (lsr & UART_LSR_TEMT && iir & UART_IIR_NO_INT) {
1884                 if (!(up->bugs & UART_BUG_TXEN)) {
1885                         up->bugs |= UART_BUG_TXEN;
1886                         pr_debug("ttyS%d - enabling bad tx status workarounds\n",
1887                                  port->line);
1888                 }
1889         } else {
1890                 up->bugs &= ~UART_BUG_TXEN;
1891         }
1892
1893         spin_unlock_irqrestore(&up->port.lock, flags);
1894
1895         /*
1896          * Finally, enable interrupts.  Note: Modem status interrupts
1897          * are set via set_termios(), which will be occurring imminently
1898          * anyway, so we don't enable them here.
1899          */
1900         up->ier = UART_IER_RLSI | UART_IER_RDI;
1901         serial_outp(up, UART_IER, up->ier);
1902
1903         if (up->port.flags & UPF_FOURPORT) {
1904                 unsigned int icp;
1905                 /*
1906                  * Enable interrupts on the AST Fourport board
1907                  */
1908                 icp = (up->port.iobase & 0xfe0) | 0x01f;
1909                 outb_p(0x80, icp);
1910                 (void) inb_p(icp);
1911         }
1912
1913         /*
1914          * And clear the interrupt registers again for luck.
1915          */
1916         (void) serial_inp(up, UART_LSR);
1917         (void) serial_inp(up, UART_RX);
1918         (void) serial_inp(up, UART_IIR);
1919         (void) serial_inp(up, UART_MSR);
1920
1921         return 0;
1922 }
1923
1924 static void serial8250_shutdown(struct uart_port *port)
1925 {
1926         struct uart_8250_port *up = (struct uart_8250_port *)port;
1927         unsigned long flags;
1928
1929         /*
1930          * Disable interrupts from this port
1931          */
1932         up->ier = 0;
1933         serial_outp(up, UART_IER, 0);
1934
1935         spin_lock_irqsave(&up->port.lock, flags);
1936         if (up->port.flags & UPF_FOURPORT) {
1937                 /* reset interrupts on the AST Fourport board */
1938                 inb((up->port.iobase & 0xfe0) | 0x1f);
1939                 up->port.mctrl |= TIOCM_OUT1;
1940         } else
1941                 up->port.mctrl &= ~TIOCM_OUT2;
1942
1943         serial8250_set_mctrl(&up->port, up->port.mctrl);
1944         spin_unlock_irqrestore(&up->port.lock, flags);
1945
1946         /*
1947          * Disable break condition and FIFOs
1948          */
1949         serial_out(up, UART_LCR, serial_inp(up, UART_LCR) & ~UART_LCR_SBC);
1950         serial8250_clear_fifos(up);
1951
1952 #ifdef CONFIG_SERIAL_8250_RSA
1953         /*
1954          * Reset the RSA board back to 115kbps compat mode.
1955          */
1956         disable_rsa(up);
1957 #endif
1958
1959         /*
1960          * Read data port to reset things, and then unlink from
1961          * the IRQ chain.
1962          */
1963         (void) serial_in(up, UART_RX);
1964
1965         del_timer_sync(&up->timer);
1966         up->timer.function = serial8250_timeout;
1967         if (is_real_interrupt(up->port.irq))
1968                 serial_unlink_irq_chain(up);
1969 }
1970
1971 static unsigned int serial8250_get_divisor(struct uart_port *port, unsigned int baud)
1972 {
1973         unsigned int quot;
1974
1975         /*
1976          * Handle magic divisors for baud rates above baud_base on
1977          * SMSC SuperIO chips.
1978          */
1979         if ((port->flags & UPF_MAGIC_MULTIPLIER) &&
1980             baud == (port->uartclk/4))
1981                 quot = 0x8001;
1982         else if ((port->flags & UPF_MAGIC_MULTIPLIER) &&
1983                  baud == (port->uartclk/8))
1984                 quot = 0x8002;
1985         else
1986                 quot = uart_get_divisor(port, baud);
1987
1988         return quot;
1989 }
1990
1991 static void
1992 serial8250_set_termios(struct uart_port *port, struct ktermios *termios,
1993                        struct ktermios *old)
1994 {
1995         struct uart_8250_port *up = (struct uart_8250_port *)port;
1996         unsigned char cval, fcr = 0;
1997         unsigned long flags;
1998         unsigned int baud, quot;
1999
2000         switch (termios->c_cflag & CSIZE) {
2001         case CS5:
2002                 cval = UART_LCR_WLEN5;
2003                 break;
2004         case CS6:
2005                 cval = UART_LCR_WLEN6;
2006                 break;
2007         case CS7:
2008                 cval = UART_LCR_WLEN7;
2009                 break;
2010         default:
2011         case CS8:
2012                 cval = UART_LCR_WLEN8;
2013                 break;
2014         }
2015
2016         if (termios->c_cflag & CSTOPB)
2017                 cval |= UART_LCR_STOP;
2018         if (termios->c_cflag & PARENB)
2019                 cval |= UART_LCR_PARITY;
2020         if (!(termios->c_cflag & PARODD))
2021                 cval |= UART_LCR_EPAR;
2022 #ifdef CMSPAR
2023         if (termios->c_cflag & CMSPAR)
2024                 cval |= UART_LCR_SPAR;
2025 #endif
2026
2027         /*
2028          * Ask the core to calculate the divisor for us.
2029          */
2030         baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16);
2031         quot = serial8250_get_divisor(port, baud);
2032
2033         /*
2034          * Oxford Semi 952 rev B workaround
2035          */
2036         if (up->bugs & UART_BUG_QUOT && (quot & 0xff) == 0)
2037                 quot ++;
2038
2039         if (up->capabilities & UART_CAP_FIFO && up->port.fifosize > 1) {
2040                 if (baud < 2400)
2041                         fcr = UART_FCR_ENABLE_FIFO | UART_FCR_TRIGGER_1;
2042                 else
2043                         fcr = uart_config[up->port.type].fcr;
2044         }
2045
2046         /*
2047          * MCR-based auto flow control.  When AFE is enabled, RTS will be
2048          * deasserted when the receive FIFO contains more characters than
2049          * the trigger, or the MCR RTS bit is cleared.  In the case where
2050          * the remote UART is not using CTS auto flow control, we must
2051          * have sufficient FIFO entries for the latency of the remote
2052          * UART to respond.  IOW, at least 32 bytes of FIFO.
2053          */
2054         if (up->capabilities & UART_CAP_AFE && up->port.fifosize >= 32) {
2055                 up->mcr &= ~UART_MCR_AFE;
2056                 if (termios->c_cflag & CRTSCTS)
2057                         up->mcr |= UART_MCR_AFE;
2058         }
2059
2060         /*
2061          * Ok, we're now changing the port state.  Do it with
2062          * interrupts disabled.
2063          */
2064         spin_lock_irqsave(&up->port.lock, flags);
2065
2066         /*
2067          * Update the per-port timeout.
2068          */
2069         uart_update_timeout(port, termios->c_cflag, baud);
2070
2071         up->port.read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR;
2072         if (termios->c_iflag & INPCK)
2073                 up->port.read_status_mask |= UART_LSR_FE | UART_LSR_PE;
2074         if (termios->c_iflag & (BRKINT | PARMRK))
2075                 up->port.read_status_mask |= UART_LSR_BI;
2076
2077         /*
2078          * Characteres to ignore
2079          */
2080         up->port.ignore_status_mask = 0;
2081         if (termios->c_iflag & IGNPAR)
2082                 up->port.ignore_status_mask |= UART_LSR_PE | UART_LSR_FE;
2083         if (termios->c_iflag & IGNBRK) {
2084                 up->port.ignore_status_mask |= UART_LSR_BI;
2085                 /*
2086                  * If we're ignoring parity and break indicators,
2087                  * ignore overruns too (for real raw support).
2088                  */
2089                 if (termios->c_iflag & IGNPAR)
2090                         up->port.ignore_status_mask |= UART_LSR_OE;
2091         }
2092
2093         /*
2094          * ignore all characters if CREAD is not set
2095          */
2096         if ((termios->c_cflag & CREAD) == 0)
2097                 up->port.ignore_status_mask |= UART_LSR_DR;
2098
2099         /*
2100          * CTS flow control flag and modem status interrupts
2101          */
2102         up->ier &= ~UART_IER_MSI;
2103         if (!(up->bugs & UART_BUG_NOMSR) &&
2104                         UART_ENABLE_MS(&up->port, termios->c_cflag))
2105                 up->ier |= UART_IER_MSI;
2106         if (up->capabilities & UART_CAP_UUE)
2107                 up->ier |= UART_IER_UUE | UART_IER_RTOIE;
2108
2109         serial_out(up, UART_IER, up->ier);
2110
2111         if (up->capabilities & UART_CAP_EFR) {
2112                 unsigned char efr = 0;
2113                 /*
2114                  * TI16C752/Startech hardware flow control.  FIXME:
2115                  * - TI16C752 requires control thresholds to be set.
2116                  * - UART_MCR_RTS is ineffective if auto-RTS mode is enabled.
2117                  */
2118                 if (termios->c_cflag & CRTSCTS)
2119                         efr |= UART_EFR_CTS;
2120
2121                 serial_outp(up, UART_LCR, 0xBF);
2122                 serial_outp(up, UART_EFR, efr);
2123         }
2124
2125 #ifdef CONFIG_ARCH_OMAP15XX
2126         /* Workaround to enable 115200 baud on OMAP1510 internal ports */
2127         if (cpu_is_omap1510() && is_omap_port((unsigned int)up->port.membase)) {
2128                 if (baud == 115200) {
2129                         quot = 1;
2130                         serial_out(up, UART_OMAP_OSC_12M_SEL, 1);
2131                 } else
2132                         serial_out(up, UART_OMAP_OSC_12M_SEL, 0);
2133         }
2134 #endif
2135
2136         if (up->capabilities & UART_NATSEMI) {
2137                 /* Switch to bank 2 not bank 1, to avoid resetting EXCR2 */
2138                 serial_outp(up, UART_LCR, 0xe0);
2139         } else {
2140                 serial_outp(up, UART_LCR, cval | UART_LCR_DLAB);/* set DLAB */
2141         }
2142
2143         serial_dl_write(up, quot);
2144
2145         /*
2146          * LCR DLAB must be set to enable 64-byte FIFO mode. If the FCR
2147          * is written without DLAB set, this mode will be disabled.
2148          */
2149         if (up->port.type == PORT_16750)
2150                 serial_outp(up, UART_FCR, fcr);
2151
2152         serial_outp(up, UART_LCR, cval);                /* reset DLAB */
2153         up->lcr = cval;                                 /* Save LCR */
2154         if (up->port.type != PORT_16750) {
2155                 if (fcr & UART_FCR_ENABLE_FIFO) {
2156                         /* emulated UARTs (Lucent Venus 167x) need two steps */
2157                         serial_outp(up, UART_FCR, UART_FCR_ENABLE_FIFO);
2158                 }
2159
2160                 /* Note that we need to set ECB to access write water mark
2161                  * bits. First allow FCR tx fifo write, then set fcr with
2162                  * possible TX fifo settings. */
2163                 if (uart_config[up->port.type].flags & UART_CAP_EFR) {
2164                         serial_outp(up, UART_LCR, 0xbf);        /* Access EFR */
2165                         serial_outp(up, UART_EFR, UART_EFR_ECB);
2166                         serial_outp(up, UART_LCR, 0x0);         /* Access FCR */
2167                         serial_outp(up, UART_FCR, fcr);
2168                         serial_outp(up, UART_LCR, 0xbf);        /* Access EFR */
2169                         serial_outp(up, UART_EFR, 0);
2170                         serial_outp(up, UART_LCR, cval);        /* Access FCR */
2171         } else
2172                 serial_outp(up, UART_FCR, fcr);         /* set fcr */
2173         }
2174         serial8250_set_mctrl(&up->port, up->port.mctrl);
2175         spin_unlock_irqrestore(&up->port.lock, flags);
2176 }
2177
2178 static void
2179 serial8250_pm(struct uart_port *port, unsigned int state,
2180               unsigned int oldstate)
2181 {
2182         struct uart_8250_port *p = (struct uart_8250_port *)port;
2183
2184         serial8250_set_sleep(p, state != 0);
2185
2186         if (p->pm)
2187                 p->pm(port, state, oldstate);
2188 }
2189
2190 /*
2191  * Resource handling.
2192  */
2193 static int serial8250_request_std_resource(struct uart_8250_port *up)
2194 {
2195         unsigned int size = 8 << up->port.regshift;
2196         int ret = 0;
2197
2198 #ifdef CONFIG_ARCH_OMAP
2199         if (is_omap_port((unsigned int)up->port.membase))
2200                 size = 0x16 << up->port.regshift;
2201 #endif
2202
2203         switch (up->port.iotype) {
2204         case UPIO_AU:
2205                 size = 0x100000;
2206                 /* fall thru */
2207         case UPIO_TSI:
2208         case UPIO_MEM32:
2209         case UPIO_MEM:
2210         case UPIO_DWAPB:
2211                 if (!up->port.mapbase)
2212                         break;
2213
2214                 if (!request_mem_region(up->port.mapbase, size, "serial")) {
2215                         ret = -EBUSY;
2216                         break;
2217                 }
2218
2219                 if (up->port.flags & UPF_IOREMAP) {
2220                         up->port.membase = ioremap(up->port.mapbase, size);
2221                         if (!up->port.membase) {
2222                                 release_mem_region(up->port.mapbase, size);
2223                                 ret = -ENOMEM;
2224                         }
2225                 }
2226                 break;
2227
2228         case UPIO_HUB6:
2229         case UPIO_PORT:
2230                 if (!request_region(up->port.iobase, size, "serial"))
2231                         ret = -EBUSY;
2232                 break;
2233         }
2234         return ret;
2235 }
2236
2237 static void serial8250_release_std_resource(struct uart_8250_port *up)
2238 {
2239         unsigned int size = 8 << up->port.regshift;
2240
2241         switch (up->port.iotype) {
2242         case UPIO_AU:
2243                 size = 0x100000;
2244                 /* fall thru */
2245         case UPIO_TSI:
2246         case UPIO_MEM32:
2247         case UPIO_MEM:
2248         case UPIO_DWAPB:
2249                 if (!up->port.mapbase)
2250                         break;
2251
2252                 if (up->port.flags & UPF_IOREMAP) {
2253                         iounmap(up->port.membase);
2254                         up->port.membase = NULL;
2255                 }
2256
2257                 release_mem_region(up->port.mapbase, size);
2258                 break;
2259
2260         case UPIO_HUB6:
2261         case UPIO_PORT:
2262                 release_region(up->port.iobase, size);
2263                 break;
2264         }
2265 }
2266
2267 static int serial8250_request_rsa_resource(struct uart_8250_port *up)
2268 {
2269         unsigned long start = UART_RSA_BASE << up->port.regshift;
2270         unsigned int size = 8 << up->port.regshift;
2271         int ret = -EINVAL;
2272
2273         switch (up->port.iotype) {
2274         case UPIO_HUB6:
2275         case UPIO_PORT:
2276                 start += up->port.iobase;
2277                 if (request_region(start, size, "serial-rsa"))
2278                         ret = 0;
2279                 else
2280                         ret = -EBUSY;
2281                 break;
2282         }
2283
2284         return ret;
2285 }
2286
2287 static void serial8250_release_rsa_resource(struct uart_8250_port *up)
2288 {
2289         unsigned long offset = UART_RSA_BASE << up->port.regshift;
2290         unsigned int size = 8 << up->port.regshift;
2291
2292         switch (up->port.iotype) {
2293         case UPIO_HUB6:
2294         case UPIO_PORT:
2295                 release_region(up->port.iobase + offset, size);
2296                 break;
2297         }
2298 }
2299
2300 static void serial8250_release_port(struct uart_port *port)
2301 {
2302         struct uart_8250_port *up = (struct uart_8250_port *)port;
2303
2304         serial8250_release_std_resource(up);
2305         if (up->port.type == PORT_RSA)
2306                 serial8250_release_rsa_resource(up);
2307 }
2308
2309 static int serial8250_request_port(struct uart_port *port)
2310 {
2311         struct uart_8250_port *up = (struct uart_8250_port *)port;
2312         int ret = 0;
2313
2314         ret = serial8250_request_std_resource(up);
2315         if (ret == 0 && up->port.type == PORT_RSA) {
2316                 ret = serial8250_request_rsa_resource(up);
2317                 if (ret < 0)
2318                         serial8250_release_std_resource(up);
2319         }
2320
2321         return ret;
2322 }
2323
2324 static void serial8250_config_port(struct uart_port *port, int flags)
2325 {
2326         struct uart_8250_port *up = (struct uart_8250_port *)port;
2327         int probeflags = PROBE_ANY;
2328         int ret;
2329
2330         /*
2331          * Find the region that we can probe for.  This in turn
2332          * tells us whether we can probe for the type of port.
2333          */
2334         ret = serial8250_request_std_resource(up);
2335         if (ret < 0)
2336                 return;
2337
2338         ret = serial8250_request_rsa_resource(up);
2339         if (ret < 0)
2340                 probeflags &= ~PROBE_RSA;
2341
2342         if (flags & UART_CONFIG_TYPE)
2343                 autoconfig(up, probeflags);
2344         if (up->port.type != PORT_UNKNOWN && flags & UART_CONFIG_IRQ)
2345                 autoconfig_irq(up);
2346
2347         if (up->port.type != PORT_RSA && probeflags & PROBE_RSA)
2348                 serial8250_release_rsa_resource(up);
2349         if (up->port.type == PORT_UNKNOWN)
2350                 serial8250_release_std_resource(up);
2351 }
2352
2353 static int
2354 serial8250_verify_port(struct uart_port *port, struct serial_struct *ser)
2355 {
2356         if (ser->irq >= NR_IRQS || ser->irq < 0 ||
2357             ser->baud_base < 9600 || ser->type < PORT_UNKNOWN ||
2358             ser->type >= ARRAY_SIZE(uart_config) || ser->type == PORT_CIRRUS ||
2359             ser->type == PORT_STARTECH)
2360                 return -EINVAL;
2361         return 0;
2362 }
2363
2364 static const char *
2365 serial8250_type(struct uart_port *port)
2366 {
2367         int type = port->type;
2368
2369         if (type >= ARRAY_SIZE(uart_config))
2370                 type = 0;
2371         return uart_config[type].name;
2372 }
2373
2374 static struct uart_ops serial8250_pops = {
2375         .tx_empty       = serial8250_tx_empty,
2376         .set_mctrl      = serial8250_set_mctrl,
2377         .get_mctrl      = serial8250_get_mctrl,
2378         .stop_tx        = serial8250_stop_tx,
2379         .start_tx       = serial8250_start_tx,
2380         .stop_rx        = serial8250_stop_rx,
2381         .enable_ms      = serial8250_enable_ms,
2382         .break_ctl      = serial8250_break_ctl,
2383         .startup        = serial8250_startup,
2384         .shutdown       = serial8250_shutdown,
2385         .set_termios    = serial8250_set_termios,
2386         .pm             = serial8250_pm,
2387         .type           = serial8250_type,
2388         .release_port   = serial8250_release_port,
2389         .request_port   = serial8250_request_port,
2390         .config_port    = serial8250_config_port,
2391         .verify_port    = serial8250_verify_port,
2392 };
2393
2394 static struct uart_8250_port serial8250_ports[UART_NR];
2395
2396 static void __init serial8250_isa_init_ports(void)
2397 {
2398         struct uart_8250_port *up;
2399         static int first = 1;
2400         int i;
2401
2402         if (!first)
2403                 return;
2404         first = 0;
2405
2406         for (i = 0; i < nr_uarts; i++) {
2407                 struct uart_8250_port *up = &serial8250_ports[i];
2408
2409                 up->port.line = i;
2410                 spin_lock_init(&up->port.lock);
2411
2412                 init_timer(&up->timer);
2413                 up->timer.function = serial8250_timeout;
2414
2415                 /*
2416                  * ALPHA_KLUDGE_MCR needs to be killed.
2417                  */
2418                 up->mcr_mask = ~ALPHA_KLUDGE_MCR;
2419                 up->mcr_force = ALPHA_KLUDGE_MCR;
2420
2421                 up->port.ops = &serial8250_pops;
2422         }
2423
2424         for (i = 0, up = serial8250_ports;
2425              i < ARRAY_SIZE(old_serial_port) && i < nr_uarts;
2426              i++, up++) {
2427                 up->port.iobase   = old_serial_port[i].port;
2428                 up->port.irq      = irq_canonicalize(old_serial_port[i].irq);
2429                 up->port.uartclk  = old_serial_port[i].baud_base * 16;
2430                 up->port.flags    = old_serial_port[i].flags;
2431                 up->port.hub6     = old_serial_port[i].hub6;
2432                 up->port.membase  = old_serial_port[i].iomem_base;
2433                 up->port.iotype   = old_serial_port[i].io_type;
2434                 up->port.regshift = old_serial_port[i].iomem_reg_shift;
2435                 if (share_irqs)
2436                         up->port.flags |= UPF_SHARE_IRQ;
2437         }
2438 }
2439
2440 static void __init
2441 serial8250_register_ports(struct uart_driver *drv, struct device *dev)
2442 {
2443         int i;
2444
2445         serial8250_isa_init_ports();
2446
2447         for (i = 0; i < nr_uarts; i++) {
2448                 struct uart_8250_port *up = &serial8250_ports[i];
2449
2450                 up->port.dev = dev;
2451                 uart_add_one_port(drv, &up->port);
2452         }
2453 }
2454
2455 #ifdef CONFIG_SERIAL_8250_CONSOLE
2456
2457 static void serial8250_console_putchar(struct uart_port *port, int ch)
2458 {
2459         struct uart_8250_port *up = (struct uart_8250_port *)port;
2460
2461         wait_for_xmitr(up, UART_LSR_THRE);
2462         serial_out(up, UART_TX, ch);
2463 }
2464
2465 /*
2466  *      Print a string to the serial port trying not to disturb
2467  *      any possible real use of the port...
2468  *
2469  *      The console_lock must be held when we get here.
2470  */
2471 static void
2472 serial8250_console_write(struct console *co, const char *s, unsigned int count)
2473 {
2474         struct uart_8250_port *up = &serial8250_ports[co->index];
2475         unsigned long flags;
2476         unsigned int ier;
2477         int locked = 1;
2478
2479         touch_nmi_watchdog();
2480
2481         local_irq_save(flags);
2482         if (up->port.sysrq) {
2483                 /* serial8250_handle_port() already took the lock */
2484                 locked = 0;
2485         } else if (oops_in_progress) {
2486                 locked = spin_trylock(&up->port.lock);
2487         } else
2488                 spin_lock(&up->port.lock);
2489
2490         /*
2491          *      First save the IER then disable the interrupts
2492          */
2493         ier = serial_in(up, UART_IER);
2494
2495         if (up->capabilities & UART_CAP_UUE)
2496                 serial_out(up, UART_IER, UART_IER_UUE);
2497         else
2498                 serial_out(up, UART_IER, 0);
2499
2500         uart_console_write(&up->port, s, count, serial8250_console_putchar);
2501
2502         /*
2503          *      Finally, wait for transmitter to become empty
2504          *      and restore the IER
2505          */
2506         wait_for_xmitr(up, BOTH_EMPTY);
2507         serial_out(up, UART_IER, ier);
2508
2509         if (locked)
2510                 spin_unlock(&up->port.lock);
2511         local_irq_restore(flags);
2512 }
2513
2514 static int __init serial8250_console_setup(struct console *co, char *options)
2515 {
2516         struct uart_port *port;
2517         int baud = 9600;
2518         int bits = 8;
2519         int parity = 'n';
2520         int flow = 'n';
2521
2522         /*
2523          * Check whether an invalid uart number has been specified, and
2524          * if so, search for the first available port that does have
2525          * console support.
2526          */
2527         if (co->index >= nr_uarts)
2528                 co->index = 0;
2529         port = &serial8250_ports[co->index].port;
2530         if (!port->iobase && !port->membase)
2531                 return -ENODEV;
2532
2533         if (options)
2534                 uart_parse_options(options, &baud, &parity, &bits, &flow);
2535
2536         return uart_set_options(port, co, baud, parity, bits, flow);
2537 }
2538
2539 static int serial8250_console_early_setup(void)
2540 {
2541         return serial8250_find_port_for_earlycon();
2542 }
2543
2544 static struct uart_driver serial8250_reg;
2545 static struct console serial8250_console = {
2546         .name           = "ttyS",
2547         .write          = serial8250_console_write,
2548         .device         = uart_console_device,
2549         .setup          = serial8250_console_setup,
2550         .early_setup    = serial8250_console_early_setup,
2551         .flags          = CON_PRINTBUFFER,
2552         .index          = -1,
2553         .data           = &serial8250_reg,
2554 };
2555
2556 static int __init serial8250_console_init(void)
2557 {
2558         serial8250_isa_init_ports();
2559         register_console(&serial8250_console);
2560         return 0;
2561 }
2562 console_initcall(serial8250_console_init);
2563
2564 int serial8250_find_port(struct uart_port *p)
2565 {
2566         int line;
2567         struct uart_port *port;
2568
2569         for (line = 0; line < nr_uarts; line++) {
2570                 port = &serial8250_ports[line].port;
2571                 if (uart_match_port(p, port))
2572                         return line;
2573         }
2574         return -ENODEV;
2575 }
2576
2577 #define SERIAL8250_CONSOLE      &serial8250_console
2578 #else
2579 #define SERIAL8250_CONSOLE      NULL
2580 #endif
2581
2582 static struct uart_driver serial8250_reg = {
2583         .owner                  = THIS_MODULE,
2584         .driver_name            = "serial",
2585         .dev_name               = "ttyS",
2586         .major                  = TTY_MAJOR,
2587         .minor                  = 64,
2588         .nr                     = UART_NR,
2589         .cons                   = SERIAL8250_CONSOLE,
2590 };
2591
2592 /*
2593  * early_serial_setup - early registration for 8250 ports
2594  *
2595  * Setup an 8250 port structure prior to console initialisation.  Use
2596  * after console initialisation will cause undefined behaviour.
2597  */
2598 int __init early_serial_setup(struct uart_port *port)
2599 {
2600         if (port->line >= ARRAY_SIZE(serial8250_ports))
2601                 return -ENODEV;
2602
2603         serial8250_isa_init_ports();
2604         serial8250_ports[port->line].port       = *port;
2605         serial8250_ports[port->line].port.ops   = &serial8250_pops;
2606         return 0;
2607 }
2608
2609 /**
2610  *      serial8250_suspend_port - suspend one serial port
2611  *      @line:  serial line number
2612  *
2613  *      Suspend one serial port.
2614  */
2615 void serial8250_suspend_port(int line)
2616 {
2617         uart_suspend_port(&serial8250_reg, &serial8250_ports[line].port);
2618 }
2619
2620 /**
2621  *      serial8250_resume_port - resume one serial port
2622  *      @line:  serial line number
2623  *
2624  *      Resume one serial port.
2625  */
2626 void serial8250_resume_port(int line)
2627 {
2628         struct uart_8250_port *up = &serial8250_ports[line];
2629
2630         if (up->capabilities & UART_NATSEMI) {
2631                 unsigned char tmp;
2632
2633                 /* Ensure it's still in high speed mode */
2634                 serial_outp(up, UART_LCR, 0xE0);
2635
2636                 tmp = serial_in(up, 0x04); /* EXCR2 */
2637                 tmp &= ~0xB0; /* Disable LOCK, mask out PRESL[01] */
2638                 tmp |= 0x10;  /* 1.625 divisor for baud_base --> 921600 */
2639                 serial_outp(up, 0x04, tmp);
2640
2641                 serial_outp(up, UART_LCR, 0);
2642         }
2643         uart_resume_port(&serial8250_reg, &up->port);
2644 }
2645
2646 /*
2647  * Register a set of serial devices attached to a platform device.  The
2648  * list is terminated with a zero flags entry, which means we expect
2649  * all entries to have at least UPF_BOOT_AUTOCONF set.
2650  */
2651 static int __devinit serial8250_probe(struct platform_device *dev)
2652 {
2653         struct plat_serial8250_port *p = dev->dev.platform_data;
2654         struct uart_port port;
2655         int ret, i;
2656
2657         memset(&port, 0, sizeof(struct uart_port));
2658
2659         for (i = 0; p && p->flags != 0; p++, i++) {
2660                 port.iobase     = p->iobase;
2661                 port.membase    = p->membase;
2662                 port.irq        = p->irq;
2663                 port.uartclk    = p->uartclk;
2664                 port.regshift   = p->regshift;
2665                 port.iotype     = p->iotype;
2666                 port.flags      = p->flags;
2667                 port.mapbase    = p->mapbase;
2668                 port.hub6       = p->hub6;
2669                 port.dev        = &dev->dev;
2670                 if (share_irqs)
2671                         port.flags |= UPF_SHARE_IRQ;
2672                 ret = serial8250_register_port(&port);
2673                 if (ret < 0) {
2674                         dev_err(&dev->dev, "unable to register port at index %d "
2675                                 "(IO%lx MEM%llx IRQ%d): %d\n", i,
2676                                 p->iobase, (unsigned long long)p->mapbase,
2677                                 p->irq, ret);
2678                 }
2679         }
2680         return 0;
2681 }
2682
2683 /*
2684  * Remove serial ports registered against a platform device.
2685  */
2686 static int __devexit serial8250_remove(struct platform_device *dev)
2687 {
2688         int i;
2689
2690         for (i = 0; i < nr_uarts; i++) {
2691                 struct uart_8250_port *up = &serial8250_ports[i];
2692
2693                 if (up->port.dev == &dev->dev)
2694                         serial8250_unregister_port(i);
2695         }
2696         return 0;
2697 }
2698
2699 static int serial8250_suspend(struct platform_device *dev, pm_message_t state)
2700 {
2701         int i;
2702
2703         for (i = 0; i < UART_NR; i++) {
2704                 struct uart_8250_port *up = &serial8250_ports[i];
2705
2706                 if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
2707                         uart_suspend_port(&serial8250_reg, &up->port);
2708         }
2709
2710         return 0;
2711 }
2712
2713 static int serial8250_resume(struct platform_device *dev)
2714 {
2715         int i;
2716
2717         for (i = 0; i < UART_NR; i++) {
2718                 struct uart_8250_port *up = &serial8250_ports[i];
2719
2720                 if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
2721                         serial8250_resume_port(i);
2722         }
2723
2724         return 0;
2725 }
2726
2727 static struct platform_driver serial8250_isa_driver = {
2728         .probe          = serial8250_probe,
2729         .remove         = __devexit_p(serial8250_remove),
2730         .suspend        = serial8250_suspend,
2731         .resume         = serial8250_resume,
2732         .driver         = {
2733                 .name   = "serial8250",
2734                 .owner  = THIS_MODULE,
2735         },
2736 };
2737
2738 /*
2739  * This "device" covers _all_ ISA 8250-compatible serial devices listed
2740  * in the table in include/asm/serial.h
2741  */
2742 static struct platform_device *serial8250_isa_devs;
2743
2744 /*
2745  * serial8250_register_port and serial8250_unregister_port allows for
2746  * 16x50 serial ports to be configured at run-time, to support PCMCIA
2747  * modems and PCI multiport cards.
2748  */
2749 static DEFINE_MUTEX(serial_mutex);
2750
2751 static struct uart_8250_port *serial8250_find_match_or_unused(struct uart_port *port)
2752 {
2753         int i;
2754
2755         /*
2756          * First, find a port entry which matches.
2757          */
2758         for (i = 0; i < nr_uarts; i++)
2759                 if (uart_match_port(&serial8250_ports[i].port, port))
2760                         return &serial8250_ports[i];
2761
2762         /*
2763          * We didn't find a matching entry, so look for the first
2764          * free entry.  We look for one which hasn't been previously
2765          * used (indicated by zero iobase).
2766          */
2767         for (i = 0; i < nr_uarts; i++)
2768                 if (serial8250_ports[i].port.type == PORT_UNKNOWN &&
2769                     serial8250_ports[i].port.iobase == 0)
2770                         return &serial8250_ports[i];
2771
2772         /*
2773          * That also failed.  Last resort is to find any entry which
2774          * doesn't have a real port associated with it.
2775          */
2776         for (i = 0; i < nr_uarts; i++)
2777                 if (serial8250_ports[i].port.type == PORT_UNKNOWN)
2778                         return &serial8250_ports[i];
2779
2780         return NULL;
2781 }
2782
2783 /**
2784  *      serial8250_register_port - register a serial port
2785  *      @port: serial port template
2786  *
2787  *      Configure the serial port specified by the request. If the
2788  *      port exists and is in use, it is hung up and unregistered
2789  *      first.
2790  *
2791  *      The port is then probed and if necessary the IRQ is autodetected
2792  *      If this fails an error is returned.
2793  *
2794  *      On success the port is ready to use and the line number is returned.
2795  */
2796 int serial8250_register_port(struct uart_port *port)
2797 {
2798         struct uart_8250_port *uart;
2799         int ret = -ENOSPC;
2800
2801         if (port->uartclk == 0)
2802                 return -EINVAL;
2803
2804         mutex_lock(&serial_mutex);
2805
2806         uart = serial8250_find_match_or_unused(port);
2807         if (uart) {
2808                 uart_remove_one_port(&serial8250_reg, &uart->port);
2809
2810                 uart->port.iobase   = port->iobase;
2811                 uart->port.membase  = port->membase;
2812                 uart->port.irq      = port->irq;
2813                 uart->port.uartclk  = port->uartclk;
2814                 uart->port.fifosize = port->fifosize;
2815                 uart->port.regshift = port->regshift;
2816                 uart->port.iotype   = port->iotype;
2817                 uart->port.flags    = port->flags | UPF_BOOT_AUTOCONF;
2818                 uart->port.mapbase  = port->mapbase;
2819                 if (port->dev)
2820                         uart->port.dev = port->dev;
2821
2822                 ret = uart_add_one_port(&serial8250_reg, &uart->port);
2823                 if (ret == 0)
2824                         ret = uart->port.line;
2825         }
2826         mutex_unlock(&serial_mutex);
2827
2828         return ret;
2829 }
2830 EXPORT_SYMBOL(serial8250_register_port);
2831
2832 /**
2833  *      serial8250_unregister_port - remove a 16x50 serial port at runtime
2834  *      @line: serial line number
2835  *
2836  *      Remove one serial port.  This may not be called from interrupt
2837  *      context.  We hand the port back to the our control.
2838  */
2839 void serial8250_unregister_port(int line)
2840 {
2841         struct uart_8250_port *uart = &serial8250_ports[line];
2842
2843         mutex_lock(&serial_mutex);
2844         uart_remove_one_port(&serial8250_reg, &uart->port);
2845         if (serial8250_isa_devs) {
2846                 uart->port.flags &= ~UPF_BOOT_AUTOCONF;
2847                 uart->port.type = PORT_UNKNOWN;
2848                 uart->port.dev = &serial8250_isa_devs->dev;
2849                 uart_add_one_port(&serial8250_reg, &uart->port);
2850         } else {
2851                 uart->port.dev = NULL;
2852         }
2853         mutex_unlock(&serial_mutex);
2854 }
2855 EXPORT_SYMBOL(serial8250_unregister_port);
2856
2857 static int __init serial8250_init(void)
2858 {
2859         int ret, i;
2860
2861         if (nr_uarts > UART_NR)
2862                 nr_uarts = UART_NR;
2863
2864         printk(KERN_INFO "Serial: 8250/16550 driver $Revision: 1.90 $ "
2865                 "%d ports, IRQ sharing %sabled\n", nr_uarts,
2866                 share_irqs ? "en" : "dis");
2867
2868         for (i = 0; i < NR_IRQS; i++)
2869                 spin_lock_init(&irq_lists[i].lock);
2870
2871         ret = uart_register_driver(&serial8250_reg);
2872         if (ret)
2873                 goto out;
2874
2875         serial8250_isa_devs = platform_device_alloc("serial8250",
2876                                                     PLAT8250_DEV_LEGACY);
2877         if (!serial8250_isa_devs) {
2878                 ret = -ENOMEM;
2879                 goto unreg_uart_drv;
2880         }
2881
2882         ret = platform_device_add(serial8250_isa_devs);
2883         if (ret)
2884                 goto put_dev;
2885
2886         serial8250_register_ports(&serial8250_reg, &serial8250_isa_devs->dev);
2887
2888         ret = platform_driver_register(&serial8250_isa_driver);
2889         if (ret == 0)
2890                 goto out;
2891
2892         platform_device_del(serial8250_isa_devs);
2893  put_dev:
2894         platform_device_put(serial8250_isa_devs);
2895  unreg_uart_drv:
2896         uart_unregister_driver(&serial8250_reg);
2897  out:
2898         return ret;
2899 }
2900
2901 static void __exit serial8250_exit(void)
2902 {
2903         struct platform_device *isa_dev = serial8250_isa_devs;
2904
2905         /*
2906          * This tells serial8250_unregister_port() not to re-register
2907          * the ports (thereby making serial8250_isa_driver permanently
2908          * in use.)
2909          */
2910         serial8250_isa_devs = NULL;
2911
2912         platform_driver_unregister(&serial8250_isa_driver);
2913         platform_device_unregister(isa_dev);
2914
2915         uart_unregister_driver(&serial8250_reg);
2916 }
2917
2918 module_init(serial8250_init);
2919 module_exit(serial8250_exit);
2920
2921 EXPORT_SYMBOL(serial8250_suspend_port);
2922 EXPORT_SYMBOL(serial8250_resume_port);
2923
2924 MODULE_LICENSE("GPL");
2925 MODULE_DESCRIPTION("Generic 8250/16x50 serial driver $Revision: 1.90 $");
2926
2927 module_param(share_irqs, uint, 0644);
2928 MODULE_PARM_DESC(share_irqs, "Share IRQs with other non-8250/16x50 devices"
2929         " (unsafe)");
2930
2931 module_param(nr_uarts, uint, 0644);
2932 MODULE_PARM_DESC(nr_uarts, "Maximum number of UARTs supported. (1-" __MODULE_STRING(CONFIG_SERIAL_8250_NR_UARTS) ")");
2933
2934 #ifdef CONFIG_SERIAL_8250_RSA
2935 module_param_array(probe_rsa, ulong, &probe_rsa_count, 0444);
2936 MODULE_PARM_DESC(probe_rsa, "Probe I/O ports for RSA");
2937 #endif
2938 MODULE_ALIAS_CHARDEV_MAJOR(TTY_MAJOR);