drivers/serial/m32r_sio.c

   1 /*
   2  *  m32r_sio.c
   3  *
   4  *  Driver for M32R serial ports
   5  *
   6  *  Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
   7  *  Based on drivers/serial/8250.c.
   8  *
   9  *  Copyright (C) 2001  Russell King.
  10  *  Copyright (C) 2004  Hirokazu Takata <takata at linux-m32r.org>
  11  *
  12  * This program is free software; you can redistribute it and/or modify
  13  * it under the terms of the GNU General Public License as published by
  14  * the Free Software Foundation; either version 2 of the License, or
  15  * (at your option) any later version.
  16  */
  17
  18 /*
  19  * A note about mapbase / membase
  20  *
  21  *  mapbase is the physical address of the IO port.  Currently, we don't
  22  *  support this very well, and it may well be dropped from this driver
  23  *  in future.  As such, mapbase should be NULL.
  24  *
  25  *  membase is an 'ioremapped' cookie.  This is compatible with the old
  26  *  serial.c driver, and is currently the preferred form.
  27  */
  28 #include <linux/config.h>
  29
  30 #if defined(CONFIG_SERIAL_M32R_SIO_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
  31 #define SUPPORT_SYSRQ
  32 #endif
  33
  34 #include <linux/module.h>
  35 #include <linux/tty.h>
  36 #include <linux/ioport.h>
  37 #include <linux/init.h>
  38 #include <linux/console.h>
  39 #include <linux/sysrq.h>
  40 #include <linux/serial.h>
  41 #include <linux/serialP.h>
  42 #include <linux/delay.h>
  43
  44 #include <asm/m32r.h>
  45 #include <asm/io.h>
  46 #include <asm/irq.h>
  47
  48 #define PORT_M32R_BASE  PORT_M32R_SIO
  49 #define PORT_INDEX(x)   (x - PORT_M32R_BASE + 1)
  50 #define BAUD_RATE       115200
  51
  52 #include <linux/serial_core.h>
  53 #include "m32r_sio.h"
  54 #include "m32r_sio_reg.h"
  55
  56 /*
  57  * Debugging.
  58  */
  59 #if 0
  60 #define DEBUG_AUTOCONF(fmt...)  printk(fmt)
  61 #else
  62 #define DEBUG_AUTOCONF(fmt...)  do { } while (0)
  63 #endif
  64
  65 #if 0
  66 #define DEBUG_INTR(fmt...)      printk(fmt)
  67 #else
  68 #define DEBUG_INTR(fmt...)      do { } while (0)
  69 #endif
  70
  71 #define PASS_LIMIT      256
  72
  73 /*
  74  * We default to IRQ0 for the "no irq" hack.   Some
  75  * machine types want others as well - they're free
  76  * to redefine this in their header file.
  77  */
  78 #define is_real_interrupt(irq)  ((irq) != 0)
  79
  80 #include <asm/serial.h>
  81
  82 /* Standard COM flags */
  83 #define STD_COM_FLAGS (ASYNC_BOOT_AUTOCONF | ASYNC_SKIP_TEST)
  84
  85 /*
  86  * SERIAL_PORT_DFNS tells us about built-in ports that have no
  87  * standard enumeration mechanism.   Platforms that can find all
  88  * serial ports via mechanisms like ACPI or PCI need not supply it.
  89  */
  90 #undef SERIAL_PORT_DFNS
  91 #if defined(CONFIG_PLAT_USRV)
  92
  93 #define SERIAL_PORT_DFNS                                                \
  94        /* UART  CLK     PORT   IRQ            FLAGS */                  \
  95         { 0, BASE_BAUD, 0x3F8, PLD_IRQ_UART0, STD_COM_FLAGS }, /* ttyS0 */ \
  96         { 0, BASE_BAUD, 0x2F8, PLD_IRQ_UART1, STD_COM_FLAGS }, /* ttyS1 */
  97
  98 #else /* !CONFIG_PLAT_USRV */
  99
 100 #if defined(CONFIG_SERIAL_M32R_PLDSIO)
 101 #define SERIAL_PORT_DFNS                                                \
 102         { 0, BASE_BAUD, ((unsigned long)PLD_ESIO0CR), PLD_IRQ_SIO0_RCV, \
 103           STD_COM_FLAGS }, /* ttyS0 */
 104 #else
 105 #define SERIAL_PORT_DFNS                                                \
 106         { 0, BASE_BAUD, M32R_SIO_OFFSET, M32R_IRQ_SIO0_R,               \
 107           STD_COM_FLAGS }, /* ttyS0 */
 108 #endif
 109
 110 #endif /* !CONFIG_PLAT_USRV */
 111
 112 static struct old_serial_port old_serial_port[] = {
 113         SERIAL_PORT_DFNS        /* defined in asm/serial.h */
 114 };
 115
 116 #define UART_NR ARRAY_SIZE(old_serial_port)
 117
 118 struct uart_sio_port {
 119         struct uart_port        port;
 120         struct timer_list       timer;          /* "no irq" timer */
 121         struct list_head        list;           /* ports on this IRQ */
 122         unsigned short          rev;
 123         unsigned char           acr;
 124         unsigned char           ier;
 125         unsigned char           lcr;
 126         unsigned char           mcr_mask;       /* mask of user bits */
 127         unsigned char           mcr_force;      /* mask of forced bits */
 128         unsigned char           lsr_break_flag;
 129
 130         /*
 131          * We provide a per-port pm hook.
 132          */
 133         void                    (*pm)(struct uart_port *port,
 134                                       unsigned int state, unsigned int old);
 135 };
 136
 137 struct irq_info {
 138         spinlock_t              lock;
 139         struct list_head        *head;
 140 };
 141
 142 static struct irq_info irq_lists[NR_IRQS];
 143
 144 /*
 145  * Here we define the default xmit fifo size used for each type of UART.
 146  */
 147 static const struct serial_uart_config uart_config[] = {
 148         [PORT_UNKNOWN] = {
 149                 .name                   = "unknown",
 150                 .dfl_xmit_fifo_size     = 1,
 151                 .flags                  = 0,
 152         },
 153         [PORT_INDEX(PORT_M32R_SIO)] = {
 154                 .name                   = "M32RSIO",
 155                 .dfl_xmit_fifo_size     = 1,
 156                 .flags                  = 0,
 157         },
 158 };
 159
 160 #ifdef CONFIG_SERIAL_M32R_PLDSIO
 161
 162 #define __sio_in(x) inw((unsigned long)(x))
 163 #define __sio_out(v,x) outw((v),(unsigned long)(x))
 164
 165 static inline void sio_set_baud_rate(unsigned long baud)
 166 {
 167         unsigned short sbaud;
 168         sbaud = (boot_cpu_data.bus_clock / (baud * 4))-1;
 169         __sio_out(sbaud, PLD_ESIO0BAUR);
 170 }
 171
 172 static void sio_reset(void)
 173 {
 174         unsigned short tmp;
 175
 176         tmp = __sio_in(PLD_ESIO0RXB);
 177         tmp = __sio_in(PLD_ESIO0RXB);
 178         tmp = __sio_in(PLD_ESIO0CR);
 179         sio_set_baud_rate(BAUD_RATE);
 180         __sio_out(0x0300, PLD_ESIO0CR);
 181         __sio_out(0x0003, PLD_ESIO0CR);
 182 }
 183
 184 static void sio_init(void)
 185 {
 186         unsigned short tmp;
 187
 188         tmp = __sio_in(PLD_ESIO0RXB);
 189         tmp = __sio_in(PLD_ESIO0RXB);
 190         tmp = __sio_in(PLD_ESIO0CR);
 191         __sio_out(0x0300, PLD_ESIO0CR);
 192         __sio_out(0x0003, PLD_ESIO0CR);
 193 }
 194
 195 static void sio_error(int *status)
 196 {
 197         printk("SIO0 error[%04x]\n", *status);
 198         do {
 199                 sio_init();
 200         } while ((*status = __sio_in(PLD_ESIO0CR)) != 3);
 201 }
 202
 203 #else /* not CONFIG_SERIAL_M32R_PLDSIO */
 204
 205 #define __sio_in(x) inl(x)
 206 #define __sio_out(v,x) outl((v),(x))
 207
 208 static inline void sio_set_baud_rate(unsigned long baud)
 209 {
 210         unsigned long i, j;
 211
 212         i = boot_cpu_data.bus_clock / (baud * 16);
 213         j = (boot_cpu_data.bus_clock - (i * baud * 16)) / baud;
 214         i -= 1;
 215         j = (j + 1) >> 1;
 216
 217         __sio_out(i, M32R_SIO0_BAUR_PORTL);
 218         __sio_out(j, M32R_SIO0_RBAUR_PORTL);
 219 }
 220
 221 static void sio_reset(void)
 222 {
 223         __sio_out(0x00000300, M32R_SIO0_CR_PORTL);      /* init status */
 224         __sio_out(0x00000800, M32R_SIO0_MOD1_PORTL);    /* 8bit        */
 225         __sio_out(0x00000080, M32R_SIO0_MOD0_PORTL);    /* 1stop non   */
 226         sio_set_baud_rate(BAUD_RATE);
 227         __sio_out(0x00000000, M32R_SIO0_TRCR_PORTL);
 228         __sio_out(0x00000003, M32R_SIO0_CR_PORTL);      /* RXCEN */
 229 }
 230
 231 static void sio_init(void)
 232 {
 233         unsigned int tmp;
 234
 235         tmp = __sio_in(M32R_SIO0_RXB_PORTL);
 236         tmp = __sio_in(M32R_SIO0_RXB_PORTL);
 237         tmp = __sio_in(M32R_SIO0_STS_PORTL);
 238         __sio_out(0x00000003, M32R_SIO0_CR_PORTL);
 239 }
 240
 241 static void sio_error(int *status)
 242 {
 243         printk("SIO0 error[%04x]\n", *status);
 244         do {
 245                 sio_init();
 246         } while ((*status = __sio_in(M32R_SIO0_CR_PORTL)) != 3);
 247 }
 248
 249 #endif /* CONFIG_SERIAL_M32R_PLDSIO */
 250
 251 static _INLINE_ unsigned int sio_in(struct uart_sio_port *up, int offset)
 252 {
 253         return __sio_in(up->port.iobase + offset);
 254 }
 255
 256 static _INLINE_ void sio_out(struct uart_sio_port *up, int offset, int value)
 257 {
 258         __sio_out(value, up->port.iobase + offset);
 259 }
 260
 261 static _INLINE_ unsigned int serial_in(struct uart_sio_port *up, int offset)
 262 {
 263         if (!offset)
 264                 return 0;
 265
 266         return __sio_in(offset);
 267 }
 268
 269 static _INLINE_ void
 270 serial_out(struct uart_sio_port *up, int offset, int value)
 271 {
 272         if (!offset)
 273                 return;
 274
 275         __sio_out(value, offset);
 276 }
 277
 278 static void m32r_sio_stop_tx(struct uart_port *port)
 279 {
 280         struct uart_sio_port *up = (struct uart_sio_port *)port;
 281
 282         if (up->ier & UART_IER_THRI) {
 283                 up->ier &= ~UART_IER_THRI;
 284                 serial_out(up, UART_IER, up->ier);
 285         }
 286 }
 287
 288 static void m32r_sio_start_tx(struct uart_port *port)
 289 {
 290 #ifdef CONFIG_SERIAL_M32R_PLDSIO
 291         struct uart_sio_port *up = (struct uart_sio_port *)port;
 292         struct circ_buf *xmit = &up->port.info->xmit;
 293
 294         if (!(up->ier & UART_IER_THRI)) {
 295                 up->ier |= UART_IER_THRI;
 296                 serial_out(up, UART_IER, up->ier);
 297                 serial_out(up, UART_TX, xmit->buf[xmit->tail]);
 298                 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
 299                 up->port.icount.tx++;
 300         }
 301         while((serial_in(up, UART_LSR) & UART_EMPTY) != UART_EMPTY);
 302 #else
 303         struct uart_sio_port *up = (struct uart_sio_port *)port;
 304
 305         if (!(up->ier & UART_IER_THRI)) {
 306                 up->ier |= UART_IER_THRI;
 307                 serial_out(up, UART_IER, up->ier);
 308         }
 309 #endif
 310 }
 311
 312 static void m32r_sio_stop_rx(struct uart_port *port)
 313 {
 314         struct uart_sio_port *up = (struct uart_sio_port *)port;
 315
 316         up->ier &= ~UART_IER_RLSI;
 317         up->port.read_status_mask &= ~UART_LSR_DR;
 318         serial_out(up, UART_IER, up->ier);
 319 }
 320
 321 static void m32r_sio_enable_ms(struct uart_port *port)
 322 {
 323         struct uart_sio_port *up = (struct uart_sio_port *)port;
 324
 325         up->ier |= UART_IER_MSI;
 326         serial_out(up, UART_IER, up->ier);
 327 }
 328
 329 static _INLINE_ void receive_chars(struct uart_sio_port *up, int *status,
 330         struct pt_regs *regs)
 331 {
 332         struct tty_struct *tty = up->port.info->tty;
 333         unsigned char ch;
 334         int max_count = 256;
 335
 336         do {
 337                 if (unlikely(tty->flip.count >= TTY_FLIPBUF_SIZE)) {
 338                         tty->flip.work.func((void *)tty);
 339                         if (tty->flip.count >= TTY_FLIPBUF_SIZE)
 340                                 return; // if TTY_DONT_FLIP is set
 341                 }
 342                 ch = sio_in(up, SIORXB);
 343                 *tty->flip.char_buf_ptr = ch;
 344                 *tty->flip.flag_buf_ptr = TTY_NORMAL;
 345                 up->port.icount.rx++;
 346
 347                 if (unlikely(*status & (UART_LSR_BI | UART_LSR_PE |
 348                                        UART_LSR_FE | UART_LSR_OE))) {
 349                         /*
 350                          * For statistics only
 351                          */
 352                         if (*status & UART_LSR_BI) {
 353                                 *status &= ~(UART_LSR_FE | UART_LSR_PE);
 354                                 up->port.icount.brk++;
 355                                 /*
 356                                  * We do the SysRQ and SAK checking
 357                                  * here because otherwise the break
 358                                  * may get masked by ignore_status_mask
 359                                  * or read_status_mask.
 360                                  */
 361                                 if (uart_handle_break(&up->port))
 362                                         goto ignore_char;
 363                         } else if (*status & UART_LSR_PE)
 364                                 up->port.icount.parity++;
 365                         else if (*status & UART_LSR_FE)
 366                                 up->port.icount.frame++;
 367                         if (*status & UART_LSR_OE)
 368                                 up->port.icount.overrun++;
 369
 370                         /*
 371                          * Mask off conditions which should be ingored.
 372                          */
 373                         *status &= up->port.read_status_mask;
 374
 375                         if (up->port.line == up->port.cons->index) {
 376                                 /* Recover the break flag from console xmit */
 377                                 *status |= up->lsr_break_flag;
 378                                 up->lsr_break_flag = 0;
 379                         }
 380
 381                         if (*status & UART_LSR_BI) {
 382                                 DEBUG_INTR("handling break....");
 383                                 *tty->flip.flag_buf_ptr = TTY_BREAK;
 384                         } else if (*status & UART_LSR_PE)
 385                                 *tty->flip.flag_buf_ptr = TTY_PARITY;
 386                         else if (*status & UART_LSR_FE)
 387                                 *tty->flip.flag_buf_ptr = TTY_FRAME;
 388                 }
 389                 if (uart_handle_sysrq_char(&up->port, ch, regs))
 390                         goto ignore_char;
 391                 if ((*status & up->port.ignore_status_mask) == 0) {
 392                         tty->flip.flag_buf_ptr++;
 393                         tty->flip.char_buf_ptr++;
 394                         tty->flip.count++;
 395                 }
 396                 if ((*status & UART_LSR_OE) &&
 397                     tty->flip.count < TTY_FLIPBUF_SIZE) {
 398                         /*
 399                          * Overrun is special, since it's reported
 400                          * immediately, and doesn't affect the current
 401                          * character.
 402                          */
 403                         *tty->flip.flag_buf_ptr = TTY_OVERRUN;
 404                         tty->flip.flag_buf_ptr++;
 405                         tty->flip.char_buf_ptr++;
 406                         tty->flip.count++;
 407                 }
 408         ignore_char:
 409                 *status = serial_in(up, UART_LSR);
 410         } while ((*status & UART_LSR_DR) && (max_count-- > 0));
 411         tty_flip_buffer_push(tty);
 412 }
 413
 414 static _INLINE_ void transmit_chars(struct uart_sio_port *up)
 415 {
 416         struct circ_buf *xmit = &up->port.info->xmit;
 417         int count;
 418
 419         if (up->port.x_char) {
 420 #ifndef CONFIG_SERIAL_M32R_PLDSIO       /* XXX */
 421                 serial_out(up, UART_TX, up->port.x_char);
 422 #endif
 423                 up->port.icount.tx++;
 424                 up->port.x_char = 0;
 425                 return;
 426         }
 427         if (uart_circ_empty(xmit) || uart_tx_stopped(&up->port)) {
 428                 m32r_sio_stop_tx(&up->port);
 429                 return;
 430         }
 431
 432         count = up->port.fifosize;
 433         do {
 434                 serial_out(up, UART_TX, xmit->buf[xmit->tail]);
 435                 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
 436                 up->port.icount.tx++;
 437                 if (uart_circ_empty(xmit))
 438                         break;
 439                 while (!serial_in(up, UART_LSR) & UART_LSR_THRE);
 440
 441         } while (--count > 0);
 442
 443         if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 444                 uart_write_wakeup(&up->port);
 445
 446         DEBUG_INTR("THRE...");
 447
 448         if (uart_circ_empty(xmit))
 449                 m32r_sio_stop_tx(&up->port);
 450 }
 451
 452 /*
 453  * This handles the interrupt from one port.
 454  */
 455 static inline void m32r_sio_handle_port(struct uart_sio_port *up,
 456         unsigned int status, struct pt_regs *regs)
 457 {
 458         DEBUG_INTR("status = %x...", status);
 459
 460         if (status & 0x04)
 461                 receive_chars(up, &status, regs);
 462         if (status & 0x01)
 463                 transmit_chars(up);
 464 }
 465
 466 /*
 467  * This is the serial driver's interrupt routine.
 468  *
 469  * Arjan thinks the old way was overly complex, so it got simplified.
 470  * Alan disagrees, saying that need the complexity to handle the weird
 471  * nature of ISA shared interrupts.  (This is a special exception.)
 472  *
 473  * In order to handle ISA shared interrupts properly, we need to check
 474  * that all ports have been serviced, and therefore the ISA interrupt
 475  * line has been de-asserted.
 476  *
 477  * This means we need to loop through all ports. checking that they
 478  * don't have an interrupt pending.
 479  */
 480 static irqreturn_t m32r_sio_interrupt(int irq, void *dev_id,
 481         struct pt_regs *regs)
 482 {
 483         struct irq_info *i = dev_id;
 484         struct list_head *l, *end = NULL;
 485         int pass_counter = 0;
 486
 487         DEBUG_INTR("m32r_sio_interrupt(%d)...", irq);
 488
 489 #ifdef CONFIG_SERIAL_M32R_PLDSIO
 490 //      if (irq == PLD_IRQ_SIO0_SND)
 491 //              irq = PLD_IRQ_SIO0_RCV;
 492 #else
 493         if (irq == M32R_IRQ_SIO0_S)
 494                 irq = M32R_IRQ_SIO0_R;
 495 #endif
 496
 497         spin_lock(&i->lock);
 498
 499         l = i->head;
 500         do {
 501                 struct uart_sio_port *up;
 502                 unsigned int sts;
 503
 504                 up = list_entry(l, struct uart_sio_port, list);
 505
 506                 sts = sio_in(up, SIOSTS);
 507                 if (sts & 0x5) {
 508                         spin_lock(&up->port.lock);
 509                         m32r_sio_handle_port(up, sts, regs);
 510                         spin_unlock(&up->port.lock);
 511
 512                         end = NULL;
 513                 } else if (end == NULL)
 514                         end = l;
 515
 516                 l = l->next;
 517
 518                 if (l == i->head && pass_counter++ > PASS_LIMIT) {
 519                         if (sts & 0xe0)
 520                                 sio_error(&sts);
 521                         break;
 522                 }
 523         } while (l != end);
 524
 525         spin_unlock(&i->lock);
 526
 527         DEBUG_INTR("end.\n");
 528
 529         return IRQ_HANDLED;
 530 }
 531
 532 /*
 533  * To support ISA shared interrupts, we need to have one interrupt
 534  * handler that ensures that the IRQ line has been deasserted
 535  * before returning.  Failing to do this will result in the IRQ
 536  * line being stuck active, and, since ISA irqs are edge triggered,
 537  * no more IRQs will be seen.
 538  */
 539 static void serial_do_unlink(struct irq_info *i, struct uart_sio_port *up)
 540 {
 541         spin_lock_irq(&i->lock);
 542
 543         if (!list_empty(i->head)) {
 544                 if (i->head == &up->list)
 545                         i->head = i->head->next;
 546                 list_del(&up->list);
 547         } else {
 548                 BUG_ON(i->head != &up->list);
 549                 i->head = NULL;
 550         }
 551
 552         spin_unlock_irq(&i->lock);
 553 }
 554
 555 static int serial_link_irq_chain(struct uart_sio_port *up)
 556 {
 557         struct irq_info *i = irq_lists + up->port.irq;
 558         int ret, irq_flags = up->port.flags & UPF_SHARE_IRQ ? SA_SHIRQ : 0;
 559
 560         spin_lock_irq(&i->lock);
 561
 562         if (i->head) {
 563                 list_add(&up->list, i->head);
 564                 spin_unlock_irq(&i->lock);
 565
 566                 ret = 0;
 567         } else {
 568                 INIT_LIST_HEAD(&up->list);
 569                 i->head = &up->list;
 570                 spin_unlock_irq(&i->lock);
 571
 572                 ret = request_irq(up->port.irq, m32r_sio_interrupt,
 573                                   irq_flags, "SIO0-RX", i);
 574                 ret |= request_irq(up->port.irq + 1, m32r_sio_interrupt,
 575                                   irq_flags, "SIO0-TX", i);
 576                 if (ret < 0)
 577                         serial_do_unlink(i, up);
 578         }
 579
 580         return ret;
 581 }
 582
 583 static void serial_unlink_irq_chain(struct uart_sio_port *up)
 584 {
 585         struct irq_info *i = irq_lists + up->port.irq;
 586
 587         BUG_ON(i->head == NULL);
 588
 589         if (list_empty(i->head)) {
 590                 free_irq(up->port.irq, i);
 591                 free_irq(up->port.irq + 1, i);
 592         }
 593
 594         serial_do_unlink(i, up);
 595 }
 596
 597 /*
 598  * This function is used to handle ports that do not have an interrupt.
 599  */
 600 static void m32r_sio_timeout(unsigned long data)
 601 {
 602         struct uart_sio_port *up = (struct uart_sio_port *)data;
 603         unsigned int timeout;
 604         unsigned int sts;
 605
 606         sts = sio_in(up, SIOSTS);
 607         if (sts & 0x5) {
 608                 spin_lock(&up->port.lock);
 609                 m32r_sio_handle_port(up, sts, NULL);
 610                 spin_unlock(&up->port.lock);
 611         }
 612
 613         timeout = up->port.timeout;
 614         timeout = timeout > 6 ? (timeout / 2 - 2) : 1;
 615         mod_timer(&up->timer, jiffies + timeout);
 616 }
 617
 618 static unsigned int m32r_sio_tx_empty(struct uart_port *port)
 619 {
 620         struct uart_sio_port *up = (struct uart_sio_port *)port;
 621         unsigned long flags;
 622         unsigned int ret;
 623
 624         spin_lock_irqsave(&up->port.lock, flags);
 625         ret = serial_in(up, UART_LSR) & UART_LSR_TEMT ? TIOCSER_TEMT : 0;
 626         spin_unlock_irqrestore(&up->port.lock, flags);
 627
 628         return ret;
 629 }
 630
 631 static unsigned int m32r_sio_get_mctrl(struct uart_port *port)
 632 {
 633         return 0;
 634 }
 635
 636 static void m32r_sio_set_mctrl(struct uart_port *port, unsigned int mctrl)
 637 {
 638
 639 }
 640
 641 static void m32r_sio_break_ctl(struct uart_port *port, int break_state)
 642 {
 643
 644 }
 645
 646 static int m32r_sio_startup(struct uart_port *port)
 647 {
 648         struct uart_sio_port *up = (struct uart_sio_port *)port;
 649         int retval;
 650
 651         sio_init();
 652
 653         /*
 654          * If the "interrupt" for this port doesn't correspond with any
 655          * hardware interrupt, we use a timer-based system.  The original
 656          * driver used to do this with IRQ0.
 657          */
 658         if (!is_real_interrupt(up->port.irq)) {
 659                 unsigned int timeout = up->port.timeout;
 660
 661                 timeout = timeout > 6 ? (timeout / 2 - 2) : 1;
 662
 663                 up->timer.data = (unsigned long)up;
 664                 mod_timer(&up->timer, jiffies + timeout);
 665         } else {
 666                 retval = serial_link_irq_chain(up);
 667                 if (retval)
 668                         return retval;
 669         }
 670
 671         /*
 672          * Finally, enable interrupts.  Note: Modem status interrupts
 673          * are set via set_termios(), which will be occurring imminently
 674          * anyway, so we don't enable them here.
 675          * - M32R_SIO: 0x0c
 676          * - M32R_PLDSIO: 0x04
 677          */
 678         up->ier = UART_IER_MSI | UART_IER_RLSI | UART_IER_RDI;
 679         sio_out(up, SIOTRCR, up->ier);
 680
 681         /*
 682          * And clear the interrupt registers again for luck.
 683          */
 684         sio_reset();
 685
 686         return 0;
 687 }
 688
 689 static void m32r_sio_shutdown(struct uart_port *port)
 690 {
 691         struct uart_sio_port *up = (struct uart_sio_port *)port;
 692
 693         /*
 694          * Disable interrupts from this port
 695          */
 696         up->ier = 0;
 697         sio_out(up, SIOTRCR, 0);
 698
 699         /*
 700          * Disable break condition and FIFOs
 701          */
 702
 703         sio_init();
 704
 705         if (!is_real_interrupt(up->port.irq))
 706                 del_timer_sync(&up->timer);
 707         else
 708                 serial_unlink_irq_chain(up);
 709 }
 710
 711 static unsigned int m32r_sio_get_divisor(struct uart_port *port,
 712         unsigned int baud)
 713 {
 714         return uart_get_divisor(port, baud);
 715 }
 716
 717 static void m32r_sio_set_termios(struct uart_port *port,
 718         struct termios *termios, struct termios *old)
 719 {
 720         struct uart_sio_port *up = (struct uart_sio_port *)port;
 721         unsigned char cval = 0;
 722         unsigned long flags;
 723         unsigned int baud, quot;
 724
 725         switch (termios->c_cflag & CSIZE) {
 726         case CS5:
 727                 cval = UART_LCR_WLEN5;
 728                 break;
 729         case CS6:
 730                 cval = UART_LCR_WLEN6;
 731                 break;
 732         case CS7:
 733                 cval = UART_LCR_WLEN7;
 734                 break;
 735         default:
 736         case CS8:
 737                 cval = UART_LCR_WLEN8;
 738                 break;
 739         }
 740
 741         if (termios->c_cflag & CSTOPB)
 742                 cval |= UART_LCR_STOP;
 743         if (termios->c_cflag & PARENB)
 744                 cval |= UART_LCR_PARITY;
 745         if (!(termios->c_cflag & PARODD))
 746                 cval |= UART_LCR_EPAR;
 747 #ifdef CMSPAR
 748         if (termios->c_cflag & CMSPAR)
 749                 cval |= UART_LCR_SPAR;
 750 #endif
 751
 752         /*
 753          * Ask the core to calculate the divisor for us.
 754          */
 755 #ifdef CONFIG_SERIAL_M32R_PLDSIO
 756         baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/4);
 757 #else
 758         baud = uart_get_baud_rate(port, termios, old, 0, port->uartclk/16);
 759 #endif
 760         quot = m32r_sio_get_divisor(port, baud);
 761
 762         /*
 763          * Ok, we're now changing the port state.  Do it with
 764          * interrupts disabled.
 765          */
 766         spin_lock_irqsave(&up->port.lock, flags);
 767
 768         sio_set_baud_rate(baud);
 769
 770         /*
 771          * Update the per-port timeout.
 772          */
 773         uart_update_timeout(port, termios->c_cflag, baud);
 774
 775         up->port.read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR;
 776         if (termios->c_iflag & INPCK)
 777                 up->port.read_status_mask |= UART_LSR_FE | UART_LSR_PE;
 778         if (termios->c_iflag & (BRKINT | PARMRK))
 779                 up->port.read_status_mask |= UART_LSR_BI;
 780
 781         /*
 782          * Characteres to ignore
 783          */
 784         up->port.ignore_status_mask = 0;
 785         if (termios->c_iflag & IGNPAR)
 786                 up->port.ignore_status_mask |= UART_LSR_PE | UART_LSR_FE;
 787         if (termios->c_iflag & IGNBRK) {
 788                 up->port.ignore_status_mask |= UART_LSR_BI;
 789                 /*
 790                  * If we're ignoring parity and break indicators,
 791                  * ignore overruns too (for real raw support).
 792                  */
 793                 if (termios->c_iflag & IGNPAR)
 794                         up->port.ignore_status_mask |= UART_LSR_OE;
 795         }
 796
 797         /*
 798          * ignore all characters if CREAD is not set
 799          */
 800         if ((termios->c_cflag & CREAD) == 0)
 801                 up->port.ignore_status_mask |= UART_LSR_DR;
 802
 803         /*
 804          * CTS flow control flag and modem status interrupts
 805          */
 806         up->ier &= ~UART_IER_MSI;
 807         if (UART_ENABLE_MS(&up->port, termios->c_cflag))
 808                 up->ier |= UART_IER_MSI;
 809
 810         serial_out(up, UART_IER, up->ier);
 811
 812         up->lcr = cval;                                 /* Save LCR */
 813         spin_unlock_irqrestore(&up->port.lock, flags);
 814 }
 815
 816 static void m32r_sio_pm(struct uart_port *port, unsigned int state,
 817         unsigned int oldstate)
 818 {
 819         struct uart_sio_port *up = (struct uart_sio_port *)port;
 820
 821         if (up->pm)
 822                 up->pm(port, state, oldstate);
 823 }
 824
 825 /*
 826  * Resource handling.  This is complicated by the fact that resources
 827  * depend on the port type.  Maybe we should be claiming the standard
 828  * 8250 ports, and then trying to get other resources as necessary?
 829  */
 830 static int
 831 m32r_sio_request_std_resource(struct uart_sio_port *up, struct resource **res)
 832 {
 833         unsigned int size = 8 << up->port.regshift;
 834 #ifndef CONFIG_SERIAL_M32R_PLDSIO
 835         unsigned long start;
 836 #endif
 837         int ret = 0;
 838
 839         switch (up->port.iotype) {
 840         case UPIO_MEM:
 841                 if (up->port.mapbase) {
 842 #ifdef CONFIG_SERIAL_M32R_PLDSIO
 843                         *res = request_mem_region(up->port.mapbase, size, "serial");
 844 #else
 845                         start = up->port.mapbase;
 846                         *res = request_mem_region(start, size, "serial");
 847 #endif
 848                         if (!*res)
 849                                 ret = -EBUSY;
 850                 }
 851                 break;
 852
 853         case UPIO_PORT:
 854                 *res = request_region(up->port.iobase, size, "serial");
 855                 if (!*res)
 856                         ret = -EBUSY;
 857                 break;
 858         }
 859         return ret;
 860 }
 861
 862 static void m32r_sio_release_port(struct uart_port *port)
 863 {
 864         struct uart_sio_port *up = (struct uart_sio_port *)port;
 865         unsigned long start, offset = 0, size = 0;
 866
 867         size <<= up->port.regshift;
 868
 869         switch (up->port.iotype) {
 870         case UPIO_MEM:
 871                 if (up->port.mapbase) {
 872                         /*
 873                          * Unmap the area.
 874                          */
 875                         iounmap(up->port.membase);
 876                         up->port.membase = NULL;
 877
 878                         start = up->port.mapbase;
 879
 880                         if (size)
 881                                 release_mem_region(start + offset, size);
 882                         release_mem_region(start, 8 << up->port.regshift);
 883                 }
 884                 break;
 885
 886         case UPIO_PORT:
 887                 start = up->port.iobase;
 888
 889                 if (size)
 890                         release_region(start + offset, size);
 891                 release_region(start + offset, 8 << up->port.regshift);
 892                 break;
 893
 894         default:
 895                 break;
 896         }
 897 }
 898
 899 static int m32r_sio_request_port(struct uart_port *port)
 900 {
 901         struct uart_sio_port *up = (struct uart_sio_port *)port;
 902         struct resource *res = NULL;
 903         int ret = 0;
 904
 905         ret = m32r_sio_request_std_resource(up, &res);
 906
 907         /*
 908          * If we have a mapbase, then request that as well.
 909          */
 910         if (ret == 0 && up->port.flags & UPF_IOREMAP) {
 911                 int size = res->end - res->start + 1;
 912
 913                 up->port.membase = ioremap(up->port.mapbase, size);
 914                 if (!up->port.membase)
 915                         ret = -ENOMEM;
 916         }
 917
 918         if (ret < 0) {
 919                 if (res)
 920                         release_resource(res);
 921         }
 922
 923         return ret;
 924 }
 925
 926 static void m32r_sio_config_port(struct uart_port *port, int flags)
 927 {
 928         struct uart_sio_port *up = (struct uart_sio_port *)port;
 929
 930         spin_lock_irqsave(&up->port.lock, flags);
 931
 932         up->port.type = (PORT_M32R_SIO - PORT_M32R_BASE + 1);
 933         up->port.fifosize = uart_config[up->port.type].dfl_xmit_fifo_size;
 934
 935         spin_unlock_irqrestore(&up->port.lock, flags);
 936 }
 937
 938 static int
 939 m32r_sio_verify_port(struct uart_port *port, struct serial_struct *ser)
 940 {
 941         if (ser->irq >= NR_IRQS || ser->irq < 0 ||
 942             ser->baud_base < 9600 || ser->type < PORT_UNKNOWN ||
 943             ser->type >= ARRAY_SIZE(uart_config))
 944                 return -EINVAL;
 945         return 0;
 946 }
 947
 948 static const char *
 949 m32r_sio_type(struct uart_port *port)
 950 {
 951         int type = port->type;
 952
 953         if (type >= ARRAY_SIZE(uart_config))
 954                 type = 0;
 955         return uart_config[type].name;
 956 }
 957
 958 static struct uart_ops m32r_sio_pops = {
 959         .tx_empty       = m32r_sio_tx_empty,
 960         .set_mctrl      = m32r_sio_set_mctrl,
 961         .get_mctrl      = m32r_sio_get_mctrl,
 962         .stop_tx        = m32r_sio_stop_tx,
 963         .start_tx       = m32r_sio_start_tx,
 964         .stop_rx        = m32r_sio_stop_rx,
 965         .enable_ms      = m32r_sio_enable_ms,
 966         .break_ctl      = m32r_sio_break_ctl,
 967         .startup        = m32r_sio_startup,
 968         .shutdown       = m32r_sio_shutdown,
 969         .set_termios    = m32r_sio_set_termios,
 970         .pm             = m32r_sio_pm,
 971         .type           = m32r_sio_type,
 972         .release_port   = m32r_sio_release_port,
 973         .request_port   = m32r_sio_request_port,
 974         .config_port    = m32r_sio_config_port,
 975         .verify_port    = m32r_sio_verify_port,
 976 };
 977
 978 static struct uart_sio_port m32r_sio_ports[UART_NR];
 979
 980 static void __init m32r_sio_init_ports(void)
 981 {
 982         struct uart_sio_port *up;
 983         static int first = 1;
 984         int i;
 985
 986         if (!first)
 987                 return;
 988         first = 0;
 989
 990         for (i = 0, up = m32r_sio_ports; i < ARRAY_SIZE(old_serial_port);
 991              i++, up++) {
 992                 up->port.iobase   = old_serial_port[i].port;
 993                 up->port.irq      = irq_canonicalize(old_serial_port[i].irq);
 994                 up->port.uartclk  = old_serial_port[i].baud_base * 16;
 995                 up->port.flags    = old_serial_port[i].flags;
 996                 up->port.membase  = old_serial_port[i].iomem_base;
 997                 up->port.iotype   = old_serial_port[i].io_type;
 998                 up->port.regshift = old_serial_port[i].iomem_reg_shift;
 999                 up->port.ops      = &m32r_sio_pops;
1000         }
1001 }
1002
1003 static void __init m32r_sio_register_ports(struct uart_driver *drv)
1004 {
1005         int i;
1006
1007         m32r_sio_init_ports();
1008
1009         for (i = 0; i < UART_NR; i++) {
1010                 struct uart_sio_port *up = &m32r_sio_ports[i];
1011
1012                 up->port.line = i;
1013                 up->port.ops = &m32r_sio_pops;
1014                 init_timer(&up->timer);
1015                 up->timer.function = m32r_sio_timeout;
1016
1017                 /*
1018                  * ALPHA_KLUDGE_MCR needs to be killed.
1019                  */
1020                 up->mcr_mask = ~ALPHA_KLUDGE_MCR;
1021                 up->mcr_force = ALPHA_KLUDGE_MCR;
1022
1023                 uart_add_one_port(drv, &up->port);
1024         }
1025 }
1026
1027 #ifdef CONFIG_SERIAL_M32R_SIO_CONSOLE
1028
1029 /*
1030  *      Wait for transmitter & holding register to empty
1031  */
1032 static inline void wait_for_xmitr(struct uart_sio_port *up)
1033 {
1034         unsigned int status, tmout = 10000;
1035
1036         /* Wait up to 10ms for the character(s) to be sent. */
1037         do {
1038                 status = sio_in(up, SIOSTS);
1039
1040                 if (--tmout == 0)
1041                         break;
1042                 udelay(1);
1043         } while ((status & UART_EMPTY) != UART_EMPTY);
1044
1045         /* Wait up to 1s for flow control if necessary */
1046         if (up->port.flags & UPF_CONS_FLOW) {
1047                 tmout = 1000000;
1048                 while (--tmout)
1049                         udelay(1);
1050         }
1051 }
1052
1053 /*
1054  *      Print a string to the serial port trying not to disturb
1055  *      any possible real use of the port...
1056  *
1057  *      The console_lock must be held when we get here.
1058  */
1059 static void m32r_sio_console_write(struct console *co, const char *s,
1060         unsigned int count)
1061 {
1062         struct uart_sio_port *up = &m32r_sio_ports[co->index];
1063         unsigned int ier;
1064         int i;
1065
1066         /*
1067          *      First save the UER then disable the interrupts
1068          */
1069         ier = sio_in(up, SIOTRCR);
1070         sio_out(up, SIOTRCR, 0);
1071
1072         /*
1073          *      Now, do each character
1074          */
1075         for (i = 0; i < count; i++, s++) {
1076                 wait_for_xmitr(up);
1077
1078                 /*
1079                  *      Send the character out.
1080                  *      If a LF, also do CR...
1081                  */
1082                 sio_out(up, SIOTXB, *s);
1083
1084                 if (*s == 10) {
1085                         wait_for_xmitr(up);
1086                         sio_out(up, SIOTXB, 13);
1087                 }
1088         }
1089
1090         /*
1091          *      Finally, wait for transmitter to become empty
1092          *      and restore the IER
1093          */
1094         wait_for_xmitr(up);
1095         sio_out(up, SIOTRCR, ier);
1096 }
1097
1098 static int __init m32r_sio_console_setup(struct console *co, char *options)
1099 {
1100         struct uart_port *port;
1101         int baud = 9600;
1102         int bits = 8;
1103         int parity = 'n';
1104         int flow = 'n';
1105
1106         /*
1107          * Check whether an invalid uart number has been specified, and
1108          * if so, search for the first available port that does have
1109          * console support.
1110          */
1111         if (co->index >= UART_NR)
1112                 co->index = 0;
1113         port = &m32r_sio_ports[co->index].port;
1114
1115         /*
1116          * Temporary fix.
1117          */
1118         spin_lock_init(&port->lock);
1119
1120         if (options)
1121                 uart_parse_options(options, &baud, &parity, &bits, &flow);
1122
1123         return uart_set_options(port, co, baud, parity, bits, flow);
1124 }
1125
1126 static struct uart_driver m32r_sio_reg;
1127 static struct console m32r_sio_console = {
1128         .name           = "ttyS",
1129         .write          = m32r_sio_console_write,
1130         .device         = uart_console_device,
1131         .setup          = m32r_sio_console_setup,
1132         .flags          = CON_PRINTBUFFER,
1133         .index          = -1,
1134         .data           = &m32r_sio_reg,
1135 };
1136
1137 static int __init m32r_sio_console_init(void)
1138 {
1139         sio_reset();
1140         sio_init();
1141         m32r_sio_init_ports();
1142         register_console(&m32r_sio_console);
1143         return 0;
1144 }
1145 console_initcall(m32r_sio_console_init);
1146
1147 #define M32R_SIO_CONSOLE        &m32r_sio_console
1148 #else
1149 #define M32R_SIO_CONSOLE        NULL
1150 #endif
1151
1152 static struct uart_driver m32r_sio_reg = {
1153         .owner                  = THIS_MODULE,
1154         .driver_name            = "sio",
1155         .devfs_name             = "tts/",
1156         .dev_name               = "ttyS",
1157         .major                  = TTY_MAJOR,
1158         .minor                  = 64,
1159         .nr                     = UART_NR,
1160         .cons                   = M32R_SIO_CONSOLE,
1161 };
1162
1163 /**
1164  *      m32r_sio_suspend_port - suspend one serial port
1165  *      @line: serial line number
1166  *
1167  *      Suspend one serial port.
1168  */
1169 void m32r_sio_suspend_port(int line)
1170 {
1171         uart_suspend_port(&m32r_sio_reg, &m32r_sio_ports[line].port);
1172 }
1173
1174 /**
1175  *      m32r_sio_resume_port - resume one serial port
1176  *      @line: serial line number
1177  *
1178  *      Resume one serial port.
1179  */
1180 void m32r_sio_resume_port(int line)
1181 {
1182         uart_resume_port(&m32r_sio_reg, &m32r_sio_ports[line].port);
1183 }
1184
1185 static int __init m32r_sio_init(void)
1186 {
1187         int ret, i;
1188
1189         printk(KERN_INFO "Serial: M32R SIO driver $Revision: 1.11 $ ");
1190
1191         for (i = 0; i < NR_IRQS; i++)
1192                 spin_lock_init(&irq_lists[i].lock);
1193
1194         ret = uart_register_driver(&m32r_sio_reg);
1195         if (ret >= 0)
1196                 m32r_sio_register_ports(&m32r_sio_reg);
1197
1198         return ret;
1199 }
1200
1201 static void __exit m32r_sio_exit(void)
1202 {
1203         int i;
1204
1205         for (i = 0; i < UART_NR; i++)
1206                 uart_remove_one_port(&m32r_sio_reg, &m32r_sio_ports[i].port);
1207
1208         uart_unregister_driver(&m32r_sio_reg);
1209 }
1210
1211 module_init(m32r_sio_init);
1212 module_exit(m32r_sio_exit);
1213
1214 EXPORT_SYMBOL(m32r_sio_suspend_port);
1215 EXPORT_SYMBOL(m32r_sio_resume_port);
1216
1217 MODULE_LICENSE("GPL");
1218 MODULE_DESCRIPTION("Generic M32R SIO serial driver $Revision: 1.11 $");