git.oblomov.eu Git - linux-2.6/blob - arch/mn10300/kernel/mn10300-serial.c

   1 /* MN10300 On-chip serial port UART driver
   2  *
   3  * Copyright (C) 2007 Red Hat, Inc. All Rights Reserved.
   4  * Written by David Howells (dhowells@redhat.com)
   5  *
   6  * This program is free software; you can redistribute it and/or
   7  * modify it under the terms of the GNU General Public Licence
   8  * as published by the Free Software Foundation; either version
   9  * 2 of the Licence, or (at your option) any later version.
  10  */
  11
  12 static const char serial_name[] = "MN10300 Serial driver";
  13 static const char serial_version[] = "mn10300_serial-1.0";
  14 static const char serial_revdate[] = "2007-11-06";
  15
  16 #if defined(CONFIG_MN10300_TTYSM_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
  17 #define SUPPORT_SYSRQ
  18 #endif
  19
  20 #include <linux/version.h>
  21 #include <linux/module.h>
  22 #include <linux/serial.h>
  23 #include <linux/circ_buf.h>
  24 #include <linux/errno.h>
  25 #include <linux/signal.h>
  26 #include <linux/sched.h>
  27 #include <linux/timer.h>
  28 #include <linux/interrupt.h>
  29 #include <linux/tty.h>
  30 #include <linux/tty_flip.h>
  31 #include <linux/major.h>
  32 #include <linux/string.h>
  33 #include <linux/ioport.h>
  34 #include <linux/mm.h>
  35 #include <linux/slab.h>
  36 #include <linux/init.h>
  37 #include <linux/console.h>
  38 #include <linux/sysrq.h>
  39
  40 #include <asm/system.h>
  41 #include <asm/io.h>
  42 #include <asm/irq.h>
  43 #include <asm/bitops.h>
  44 #include <asm/serial-regs.h>
  45 #include <asm/unit/timex.h>
  46 #include "mn10300-serial.h"
  47
  48 static inline __attribute__((format(printf, 1, 2)))
  49 void no_printk(const char *fmt, ...)
  50 {
  51 }
  52
  53 #define kenter(FMT, ...) \
  54         printk(KERN_DEBUG "-->%s(" FMT ")\n", __func__, ##__VA_ARGS__)
  55 #define _enter(FMT, ...) \
  56         no_printk(KERN_DEBUG "-->%s(" FMT ")\n", __func__, ##__VA_ARGS__)
  57 #define kdebug(FMT, ...) \
  58         printk(KERN_DEBUG "--- " FMT "\n", ##__VA_ARGS__)
  59 #define _debug(FMT, ...) \
  60         no_printk(KERN_DEBUG "--- " FMT "\n", ##__VA_ARGS__)
  61 #define kproto(FMT, ...) \
  62         printk(KERN_DEBUG "### MNSERIAL " FMT " ###\n", ##__VA_ARGS__)
  63 #define _proto(FMT, ...) \
  64         no_printk(KERN_DEBUG "### MNSERIAL " FMT " ###\n", ##__VA_ARGS__)
  65
  66 #define NR_UARTS 3
  67
  68 #ifdef CONFIG_MN10300_TTYSM_CONSOLE
  69 static void mn10300_serial_console_write(struct console *co,
  70                                            const char *s, unsigned count);
  71 static int __init mn10300_serial_console_setup(struct console *co,
  72                                                  char *options);
  73
  74 static struct uart_driver mn10300_serial_driver;
  75 static struct console mn10300_serial_console = {
  76         .name           = "ttySM",
  77         .write          = mn10300_serial_console_write,
  78         .device         = uart_console_device,
  79         .setup          = mn10300_serial_console_setup,
  80         .flags          = CON_PRINTBUFFER,
  81         .index          = -1,
  82         .data           = &mn10300_serial_driver,
  83 };
  84 #endif
  85
  86 static struct uart_driver mn10300_serial_driver = {
  87         .owner          = NULL,
  88         .driver_name    = "mn10300-serial",
  89         .dev_name       = "ttySM",
  90         .major          = TTY_MAJOR,
  91         .minor          = 128,
  92         .nr             = NR_UARTS,
  93 #ifdef CONFIG_MN10300_TTYSM_CONSOLE
  94         .cons           = &mn10300_serial_console,
  95 #endif
  96 };
  97
  98 static unsigned int mn10300_serial_tx_empty(struct uart_port *);
  99 static void mn10300_serial_set_mctrl(struct uart_port *, unsigned int mctrl);
 100 static unsigned int mn10300_serial_get_mctrl(struct uart_port *);
 101 static void mn10300_serial_stop_tx(struct uart_port *);
 102 static void mn10300_serial_start_tx(struct uart_port *);
 103 static void mn10300_serial_send_xchar(struct uart_port *, char ch);
 104 static void mn10300_serial_stop_rx(struct uart_port *);
 105 static void mn10300_serial_enable_ms(struct uart_port *);
 106 static void mn10300_serial_break_ctl(struct uart_port *, int ctl);
 107 static int mn10300_serial_startup(struct uart_port *);
 108 static void mn10300_serial_shutdown(struct uart_port *);
 109 static void mn10300_serial_set_termios(struct uart_port *,
 110                                          struct ktermios *new,
 111                                          struct ktermios *old);
 112 static const char *mn10300_serial_type(struct uart_port *);
 113 static void mn10300_serial_release_port(struct uart_port *);
 114 static int mn10300_serial_request_port(struct uart_port *);
 115 static void mn10300_serial_config_port(struct uart_port *, int);
 116 static int mn10300_serial_verify_port(struct uart_port *,
 117                                         struct serial_struct *);
 118
 119 static const struct uart_ops mn10300_serial_ops = {
 120         .tx_empty       = mn10300_serial_tx_empty,
 121         .set_mctrl      = mn10300_serial_set_mctrl,
 122         .get_mctrl      = mn10300_serial_get_mctrl,
 123         .stop_tx        = mn10300_serial_stop_tx,
 124         .start_tx       = mn10300_serial_start_tx,
 125         .send_xchar     = mn10300_serial_send_xchar,
 126         .stop_rx        = mn10300_serial_stop_rx,
 127         .enable_ms      = mn10300_serial_enable_ms,
 128         .break_ctl      = mn10300_serial_break_ctl,
 129         .startup        = mn10300_serial_startup,
 130         .shutdown       = mn10300_serial_shutdown,
 131         .set_termios    = mn10300_serial_set_termios,
 132         .type           = mn10300_serial_type,
 133         .release_port   = mn10300_serial_release_port,
 134         .request_port   = mn10300_serial_request_port,
 135         .config_port    = mn10300_serial_config_port,
 136         .verify_port    = mn10300_serial_verify_port,
 137 };
 138
 139 static irqreturn_t mn10300_serial_interrupt(int irq, void *dev_id);
 140
 141 /*
 142  * the first on-chip serial port: ttySM0 (aka SIF0)
 143  */
 144 #ifdef CONFIG_MN10300_TTYSM0
 145 struct mn10300_serial_port mn10300_serial_port_sif0 = {
 146         .uart.ops       = &mn10300_serial_ops,
 147         .uart.membase   = (void __iomem *) &SC0CTR,
 148         .uart.mapbase   = (unsigned long) &SC0CTR,
 149         .uart.iotype    = UPIO_MEM,
 150         .uart.irq       = 0,
 151         .uart.uartclk   = 0, /* MN10300_IOCLK, */
 152         .uart.fifosize  = 1,
 153         .uart.flags     = UPF_BOOT_AUTOCONF,
 154         .uart.line      = 0,
 155         .uart.type      = PORT_MN10300,
 156         .uart.lock      =
 157         __SPIN_LOCK_UNLOCKED(mn10300_serial_port_sif0.uart.lock),
 158         .name           = "ttySM0",
 159         ._iobase        = &SC0CTR,
 160         ._control       = &SC0CTR,
 161         ._status        = (volatile u8 *) &SC0STR,
 162         ._intr          = &SC0ICR,
 163         ._rxb           = &SC0RXB,
 164         ._txb           = &SC0TXB,
 165         .rx_name        = "ttySM0/Rx",
 166         .tx_name        = "ttySM0/Tx",
 167 #ifdef CONFIG_MN10300_TTYSM0_TIMER8
 168         .tm_name        = "ttySM0/Timer8",
 169         ._tmxmd         = &TM8MD,
 170         ._tmxbr         = &TM8BR,
 171         ._tmicr         = &TM8ICR,
 172         .tm_irq         = TM8IRQ,
 173         .div_timer      = MNSCx_DIV_TIMER_16BIT,
 174 #else /* CONFIG_MN10300_TTYSM0_TIMER2 */
 175         .tm_name        = "ttySM0/Timer2",
 176         ._tmxmd         = &TM2MD,
 177         ._tmxbr         = (volatile u16 *) &TM2BR,
 178         ._tmicr         = &TM2ICR,
 179         .tm_irq         = TM2IRQ,
 180         .div_timer      = MNSCx_DIV_TIMER_8BIT,
 181 #endif
 182         .rx_irq         = SC0RXIRQ,
 183         .tx_irq         = SC0TXIRQ,
 184         .rx_icr         = &GxICR(SC0RXIRQ),
 185         .tx_icr         = &GxICR(SC0TXIRQ),
 186         .clock_src      = MNSCx_CLOCK_SRC_IOCLK,
 187         .options        = 0,
 188 #ifdef CONFIG_GDBSTUB_ON_TTYSM0
 189         .gdbstub        = 1,
 190 #endif
 191 };
 192 #endif /* CONFIG_MN10300_TTYSM0 */
 193
 194 /*
 195  * the second on-chip serial port: ttySM1 (aka SIF1)
 196  */
 197 #ifdef CONFIG_MN10300_TTYSM1
 198 struct mn10300_serial_port mn10300_serial_port_sif1 = {
 199         .uart.ops       = &mn10300_serial_ops,
 200         .uart.membase   = (void __iomem *) &SC1CTR,
 201         .uart.mapbase   = (unsigned long) &SC1CTR,
 202         .uart.iotype    = UPIO_MEM,
 203         .uart.irq       = 0,
 204         .uart.uartclk   = 0, /* MN10300_IOCLK, */
 205         .uart.fifosize  = 1,
 206         .uart.flags     = UPF_BOOT_AUTOCONF,
 207         .uart.line      = 1,
 208         .uart.type      = PORT_MN10300,
 209         .uart.lock      =
 210         __SPIN_LOCK_UNLOCKED(mn10300_serial_port_sif1.uart.lock),
 211         .name           = "ttySM1",
 212         ._iobase        = &SC1CTR,
 213         ._control       = &SC1CTR,
 214         ._status        = (volatile u8 *) &SC1STR,
 215         ._intr          = &SC1ICR,
 216         ._rxb           = &SC1RXB,
 217         ._txb           = &SC1TXB,
 218         .rx_name        = "ttySM1/Rx",
 219         .tx_name        = "ttySM1/Tx",
 220 #ifdef CONFIG_MN10300_TTYSM1_TIMER9
 221         .tm_name        = "ttySM1/Timer9",
 222         ._tmxmd         = &TM9MD,
 223         ._tmxbr         = &TM9BR,
 224         ._tmicr         = &TM9ICR,
 225         .tm_irq         = TM9IRQ,
 226         .div_timer      = MNSCx_DIV_TIMER_16BIT,
 227 #else /* CONFIG_MN10300_TTYSM1_TIMER3 */
 228         .tm_name        = "ttySM1/Timer3",
 229         ._tmxmd         = &TM3MD,
 230         ._tmxbr         = (volatile u16 *) &TM3BR,
 231         ._tmicr         = &TM3ICR,
 232         .tm_irq         = TM3IRQ,
 233         .div_timer      = MNSCx_DIV_TIMER_8BIT,
 234 #endif
 235         .rx_irq         = SC1RXIRQ,
 236         .tx_irq         = SC1TXIRQ,
 237         .rx_icr         = &GxICR(SC1RXIRQ),
 238         .tx_icr         = &GxICR(SC1TXIRQ),
 239         .clock_src      = MNSCx_CLOCK_SRC_IOCLK,
 240         .options        = 0,
 241 #ifdef CONFIG_GDBSTUB_ON_TTYSM1
 242         .gdbstub        = 1,
 243 #endif
 244 };
 245 #endif /* CONFIG_MN10300_TTYSM1 */
 246
 247 /*
 248  * the third on-chip serial port: ttySM2 (aka SIF2)
 249  */
 250 #ifdef CONFIG_MN10300_TTYSM2
 251 struct mn10300_serial_port mn10300_serial_port_sif2 = {
 252         .uart.ops       = &mn10300_serial_ops,
 253         .uart.membase   = (void __iomem *) &SC2CTR,
 254         .uart.mapbase   = (unsigned long) &SC2CTR,
 255         .uart.iotype    = UPIO_MEM,
 256         .uart.irq       = 0,
 257         .uart.uartclk   = 0, /* MN10300_IOCLK, */
 258         .uart.fifosize  = 1,
 259         .uart.flags     = UPF_BOOT_AUTOCONF,
 260         .uart.line      = 2,
 261 #ifdef CONFIG_MN10300_TTYSM2_CTS
 262         .uart.type      = PORT_MN10300_CTS,
 263 #else
 264         .uart.type      = PORT_MN10300,
 265 #endif
 266         .uart.lock      =
 267         __SPIN_LOCK_UNLOCKED(mn10300_serial_port_sif2.uart.lock),
 268         .name           = "ttySM2",
 269         .rx_name        = "ttySM2/Rx",
 270         .tx_name        = "ttySM2/Tx",
 271         .tm_name        = "ttySM2/Timer10",
 272         ._iobase        = &SC2CTR,
 273         ._control       = &SC2CTR,
 274         ._status        = &SC2STR,
 275         ._intr          = &SC2ICR,
 276         ._rxb           = &SC2RXB,
 277         ._txb           = &SC2TXB,
 278         ._tmxmd         = &TM10MD,
 279         ._tmxbr         = &TM10BR,
 280         ._tmicr         = &TM10ICR,
 281         .tm_irq         = TM10IRQ,
 282         .div_timer      = MNSCx_DIV_TIMER_16BIT,
 283         .rx_irq         = SC2RXIRQ,
 284         .tx_irq         = SC2TXIRQ,
 285         .rx_icr         = &GxICR(SC2RXIRQ),
 286         .tx_icr         = &GxICR(SC2TXIRQ),
 287         .clock_src      = MNSCx_CLOCK_SRC_IOCLK,
 288 #ifdef CONFIG_MN10300_TTYSM2_CTS
 289         .options        = MNSCx_OPT_CTS,
 290 #else
 291         .options        = 0,
 292 #endif
 293 #ifdef CONFIG_GDBSTUB_ON_TTYSM2
 294         .gdbstub        = 1,
 295 #endif
 296 };
 297 #endif /* CONFIG_MN10300_TTYSM2 */
 298
 299
 300 /*
 301  * list of available serial ports
 302  */
 303 struct mn10300_serial_port *mn10300_serial_ports[NR_UARTS + 1] = {
 304 #ifdef CONFIG_MN10300_TTYSM0
 305         [0]     = &mn10300_serial_port_sif0,
 306 #endif
 307 #ifdef CONFIG_MN10300_TTYSM1
 308         [1]     = &mn10300_serial_port_sif1,
 309 #endif
 310 #ifdef CONFIG_MN10300_TTYSM2
 311         [2]     = &mn10300_serial_port_sif2,
 312 #endif
 313         [NR_UARTS] = NULL,
 314 };
 315
 316
 317 /*
 318  * we abuse the serial ports' baud timers' interrupt lines to get the ability
 319  * to deliver interrupts to userspace as we use the ports' interrupt lines to
 320  * do virtual DMA on account of the ports having no hardware FIFOs
 321  *
 322  * we can generate an interrupt manually in the assembly stubs by writing to
 323  * the enable and detect bits in the interrupt control register, so all we need
 324  * to do here is disable the interrupt line
 325  *
 326  * note that we can't just leave the line enabled as the baud rate timer *also*
 327  * generates interrupts
 328  */
 329 static void mn10300_serial_mask_ack(unsigned int irq)
 330 {
 331         u16 tmp;
 332         GxICR(irq) = GxICR_LEVEL_6;
 333         tmp = GxICR(irq); /* flush write buffer */
 334 }
 335
 336 static void mn10300_serial_nop(unsigned int irq)
 337 {
 338 }
 339
 340 static struct irq_chip mn10300_serial_pic = {
 341         .name           = "mnserial",
 342         .ack            = mn10300_serial_mask_ack,
 343         .mask           = mn10300_serial_mask_ack,
 344         .mask_ack       = mn10300_serial_mask_ack,
 345         .unmask         = mn10300_serial_nop,
 346         .end            = mn10300_serial_nop,
 347 };
 348
 349
 350 /*
 351  * serial virtual DMA interrupt jump table
 352  */
 353 struct mn10300_serial_int mn10300_serial_int_tbl[NR_IRQS];
 354
 355 static void mn10300_serial_dis_tx_intr(struct mn10300_serial_port *port)
 356 {
 357         u16 x;
 358         *port->tx_icr = GxICR_LEVEL_1 | GxICR_DETECT;
 359         x = *port->tx_icr;
 360 }
 361
 362 static void mn10300_serial_en_tx_intr(struct mn10300_serial_port *port)
 363 {
 364         u16 x;
 365         *port->tx_icr = GxICR_LEVEL_1 | GxICR_ENABLE;
 366         x = *port->tx_icr;
 367 }
 368
 369 static void mn10300_serial_dis_rx_intr(struct mn10300_serial_port *port)
 370 {
 371         u16 x;
 372         *port->rx_icr = GxICR_LEVEL_1 | GxICR_DETECT;
 373         x = *port->rx_icr;
 374 }
 375
 376 /*
 377  * multi-bit equivalent of test_and_clear_bit()
 378  */
 379 static int mask_test_and_clear(volatile u8 *ptr, u8 mask)
 380 {
 381         u32 epsw;
 382         asm volatile("  bclr    %1,(%2)         \n"
 383                      "  mov     epsw,%0         \n"
 384                      : "=d"(epsw) : "d"(mask), "a"(ptr));
 385         return !(epsw & EPSW_FLAG_Z);
 386 }
 387
 388 /*
 389  * receive chars from the ring buffer for this serial port
 390  * - must do break detection here (not done in the UART)
 391  */
 392 static void mn10300_serial_receive_interrupt(struct mn10300_serial_port *port)
 393 {
 394         struct uart_icount *icount = &port->uart.icount;
 395         struct tty_struct *tty = port->uart.info->tty;
 396         unsigned ix;
 397         int count;
 398         u8 st, ch, push, status, overrun;
 399
 400         _enter("%s", port->name);
 401
 402         push = 0;
 403
 404         count = CIRC_CNT(port->rx_inp, port->rx_outp, MNSC_BUFFER_SIZE);
 405         count = tty_buffer_request_room(tty, count);
 406         if (count == 0) {
 407                 if (!tty->low_latency)
 408                         tty_flip_buffer_push(tty);
 409                 return;
 410         }
 411
 412 try_again:
 413         /* pull chars out of the hat */
 414         ix = port->rx_outp;
 415         if (ix == port->rx_inp) {
 416                 if (push && !tty->low_latency)
 417                         tty_flip_buffer_push(tty);
 418                 return;
 419         }
 420
 421         ch = port->rx_buffer[ix++];
 422         st = port->rx_buffer[ix++];
 423         smp_rmb();
 424         port->rx_outp = ix & (MNSC_BUFFER_SIZE - 1);
 425         port->uart.icount.rx++;
 426
 427         st &= SC01STR_FEF | SC01STR_PEF | SC01STR_OEF;
 428         status = 0;
 429         overrun = 0;
 430
 431         /* the UART doesn't detect BREAK, so we have to do that ourselves
 432          * - it starts as a framing error on a NUL character
 433          * - then we count another two NUL characters before issuing TTY_BREAK
 434          * - then we end on a normal char or one that has all the bottom bits
 435          *   zero and the top bits set
 436          */
 437         switch (port->rx_brk) {
 438         case 0:
 439                 /* not breaking at the moment */
 440                 break;
 441
 442         case 1:
 443                 if (st & SC01STR_FEF && ch == 0) {
 444                         port->rx_brk = 2;
 445                         goto try_again;
 446                 }
 447                 goto not_break;
 448
 449         case 2:
 450                 if (st & SC01STR_FEF && ch == 0) {
 451                         port->rx_brk = 3;
 452                         _proto("Rx Break Detected");
 453                         icount->brk++;
 454                         if (uart_handle_break(&port->uart))
 455                                 goto ignore_char;
 456                         status |= 1 << TTY_BREAK;
 457                         goto insert;
 458                 }
 459                 goto not_break;
 460
 461         default:
 462                 if (st & (SC01STR_FEF | SC01STR_PEF | SC01STR_OEF))
 463                         goto try_again; /* still breaking */
 464
 465                 port->rx_brk = 0; /* end of the break */
 466
 467                 switch (ch) {
 468                 case 0xFF:
 469                 case 0xFE:
 470                 case 0xFC:
 471                 case 0xF8:
 472                 case 0xF0:
 473                 case 0xE0:
 474                 case 0xC0:
 475                 case 0x80:
 476                 case 0x00:
 477                         /* discard char at probable break end */
 478                         goto try_again;
 479                 }
 480                 break;
 481         }
 482
 483 process_errors:
 484         /* handle framing error */
 485         if (st & SC01STR_FEF) {
 486                 if (ch == 0) {
 487                         /* framing error with NUL char is probably a BREAK */
 488                         port->rx_brk = 1;
 489                         goto try_again;
 490                 }
 491
 492                 _proto("Rx Framing Error");
 493                 icount->frame++;
 494                 status |= 1 << TTY_FRAME;
 495         }
 496
 497         /* handle parity error */
 498         if (st & SC01STR_PEF) {
 499                 _proto("Rx Parity Error");
 500                 icount->parity++;
 501                 status = TTY_PARITY;
 502         }
 503
 504         /* handle normal char */
 505         if (status == 0) {
 506                 if (uart_handle_sysrq_char(&port->uart, ch))
 507                         goto ignore_char;
 508                 status = (1 << TTY_NORMAL);
 509         }
 510
 511         /* handle overrun error */
 512         if (st & SC01STR_OEF) {
 513                 if (port->rx_brk)
 514                         goto try_again;
 515
 516                 _proto("Rx Overrun Error");
 517                 icount->overrun++;
 518                 overrun = 1;
 519         }
 520
 521 insert:
 522         status &= port->uart.read_status_mask;
 523
 524         if (!overrun && !(status & port->uart.ignore_status_mask)) {
 525                 int flag;
 526
 527                 if (status & (1 << TTY_BREAK))
 528                         flag = TTY_BREAK;
 529                 else if (status & (1 << TTY_PARITY))
 530                         flag = TTY_PARITY;
 531                 else if (status & (1 << TTY_FRAME))
 532                         flag = TTY_FRAME;
 533                 else
 534                         flag = TTY_NORMAL;
 535
 536                 tty_insert_flip_char(tty, ch, flag);
 537         }
 538
 539         /* overrun is special, since it's reported immediately, and doesn't
 540          * affect the current character
 541          */
 542         if (overrun)
 543                 tty_insert_flip_char(tty, 0, TTY_OVERRUN);
 544
 545         count--;
 546         if (count <= 0) {
 547                 if (!tty->low_latency)
 548                         tty_flip_buffer_push(tty);
 549                 return;
 550         }
 551
 552 ignore_char:
 553         push = 1;
 554         goto try_again;
 555
 556 not_break:
 557         port->rx_brk = 0;
 558         goto process_errors;
 559 }
 560
 561 /*
 562  * handle an interrupt from the serial transmission "virtual DMA" driver
 563  * - note: the interrupt routine will disable its own interrupts when the Tx
 564  *   buffer is empty
 565  */
 566 static void mn10300_serial_transmit_interrupt(struct mn10300_serial_port *port)
 567 {
 568         _enter("%s", port->name);
 569
 570         if (uart_tx_stopped(&port->uart) ||
 571             uart_circ_empty(&port->uart.info->xmit))
 572                 mn10300_serial_dis_tx_intr(port);
 573
 574         if (uart_circ_chars_pending(&port->uart.info->xmit) < WAKEUP_CHARS)
 575                 uart_write_wakeup(&port->uart);
 576 }
 577
 578 /*
 579  * deal with a change in the status of the CTS line
 580  */
 581 static void mn10300_serial_cts_changed(struct mn10300_serial_port *port, u8 st)
 582 {
 583         u16 ctr;
 584
 585         port->tx_cts = st;
 586         port->uart.icount.cts++;
 587
 588         /* flip the CTS state selector flag to interrupt when it changes
 589          * back */
 590         ctr = *port->_control;
 591         ctr ^= SC2CTR_TWS;
 592         *port->_control = ctr;
 593
 594         uart_handle_cts_change(&port->uart, st & SC2STR_CTS);
 595         wake_up_interruptible(&port->uart.info->delta_msr_wait);
 596 }
 597
 598 /*
 599  * handle a virtual interrupt generated by the lower level "virtual DMA"
 600  * routines (irq is the baud timer interrupt)
 601  */
 602 static irqreturn_t mn10300_serial_interrupt(int irq, void *dev_id)
 603 {
 604         struct mn10300_serial_port *port = dev_id;
 605         u8 st;
 606
 607         spin_lock(&port->uart.lock);
 608
 609         if (port->intr_flags) {
 610                 _debug("INT %s: %x", port->name, port->intr_flags);
 611
 612                 if (mask_test_and_clear(&port->intr_flags, MNSCx_RX_AVAIL))
 613                         mn10300_serial_receive_interrupt(port);
 614
 615                 if (mask_test_and_clear(&port->intr_flags,
 616                                         MNSCx_TX_SPACE | MNSCx_TX_EMPTY))
 617                         mn10300_serial_transmit_interrupt(port);
 618         }
 619
 620         /* the only modem control line amongst the whole lot is CTS on
 621          * serial port 2 */
 622         if (port->type == PORT_MN10300_CTS) {
 623                 st = *port->_status;
 624                 if ((port->tx_cts ^ st) & SC2STR_CTS)
 625                         mn10300_serial_cts_changed(port, st);
 626         }
 627
 628         spin_unlock(&port->uart.lock);
 629
 630         return IRQ_HANDLED;
 631 }
 632
 633 /*
 634  * return indication of whether the hardware transmit buffer is empty
 635  */
 636 static unsigned int mn10300_serial_tx_empty(struct uart_port *_port)
 637 {
 638         struct mn10300_serial_port *port =
 639                 container_of(_port, struct mn10300_serial_port, uart);
 640
 641         _enter("%s", port->name);
 642
 643         return (*port->_status & (SC01STR_TXF | SC01STR_TBF)) ?
 644                 0 : TIOCSER_TEMT;
 645 }
 646
 647 /*
 648  * set the modem control lines (we don't have any)
 649  */
 650 static void mn10300_serial_set_mctrl(struct uart_port *_port,
 651                                      unsigned int mctrl)
 652 {
 653         struct mn10300_serial_port *port =
 654                 container_of(_port, struct mn10300_serial_port, uart);
 655
 656         _enter("%s,%x", port->name, mctrl);
 657 }
 658
 659 /*
 660  * get the modem control line statuses
 661  */
 662 static unsigned int mn10300_serial_get_mctrl(struct uart_port *_port)
 663 {
 664         struct mn10300_serial_port *port =
 665                 container_of(_port, struct mn10300_serial_port, uart);
 666
 667         _enter("%s", port->name);
 668
 669         if (port->type == PORT_MN10300_CTS && !(*port->_status & SC2STR_CTS))
 670                 return TIOCM_CAR | TIOCM_DSR;
 671
 672         return TIOCM_CAR | TIOCM_CTS | TIOCM_DSR;
 673 }
 674
 675 /*
 676  * stop transmitting characters
 677  */
 678 static void mn10300_serial_stop_tx(struct uart_port *_port)
 679 {
 680         struct mn10300_serial_port *port =
 681                 container_of(_port, struct mn10300_serial_port, uart);
 682
 683         _enter("%s", port->name);
 684
 685         /* disable the virtual DMA */
 686         mn10300_serial_dis_tx_intr(port);
 687 }
 688
 689 /*
 690  * start transmitting characters
 691  * - jump-start transmission if it has stalled
 692  *   - enable the serial Tx interrupt (used by the virtual DMA controller)
 693  *   - force an interrupt to happen if necessary
 694  */
 695 static void mn10300_serial_start_tx(struct uart_port *_port)
 696 {
 697         struct mn10300_serial_port *port =
 698                 container_of(_port, struct mn10300_serial_port, uart);
 699
 700         u16 x;
 701
 702         _enter("%s{%lu}",
 703                port->name,
 704                CIRC_CNT(&port->uart.info->xmit.head,
 705                         &port->uart.info->xmit.tail,
 706                         UART_XMIT_SIZE));
 707
 708         /* kick the virtual DMA controller */
 709         x = *port->tx_icr;
 710         x |= GxICR_ENABLE;
 711
 712         if (*port->_status & SC01STR_TBF)
 713                 x &= ~(GxICR_REQUEST | GxICR_DETECT);
 714         else
 715                 x |= GxICR_REQUEST | GxICR_DETECT;
 716
 717         _debug("CTR=%04hx ICR=%02hx STR=%04x TMD=%02hx TBR=%04hx ICR=%04hx",
 718                *port->_control, *port->_intr, *port->_status,
 719                *port->_tmxmd, *port->_tmxbr, *port->tx_icr);
 720
 721         *port->tx_icr = x;
 722         x = *port->tx_icr;
 723 }
 724
 725 /*
 726  * transmit a high-priority XON/XOFF character
 727  */
 728 static void mn10300_serial_send_xchar(struct uart_port *_port, char ch)
 729 {
 730         struct mn10300_serial_port *port =
 731                 container_of(_port, struct mn10300_serial_port, uart);
 732
 733         _enter("%s,%02x", port->name, ch);
 734
 735         if (likely(port->gdbstub)) {
 736                 port->tx_xchar = ch;
 737                 if (ch)
 738                         mn10300_serial_en_tx_intr(port);
 739         }
 740 }
 741
 742 /*
 743  * stop receiving characters
 744  * - called whilst the port is being closed
 745  */
 746 static void mn10300_serial_stop_rx(struct uart_port *_port)
 747 {
 748         struct mn10300_serial_port *port =
 749                 container_of(_port, struct mn10300_serial_port, uart);
 750
 751         u16 ctr;
 752
 753         _enter("%s", port->name);
 754
 755         ctr = *port->_control;
 756         ctr &= ~SC01CTR_RXE;
 757         *port->_control = ctr;
 758
 759         mn10300_serial_dis_rx_intr(port);
 760 }
 761
 762 /*
 763  * enable modem status interrupts
 764  */
 765 static void mn10300_serial_enable_ms(struct uart_port *_port)
 766 {
 767         struct mn10300_serial_port *port =
 768                 container_of(_port, struct mn10300_serial_port, uart);
 769
 770         u16 ctr, cts;
 771
 772         _enter("%s", port->name);
 773
 774         if (port->type == PORT_MN10300_CTS) {
 775                 /* want to interrupt when CTS goes low if CTS is now high and
 776                  * vice versa
 777                  */
 778                 port->tx_cts = *port->_status;
 779
 780                 cts = (port->tx_cts & SC2STR_CTS) ?
 781                         SC2CTR_TWE : SC2CTR_TWE | SC2CTR_TWS;
 782
 783                 ctr = *port->_control;
 784                 ctr &= ~SC2CTR_TWS;
 785                 ctr |= cts;
 786                 *port->_control = ctr;
 787
 788                 mn10300_serial_en_tx_intr(port);
 789         }
 790 }
 791
 792 /*
 793  * transmit or cease transmitting a break signal
 794  */
 795 static void mn10300_serial_break_ctl(struct uart_port *_port, int ctl)
 796 {
 797         struct mn10300_serial_port *port =
 798                 container_of(_port, struct mn10300_serial_port, uart);
 799
 800         _enter("%s,%d", port->name, ctl);
 801
 802         if (ctl) {
 803                 /* tell the virtual DMA handler to assert BREAK */
 804                 port->tx_break = 1;
 805                 mn10300_serial_en_tx_intr(port);
 806         } else {
 807                 port->tx_break = 0;
 808                 *port->_control &= ~SC01CTR_BKE;
 809                 mn10300_serial_en_tx_intr(port);
 810         }
 811 }
 812
 813 /*
 814  * grab the interrupts and enable the port for reception
 815  */
 816 static int mn10300_serial_startup(struct uart_port *_port)
 817 {
 818         struct mn10300_serial_port *port =
 819                 container_of(_port, struct mn10300_serial_port, uart);
 820         struct mn10300_serial_int *pint;
 821
 822         _enter("%s{%d}", port->name, port->gdbstub);
 823
 824         if (unlikely(port->gdbstub))
 825                 return -EBUSY;
 826
 827         /* allocate an Rx buffer for the virtual DMA handler */
 828         port->rx_buffer = kmalloc(MNSC_BUFFER_SIZE, GFP_KERNEL);
 829         if (!port->rx_buffer)
 830                 return -ENOMEM;
 831
 832         port->rx_inp = port->rx_outp = 0;
 833
 834         /* finally, enable the device */
 835         *port->_intr = SC01ICR_TI;
 836         *port->_control |= SC01CTR_TXE | SC01CTR_RXE;
 837
 838         pint = &mn10300_serial_int_tbl[port->rx_irq];
 839         pint->port = port;
 840         pint->vdma = mn10300_serial_vdma_rx_handler;
 841         pint = &mn10300_serial_int_tbl[port->tx_irq];
 842         pint->port = port;
 843         pint->vdma = mn10300_serial_vdma_tx_handler;
 844
 845         set_intr_level(port->rx_irq, GxICR_LEVEL_1);
 846         set_intr_level(port->tx_irq, GxICR_LEVEL_1);
 847         set_irq_chip(port->tm_irq, &mn10300_serial_pic);
 848
 849         if (request_irq(port->rx_irq, mn10300_serial_interrupt,
 850                         IRQF_DISABLED, port->rx_name, port) < 0)
 851                 goto error;
 852
 853         if (request_irq(port->tx_irq, mn10300_serial_interrupt,
 854                         IRQF_DISABLED, port->tx_name, port) < 0)
 855                 goto error2;
 856
 857         if (request_irq(port->tm_irq, mn10300_serial_interrupt,
 858                         IRQF_DISABLED, port->tm_name, port) < 0)
 859                 goto error3;
 860         mn10300_serial_mask_ack(port->tm_irq);
 861
 862         return 0;
 863
 864 error3:
 865         free_irq(port->tx_irq, port);
 866 error2:
 867         free_irq(port->rx_irq, port);
 868 error:
 869         kfree(port->rx_buffer);
 870         port->rx_buffer = NULL;
 871         return -EBUSY;
 872 }
 873
 874 /*
 875  * shutdown the port and release interrupts
 876  */
 877 static void mn10300_serial_shutdown(struct uart_port *_port)
 878 {
 879         struct mn10300_serial_port *port =
 880                 container_of(_port, struct mn10300_serial_port, uart);
 881
 882         _enter("%s", port->name);
 883
 884         /* disable the serial port and its baud rate timer */
 885         port->tx_break = 0;
 886         *port->_control &= ~(SC01CTR_TXE | SC01CTR_RXE | SC01CTR_BKE);
 887         *port->_tmxmd = 0;
 888
 889         if (port->rx_buffer) {
 890                 void *buf = port->rx_buffer;
 891                 port->rx_buffer = NULL;
 892                 kfree(buf);
 893         }
 894
 895         /* disable all intrs */
 896         free_irq(port->tm_irq, port);
 897         free_irq(port->rx_irq, port);
 898         free_irq(port->tx_irq, port);
 899
 900         *port->rx_icr = GxICR_LEVEL_1;
 901         *port->tx_icr = GxICR_LEVEL_1;
 902 }
 903
 904 /*
 905  * this routine is called to set the UART divisor registers to match the
 906  * specified baud rate for a serial port.
 907  */
 908 static void mn10300_serial_change_speed(struct mn10300_serial_port *port,
 909                                           struct ktermios *new,
 910                                           struct ktermios *old)
 911 {
 912         unsigned long flags;
 913         unsigned long ioclk = port->ioclk;
 914         unsigned cflag;
 915         int baud, bits, xdiv, tmp;
 916         u16 tmxbr, scxctr;
 917         u8 tmxmd, battempt;
 918         u8 div_timer = port->div_timer;
 919
 920         _enter("%s{%lu}", port->name, ioclk);
 921
 922         /* byte size and parity */
 923         cflag = new->c_cflag;
 924         switch (cflag & CSIZE) {
 925         case CS7: scxctr = SC01CTR_CLN_7BIT; bits = 9;  break;
 926         case CS8: scxctr = SC01CTR_CLN_8BIT; bits = 10; break;
 927         default:  scxctr = SC01CTR_CLN_8BIT; bits = 10; break;
 928         }
 929
 930         if (cflag & CSTOPB) {
 931                 scxctr |= SC01CTR_STB_2BIT;
 932                 bits++;
 933         }
 934
 935         if (cflag & PARENB) {
 936                 bits++;
 937                 if (cflag & PARODD)
 938                         scxctr |= SC01CTR_PB_ODD;
 939 #ifdef CMSPAR
 940                 else if (cflag & CMSPAR)
 941                         scxctr |= SC01CTR_PB_FIXED0;
 942 #endif
 943                 else
 944                         scxctr |= SC01CTR_PB_EVEN;
 945         }
 946
 947         /* Determine divisor based on baud rate */
 948         battempt = 0;
 949
 950         if (div_timer == MNSCx_DIV_TIMER_16BIT)
 951                 scxctr |= SC0CTR_CK_TM8UFLOW_8; /* ( == SC1CTR_CK_TM9UFLOW_8
 952                                                  *   == SC2CTR_CK_TM10UFLOW) */
 953         else if (div_timer == MNSCx_DIV_TIMER_8BIT)
 954                 scxctr |= SC0CTR_CK_TM2UFLOW_8;
 955
 956 try_alternative:
 957         baud = uart_get_baud_rate(&port->uart, new, old, 0,
 958                                   port->ioclk / 8);
 959
 960         _debug("ALT %d [baud %d]", battempt, baud);
 961
 962         if (!baud)
 963                 baud = 9600;    /* B0 transition handled in rs_set_termios */
 964         xdiv = 1;
 965         if (baud == 134) {
 966                 baud = 269;     /* 134 is really 134.5 */
 967                 xdiv = 2;
 968         }
 969
 970         if (baud == 38400 &&
 971             (port->uart.flags & UPF_SPD_MASK) == UPF_SPD_CUST
 972             ) {
 973                 _debug("CUSTOM %u", port->uart.custom_divisor);
 974
 975                 if (div_timer == MNSCx_DIV_TIMER_16BIT) {
 976                         if (port->uart.custom_divisor <= 65535) {
 977                                 tmxmd = TM8MD_SRC_IOCLK;
 978                                 tmxbr = port->uart.custom_divisor;
 979                                 port->uart.uartclk = ioclk;
 980                                 goto timer_okay;
 981                         }
 982                         if (port->uart.custom_divisor / 8 <= 65535) {
 983                                 tmxmd = TM8MD_SRC_IOCLK_8;
 984                                 tmxbr = port->uart.custom_divisor / 8;
 985                                 port->uart.custom_divisor = tmxbr * 8;
 986                                 port->uart.uartclk = ioclk / 8;
 987                                 goto timer_okay;
 988                         }
 989                         if (port->uart.custom_divisor / 32 <= 65535) {
 990                                 tmxmd = TM8MD_SRC_IOCLK_32;
 991                                 tmxbr = port->uart.custom_divisor / 32;
 992                                 port->uart.custom_divisor = tmxbr * 32;
 993                                 port->uart.uartclk = ioclk / 32;
 994                                 goto timer_okay;
 995                         }
 996
 997                 } else if (div_timer == MNSCx_DIV_TIMER_8BIT) {
 998                         if (port->uart.custom_divisor <= 255) {
 999                                 tmxmd = TM2MD_SRC_IOCLK;
1000                                 tmxbr = port->uart.custom_divisor;
1001                                 port->uart.uartclk = ioclk;
1002                                 goto timer_okay;
1003                         }
1004                         if (port->uart.custom_divisor / 8 <= 255) {
1005                                 tmxmd = TM2MD_SRC_IOCLK_8;
1006                                 tmxbr = port->uart.custom_divisor / 8;
1007                                 port->uart.custom_divisor = tmxbr * 8;
1008                                 port->uart.uartclk = ioclk / 8;
1009                                 goto timer_okay;
1010                         }
1011                         if (port->uart.custom_divisor / 32 <= 255) {
1012                                 tmxmd = TM2MD_SRC_IOCLK_32;
1013                                 tmxbr = port->uart.custom_divisor / 32;
1014                                 port->uart.custom_divisor = tmxbr * 32;
1015                                 port->uart.uartclk = ioclk / 32;
1016                                 goto timer_okay;
1017                         }
1018                 }
1019         }
1020
1021         switch (div_timer) {
1022         case MNSCx_DIV_TIMER_16BIT:
1023                 port->uart.uartclk = ioclk;
1024                 tmxmd = TM8MD_SRC_IOCLK;
1025                 tmxbr = tmp = (ioclk / (baud * xdiv) + 4) / 8 - 1;
1026                 if (tmp > 0 && tmp <= 65535)
1027                         goto timer_okay;
1028
1029                 port->uart.uartclk = ioclk / 8;
1030                 tmxmd = TM8MD_SRC_IOCLK_8;
1031                 tmxbr = tmp = (ioclk / (baud * 8 * xdiv) + 4) / 8 - 1;
1032                 if (tmp > 0 && tmp <= 65535)
1033                         goto timer_okay;
1034
1035                 port->uart.uartclk = ioclk / 32;
1036                 tmxmd = TM8MD_SRC_IOCLK_32;
1037                 tmxbr = tmp = (ioclk / (baud * 32 * xdiv) + 4) / 8 - 1;
1038                 if (tmp > 0 && tmp <= 65535)
1039                         goto timer_okay;
1040                 break;
1041
1042         case MNSCx_DIV_TIMER_8BIT:
1043                 port->uart.uartclk = ioclk;
1044                 tmxmd = TM2MD_SRC_IOCLK;
1045                 tmxbr = tmp = (ioclk / (baud * xdiv) + 4) / 8 - 1;
1046                 if (tmp > 0 && tmp <= 255)
1047                         goto timer_okay;
1048
1049                 port->uart.uartclk = ioclk / 8;
1050                 tmxmd = TM2MD_SRC_IOCLK_8;
1051                 tmxbr = tmp = (ioclk / (baud * 8 * xdiv) + 4) / 8 - 1;
1052                 if (tmp > 0 && tmp <= 255)
1053                         goto timer_okay;
1054
1055                 port->uart.uartclk = ioclk / 32;
1056                 tmxmd = TM2MD_SRC_IOCLK_32;
1057                 tmxbr = tmp = (ioclk / (baud * 32 * xdiv) + 4) / 8 - 1;
1058                 if (tmp > 0 && tmp <= 255)
1059                         goto timer_okay;
1060                 break;
1061
1062         default:
1063                 BUG();
1064                 return;
1065         }
1066
1067         /* refuse to change to a baud rate we can't support */
1068         _debug("CAN'T SUPPORT");
1069
1070         switch (battempt) {
1071         case 0:
1072                 if (old) {
1073                         new->c_cflag &= ~CBAUD;
1074                         new->c_cflag |= (old->c_cflag & CBAUD);
1075                         battempt = 1;
1076                         goto try_alternative;
1077                 }
1078
1079         case 1:
1080                 /* as a last resort, if the quotient is zero, default to 9600
1081                  * bps */
1082                 new->c_cflag &= ~CBAUD;
1083                 new->c_cflag |= B9600;
1084                 battempt = 2;
1085                 goto try_alternative;
1086
1087         default:
1088                 /* hmmm... can't seem to support 9600 either
1089                  * - we could try iterating through the speeds we know about to
1090                  *   find the lowest
1091                  */
1092                 new->c_cflag &= ~CBAUD;
1093                 new->c_cflag |= B0;
1094
1095                 if (div_timer == MNSCx_DIV_TIMER_16BIT)
1096                         tmxmd = TM8MD_SRC_IOCLK_32;
1097                 else if (div_timer == MNSCx_DIV_TIMER_8BIT)
1098                         tmxmd = TM2MD_SRC_IOCLK_32;
1099                 tmxbr = 1;
1100
1101                 port->uart.uartclk = ioclk / 32;
1102                 break;
1103         }
1104 timer_okay:
1105
1106         _debug("UARTCLK: %u / %hu", port->uart.uartclk, tmxbr);
1107
1108         /* make the changes */
1109         spin_lock_irqsave(&port->uart.lock, flags);
1110
1111         uart_update_timeout(&port->uart, new->c_cflag, baud);
1112
1113         /* set the timer to produce the required baud rate */
1114         switch (div_timer) {
1115         case MNSCx_DIV_TIMER_16BIT:
1116                 *port->_tmxmd = 0;
1117                 *port->_tmxbr = tmxbr;
1118                 *port->_tmxmd = TM8MD_INIT_COUNTER;
1119                 *port->_tmxmd = tmxmd | TM8MD_COUNT_ENABLE;
1120                 break;
1121
1122         case MNSCx_DIV_TIMER_8BIT:
1123                 *port->_tmxmd = 0;
1124                 *(volatile u8 *) port->_tmxbr = (u8) tmxbr;
1125                 *port->_tmxmd = TM2MD_INIT_COUNTER;
1126                 *port->_tmxmd = tmxmd | TM2MD_COUNT_ENABLE;
1127                 break;
1128         }
1129
1130         /* CTS flow control flag and modem status interrupts */
1131         scxctr &= ~(SC2CTR_TWE | SC2CTR_TWS);
1132
1133         if (port->type == PORT_MN10300_CTS && cflag & CRTSCTS) {
1134                 /* want to interrupt when CTS goes low if CTS is now
1135                  * high and vice versa
1136                  */
1137                 port->tx_cts = *port->_status;
1138
1139                 if (port->tx_cts & SC2STR_CTS)
1140                         scxctr |= SC2CTR_TWE;
1141                 else
1142                         scxctr |= SC2CTR_TWE | SC2CTR_TWS;
1143         }
1144
1145         /* set up parity check flag */
1146         port->uart.read_status_mask = (1 << TTY_NORMAL) | (1 << TTY_OVERRUN);
1147         if (new->c_iflag & INPCK)
1148                 port->uart.read_status_mask |=
1149                         (1 << TTY_PARITY) | (1 << TTY_FRAME);
1150         if (new->c_iflag & (BRKINT | PARMRK))
1151                 port->uart.read_status_mask |= (1 << TTY_BREAK);
1152
1153         /* characters to ignore */
1154         port->uart.ignore_status_mask = 0;
1155         if (new->c_iflag & IGNPAR)
1156                 port->uart.ignore_status_mask |=
1157                         (1 << TTY_PARITY) | (1 << TTY_FRAME);
1158         if (new->c_iflag & IGNBRK) {
1159                 port->uart.ignore_status_mask |= (1 << TTY_BREAK);
1160                 /*
1161                  * If we're ignoring parity and break indicators,
1162                  * ignore overruns to (for real raw support).
1163                  */
1164                 if (new->c_iflag & IGNPAR)
1165                         port->uart.ignore_status_mask |= (1 << TTY_OVERRUN);
1166         }
1167
1168         /* Ignore all characters if CREAD is not set */
1169         if ((new->c_cflag & CREAD) == 0)
1170                 port->uart.ignore_status_mask |= (1 << TTY_NORMAL);
1171
1172         scxctr |= *port->_control & (SC01CTR_TXE | SC01CTR_RXE | SC01CTR_BKE);
1173         *port->_control = scxctr;
1174
1175         spin_unlock_irqrestore(&port->uart.lock, flags);
1176 }
1177
1178 /*
1179  * set the terminal I/O parameters
1180  */
1181 static void mn10300_serial_set_termios(struct uart_port *_port,
1182                                          struct ktermios *new,
1183                                          struct ktermios *old)
1184 {
1185         struct mn10300_serial_port *port =
1186                 container_of(_port, struct mn10300_serial_port, uart);
1187
1188         _enter("%s,%p,%p", port->name, new, old);
1189
1190         mn10300_serial_change_speed(port, new, old);
1191
1192         /* handle turning off CRTSCTS */
1193         if (!(new->c_cflag & CRTSCTS)) {
1194                 u16 ctr = *port->_control;
1195                 ctr &= ~SC2CTR_TWE;
1196                 *port->_control = ctr;
1197         }
1198 }
1199
1200 /*
1201  * return description of port type
1202  */
1203 static const char *mn10300_serial_type(struct uart_port *_port)
1204 {
1205         struct mn10300_serial_port *port =
1206                 container_of(_port, struct mn10300_serial_port, uart);
1207
1208         if (port->uart.type == PORT_MN10300_CTS)
1209                 return "MN10300 SIF_CTS";
1210
1211         return "MN10300 SIF";
1212 }
1213
1214 /*
1215  * release I/O and memory regions in use by port
1216  */
1217 static void mn10300_serial_release_port(struct uart_port *_port)
1218 {
1219         struct mn10300_serial_port *port =
1220                 container_of(_port, struct mn10300_serial_port, uart);
1221
1222         _enter("%s", port->name);
1223
1224         release_mem_region((unsigned long) port->_iobase, 16);
1225 }
1226
1227 /*
1228  * request I/O and memory regions for port
1229  */
1230 static int mn10300_serial_request_port(struct uart_port *_port)
1231 {
1232         struct mn10300_serial_port *port =
1233                 container_of(_port, struct mn10300_serial_port, uart);
1234
1235         _enter("%s", port->name);
1236
1237         request_mem_region((unsigned long) port->_iobase, 16, port->name);
1238         return 0;
1239 }
1240
1241 /*
1242  * configure the type and reserve the ports
1243  */
1244 static void mn10300_serial_config_port(struct uart_port *_port, int type)
1245 {
1246         struct mn10300_serial_port *port =
1247                 container_of(_port, struct mn10300_serial_port, uart);
1248
1249         _enter("%s", port->name);
1250
1251         port->uart.type = PORT_MN10300;
1252
1253         if (port->options & MNSCx_OPT_CTS)
1254                 port->uart.type = PORT_MN10300_CTS;
1255
1256         mn10300_serial_request_port(_port);
1257 }
1258
1259 /*
1260  * verify serial parameters are suitable for this port type
1261  */
1262 static int mn10300_serial_verify_port(struct uart_port *_port,
1263                                         struct serial_struct *ss)
1264 {
1265         struct mn10300_serial_port *port =
1266                 container_of(_port, struct mn10300_serial_port, uart);
1267         void *mapbase = (void *) (unsigned long) port->uart.mapbase;
1268
1269         _enter("%s", port->name);
1270
1271         /* these things may not be changed */
1272         if (ss->irq             != port->uart.irq       ||
1273             ss->port            != port->uart.iobase    ||
1274             ss->io_type         != port->uart.iotype    ||
1275             ss->iomem_base      != mapbase ||
1276             ss->iomem_reg_shift != port->uart.regshift  ||
1277             ss->hub6            != port->uart.hub6      ||
1278             ss->xmit_fifo_size  != port->uart.fifosize)
1279                 return -EINVAL;
1280
1281         /* type may be changed on a port that supports CTS */
1282         if (ss->type != port->uart.type) {
1283                 if (!(port->options & MNSCx_OPT_CTS))
1284                         return -EINVAL;
1285
1286                 if (ss->type != PORT_MN10300 &&
1287                     ss->type != PORT_MN10300_CTS)
1288                         return -EINVAL;
1289         }
1290
1291         return 0;
1292 }
1293
1294 /*
1295  * initialise the MN10300 on-chip UARTs
1296  */
1297 static int __init mn10300_serial_init(void)
1298 {
1299         struct mn10300_serial_port *port;
1300         int ret, i;
1301
1302         printk(KERN_INFO "%s version %s (%s)\n",
1303                serial_name, serial_version, serial_revdate);
1304
1305 #ifdef CONFIG_MN10300_TTYSM2
1306         SC2TIM = 8; /* make the baud base of timer 2 IOCLK/8 */
1307 #endif
1308
1309         set_intr_stub(EXCEP_IRQ_LEVEL1, mn10300_serial_vdma_interrupt);
1310
1311         ret = uart_register_driver(&mn10300_serial_driver);
1312         if (!ret) {
1313                 for (i = 0 ; i < NR_PORTS ; i++) {
1314                         port = mn10300_serial_ports[i];
1315                         if (!port || port->gdbstub)
1316                                 continue;
1317
1318                         switch (port->clock_src) {
1319                         case MNSCx_CLOCK_SRC_IOCLK:
1320                                 port->ioclk = MN10300_IOCLK;
1321                                 break;
1322
1323 #ifdef MN10300_IOBCLK
1324                         case MNSCx_CLOCK_SRC_IOBCLK:
1325                                 port->ioclk = MN10300_IOBCLK;
1326                                 break;
1327 #endif
1328                         default:
1329                                 BUG();
1330                         }
1331
1332                         ret = uart_add_one_port(&mn10300_serial_driver,
1333                                                 &port->uart);
1334
1335                         if (ret < 0) {
1336                                 _debug("ERROR %d", -ret);
1337                                 break;
1338                         }
1339                 }
1340
1341                 if (ret)
1342                         uart_unregister_driver(&mn10300_serial_driver);
1343         }
1344
1345         return ret;
1346 }
1347
1348 __initcall(mn10300_serial_init);
1349
1350
1351 #ifdef CONFIG_MN10300_TTYSM_CONSOLE
1352
1353 /*
1354  * print a string to the serial port without disturbing the real user of the
1355  * port too much
1356  * - the console must be locked by the caller
1357  */
1358 static void mn10300_serial_console_write(struct console *co,
1359                                            const char *s, unsigned count)
1360 {
1361         struct mn10300_serial_port *port;
1362         unsigned i;
1363         u16 scxctr, txicr, tmp;
1364         u8 tmxmd;
1365
1366         port = mn10300_serial_ports[co->index];
1367
1368         /* firstly hijack the serial port from the "virtual DMA" controller */
1369         txicr = *port->tx_icr;
1370         *port->tx_icr = GxICR_LEVEL_1;
1371         tmp = *port->tx_icr;
1372
1373         /* the transmitter may be disabled */
1374         scxctr = *port->_control;
1375         if (!(scxctr & SC01CTR_TXE)) {
1376                 /* restart the UART clock */
1377                 tmxmd = *port->_tmxmd;
1378
1379                 switch (port->div_timer) {
1380                 case MNSCx_DIV_TIMER_16BIT:
1381                         *port->_tmxmd = 0;
1382                         *port->_tmxmd = TM8MD_INIT_COUNTER;
1383                         *port->_tmxmd = tmxmd | TM8MD_COUNT_ENABLE;
1384                         break;
1385
1386                 case MNSCx_DIV_TIMER_8BIT:
1387                         *port->_tmxmd = 0;
1388                         *port->_tmxmd = TM2MD_INIT_COUNTER;
1389                         *port->_tmxmd = tmxmd | TM2MD_COUNT_ENABLE;
1390                         break;
1391                 }
1392
1393                 /* enable the transmitter */
1394                 *port->_control = (scxctr & ~SC01CTR_BKE) | SC01CTR_TXE;
1395
1396         } else if (scxctr & SC01CTR_BKE) {
1397                 /* stop transmitting BREAK */
1398                 *port->_control = (scxctr & ~SC01CTR_BKE);
1399         }
1400
1401         /* send the chars into the serial port (with LF -> LFCR conversion) */
1402         for (i = 0; i < count; i++) {
1403                 char ch = *s++;
1404
1405                 while (*port->_status & SC01STR_TBF)
1406                         continue;
1407                 *(u8 *) port->_txb = ch;
1408
1409                 if (ch == 0x0a) {
1410                         while (*port->_status & SC01STR_TBF)
1411                                 continue;
1412                         *(u8 *) port->_txb = 0xd;
1413                 }
1414         }
1415
1416         /* can't let the transmitter be turned off if it's actually
1417          * transmitting */
1418         while (*port->_status & (SC01STR_TXF | SC01STR_TBF))
1419                 continue;
1420
1421         /* disable the transmitter if we re-enabled it */
1422         if (!(scxctr & SC01CTR_TXE))
1423                 *port->_control = scxctr;
1424
1425         *port->tx_icr = txicr;
1426         tmp = *port->tx_icr;
1427 }
1428
1429 /*
1430  * set up a serial port as a console
1431  * - construct a cflag setting for the first rs_open()
1432  * - initialize the serial port
1433  * - return non-zero if we didn't find a serial port.
1434  */
1435 static int __init mn10300_serial_console_setup(struct console *co,
1436                                                  char *options)
1437 {
1438         struct mn10300_serial_port *port;
1439         int i, parity = 'n', baud = 9600, bits = 8, flow = 0;
1440
1441         for (i = 0 ; i < NR_PORTS ; i++) {
1442                 port = mn10300_serial_ports[i];
1443                 if (port && !port->gdbstub && port->uart.line == co->index)
1444                         goto found_device;
1445         }
1446
1447         return -ENODEV;
1448
1449 found_device:
1450         switch (port->clock_src) {
1451         case MNSCx_CLOCK_SRC_IOCLK:
1452                 port->ioclk = MN10300_IOCLK;
1453                 break;
1454
1455 #ifdef MN10300_IOBCLK
1456         case MNSCx_CLOCK_SRC_IOBCLK:
1457                 port->ioclk = MN10300_IOBCLK;
1458                 break;
1459 #endif
1460         default:
1461                 BUG();
1462         }
1463
1464         if (options)
1465                 uart_parse_options(options, &baud, &parity, &bits, &flow);
1466
1467         return uart_set_options(&port->uart, co, baud, parity, bits, flow);
1468 }
1469
1470 /*
1471  * register console
1472  */
1473 static int __init mn10300_serial_console_init(void)
1474 {
1475         register_console(&mn10300_serial_console);
1476         return 0;
1477 }
1478
1479 console_initcall(mn10300_serial_console_init);
1480 #endif