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