release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/serial/altera_jtaguart.c

   1 /*
   2  * altera_jtaguart.c -- Altera JTAG UART driver
   3  *
   4  * Based on mcf.c -- Freescale ColdFire UART driver
   5  *
   6  * (C) Copyright 2003-2007, Greg Ungerer <gerg@snapgear.com>
   7  * (C) Copyright 2008, Thomas Chou <thomas@wytron.com.tw>
   8  * (C) Copyright 2010, Tobias Klauser <tklauser@distanz.ch>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  */
  15
  16 #include <linux/kernel.h>
  17 #include <linux/init.h>
  18 #include <linux/interrupt.h>
  19 #include <linux/module.h>
  20 #include <linux/console.h>
  21 #include <linux/tty.h>
  22 #include <linux/tty_flip.h>
  23 #include <linux/serial.h>
  24 #include <linux/serial_core.h>
  25 #include <linux/platform_device.h>
  26 #include <linux/io.h>
  27 #include <linux/altera_jtaguart.h>
  28
  29 #define DRV_NAME "altera_jtaguart"
  30
  31 /*
  32  * Altera JTAG UART register definitions according to the Altera JTAG UART
  33  * datasheet: http://www.altera.com/literature/hb/nios2/n2cpu_nii51009.pdf
  34  */
  35
  36 #define ALTERA_JTAGUART_SIZE                    8
  37
  38 #define ALTERA_JTAGUART_DATA_REG                0
  39
  40 #define ALTERA_JTAGUART_DATA_DATA_MSK           0x000000FF
  41 #define ALTERA_JTAGUART_DATA_RVALID_MSK         0x00008000
  42 #define ALTERA_JTAGUART_DATA_RAVAIL_MSK         0xFFFF0000
  43 #define ALTERA_JTAGUART_DATA_RAVAIL_OFF         16
  44
  45 #define ALTERA_JTAGUART_CONTROL_REG             4
  46
  47 #define ALTERA_JTAGUART_CONTROL_RE_MSK          0x00000001
  48 #define ALTERA_JTAGUART_CONTROL_WE_MSK          0x00000002
  49 #define ALTERA_JTAGUART_CONTROL_RI_MSK          0x00000100
  50 #define ALTERA_JTAGUART_CONTROL_RI_OFF          8
  51 #define ALTERA_JTAGUART_CONTROL_WI_MSK          0x00000200
  52 #define ALTERA_JTAGUART_CONTROL_AC_MSK          0x00000400
  53 #define ALTERA_JTAGUART_CONTROL_WSPACE_MSK      0xFFFF0000
  54 #define ALTERA_JTAGUART_CONTROL_WSPACE_OFF      16
  55
  56 /*
  57  * Local per-uart structure.
  58  */
  59 struct altera_jtaguart {
  60         struct uart_port port;
  61         unsigned int sigs;      /* Local copy of line sigs */
  62         unsigned long imr;      /* Local IMR mirror */
  63 };
  64
  65 static unsigned int altera_jtaguart_tx_empty(struct uart_port *port)
  66 {
  67         return (readl(port->membase + ALTERA_JTAGUART_CONTROL_REG) &
  68                 ALTERA_JTAGUART_CONTROL_WSPACE_MSK) ? TIOCSER_TEMT : 0;
  69 }
  70
  71 static unsigned int altera_jtaguart_get_mctrl(struct uart_port *port)
  72 {
  73         return TIOCM_CAR | TIOCM_DSR | TIOCM_CTS;
  74 }
  75
  76 static void altera_jtaguart_set_mctrl(struct uart_port *port, unsigned int sigs)
  77 {
  78 }
  79
  80 static void altera_jtaguart_start_tx(struct uart_port *port)
  81 {
  82         struct altera_jtaguart *pp =
  83             container_of(port, struct altera_jtaguart, port);
  84
  85         pp->imr |= ALTERA_JTAGUART_CONTROL_WE_MSK;
  86         writel(pp->imr, port->membase + ALTERA_JTAGUART_CONTROL_REG);
  87 }
  88
  89 static void altera_jtaguart_stop_tx(struct uart_port *port)
  90 {
  91         struct altera_jtaguart *pp =
  92             container_of(port, struct altera_jtaguart, port);
  93
  94         pp->imr &= ~ALTERA_JTAGUART_CONTROL_WE_MSK;
  95         writel(pp->imr, port->membase + ALTERA_JTAGUART_CONTROL_REG);
  96 }
  97
  98 static void altera_jtaguart_stop_rx(struct uart_port *port)
  99 {
 100         struct altera_jtaguart *pp =
 101             container_of(port, struct altera_jtaguart, port);
 102
 103         pp->imr &= ~ALTERA_JTAGUART_CONTROL_RE_MSK;
 104         writel(pp->imr, port->membase + ALTERA_JTAGUART_CONTROL_REG);
 105 }
 106
 107 static void altera_jtaguart_break_ctl(struct uart_port *port, int break_state)
 108 {
 109 }
 110
 111 static void altera_jtaguart_enable_ms(struct uart_port *port)
 112 {
 113 }
 114
 115 static void altera_jtaguart_set_termios(struct uart_port *port,
 116                                         struct ktermios *termios,
 117                                         struct ktermios *old)
 118 {
 119         /* Just copy the old termios settings back */
 120         if (old)
 121                 tty_termios_copy_hw(termios, old);
 122 }
 123
 124 static void altera_jtaguart_rx_chars(struct altera_jtaguart *pp)
 125 {
 126         struct uart_port *port = &pp->port;
 127         unsigned char ch, flag;
 128         unsigned long status;
 129
 130         while ((status = readl(port->membase + ALTERA_JTAGUART_DATA_REG)) &
 131                ALTERA_JTAGUART_DATA_RVALID_MSK) {
 132                 ch = status & ALTERA_JTAGUART_DATA_DATA_MSK;
 133                 flag = TTY_NORMAL;
 134                 port->icount.rx++;
 135
 136                 if (uart_handle_sysrq_char(port, ch))
 137                         continue;
 138                 uart_insert_char(port, 0, 0, ch, flag);
 139         }
 140
 141         tty_flip_buffer_push(port->state->port.tty);
 142 }
 143
 144 static void altera_jtaguart_tx_chars(struct altera_jtaguart *pp)
 145 {
 146         struct uart_port *port = &pp->port;
 147         struct circ_buf *xmit = &port->state->xmit;
 148         unsigned int pending, count;
 149
 150         if (port->x_char) {
 151                 /* Send special char - probably flow control */
 152                 writel(port->x_char, port->membase + ALTERA_JTAGUART_DATA_REG);
 153                 port->x_char = 0;
 154                 port->icount.tx++;
 155                 return;
 156         }
 157
 158         pending = uart_circ_chars_pending(xmit);
 159         if (pending > 0) {
 160                 count = (readl(port->membase + ALTERA_JTAGUART_CONTROL_REG) &
 161                                 ALTERA_JTAGUART_CONTROL_WSPACE_MSK) >>
 162                         ALTERA_JTAGUART_CONTROL_WSPACE_OFF;
 163                 if (count > pending)
 164                         count = pending;
 165                 if (count > 0) {
 166                         pending -= count;
 167                         while (count--) {
 168                                 writel(xmit->buf[xmit->tail],
 169                                        port->membase + ALTERA_JTAGUART_DATA_REG);
 170                                 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
 171                                 port->icount.tx++;
 172                         }
 173                         if (pending < WAKEUP_CHARS)
 174                                 uart_write_wakeup(port);
 175                 }
 176         }
 177
 178         if (pending == 0) {
 179                 pp->imr &= ~ALTERA_JTAGUART_CONTROL_WE_MSK;
 180                 writel(pp->imr, port->membase + ALTERA_JTAGUART_CONTROL_REG);
 181         }
 182 }
 183
 184 static irqreturn_t altera_jtaguart_interrupt(int irq, void *data)
 185 {
 186         struct uart_port *port = data;
 187         struct altera_jtaguart *pp =
 188             container_of(port, struct altera_jtaguart, port);
 189         unsigned int isr;
 190
 191         isr = (readl(port->membase + ALTERA_JTAGUART_CONTROL_REG) >>
 192                ALTERA_JTAGUART_CONTROL_RI_OFF) & pp->imr;
 193
 194         spin_lock(&port->lock);
 195
 196         if (isr & ALTERA_JTAGUART_CONTROL_RE_MSK)
 197                 altera_jtaguart_rx_chars(pp);
 198         if (isr & ALTERA_JTAGUART_CONTROL_WE_MSK)
 199                 altera_jtaguart_tx_chars(pp);
 200
 201         spin_unlock(&port->lock);
 202
 203         return IRQ_RETVAL(isr);
 204 }
 205
 206 static void altera_jtaguart_config_port(struct uart_port *port, int flags)
 207 {
 208         port->type = PORT_ALTERA_JTAGUART;
 209
 210         /* Clear mask, so no surprise interrupts. */
 211         writel(0, port->membase + ALTERA_JTAGUART_CONTROL_REG);
 212 }
 213
 214 static int altera_jtaguart_startup(struct uart_port *port)
 215 {
 216         struct altera_jtaguart *pp =
 217             container_of(port, struct altera_jtaguart, port);
 218         unsigned long flags;
 219         int ret;
 220
 221         ret = request_irq(port->irq, altera_jtaguart_interrupt, IRQF_DISABLED,
 222                         DRV_NAME, port);
 223         if (ret) {
 224                 pr_err(DRV_NAME ": unable to attach Altera JTAG UART %d "
 225                        "interrupt vector=%d\n", port->line, port->irq);
 226                 return ret;
 227         }
 228
 229         spin_lock_irqsave(&port->lock, flags);
 230
 231         /* Enable RX interrupts now */
 232         pp->imr = ALTERA_JTAGUART_CONTROL_RE_MSK;
 233         writel(pp->imr, port->membase + ALTERA_JTAGUART_CONTROL_REG);
 234
 235         spin_unlock_irqrestore(&port->lock, flags);
 236
 237         return 0;
 238 }
 239
 240 static void altera_jtaguart_shutdown(struct uart_port *port)
 241 {
 242         struct altera_jtaguart *pp =
 243             container_of(port, struct altera_jtaguart, port);
 244         unsigned long flags;
 245
 246         spin_lock_irqsave(&port->lock, flags);
 247
 248         /* Disable all interrupts now */
 249         pp->imr = 0;
 250         writel(pp->imr, port->membase + ALTERA_JTAGUART_CONTROL_REG);
 251
 252         spin_unlock_irqrestore(&port->lock, flags);
 253
 254         free_irq(port->irq, port);
 255 }
 256
 257 static const char *altera_jtaguart_type(struct uart_port *port)
 258 {
 259         return (port->type == PORT_ALTERA_JTAGUART) ? "Altera JTAG UART" : NULL;
 260 }
 261
 262 static int altera_jtaguart_request_port(struct uart_port *port)
 263 {
 264         /* UARTs always present */
 265         return 0;
 266 }
 267
 268 static void altera_jtaguart_release_port(struct uart_port *port)
 269 {
 270         /* Nothing to release... */
 271 }
 272
 273 static int altera_jtaguart_verify_port(struct uart_port *port,
 274                                        struct serial_struct *ser)
 275 {
 276         if (ser->type != PORT_UNKNOWN && ser->type != PORT_ALTERA_JTAGUART)
 277                 return -EINVAL;
 278         return 0;
 279 }
 280
 281 /*
 282  *      Define the basic serial functions we support.
 283  */
 284 static struct uart_ops altera_jtaguart_ops = {
 285         .tx_empty       = altera_jtaguart_tx_empty,
 286         .get_mctrl      = altera_jtaguart_get_mctrl,
 287         .set_mctrl      = altera_jtaguart_set_mctrl,
 288         .start_tx       = altera_jtaguart_start_tx,
 289         .stop_tx        = altera_jtaguart_stop_tx,
 290         .stop_rx        = altera_jtaguart_stop_rx,
 291         .enable_ms      = altera_jtaguart_enable_ms,
 292         .break_ctl      = altera_jtaguart_break_ctl,
 293         .startup        = altera_jtaguart_startup,
 294         .shutdown       = altera_jtaguart_shutdown,
 295         .set_termios    = altera_jtaguart_set_termios,
 296         .type           = altera_jtaguart_type,
 297         .request_port   = altera_jtaguart_request_port,
 298         .release_port   = altera_jtaguart_release_port,
 299         .config_port    = altera_jtaguart_config_port,
 300         .verify_port    = altera_jtaguart_verify_port,
 301 };
 302
 303 #define ALTERA_JTAGUART_MAXPORTS 1
 304 static struct altera_jtaguart altera_jtaguart_ports[ALTERA_JTAGUART_MAXPORTS];
 305
 306 #if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE)
 307
 308 int __init early_altera_jtaguart_setup(struct altera_jtaguart_platform_uart
 309                                        *platp)
 310 {
 311         struct uart_port *port;
 312         int i;
 313
 314         for (i = 0; i < ALTERA_JTAGUART_MAXPORTS && platp[i].mapbase; i++) {
 315                 port = &altera_jtaguart_ports[i].port;
 316
 317                 port->line = i;
 318                 port->type = PORT_ALTERA_JTAGUART;
 319                 port->mapbase = platp[i].mapbase;
 320                 port->membase = ioremap(port->mapbase, ALTERA_JTAGUART_SIZE);
 321                 port->iotype = SERIAL_IO_MEM;
 322                 port->irq = platp[i].irq;
 323                 port->flags = ASYNC_BOOT_AUTOCONF;
 324                 port->ops = &altera_jtaguart_ops;
 325         }
 326
 327         return 0;
 328 }
 329
 330 #if defined(CONFIG_SERIAL_ALTERA_JTAGUART_CONSOLE_BYPASS)
 331 static void altera_jtaguart_console_putc(struct console *co, const char c)
 332 {
 333         struct uart_port *port = &(altera_jtaguart_ports + co->index)->port;
 334         unsigned long status;
 335         unsigned long flags;
 336
 337         spin_lock_irqsave(&port->lock, flags);
 338         while (((status = readl(port->membase + ALTERA_JTAGUART_CONTROL_REG)) &
 339                 ALTERA_JTAGUART_CONTROL_WSPACE_MSK) == 0) {
 340                 if ((status & ALTERA_JTAGUART_CONTROL_AC_MSK) == 0) {
 341                         spin_unlock_irqrestore(&port->lock, flags);
 342                         return; /* no connection activity */
 343                 }
 344                 spin_unlock_irqrestore(&port->lock, flags);
 345                 cpu_relax();
 346                 spin_lock_irqsave(&port->lock, flags);
 347         }
 348         writel(c, port->membase + ALTERA_JTAGUART_DATA_REG);
 349         spin_unlock_irqrestore(&port->lock, flags);
 350 }
 351 #else
 352 static void altera_jtaguart_console_putc(struct console *co, const char c)
 353 {
 354         struct uart_port *port = &(altera_jtaguart_ports + co->index)->port;
 355         unsigned long flags;
 356
 357         spin_lock_irqsave(&port->lock, flags);
 358         while ((readl(port->membase + ALTERA_JTAGUART_CONTROL_REG) &
 359                 ALTERA_JTAGUART_CONTROL_WSPACE_MSK) == 0) {
 360                 spin_unlock_irqrestore(&port->lock, flags);
 361                 cpu_relax();
 362                 spin_lock_irqsave(&port->lock, flags);
 363         }
 364         writel(c, port->membase + ALTERA_JTAGUART_DATA_REG);
 365         spin_unlock_irqrestore(&port->lock, flags);
 366 }
 367 #endif
 368
 369 static void altera_jtaguart_console_write(struct console *co, const char *s,
 370                                           unsigned int count)
 371 {
 372         for (; count; count--, s++) {
 373                 altera_jtaguart_console_putc(co, *s);
 374                 if (*s == '\n')
 375                         altera_jtaguart_console_putc(co, '\r');
 376         }
 377 }
 378
 379 static int __init altera_jtaguart_console_setup(struct console *co,
 380                                                 char *options)
 381 {
 382         struct uart_port *port;
 383
 384         if (co->index < 0 || co->index >= ALTERA_JTAGUART_MAXPORTS)
 385                 return -EINVAL;
 386         port = &altera_jtaguart_ports[co->index].port;
 387         if (port->membase == 0)
 388                 return -ENODEV;
 389         return 0;
 390 }
 391
 392 static struct uart_driver altera_jtaguart_driver;
 393
 394 static struct console altera_jtaguart_console = {
 395         .name   = "ttyJ",
 396         .write  = altera_jtaguart_console_write,
 397         .device = uart_console_device,
 398         .setup  = altera_jtaguart_console_setup,
 399         .flags  = CON_PRINTBUFFER,
 400         .index  = -1,
 401         .data   = &altera_jtaguart_driver,
 402 };
 403
 404 static int __init altera_jtaguart_console_init(void)
 405 {
 406         register_console(&altera_jtaguart_console);
 407         return 0;
 408 }
 409
 410 console_initcall(altera_jtaguart_console_init);
 411
 412 #define ALTERA_JTAGUART_CONSOLE (&altera_jtaguart_console)
 413
 414 #else
 415
 416 #define ALTERA_JTAGUART_CONSOLE NULL
 417
 418 #endif /* CONFIG_ALTERA_JTAGUART_CONSOLE */
 419
 420 static struct uart_driver altera_jtaguart_driver = {
 421         .owner          = THIS_MODULE,
 422         .driver_name    = "altera_jtaguart",
 423         .dev_name       = "ttyJ",
 424         .major          = ALTERA_JTAGUART_MAJOR,
 425         .minor          = ALTERA_JTAGUART_MINOR,
 426         .nr             = ALTERA_JTAGUART_MAXPORTS,
 427         .cons           = ALTERA_JTAGUART_CONSOLE,
 428 };
 429
 430 static int __devinit altera_jtaguart_probe(struct platform_device *pdev)
 431 {
 432         struct altera_jtaguart_platform_uart *platp = pdev->dev.platform_data;
 433         struct uart_port *port;
 434         int i;
 435
 436         for (i = 0; i < ALTERA_JTAGUART_MAXPORTS && platp[i].mapbase; i++) {
 437                 port = &altera_jtaguart_ports[i].port;
 438
 439                 port->line = i;
 440                 port->type = PORT_ALTERA_JTAGUART;
 441                 port->mapbase = platp[i].mapbase;
 442                 port->membase = ioremap(port->mapbase, ALTERA_JTAGUART_SIZE);
 443                 port->iotype = SERIAL_IO_MEM;
 444                 port->irq = platp[i].irq;
 445                 port->ops = &altera_jtaguart_ops;
 446                 port->flags = ASYNC_BOOT_AUTOCONF;
 447
 448                 uart_add_one_port(&altera_jtaguart_driver, port);
 449         }
 450
 451         return 0;
 452 }
 453
 454 static int __devexit altera_jtaguart_remove(struct platform_device *pdev)
 455 {
 456         struct uart_port *port;
 457         int i;
 458
 459         for (i = 0; i < ALTERA_JTAGUART_MAXPORTS; i++) {
 460                 port = &altera_jtaguart_ports[i].port;
 461                 if (port)
 462                         uart_remove_one_port(&altera_jtaguart_driver, port);
 463         }
 464
 465         return 0;
 466 }
 467
 468 static struct platform_driver altera_jtaguart_platform_driver = {
 469         .probe  = altera_jtaguart_probe,
 470         .remove = __devexit_p(altera_jtaguart_remove),
 471         .driver = {
 472                 .name   = DRV_NAME,
 473                 .owner  = THIS_MODULE,
 474         },
 475 };
 476
 477 static int __init altera_jtaguart_init(void)
 478 {
 479         int rc;
 480
 481         rc = uart_register_driver(&altera_jtaguart_driver);
 482         if (rc)
 483                 return rc;
 484         rc = platform_driver_register(&altera_jtaguart_platform_driver);
 485         if (rc) {
 486                 uart_unregister_driver(&altera_jtaguart_driver);
 487                 return rc;
 488         }
 489         return 0;
 490 }
 491
 492 static void __exit altera_jtaguart_exit(void)
 493 {
 494         platform_driver_unregister(&altera_jtaguart_platform_driver);
 495         uart_unregister_driver(&altera_jtaguart_driver);
 496 }
 497
 498 module_init(altera_jtaguart_init);
 499 module_exit(altera_jtaguart_exit);
 500
 501 MODULE_DESCRIPTION("Altera JTAG UART driver");
 502 MODULE_AUTHOR("Thomas Chou <thomas@wytron.com.tw>");
 503 MODULE_LICENSE("GPL");
 504 MODULE_ALIAS("platform:" DRV_NAME);