drivers/serial/8250.c

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