drivers/tty/serial/men_z135_uart.c

   1 /*
   2  * MEN 16z135 High Speed UART
   3  *
   4  * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
   5  * Author: Johannes Thumshirn <[email protected]>
   6  *
   7  * This program is free software; you can redistribute it and/or modify it
   8  * under the terms of the GNU General Public License as published by the Free
   9  * Software Foundation; version 2 of the License.
  10  */
  11 #define pr_fmt(fmt) KBUILD_MODNAME ":" fmt
  12
  13 #include <linux/kernel.h>
  14 #include <linux/module.h>
  15 #include <linux/interrupt.h>
  16 #include <linux/serial_core.h>
  17 #include <linux/ioport.h>
  18 #include <linux/io.h>
  19 #include <linux/tty_flip.h>
  20 #include <linux/bitops.h>
  21 #include <linux/mcb.h>
  22
  23 #define MEN_Z135_MAX_PORTS              12
  24 #define MEN_Z135_BASECLK                29491200
  25 #define MEN_Z135_FIFO_SIZE              1024
  26 #define MEN_Z135_FIFO_WATERMARK         1020
  27
  28 #define MEN_Z135_STAT_REG               0x0
  29 #define MEN_Z135_RX_RAM                 0x4
  30 #define MEN_Z135_TX_RAM                 0x400
  31 #define MEN_Z135_RX_CTRL                0x800
  32 #define MEN_Z135_TX_CTRL                0x804
  33 #define MEN_Z135_CONF_REG               0x808
  34 #define MEN_Z135_UART_FREQ              0x80c
  35 #define MEN_Z135_BAUD_REG               0x810
  36 #define MEN_Z135_TIMEOUT                0x814
  37
  38 #define IRQ_ID(x) ((x) & 0x1f)
  39
  40 #define MEN_Z135_IER_RXCIEN BIT(0)              /* RX Space IRQ */
  41 #define MEN_Z135_IER_TXCIEN BIT(1)              /* TX Space IRQ */
  42 #define MEN_Z135_IER_RLSIEN BIT(2)              /* Receiver Line Status IRQ */
  43 #define MEN_Z135_IER_MSIEN  BIT(3)              /* Modem Status IRQ */
  44 #define MEN_Z135_ALL_IRQS (MEN_Z135_IER_RXCIEN          \
  45                                 | MEN_Z135_IER_RLSIEN   \
  46                                 | MEN_Z135_IER_MSIEN    \
  47                                 | MEN_Z135_IER_TXCIEN)
  48
  49 #define MEN_Z135_MCR_DTR        BIT(24)
  50 #define MEN_Z135_MCR_RTS        BIT(25)
  51 #define MEN_Z135_MCR_OUT1       BIT(26)
  52 #define MEN_Z135_MCR_OUT2       BIT(27)
  53 #define MEN_Z135_MCR_LOOP       BIT(28)
  54 #define MEN_Z135_MCR_RCFC       BIT(29)
  55
  56 #define MEN_Z135_MSR_DCTS       BIT(0)
  57 #define MEN_Z135_MSR_DDSR       BIT(1)
  58 #define MEN_Z135_MSR_DRI        BIT(2)
  59 #define MEN_Z135_MSR_DDCD       BIT(3)
  60 #define MEN_Z135_MSR_CTS        BIT(4)
  61 #define MEN_Z135_MSR_DSR        BIT(5)
  62 #define MEN_Z135_MSR_RI         BIT(6)
  63 #define MEN_Z135_MSR_DCD        BIT(7)
  64
  65 #define MEN_Z135_LCR_SHIFT 8    /* LCR shift mask */
  66
  67 #define MEN_Z135_WL5 0          /* CS5 */
  68 #define MEN_Z135_WL6 1          /* CS6 */
  69 #define MEN_Z135_WL7 2          /* CS7 */
  70 #define MEN_Z135_WL8 3          /* CS8 */
  71
  72 #define MEN_Z135_STB_SHIFT 2    /* Stopbits */
  73 #define MEN_Z135_NSTB1 0
  74 #define MEN_Z135_NSTB2 1
  75
  76 #define MEN_Z135_PEN_SHIFT 3    /* Parity enable */
  77 #define MEN_Z135_PAR_DIS 0
  78 #define MEN_Z135_PAR_ENA 1
  79
  80 #define MEN_Z135_PTY_SHIFT 4    /* Parity type */
  81 #define MEN_Z135_PTY_ODD 0
  82 #define MEN_Z135_PTY_EVN 1
  83
  84 #define MEN_Z135_LSR_DR BIT(0)
  85 #define MEN_Z135_LSR_OE BIT(1)
  86 #define MEN_Z135_LSR_PE BIT(2)
  87 #define MEN_Z135_LSR_FE BIT(3)
  88 #define MEN_Z135_LSR_BI BIT(4)
  89 #define MEN_Z135_LSR_THEP BIT(5)
  90 #define MEN_Z135_LSR_TEXP BIT(6)
  91 #define MEN_Z135_LSR_RXFIFOERR BIT(7)
  92
  93 #define MEN_Z135_IRQ_ID_RLS BIT(0)
  94 #define MEN_Z135_IRQ_ID_RDA BIT(1)
  95 #define MEN_Z135_IRQ_ID_CTI BIT(2)
  96 #define MEN_Z135_IRQ_ID_TSA BIT(3)
  97 #define MEN_Z135_IRQ_ID_MST BIT(4)
  98
  99 #define LCR(x) (((x) >> MEN_Z135_LCR_SHIFT) & 0xff)
 100
 101 #define BYTES_TO_ALIGN(x) ((x) & 0x3)
 102
 103 static int line;
 104
 105 static int txlvl = 5;
 106 module_param(txlvl, int, S_IRUGO);
 107 MODULE_PARM_DESC(txlvl, "TX IRQ trigger level 0-7, default 5 (128 byte)");
 108
 109 static int rxlvl = 6;
 110 module_param(rxlvl, int, S_IRUGO);
 111 MODULE_PARM_DESC(rxlvl, "RX IRQ trigger level 0-7, default 6 (256 byte)");
 112
 113 static int align;
 114 module_param(align, int, S_IRUGO);
 115 MODULE_PARM_DESC(align, "Keep hardware FIFO write pointer aligned, default 0");
 116
 117 static uint rx_timeout;
 118 module_param(rx_timeout, uint, S_IRUGO);
 119 MODULE_PARM_DESC(rx_timeout, "RX timeout. "
 120                 "Timeout in seconds = (timeout_reg * baud_reg * 4) / freq_reg");
 121
 122 struct men_z135_port {
 123         struct uart_port port;
 124         struct mcb_device *mdev;
 125         struct resource *mem;
 126         unsigned char *rxbuf;
 127         u32 stat_reg;
 128         spinlock_t lock;
 129         bool automode;
 130 };
 131 #define to_men_z135(port) container_of((port), struct men_z135_port, port)
 132
 133 /**
 134  * men_z135_reg_set() - Set value in register
 135  * @uart: The UART port
 136  * @addr: Register address
 137  * @val: value to set
 138  */
 139 static inline void men_z135_reg_set(struct men_z135_port *uart,
 140                                 u32 addr, u32 val)
 141 {
 142         struct uart_port *port = &uart->port;
 143         unsigned long flags;
 144         u32 reg;
 145
 146         spin_lock_irqsave(&uart->lock, flags);
 147
 148         reg = ioread32(port->membase + addr);
 149         reg |= val;
 150         iowrite32(reg, port->membase + addr);
 151
 152         spin_unlock_irqrestore(&uart->lock, flags);
 153 }
 154
 155 /**
 156  * men_z135_reg_clr() - Unset value in register
 157  * @uart: The UART port
 158  * @addr: Register address
 159  * @val: value to clear
 160  */
 161 static void men_z135_reg_clr(struct men_z135_port *uart,
 162                                 u32 addr, u32 val)
 163 {
 164         struct uart_port *port = &uart->port;
 165         unsigned long flags;
 166         u32 reg;
 167
 168         spin_lock_irqsave(&uart->lock, flags);
 169
 170         reg = ioread32(port->membase + addr);
 171         reg &= ~val;
 172         iowrite32(reg, port->membase + addr);
 173
 174         spin_unlock_irqrestore(&uart->lock, flags);
 175 }
 176
 177 /**
 178  * men_z135_handle_modem_status() - Handle change of modem status
 179  * @port: The UART port
 180  *
 181  * Handle change of modem status register. This is done by reading the "delta"
 182  * versions of DCD (Data Carrier Detect) and CTS (Clear To Send).
 183  */
 184 static void men_z135_handle_modem_status(struct men_z135_port *uart)
 185 {
 186         u8 msr;
 187
 188         msr = (uart->stat_reg >> 8) & 0xff;
 189
 190         if (msr & MEN_Z135_MSR_DDCD)
 191                 uart_handle_dcd_change(&uart->port,
 192                                 msr & MEN_Z135_MSR_DCD);
 193         if (msr & MEN_Z135_MSR_DCTS)
 194                 uart_handle_cts_change(&uart->port,
 195                                 msr & MEN_Z135_MSR_CTS);
 196 }
 197
 198 static void men_z135_handle_lsr(struct men_z135_port *uart)
 199 {
 200         struct uart_port *port = &uart->port;
 201         u8 lsr;
 202
 203         lsr = (uart->stat_reg >> 16) & 0xff;
 204
 205         if (lsr & MEN_Z135_LSR_OE)
 206                 port->icount.overrun++;
 207         if (lsr & MEN_Z135_LSR_PE)
 208                 port->icount.parity++;
 209         if (lsr & MEN_Z135_LSR_FE)
 210                 port->icount.frame++;
 211         if (lsr & MEN_Z135_LSR_BI) {
 212                 port->icount.brk++;
 213                 uart_handle_break(port);
 214         }
 215 }
 216
 217 /**
 218  * get_rx_fifo_content() - Get the number of bytes in RX FIFO
 219  * @uart: The UART port
 220  *
 221  * Read RXC register from hardware and return current FIFO fill size.
 222  */
 223 static u16 get_rx_fifo_content(struct men_z135_port *uart)
 224 {
 225         struct uart_port *port = &uart->port;
 226         u32 stat_reg;
 227         u16 rxc;
 228         u8 rxc_lo;
 229         u8 rxc_hi;
 230
 231         stat_reg = ioread32(port->membase + MEN_Z135_STAT_REG);
 232         rxc_lo = stat_reg >> 24;
 233         rxc_hi = (stat_reg & 0xC0) >> 6;
 234
 235         rxc = rxc_lo | (rxc_hi << 8);
 236
 237         return rxc;
 238 }
 239
 240 /**
 241  * men_z135_handle_rx() - RX tasklet routine
 242  * @arg: Pointer to struct men_z135_port
 243  *
 244  * Copy from RX FIFO and acknowledge number of bytes copied.
 245  */
 246 static void men_z135_handle_rx(struct men_z135_port *uart)
 247 {
 248         struct uart_port *port = &uart->port;
 249         struct tty_port *tport = &port->state->port;
 250         int copied;
 251         u16 size;
 252         int room;
 253
 254         size = get_rx_fifo_content(uart);
 255
 256         if (size == 0)
 257                 return;
 258
 259         /* Avoid accidently accessing TX FIFO instead of RX FIFO. Last
 260          * longword in RX FIFO cannot be read.(0x004-0x3FF)
 261          */
 262         if (size > MEN_Z135_FIFO_WATERMARK)
 263                 size = MEN_Z135_FIFO_WATERMARK;
 264
 265         room = tty_buffer_request_room(tport, size);
 266         if (room != size)
 267                 dev_warn(&uart->mdev->dev,
 268                         "Not enough room in flip buffer, truncating to %d\n",
 269                         room);
 270
 271         if (room == 0)
 272                 return;
 273
 274         memcpy_fromio(uart->rxbuf, port->membase + MEN_Z135_RX_RAM, room);
 275         /* Be sure to first copy all data and then acknowledge it */
 276         mb();
 277         iowrite32(room, port->membase +  MEN_Z135_RX_CTRL);
 278
 279         copied = tty_insert_flip_string(tport, uart->rxbuf, room);
 280         if (copied != room)
 281                 dev_warn(&uart->mdev->dev,
 282                         "Only copied %d instead of %d bytes\n",
 283                         copied, room);
 284
 285         port->icount.rx += copied;
 286
 287         tty_flip_buffer_push(tport);
 288
 289 }
 290
 291 /**
 292  * men_z135_handle_tx() - TX tasklet routine
 293  * @arg: Pointer to struct men_z135_port
 294  *
 295  */
 296 static void men_z135_handle_tx(struct men_z135_port *uart)
 297 {
 298         struct uart_port *port = &uart->port;
 299         struct circ_buf *xmit = &port->state->xmit;
 300         u32 txc;
 301         u32 wptr;
 302         int qlen;
 303         int n;
 304         int txfree;
 305         int head;
 306         int tail;
 307         int s;
 308
 309         if (uart_circ_empty(xmit))
 310                 goto out;
 311
 312         if (uart_tx_stopped(port))
 313                 goto out;
 314
 315         if (port->x_char)
 316                 goto out;
 317
 318         /* calculate bytes to copy */
 319         qlen = uart_circ_chars_pending(xmit);
 320         if (qlen <= 0)
 321                 goto out;
 322
 323         wptr = ioread32(port->membase + MEN_Z135_TX_CTRL);
 324         txc = (wptr >> 16) & 0x3ff;
 325         wptr &= 0x3ff;
 326
 327         if (txc > MEN_Z135_FIFO_WATERMARK)
 328                 txc = MEN_Z135_FIFO_WATERMARK;
 329
 330         txfree = MEN_Z135_FIFO_WATERMARK - txc;
 331         if (txfree <= 0) {
 332                 dev_err(&uart->mdev->dev,
 333                         "Not enough room in TX FIFO have %d, need %d\n",
 334                         txfree, qlen);
 335                 goto irq_en;
 336         }
 337
 338         /* if we're not aligned, it's better to copy only 1 or 2 bytes and
 339          * then the rest.
 340          */
 341         if (align && qlen >= 3 && BYTES_TO_ALIGN(wptr))
 342                 n = 4 - BYTES_TO_ALIGN(wptr);
 343         else if (qlen > txfree)
 344                 n = txfree;
 345         else
 346                 n = qlen;
 347
 348         if (n <= 0)
 349                 goto irq_en;
 350
 351         head = xmit->head & (UART_XMIT_SIZE - 1);
 352         tail = xmit->tail & (UART_XMIT_SIZE - 1);
 353
 354         s = ((head >= tail) ? head : UART_XMIT_SIZE) - tail;
 355         n = min(n, s);
 356
 357         memcpy_toio(port->membase + MEN_Z135_TX_RAM, &xmit->buf[xmit->tail], n);
 358         xmit->tail = (xmit->tail + n) & (UART_XMIT_SIZE - 1);
 359         mmiowb();
 360
 361         iowrite32(n & 0x3ff, port->membase + MEN_Z135_TX_CTRL);
 362
 363         port->icount.tx += n;
 364
 365         if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 366                 uart_write_wakeup(port);
 367
 368 irq_en:
 369         if (!uart_circ_empty(xmit))
 370                 men_z135_reg_set(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_TXCIEN);
 371         else
 372                 men_z135_reg_clr(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_TXCIEN);
 373
 374 out:
 375         return;
 376
 377 }
 378
 379 /**
 380  * men_z135_intr() - Handle legacy IRQs
 381  * @irq: The IRQ number
 382  * @data: Pointer to UART port
 383  *
 384  * Check IIR register to find the cause of the interrupt and handle it.
 385  * It is possible that multiple interrupts reason bits are set and reading
 386  * the IIR is a destructive read, so we always need to check for all possible
 387  * interrupts and handle them.
 388  */
 389 static irqreturn_t men_z135_intr(int irq, void *data)
 390 {
 391         struct men_z135_port *uart = (struct men_z135_port *)data;
 392         struct uart_port *port = &uart->port;
 393         bool handled = false;
 394         int irq_id;
 395
 396         uart->stat_reg = ioread32(port->membase + MEN_Z135_STAT_REG);
 397         irq_id = IRQ_ID(uart->stat_reg);
 398
 399         if (!irq_id)
 400                 goto out;
 401
 402         spin_lock(&port->lock);
 403         /* It's save to write to IIR[7:6] RXC[9:8] */
 404         iowrite8(irq_id, port->membase + MEN_Z135_STAT_REG);
 405
 406         if (irq_id & MEN_Z135_IRQ_ID_RLS) {
 407                 men_z135_handle_lsr(uart);
 408                 handled = true;
 409         }
 410
 411         if (irq_id & (MEN_Z135_IRQ_ID_RDA | MEN_Z135_IRQ_ID_CTI)) {
 412                 if (irq_id & MEN_Z135_IRQ_ID_CTI)
 413                         dev_dbg(&uart->mdev->dev, "Character Timeout Indication\n");
 414                 men_z135_handle_rx(uart);
 415                 handled = true;
 416         }
 417
 418         if (irq_id & MEN_Z135_IRQ_ID_TSA) {
 419                 men_z135_handle_tx(uart);
 420                 handled = true;
 421         }
 422
 423         if (irq_id & MEN_Z135_IRQ_ID_MST) {
 424                 men_z135_handle_modem_status(uart);
 425                 handled = true;
 426         }
 427
 428         spin_unlock(&port->lock);
 429 out:
 430         return IRQ_RETVAL(handled);
 431 }
 432
 433 /**
 434  * men_z135_request_irq() - Request IRQ for 16z135 core
 435  * @uart: z135 private uart port structure
 436  *
 437  * Request an IRQ for 16z135 to use. First try using MSI, if it fails
 438  * fall back to using legacy interrupts.
 439  */
 440 static int men_z135_request_irq(struct men_z135_port *uart)
 441 {
 442         struct device *dev = &uart->mdev->dev;
 443         struct uart_port *port = &uart->port;
 444         int err = 0;
 445
 446         err = request_irq(port->irq, men_z135_intr, IRQF_SHARED,
 447                         "men_z135_intr", uart);
 448         if (err)
 449                 dev_err(dev, "Error %d getting interrupt\n", err);
 450
 451         return err;
 452 }
 453
 454 /**
 455  * men_z135_tx_empty() - Handle tx_empty call
 456  * @port: The UART port
 457  *
 458  * This function tests whether the TX FIFO and shifter for the port
 459  * described by @port is empty.
 460  */
 461 static unsigned int men_z135_tx_empty(struct uart_port *port)
 462 {
 463         u32 wptr;
 464         u16 txc;
 465
 466         wptr = ioread32(port->membase + MEN_Z135_TX_CTRL);
 467         txc = (wptr >> 16) & 0x3ff;
 468
 469         if (txc == 0)
 470                 return TIOCSER_TEMT;
 471         else
 472                 return 0;
 473 }
 474
 475 /**
 476  * men_z135_set_mctrl() - Set modem control lines
 477  * @port: The UART port
 478  * @mctrl: The modem control lines
 479  *
 480  * This function sets the modem control lines for a port described by @port
 481  * to the state described by @mctrl
 482  */
 483 static void men_z135_set_mctrl(struct uart_port *port, unsigned int mctrl)
 484 {
 485         u32 old;
 486         u32 conf_reg;
 487
 488         conf_reg = old = ioread32(port->membase + MEN_Z135_CONF_REG);
 489         if (mctrl & TIOCM_RTS)
 490                 conf_reg |= MEN_Z135_MCR_RTS;
 491         else
 492                 conf_reg &= ~MEN_Z135_MCR_RTS;
 493
 494         if (mctrl & TIOCM_DTR)
 495                 conf_reg |= MEN_Z135_MCR_DTR;
 496         else
 497                 conf_reg &= ~MEN_Z135_MCR_DTR;
 498
 499         if (mctrl & TIOCM_OUT1)
 500                 conf_reg |= MEN_Z135_MCR_OUT1;
 501         else
 502                 conf_reg &= ~MEN_Z135_MCR_OUT1;
 503
 504         if (mctrl & TIOCM_OUT2)
 505                 conf_reg |= MEN_Z135_MCR_OUT2;
 506         else
 507                 conf_reg &= ~MEN_Z135_MCR_OUT2;
 508
 509         if (mctrl & TIOCM_LOOP)
 510                 conf_reg |= MEN_Z135_MCR_LOOP;
 511         else
 512                 conf_reg &= ~MEN_Z135_MCR_LOOP;
 513
 514         if (conf_reg != old)
 515                 iowrite32(conf_reg, port->membase + MEN_Z135_CONF_REG);
 516 }
 517
 518 /**
 519  * men_z135_get_mctrl() - Get modem control lines
 520  * @port: The UART port
 521  *
 522  * Retruns the current state of modem control inputs.
 523  */
 524 static unsigned int men_z135_get_mctrl(struct uart_port *port)
 525 {
 526         unsigned int mctrl = 0;
 527         u8 msr;
 528
 529         msr = ioread8(port->membase + MEN_Z135_STAT_REG + 1);
 530
 531         if (msr & MEN_Z135_MSR_CTS)
 532                 mctrl |= TIOCM_CTS;
 533         if (msr & MEN_Z135_MSR_DSR)
 534                 mctrl |= TIOCM_DSR;
 535         if (msr & MEN_Z135_MSR_RI)
 536                 mctrl |= TIOCM_RI;
 537         if (msr & MEN_Z135_MSR_DCD)
 538                 mctrl |= TIOCM_CAR;
 539
 540         return mctrl;
 541 }
 542
 543 /**
 544  * men_z135_stop_tx() - Stop transmitting characters
 545  * @port: The UART port
 546  *
 547  * Stop transmitting characters. This might be due to CTS line becomming
 548  * inactive or the tty layer indicating we want to stop transmission due to
 549  * an XOFF character.
 550  */
 551 static void men_z135_stop_tx(struct uart_port *port)
 552 {
 553         struct men_z135_port *uart = to_men_z135(port);
 554
 555         men_z135_reg_clr(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_TXCIEN);
 556 }
 557
 558 /*
 559  * men_z135_disable_ms() - Disable Modem Status
 560  * port: The UART port
 561  *
 562  * Enable Modem Status IRQ.
 563  */
 564 static void men_z135_disable_ms(struct uart_port *port)
 565 {
 566         struct men_z135_port *uart = to_men_z135(port);
 567
 568         men_z135_reg_clr(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_MSIEN);
 569 }
 570
 571 /**
 572  * men_z135_start_tx() - Start transmitting characters
 573  * @port: The UART port
 574  *
 575  * Start transmitting character. This actually doesn't transmit anything, but
 576  * fires off the TX tasklet.
 577  */
 578 static void men_z135_start_tx(struct uart_port *port)
 579 {
 580         struct men_z135_port *uart = to_men_z135(port);
 581
 582         if (uart->automode)
 583                 men_z135_disable_ms(port);
 584
 585         men_z135_handle_tx(uart);
 586 }
 587
 588 /**
 589  * men_z135_stop_rx() - Stop receiving characters
 590  * @port: The UART port
 591  *
 592  * Stop receiving characters; the port is in the process of being closed.
 593  */
 594 static void men_z135_stop_rx(struct uart_port *port)
 595 {
 596         struct men_z135_port *uart = to_men_z135(port);
 597
 598         men_z135_reg_clr(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_RXCIEN);
 599 }
 600
 601 /**
 602  * men_z135_enable_ms() - Enable Modem Status
 603  * port:
 604  *
 605  * Enable Modem Status IRQ.
 606  */
 607 static void men_z135_enable_ms(struct uart_port *port)
 608 {
 609         struct men_z135_port *uart = to_men_z135(port);
 610
 611         men_z135_reg_set(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_MSIEN);
 612 }
 613
 614 static int men_z135_startup(struct uart_port *port)
 615 {
 616         struct men_z135_port *uart = to_men_z135(port);
 617         int err;
 618         u32 conf_reg = 0;
 619
 620         err = men_z135_request_irq(uart);
 621         if (err)
 622                 return -ENODEV;
 623
 624         conf_reg = ioread32(port->membase + MEN_Z135_CONF_REG);
 625
 626         /* Activate all but TX space available IRQ */
 627         conf_reg |= MEN_Z135_ALL_IRQS & ~MEN_Z135_IER_TXCIEN;
 628         conf_reg &= ~(0xff << 16);
 629         conf_reg |= (txlvl << 16);
 630         conf_reg |= (rxlvl << 20);
 631
 632         iowrite32(conf_reg, port->membase + MEN_Z135_CONF_REG);
 633
 634         if (rx_timeout)
 635                 iowrite32(rx_timeout, port->membase + MEN_Z135_TIMEOUT);
 636
 637         return 0;
 638 }
 639
 640 static void men_z135_shutdown(struct uart_port *port)
 641 {
 642         struct men_z135_port *uart = to_men_z135(port);
 643         u32 conf_reg = 0;
 644
 645         conf_reg |= MEN_Z135_ALL_IRQS;
 646
 647         men_z135_reg_clr(uart, MEN_Z135_CONF_REG, conf_reg);
 648
 649         free_irq(uart->port.irq, uart);
 650 }
 651
 652 static void men_z135_set_termios(struct uart_port *port,
 653                                 struct ktermios *termios,
 654                                 struct ktermios *old)
 655 {
 656         struct men_z135_port *uart = to_men_z135(port);
 657         unsigned int baud;
 658         u32 conf_reg;
 659         u32 bd_reg;
 660         u32 uart_freq;
 661         u8 lcr;
 662
 663         conf_reg = ioread32(port->membase + MEN_Z135_CONF_REG);
 664         lcr = LCR(conf_reg);
 665
 666         /* byte size */
 667         switch (termios->c_cflag & CSIZE) {
 668         case CS5:
 669                 lcr |= MEN_Z135_WL5;
 670                 break;
 671         case CS6:
 672                 lcr |= MEN_Z135_WL6;
 673                 break;
 674         case CS7:
 675                 lcr |= MEN_Z135_WL7;
 676                 break;
 677         case CS8:
 678                 lcr |= MEN_Z135_WL8;
 679                 break;
 680         }
 681
 682         /* stop bits */
 683         if (termios->c_cflag & CSTOPB)
 684                 lcr |= MEN_Z135_NSTB2 << MEN_Z135_STB_SHIFT;
 685
 686         /* parity */
 687         if (termios->c_cflag & PARENB) {
 688                 lcr |= MEN_Z135_PAR_ENA << MEN_Z135_PEN_SHIFT;
 689
 690                 if (termios->c_cflag & PARODD)
 691                         lcr |= MEN_Z135_PTY_ODD << MEN_Z135_PTY_SHIFT;
 692                 else
 693                         lcr |= MEN_Z135_PTY_EVN << MEN_Z135_PTY_SHIFT;
 694         } else
 695                 lcr |= MEN_Z135_PAR_DIS << MEN_Z135_PEN_SHIFT;
 696
 697         conf_reg |= MEN_Z135_IER_MSIEN;
 698         if (termios->c_cflag & CRTSCTS) {
 699                 conf_reg |= MEN_Z135_MCR_RCFC;
 700                 uart->automode = true;
 701                 termios->c_cflag &= ~CLOCAL;
 702         } else {
 703                 conf_reg &= ~MEN_Z135_MCR_RCFC;
 704                 uart->automode = false;
 705         }
 706
 707         termios->c_cflag &= ~CMSPAR; /* Mark/Space parity is not supported */
 708
 709         conf_reg |= lcr << MEN_Z135_LCR_SHIFT;
 710         iowrite32(conf_reg, port->membase + MEN_Z135_CONF_REG);
 711
 712         uart_freq = ioread32(port->membase + MEN_Z135_UART_FREQ);
 713         if (uart_freq == 0)
 714                 uart_freq = MEN_Z135_BASECLK;
 715
 716         baud = uart_get_baud_rate(port, termios, old, 0, uart_freq / 16);
 717
 718         spin_lock_irq(&port->lock);
 719         if (tty_termios_baud_rate(termios))
 720                 tty_termios_encode_baud_rate(termios, baud, baud);
 721
 722         bd_reg = uart_freq / (4 * baud);
 723         iowrite32(bd_reg, port->membase + MEN_Z135_BAUD_REG);
 724
 725         uart_update_timeout(port, termios->c_cflag, baud);
 726         spin_unlock_irq(&port->lock);
 727 }
 728
 729 static const char *men_z135_type(struct uart_port *port)
 730 {
 731         return KBUILD_MODNAME;
 732 }
 733
 734 static void men_z135_release_port(struct uart_port *port)
 735 {
 736         struct men_z135_port *uart = to_men_z135(port);
 737
 738         iounmap(port->membase);
 739         port->membase = NULL;
 740
 741         mcb_release_mem(uart->mem);
 742 }
 743
 744 static int men_z135_request_port(struct uart_port *port)
 745 {
 746         struct men_z135_port *uart = to_men_z135(port);
 747         struct mcb_device *mdev = uart->mdev;
 748         struct resource *mem;
 749
 750         mem = mcb_request_mem(uart->mdev, dev_name(&mdev->dev));
 751         if (IS_ERR(mem))
 752                 return PTR_ERR(mem);
 753
 754         port->mapbase = mem->start;
 755         uart->mem = mem;
 756
 757         port->membase = ioremap(mem->start, resource_size(mem));
 758         if (port->membase == NULL) {
 759                 mcb_release_mem(mem);
 760                 return -ENOMEM;
 761         }
 762
 763         return 0;
 764 }
 765
 766 static void men_z135_config_port(struct uart_port *port, int type)
 767 {
 768         port->type = PORT_MEN_Z135;
 769         men_z135_request_port(port);
 770 }
 771
 772 static int men_z135_verify_port(struct uart_port *port,
 773                                 struct serial_struct *serinfo)
 774 {
 775         return -EINVAL;
 776 }
 777
 778 static struct uart_ops men_z135_ops = {
 779         .tx_empty = men_z135_tx_empty,
 780         .set_mctrl = men_z135_set_mctrl,
 781         .get_mctrl = men_z135_get_mctrl,
 782         .stop_tx = men_z135_stop_tx,
 783         .start_tx = men_z135_start_tx,
 784         .stop_rx = men_z135_stop_rx,
 785         .enable_ms = men_z135_enable_ms,
 786         .startup = men_z135_startup,
 787         .shutdown = men_z135_shutdown,
 788         .set_termios = men_z135_set_termios,
 789         .type = men_z135_type,
 790         .release_port = men_z135_release_port,
 791         .request_port = men_z135_request_port,
 792         .config_port = men_z135_config_port,
 793         .verify_port = men_z135_verify_port,
 794 };
 795
 796 static struct uart_driver men_z135_driver = {
 797         .owner = THIS_MODULE,
 798         .driver_name = KBUILD_MODNAME,
 799         .dev_name = "ttyHSU",
 800         .major = 0,
 801         .minor = 0,
 802         .nr = MEN_Z135_MAX_PORTS,
 803 };
 804
 805 /**
 806  * men_z135_probe() - Probe a z135 instance
 807  * @mdev: The MCB device
 808  * @id: The MCB device ID
 809  *
 810  * men_z135_probe does the basic setup of hardware resources and registers the
 811  * new uart port to the tty layer.
 812  */
 813 static int men_z135_probe(struct mcb_device *mdev,
 814                         const struct mcb_device_id *id)
 815 {
 816         struct men_z135_port *uart;
 817         struct resource *mem;
 818         struct device *dev;
 819         int err;
 820
 821         dev = &mdev->dev;
 822
 823         uart = devm_kzalloc(dev, sizeof(struct men_z135_port), GFP_KERNEL);
 824         if (!uart)
 825                 return -ENOMEM;
 826
 827         uart->rxbuf = (unsigned char *)__get_free_page(GFP_KERNEL);
 828         if (!uart->rxbuf)
 829                 return -ENOMEM;
 830
 831         mem = &mdev->mem;
 832
 833         mcb_set_drvdata(mdev, uart);
 834
 835         uart->port.uartclk = MEN_Z135_BASECLK * 16;
 836         uart->port.fifosize = MEN_Z135_FIFO_SIZE;
 837         uart->port.iotype = UPIO_MEM;
 838         uart->port.ops = &men_z135_ops;
 839         uart->port.irq = mcb_get_irq(mdev);
 840         uart->port.iotype = UPIO_MEM;
 841         uart->port.flags = UPF_BOOT_AUTOCONF | UPF_IOREMAP;
 842         uart->port.line = line++;
 843         uart->port.dev = dev;
 844         uart->port.type = PORT_MEN_Z135;
 845         uart->port.mapbase = mem->start;
 846         uart->port.membase = NULL;
 847         uart->mdev = mdev;
 848
 849         spin_lock_init(&uart->lock);
 850
 851         err = uart_add_one_port(&men_z135_driver, &uart->port);
 852         if (err)
 853                 goto err;
 854
 855         return 0;
 856
 857 err:
 858         free_page((unsigned long) uart->rxbuf);
 859         dev_err(dev, "Failed to add UART: %d\n", err);
 860
 861         return err;
 862 }
 863
 864 /**
 865  * men_z135_remove() - Remove a z135 instance from the system
 866  *
 867  * @mdev: The MCB device
 868  */
 869 static void men_z135_remove(struct mcb_device *mdev)
 870 {
 871         struct men_z135_port *uart = mcb_get_drvdata(mdev);
 872
 873         line--;
 874         uart_remove_one_port(&men_z135_driver, &uart->port);
 875         free_page((unsigned long) uart->rxbuf);
 876 }
 877
 878 static const struct mcb_device_id men_z135_ids[] = {
 879         { .device = 0x87 },
 880         { }
 881 };
 882 MODULE_DEVICE_TABLE(mcb, men_z135_ids);
 883
 884 static struct mcb_driver mcb_driver = {
 885         .driver = {
 886                 .name = "z135-uart",
 887                 .owner = THIS_MODULE,
 888         },
 889         .probe = men_z135_probe,
 890         .remove = men_z135_remove,
 891         .id_table = men_z135_ids,
 892 };
 893
 894 /**
 895  * men_z135_init() - Driver Registration Routine
 896  *
 897  * men_z135_init is the first routine called when the driver is loaded. All it
 898  * does is register with the legacy MEN Chameleon subsystem.
 899  */
 900 static int __init men_z135_init(void)
 901 {
 902         int err;
 903
 904         err = uart_register_driver(&men_z135_driver);
 905         if (err) {
 906                 pr_err("Failed to register UART: %d\n", err);
 907                 return err;
 908         }
 909
 910         err = mcb_register_driver(&mcb_driver);
 911         if  (err) {
 912                 pr_err("Failed to register MCB driver: %d\n", err);
 913                 uart_unregister_driver(&men_z135_driver);
 914                 return err;
 915         }
 916
 917         return 0;
 918 }
 919 module_init(men_z135_init);
 920
 921 /**
 922  * men_z135_exit() - Driver Exit Routine
 923  *
 924  * men_z135_exit is called just before the driver is removed from memory.
 925  */
 926 static void __exit men_z135_exit(void)
 927 {
 928         mcb_unregister_driver(&mcb_driver);
 929         uart_unregister_driver(&men_z135_driver);
 930 }
 931 module_exit(men_z135_exit);
 932
 933 MODULE_AUTHOR("Johannes Thumshirn <[email protected]>");
 934 MODULE_LICENSE("GPL v2");
 935 MODULE_DESCRIPTION("MEN 16z135 High Speed UART");
 936 MODULE_ALIAS("mcb:16z135");