Linux 4.16.11
[linux/fpc-iii.git] / drivers / tty / serial / men_z135_uart.c
blobef89534dd760c81ee04196b9b682dcbd5d683793
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3 * MEN 16z135 High Speed UART
5 * Copyright (C) 2014 MEN Mikroelektronik GmbH (www.men.de)
6 * Author: Johannes Thumshirn <johannes.thumshirn@men.de>
7 */
8 #define pr_fmt(fmt) KBUILD_MODNAME ":" fmt
10 #include <linux/kernel.h>
11 #include <linux/module.h>
12 #include <linux/interrupt.h>
13 #include <linux/serial_core.h>
14 #include <linux/ioport.h>
15 #include <linux/io.h>
16 #include <linux/tty_flip.h>
17 #include <linux/bitops.h>
18 #include <linux/mcb.h>
20 #define MEN_Z135_MAX_PORTS 12
21 #define MEN_Z135_BASECLK 29491200
22 #define MEN_Z135_FIFO_SIZE 1024
23 #define MEN_Z135_FIFO_WATERMARK 1020
25 #define MEN_Z135_STAT_REG 0x0
26 #define MEN_Z135_RX_RAM 0x4
27 #define MEN_Z135_TX_RAM 0x400
28 #define MEN_Z135_RX_CTRL 0x800
29 #define MEN_Z135_TX_CTRL 0x804
30 #define MEN_Z135_CONF_REG 0x808
31 #define MEN_Z135_UART_FREQ 0x80c
32 #define MEN_Z135_BAUD_REG 0x810
33 #define MEN_Z135_TIMEOUT 0x814
35 #define IRQ_ID(x) ((x) & 0x1f)
37 #define MEN_Z135_IER_RXCIEN BIT(0) /* RX Space IRQ */
38 #define MEN_Z135_IER_TXCIEN BIT(1) /* TX Space IRQ */
39 #define MEN_Z135_IER_RLSIEN BIT(2) /* Receiver Line Status IRQ */
40 #define MEN_Z135_IER_MSIEN BIT(3) /* Modem Status IRQ */
41 #define MEN_Z135_ALL_IRQS (MEN_Z135_IER_RXCIEN \
42 | MEN_Z135_IER_RLSIEN \
43 | MEN_Z135_IER_MSIEN \
44 | MEN_Z135_IER_TXCIEN)
46 #define MEN_Z135_MCR_DTR BIT(24)
47 #define MEN_Z135_MCR_RTS BIT(25)
48 #define MEN_Z135_MCR_OUT1 BIT(26)
49 #define MEN_Z135_MCR_OUT2 BIT(27)
50 #define MEN_Z135_MCR_LOOP BIT(28)
51 #define MEN_Z135_MCR_RCFC BIT(29)
53 #define MEN_Z135_MSR_DCTS BIT(0)
54 #define MEN_Z135_MSR_DDSR BIT(1)
55 #define MEN_Z135_MSR_DRI BIT(2)
56 #define MEN_Z135_MSR_DDCD BIT(3)
57 #define MEN_Z135_MSR_CTS BIT(4)
58 #define MEN_Z135_MSR_DSR BIT(5)
59 #define MEN_Z135_MSR_RI BIT(6)
60 #define MEN_Z135_MSR_DCD BIT(7)
62 #define MEN_Z135_LCR_SHIFT 8 /* LCR shift mask */
64 #define MEN_Z135_WL5 0 /* CS5 */
65 #define MEN_Z135_WL6 1 /* CS6 */
66 #define MEN_Z135_WL7 2 /* CS7 */
67 #define MEN_Z135_WL8 3 /* CS8 */
69 #define MEN_Z135_STB_SHIFT 2 /* Stopbits */
70 #define MEN_Z135_NSTB1 0
71 #define MEN_Z135_NSTB2 1
73 #define MEN_Z135_PEN_SHIFT 3 /* Parity enable */
74 #define MEN_Z135_PAR_DIS 0
75 #define MEN_Z135_PAR_ENA 1
77 #define MEN_Z135_PTY_SHIFT 4 /* Parity type */
78 #define MEN_Z135_PTY_ODD 0
79 #define MEN_Z135_PTY_EVN 1
81 #define MEN_Z135_LSR_DR BIT(0)
82 #define MEN_Z135_LSR_OE BIT(1)
83 #define MEN_Z135_LSR_PE BIT(2)
84 #define MEN_Z135_LSR_FE BIT(3)
85 #define MEN_Z135_LSR_BI BIT(4)
86 #define MEN_Z135_LSR_THEP BIT(5)
87 #define MEN_Z135_LSR_TEXP BIT(6)
88 #define MEN_Z135_LSR_RXFIFOERR BIT(7)
90 #define MEN_Z135_IRQ_ID_RLS BIT(0)
91 #define MEN_Z135_IRQ_ID_RDA BIT(1)
92 #define MEN_Z135_IRQ_ID_CTI BIT(2)
93 #define MEN_Z135_IRQ_ID_TSA BIT(3)
94 #define MEN_Z135_IRQ_ID_MST BIT(4)
96 #define LCR(x) (((x) >> MEN_Z135_LCR_SHIFT) & 0xff)
98 #define BYTES_TO_ALIGN(x) ((x) & 0x3)
100 static int line;
102 static int txlvl = 5;
103 module_param(txlvl, int, S_IRUGO);
104 MODULE_PARM_DESC(txlvl, "TX IRQ trigger level 0-7, default 5 (128 byte)");
106 static int rxlvl = 6;
107 module_param(rxlvl, int, S_IRUGO);
108 MODULE_PARM_DESC(rxlvl, "RX IRQ trigger level 0-7, default 6 (256 byte)");
110 static int align;
111 module_param(align, int, S_IRUGO);
112 MODULE_PARM_DESC(align, "Keep hardware FIFO write pointer aligned, default 0");
114 static uint rx_timeout;
115 module_param(rx_timeout, uint, S_IRUGO);
116 MODULE_PARM_DESC(rx_timeout, "RX timeout. "
117 "Timeout in seconds = (timeout_reg * baud_reg * 4) / freq_reg");
119 struct men_z135_port {
120 struct uart_port port;
121 struct mcb_device *mdev;
122 struct resource *mem;
123 unsigned char *rxbuf;
124 u32 stat_reg;
125 spinlock_t lock;
126 bool automode;
128 #define to_men_z135(port) container_of((port), struct men_z135_port, port)
131 * men_z135_reg_set() - Set value in register
132 * @uart: The UART port
133 * @addr: Register address
134 * @val: value to set
136 static inline void men_z135_reg_set(struct men_z135_port *uart,
137 u32 addr, u32 val)
139 struct uart_port *port = &uart->port;
140 unsigned long flags;
141 u32 reg;
143 spin_lock_irqsave(&uart->lock, flags);
145 reg = ioread32(port->membase + addr);
146 reg |= val;
147 iowrite32(reg, port->membase + addr);
149 spin_unlock_irqrestore(&uart->lock, flags);
153 * men_z135_reg_clr() - Unset value in register
154 * @uart: The UART port
155 * @addr: Register address
156 * @val: value to clear
158 static void men_z135_reg_clr(struct men_z135_port *uart,
159 u32 addr, u32 val)
161 struct uart_port *port = &uart->port;
162 unsigned long flags;
163 u32 reg;
165 spin_lock_irqsave(&uart->lock, flags);
167 reg = ioread32(port->membase + addr);
168 reg &= ~val;
169 iowrite32(reg, port->membase + addr);
171 spin_unlock_irqrestore(&uart->lock, flags);
175 * men_z135_handle_modem_status() - Handle change of modem status
176 * @port: The UART port
178 * Handle change of modem status register. This is done by reading the "delta"
179 * versions of DCD (Data Carrier Detect) and CTS (Clear To Send).
181 static void men_z135_handle_modem_status(struct men_z135_port *uart)
183 u8 msr;
185 msr = (uart->stat_reg >> 8) & 0xff;
187 if (msr & MEN_Z135_MSR_DDCD)
188 uart_handle_dcd_change(&uart->port,
189 msr & MEN_Z135_MSR_DCD);
190 if (msr & MEN_Z135_MSR_DCTS)
191 uart_handle_cts_change(&uart->port,
192 msr & MEN_Z135_MSR_CTS);
195 static void men_z135_handle_lsr(struct men_z135_port *uart)
197 struct uart_port *port = &uart->port;
198 u8 lsr;
200 lsr = (uart->stat_reg >> 16) & 0xff;
202 if (lsr & MEN_Z135_LSR_OE)
203 port->icount.overrun++;
204 if (lsr & MEN_Z135_LSR_PE)
205 port->icount.parity++;
206 if (lsr & MEN_Z135_LSR_FE)
207 port->icount.frame++;
208 if (lsr & MEN_Z135_LSR_BI) {
209 port->icount.brk++;
210 uart_handle_break(port);
215 * get_rx_fifo_content() - Get the number of bytes in RX FIFO
216 * @uart: The UART port
218 * Read RXC register from hardware and return current FIFO fill size.
220 static u16 get_rx_fifo_content(struct men_z135_port *uart)
222 struct uart_port *port = &uart->port;
223 u32 stat_reg;
224 u16 rxc;
225 u8 rxc_lo;
226 u8 rxc_hi;
228 stat_reg = ioread32(port->membase + MEN_Z135_STAT_REG);
229 rxc_lo = stat_reg >> 24;
230 rxc_hi = (stat_reg & 0xC0) >> 6;
232 rxc = rxc_lo | (rxc_hi << 8);
234 return rxc;
238 * men_z135_handle_rx() - RX tasklet routine
239 * @arg: Pointer to struct men_z135_port
241 * Copy from RX FIFO and acknowledge number of bytes copied.
243 static void men_z135_handle_rx(struct men_z135_port *uart)
245 struct uart_port *port = &uart->port;
246 struct tty_port *tport = &port->state->port;
247 int copied;
248 u16 size;
249 int room;
251 size = get_rx_fifo_content(uart);
253 if (size == 0)
254 return;
256 /* Avoid accidently accessing TX FIFO instead of RX FIFO. Last
257 * longword in RX FIFO cannot be read.(0x004-0x3FF)
259 if (size > MEN_Z135_FIFO_WATERMARK)
260 size = MEN_Z135_FIFO_WATERMARK;
262 room = tty_buffer_request_room(tport, size);
263 if (room != size)
264 dev_warn(&uart->mdev->dev,
265 "Not enough room in flip buffer, truncating to %d\n",
266 room);
268 if (room == 0)
269 return;
271 memcpy_fromio(uart->rxbuf, port->membase + MEN_Z135_RX_RAM, room);
272 /* Be sure to first copy all data and then acknowledge it */
273 mb();
274 iowrite32(room, port->membase + MEN_Z135_RX_CTRL);
276 copied = tty_insert_flip_string(tport, uart->rxbuf, room);
277 if (copied != room)
278 dev_warn(&uart->mdev->dev,
279 "Only copied %d instead of %d bytes\n",
280 copied, room);
282 port->icount.rx += copied;
284 tty_flip_buffer_push(tport);
289 * men_z135_handle_tx() - TX tasklet routine
290 * @arg: Pointer to struct men_z135_port
293 static void men_z135_handle_tx(struct men_z135_port *uart)
295 struct uart_port *port = &uart->port;
296 struct circ_buf *xmit = &port->state->xmit;
297 u32 txc;
298 u32 wptr;
299 int qlen;
300 int n;
301 int txfree;
302 int head;
303 int tail;
304 int s;
306 if (uart_circ_empty(xmit))
307 goto out;
309 if (uart_tx_stopped(port))
310 goto out;
312 if (port->x_char)
313 goto out;
315 /* calculate bytes to copy */
316 qlen = uart_circ_chars_pending(xmit);
317 if (qlen <= 0)
318 goto out;
320 wptr = ioread32(port->membase + MEN_Z135_TX_CTRL);
321 txc = (wptr >> 16) & 0x3ff;
322 wptr &= 0x3ff;
324 if (txc > MEN_Z135_FIFO_WATERMARK)
325 txc = MEN_Z135_FIFO_WATERMARK;
327 txfree = MEN_Z135_FIFO_WATERMARK - txc;
328 if (txfree <= 0) {
329 dev_err(&uart->mdev->dev,
330 "Not enough room in TX FIFO have %d, need %d\n",
331 txfree, qlen);
332 goto irq_en;
335 /* if we're not aligned, it's better to copy only 1 or 2 bytes and
336 * then the rest.
338 if (align && qlen >= 3 && BYTES_TO_ALIGN(wptr))
339 n = 4 - BYTES_TO_ALIGN(wptr);
340 else if (qlen > txfree)
341 n = txfree;
342 else
343 n = qlen;
345 if (n <= 0)
346 goto irq_en;
348 head = xmit->head & (UART_XMIT_SIZE - 1);
349 tail = xmit->tail & (UART_XMIT_SIZE - 1);
351 s = ((head >= tail) ? head : UART_XMIT_SIZE) - tail;
352 n = min(n, s);
354 memcpy_toio(port->membase + MEN_Z135_TX_RAM, &xmit->buf[xmit->tail], n);
355 xmit->tail = (xmit->tail + n) & (UART_XMIT_SIZE - 1);
356 mmiowb();
358 iowrite32(n & 0x3ff, port->membase + MEN_Z135_TX_CTRL);
360 port->icount.tx += n;
362 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
363 uart_write_wakeup(port);
365 irq_en:
366 if (!uart_circ_empty(xmit))
367 men_z135_reg_set(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_TXCIEN);
368 else
369 men_z135_reg_clr(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_TXCIEN);
371 out:
372 return;
377 * men_z135_intr() - Handle legacy IRQs
378 * @irq: The IRQ number
379 * @data: Pointer to UART port
381 * Check IIR register to find the cause of the interrupt and handle it.
382 * It is possible that multiple interrupts reason bits are set and reading
383 * the IIR is a destructive read, so we always need to check for all possible
384 * interrupts and handle them.
386 static irqreturn_t men_z135_intr(int irq, void *data)
388 struct men_z135_port *uart = (struct men_z135_port *)data;
389 struct uart_port *port = &uart->port;
390 bool handled = false;
391 int irq_id;
393 uart->stat_reg = ioread32(port->membase + MEN_Z135_STAT_REG);
394 irq_id = IRQ_ID(uart->stat_reg);
396 if (!irq_id)
397 goto out;
399 spin_lock(&port->lock);
400 /* It's save to write to IIR[7:6] RXC[9:8] */
401 iowrite8(irq_id, port->membase + MEN_Z135_STAT_REG);
403 if (irq_id & MEN_Z135_IRQ_ID_RLS) {
404 men_z135_handle_lsr(uart);
405 handled = true;
408 if (irq_id & (MEN_Z135_IRQ_ID_RDA | MEN_Z135_IRQ_ID_CTI)) {
409 if (irq_id & MEN_Z135_IRQ_ID_CTI)
410 dev_dbg(&uart->mdev->dev, "Character Timeout Indication\n");
411 men_z135_handle_rx(uart);
412 handled = true;
415 if (irq_id & MEN_Z135_IRQ_ID_TSA) {
416 men_z135_handle_tx(uart);
417 handled = true;
420 if (irq_id & MEN_Z135_IRQ_ID_MST) {
421 men_z135_handle_modem_status(uart);
422 handled = true;
425 spin_unlock(&port->lock);
426 out:
427 return IRQ_RETVAL(handled);
431 * men_z135_request_irq() - Request IRQ for 16z135 core
432 * @uart: z135 private uart port structure
434 * Request an IRQ for 16z135 to use. First try using MSI, if it fails
435 * fall back to using legacy interrupts.
437 static int men_z135_request_irq(struct men_z135_port *uart)
439 struct device *dev = &uart->mdev->dev;
440 struct uart_port *port = &uart->port;
441 int err = 0;
443 err = request_irq(port->irq, men_z135_intr, IRQF_SHARED,
444 "men_z135_intr", uart);
445 if (err)
446 dev_err(dev, "Error %d getting interrupt\n", err);
448 return err;
452 * men_z135_tx_empty() - Handle tx_empty call
453 * @port: The UART port
455 * This function tests whether the TX FIFO and shifter for the port
456 * described by @port is empty.
458 static unsigned int men_z135_tx_empty(struct uart_port *port)
460 u32 wptr;
461 u16 txc;
463 wptr = ioread32(port->membase + MEN_Z135_TX_CTRL);
464 txc = (wptr >> 16) & 0x3ff;
466 if (txc == 0)
467 return TIOCSER_TEMT;
468 else
469 return 0;
473 * men_z135_set_mctrl() - Set modem control lines
474 * @port: The UART port
475 * @mctrl: The modem control lines
477 * This function sets the modem control lines for a port described by @port
478 * to the state described by @mctrl
480 static void men_z135_set_mctrl(struct uart_port *port, unsigned int mctrl)
482 u32 old;
483 u32 conf_reg;
485 conf_reg = old = ioread32(port->membase + MEN_Z135_CONF_REG);
486 if (mctrl & TIOCM_RTS)
487 conf_reg |= MEN_Z135_MCR_RTS;
488 else
489 conf_reg &= ~MEN_Z135_MCR_RTS;
491 if (mctrl & TIOCM_DTR)
492 conf_reg |= MEN_Z135_MCR_DTR;
493 else
494 conf_reg &= ~MEN_Z135_MCR_DTR;
496 if (mctrl & TIOCM_OUT1)
497 conf_reg |= MEN_Z135_MCR_OUT1;
498 else
499 conf_reg &= ~MEN_Z135_MCR_OUT1;
501 if (mctrl & TIOCM_OUT2)
502 conf_reg |= MEN_Z135_MCR_OUT2;
503 else
504 conf_reg &= ~MEN_Z135_MCR_OUT2;
506 if (mctrl & TIOCM_LOOP)
507 conf_reg |= MEN_Z135_MCR_LOOP;
508 else
509 conf_reg &= ~MEN_Z135_MCR_LOOP;
511 if (conf_reg != old)
512 iowrite32(conf_reg, port->membase + MEN_Z135_CONF_REG);
516 * men_z135_get_mctrl() - Get modem control lines
517 * @port: The UART port
519 * Retruns the current state of modem control inputs.
521 static unsigned int men_z135_get_mctrl(struct uart_port *port)
523 unsigned int mctrl = 0;
524 u8 msr;
526 msr = ioread8(port->membase + MEN_Z135_STAT_REG + 1);
528 if (msr & MEN_Z135_MSR_CTS)
529 mctrl |= TIOCM_CTS;
530 if (msr & MEN_Z135_MSR_DSR)
531 mctrl |= TIOCM_DSR;
532 if (msr & MEN_Z135_MSR_RI)
533 mctrl |= TIOCM_RI;
534 if (msr & MEN_Z135_MSR_DCD)
535 mctrl |= TIOCM_CAR;
537 return mctrl;
541 * men_z135_stop_tx() - Stop transmitting characters
542 * @port: The UART port
544 * Stop transmitting characters. This might be due to CTS line becomming
545 * inactive or the tty layer indicating we want to stop transmission due to
546 * an XOFF character.
548 static void men_z135_stop_tx(struct uart_port *port)
550 struct men_z135_port *uart = to_men_z135(port);
552 men_z135_reg_clr(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_TXCIEN);
556 * men_z135_disable_ms() - Disable Modem Status
557 * port: The UART port
559 * Enable Modem Status IRQ.
561 static void men_z135_disable_ms(struct uart_port *port)
563 struct men_z135_port *uart = to_men_z135(port);
565 men_z135_reg_clr(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_MSIEN);
569 * men_z135_start_tx() - Start transmitting characters
570 * @port: The UART port
572 * Start transmitting character. This actually doesn't transmit anything, but
573 * fires off the TX tasklet.
575 static void men_z135_start_tx(struct uart_port *port)
577 struct men_z135_port *uart = to_men_z135(port);
579 if (uart->automode)
580 men_z135_disable_ms(port);
582 men_z135_handle_tx(uart);
586 * men_z135_stop_rx() - Stop receiving characters
587 * @port: The UART port
589 * Stop receiving characters; the port is in the process of being closed.
591 static void men_z135_stop_rx(struct uart_port *port)
593 struct men_z135_port *uart = to_men_z135(port);
595 men_z135_reg_clr(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_RXCIEN);
599 * men_z135_enable_ms() - Enable Modem Status
600 * port:
602 * Enable Modem Status IRQ.
604 static void men_z135_enable_ms(struct uart_port *port)
606 struct men_z135_port *uart = to_men_z135(port);
608 men_z135_reg_set(uart, MEN_Z135_CONF_REG, MEN_Z135_IER_MSIEN);
611 static int men_z135_startup(struct uart_port *port)
613 struct men_z135_port *uart = to_men_z135(port);
614 int err;
615 u32 conf_reg = 0;
617 err = men_z135_request_irq(uart);
618 if (err)
619 return -ENODEV;
621 conf_reg = ioread32(port->membase + MEN_Z135_CONF_REG);
623 /* Activate all but TX space available IRQ */
624 conf_reg |= MEN_Z135_ALL_IRQS & ~MEN_Z135_IER_TXCIEN;
625 conf_reg &= ~(0xff << 16);
626 conf_reg |= (txlvl << 16);
627 conf_reg |= (rxlvl << 20);
629 iowrite32(conf_reg, port->membase + MEN_Z135_CONF_REG);
631 if (rx_timeout)
632 iowrite32(rx_timeout, port->membase + MEN_Z135_TIMEOUT);
634 return 0;
637 static void men_z135_shutdown(struct uart_port *port)
639 struct men_z135_port *uart = to_men_z135(port);
640 u32 conf_reg = 0;
642 conf_reg |= MEN_Z135_ALL_IRQS;
644 men_z135_reg_clr(uart, MEN_Z135_CONF_REG, conf_reg);
646 free_irq(uart->port.irq, uart);
649 static void men_z135_set_termios(struct uart_port *port,
650 struct ktermios *termios,
651 struct ktermios *old)
653 struct men_z135_port *uart = to_men_z135(port);
654 unsigned int baud;
655 u32 conf_reg;
656 u32 bd_reg;
657 u32 uart_freq;
658 u8 lcr;
660 conf_reg = ioread32(port->membase + MEN_Z135_CONF_REG);
661 lcr = LCR(conf_reg);
663 /* byte size */
664 switch (termios->c_cflag & CSIZE) {
665 case CS5:
666 lcr |= MEN_Z135_WL5;
667 break;
668 case CS6:
669 lcr |= MEN_Z135_WL6;
670 break;
671 case CS7:
672 lcr |= MEN_Z135_WL7;
673 break;
674 case CS8:
675 lcr |= MEN_Z135_WL8;
676 break;
679 /* stop bits */
680 if (termios->c_cflag & CSTOPB)
681 lcr |= MEN_Z135_NSTB2 << MEN_Z135_STB_SHIFT;
683 /* parity */
684 if (termios->c_cflag & PARENB) {
685 lcr |= MEN_Z135_PAR_ENA << MEN_Z135_PEN_SHIFT;
687 if (termios->c_cflag & PARODD)
688 lcr |= MEN_Z135_PTY_ODD << MEN_Z135_PTY_SHIFT;
689 else
690 lcr |= MEN_Z135_PTY_EVN << MEN_Z135_PTY_SHIFT;
691 } else
692 lcr |= MEN_Z135_PAR_DIS << MEN_Z135_PEN_SHIFT;
694 conf_reg |= MEN_Z135_IER_MSIEN;
695 if (termios->c_cflag & CRTSCTS) {
696 conf_reg |= MEN_Z135_MCR_RCFC;
697 uart->automode = true;
698 termios->c_cflag &= ~CLOCAL;
699 } else {
700 conf_reg &= ~MEN_Z135_MCR_RCFC;
701 uart->automode = false;
704 termios->c_cflag &= ~CMSPAR; /* Mark/Space parity is not supported */
706 conf_reg |= lcr << MEN_Z135_LCR_SHIFT;
707 iowrite32(conf_reg, port->membase + MEN_Z135_CONF_REG);
709 uart_freq = ioread32(port->membase + MEN_Z135_UART_FREQ);
710 if (uart_freq == 0)
711 uart_freq = MEN_Z135_BASECLK;
713 baud = uart_get_baud_rate(port, termios, old, 0, uart_freq / 16);
715 spin_lock_irq(&port->lock);
716 if (tty_termios_baud_rate(termios))
717 tty_termios_encode_baud_rate(termios, baud, baud);
719 bd_reg = uart_freq / (4 * baud);
720 iowrite32(bd_reg, port->membase + MEN_Z135_BAUD_REG);
722 uart_update_timeout(port, termios->c_cflag, baud);
723 spin_unlock_irq(&port->lock);
726 static const char *men_z135_type(struct uart_port *port)
728 return KBUILD_MODNAME;
731 static void men_z135_release_port(struct uart_port *port)
733 struct men_z135_port *uart = to_men_z135(port);
735 iounmap(port->membase);
736 port->membase = NULL;
738 mcb_release_mem(uart->mem);
741 static int men_z135_request_port(struct uart_port *port)
743 struct men_z135_port *uart = to_men_z135(port);
744 struct mcb_device *mdev = uart->mdev;
745 struct resource *mem;
747 mem = mcb_request_mem(uart->mdev, dev_name(&mdev->dev));
748 if (IS_ERR(mem))
749 return PTR_ERR(mem);
751 port->mapbase = mem->start;
752 uart->mem = mem;
754 port->membase = ioremap(mem->start, resource_size(mem));
755 if (port->membase == NULL) {
756 mcb_release_mem(mem);
757 return -ENOMEM;
760 return 0;
763 static void men_z135_config_port(struct uart_port *port, int type)
765 port->type = PORT_MEN_Z135;
766 men_z135_request_port(port);
769 static int men_z135_verify_port(struct uart_port *port,
770 struct serial_struct *serinfo)
772 return -EINVAL;
775 static const struct uart_ops men_z135_ops = {
776 .tx_empty = men_z135_tx_empty,
777 .set_mctrl = men_z135_set_mctrl,
778 .get_mctrl = men_z135_get_mctrl,
779 .stop_tx = men_z135_stop_tx,
780 .start_tx = men_z135_start_tx,
781 .stop_rx = men_z135_stop_rx,
782 .enable_ms = men_z135_enable_ms,
783 .startup = men_z135_startup,
784 .shutdown = men_z135_shutdown,
785 .set_termios = men_z135_set_termios,
786 .type = men_z135_type,
787 .release_port = men_z135_release_port,
788 .request_port = men_z135_request_port,
789 .config_port = men_z135_config_port,
790 .verify_port = men_z135_verify_port,
793 static struct uart_driver men_z135_driver = {
794 .owner = THIS_MODULE,
795 .driver_name = KBUILD_MODNAME,
796 .dev_name = "ttyHSU",
797 .major = 0,
798 .minor = 0,
799 .nr = MEN_Z135_MAX_PORTS,
803 * men_z135_probe() - Probe a z135 instance
804 * @mdev: The MCB device
805 * @id: The MCB device ID
807 * men_z135_probe does the basic setup of hardware resources and registers the
808 * new uart port to the tty layer.
810 static int men_z135_probe(struct mcb_device *mdev,
811 const struct mcb_device_id *id)
813 struct men_z135_port *uart;
814 struct resource *mem;
815 struct device *dev;
816 int err;
818 dev = &mdev->dev;
820 uart = devm_kzalloc(dev, sizeof(struct men_z135_port), GFP_KERNEL);
821 if (!uart)
822 return -ENOMEM;
824 uart->rxbuf = (unsigned char *)__get_free_page(GFP_KERNEL);
825 if (!uart->rxbuf)
826 return -ENOMEM;
828 mem = &mdev->mem;
830 mcb_set_drvdata(mdev, uart);
832 uart->port.uartclk = MEN_Z135_BASECLK * 16;
833 uart->port.fifosize = MEN_Z135_FIFO_SIZE;
834 uart->port.iotype = UPIO_MEM;
835 uart->port.ops = &men_z135_ops;
836 uart->port.irq = mcb_get_irq(mdev);
837 uart->port.iotype = UPIO_MEM;
838 uart->port.flags = UPF_BOOT_AUTOCONF | UPF_IOREMAP;
839 uart->port.line = line++;
840 uart->port.dev = dev;
841 uart->port.type = PORT_MEN_Z135;
842 uart->port.mapbase = mem->start;
843 uart->port.membase = NULL;
844 uart->mdev = mdev;
846 spin_lock_init(&uart->lock);
848 err = uart_add_one_port(&men_z135_driver, &uart->port);
849 if (err)
850 goto err;
852 return 0;
854 err:
855 free_page((unsigned long) uart->rxbuf);
856 dev_err(dev, "Failed to add UART: %d\n", err);
858 return err;
862 * men_z135_remove() - Remove a z135 instance from the system
864 * @mdev: The MCB device
866 static void men_z135_remove(struct mcb_device *mdev)
868 struct men_z135_port *uart = mcb_get_drvdata(mdev);
870 line--;
871 uart_remove_one_port(&men_z135_driver, &uart->port);
872 free_page((unsigned long) uart->rxbuf);
875 static const struct mcb_device_id men_z135_ids[] = {
876 { .device = 0x87 },
879 MODULE_DEVICE_TABLE(mcb, men_z135_ids);
881 static struct mcb_driver mcb_driver = {
882 .driver = {
883 .name = "z135-uart",
884 .owner = THIS_MODULE,
886 .probe = men_z135_probe,
887 .remove = men_z135_remove,
888 .id_table = men_z135_ids,
892 * men_z135_init() - Driver Registration Routine
894 * men_z135_init is the first routine called when the driver is loaded. All it
895 * does is register with the legacy MEN Chameleon subsystem.
897 static int __init men_z135_init(void)
899 int err;
901 err = uart_register_driver(&men_z135_driver);
902 if (err) {
903 pr_err("Failed to register UART: %d\n", err);
904 return err;
907 err = mcb_register_driver(&mcb_driver);
908 if (err) {
909 pr_err("Failed to register MCB driver: %d\n", err);
910 uart_unregister_driver(&men_z135_driver);
911 return err;
914 return 0;
916 module_init(men_z135_init);
919 * men_z135_exit() - Driver Exit Routine
921 * men_z135_exit is called just before the driver is removed from memory.
923 static void __exit men_z135_exit(void)
925 mcb_unregister_driver(&mcb_driver);
926 uart_unregister_driver(&men_z135_driver);
928 module_exit(men_z135_exit);
930 MODULE_AUTHOR("Johannes Thumshirn <johannes.thumshirn@men.de>");
931 MODULE_LICENSE("GPL v2");
932 MODULE_DESCRIPTION("MEN 16z135 High Speed UART");
933 MODULE_ALIAS("mcb:16z135");