1 /* 2 * MEN 16z135 High Speed UART 3 * 4 * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de) 5 * Author: Johannes Thumshirn <johannes.thumshirn@men.de> 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 <johannes.thumshirn@men.de>"); 934 MODULE_LICENSE("GPL v2"); 935 MODULE_DESCRIPTION("MEN 16z135 High Speed UART"); 936 MODULE_ALIAS("mcb:16z135"); 937