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