fix a kmap leak in virtio_console
[linux/fpc-iii.git] / drivers / tty / serial / mxs-auart.c
blobaa97fd845b4d8123102c6026ed9a79e53d61e45f
1 /*
2 * Freescale STMP37XX/STMP378X Application UART driver
4 * Author: dmitry pervushin <dimka@embeddedalley.com>
6 * Copyright 2008-2010 Freescale Semiconductor, Inc.
7 * Copyright 2008 Embedded Alley Solutions, Inc All Rights Reserved.
9 * The code contained herein is licensed under the GNU General Public
10 * License. You may obtain a copy of the GNU General Public License
11 * Version 2 or later at the following locations:
13 * http://www.opensource.org/licenses/gpl-license.html
14 * http://www.gnu.org/copyleft/gpl.html
17 #include <linux/kernel.h>
18 #include <linux/errno.h>
19 #include <linux/init.h>
20 #include <linux/console.h>
21 #include <linux/interrupt.h>
22 #include <linux/module.h>
23 #include <linux/slab.h>
24 #include <linux/wait.h>
25 #include <linux/tty.h>
26 #include <linux/tty_driver.h>
27 #include <linux/tty_flip.h>
28 #include <linux/serial.h>
29 #include <linux/serial_core.h>
30 #include <linux/platform_device.h>
31 #include <linux/device.h>
32 #include <linux/clk.h>
33 #include <linux/delay.h>
34 #include <linux/io.h>
35 #include <linux/of_device.h>
36 #include <linux/dma-mapping.h>
37 #include <linux/dmaengine.h>
39 #include <asm/cacheflush.h>
41 #define MXS_AUART_PORTS 5
42 #define MXS_AUART_FIFO_SIZE 16
44 #define AUART_CTRL0 0x00000000
45 #define AUART_CTRL0_SET 0x00000004
46 #define AUART_CTRL0_CLR 0x00000008
47 #define AUART_CTRL0_TOG 0x0000000c
48 #define AUART_CTRL1 0x00000010
49 #define AUART_CTRL1_SET 0x00000014
50 #define AUART_CTRL1_CLR 0x00000018
51 #define AUART_CTRL1_TOG 0x0000001c
52 #define AUART_CTRL2 0x00000020
53 #define AUART_CTRL2_SET 0x00000024
54 #define AUART_CTRL2_CLR 0x00000028
55 #define AUART_CTRL2_TOG 0x0000002c
56 #define AUART_LINECTRL 0x00000030
57 #define AUART_LINECTRL_SET 0x00000034
58 #define AUART_LINECTRL_CLR 0x00000038
59 #define AUART_LINECTRL_TOG 0x0000003c
60 #define AUART_LINECTRL2 0x00000040
61 #define AUART_LINECTRL2_SET 0x00000044
62 #define AUART_LINECTRL2_CLR 0x00000048
63 #define AUART_LINECTRL2_TOG 0x0000004c
64 #define AUART_INTR 0x00000050
65 #define AUART_INTR_SET 0x00000054
66 #define AUART_INTR_CLR 0x00000058
67 #define AUART_INTR_TOG 0x0000005c
68 #define AUART_DATA 0x00000060
69 #define AUART_STAT 0x00000070
70 #define AUART_DEBUG 0x00000080
71 #define AUART_VERSION 0x00000090
72 #define AUART_AUTOBAUD 0x000000a0
74 #define AUART_CTRL0_SFTRST (1 << 31)
75 #define AUART_CTRL0_CLKGATE (1 << 30)
76 #define AUART_CTRL0_RXTO_ENABLE (1 << 27)
77 #define AUART_CTRL0_RXTIMEOUT(v) (((v) & 0x7ff) << 16)
78 #define AUART_CTRL0_XFER_COUNT(v) ((v) & 0xffff)
80 #define AUART_CTRL1_XFER_COUNT(v) ((v) & 0xffff)
82 #define AUART_CTRL2_DMAONERR (1 << 26)
83 #define AUART_CTRL2_TXDMAE (1 << 25)
84 #define AUART_CTRL2_RXDMAE (1 << 24)
86 #define AUART_CTRL2_CTSEN (1 << 15)
87 #define AUART_CTRL2_RTSEN (1 << 14)
88 #define AUART_CTRL2_RTS (1 << 11)
89 #define AUART_CTRL2_RXE (1 << 9)
90 #define AUART_CTRL2_TXE (1 << 8)
91 #define AUART_CTRL2_UARTEN (1 << 0)
93 #define AUART_LINECTRL_BAUD_DIVINT_SHIFT 16
94 #define AUART_LINECTRL_BAUD_DIVINT_MASK 0xffff0000
95 #define AUART_LINECTRL_BAUD_DIVINT(v) (((v) & 0xffff) << 16)
96 #define AUART_LINECTRL_BAUD_DIVFRAC_SHIFT 8
97 #define AUART_LINECTRL_BAUD_DIVFRAC_MASK 0x00003f00
98 #define AUART_LINECTRL_BAUD_DIVFRAC(v) (((v) & 0x3f) << 8)
99 #define AUART_LINECTRL_WLEN_MASK 0x00000060
100 #define AUART_LINECTRL_WLEN(v) (((v) & 0x3) << 5)
101 #define AUART_LINECTRL_FEN (1 << 4)
102 #define AUART_LINECTRL_STP2 (1 << 3)
103 #define AUART_LINECTRL_EPS (1 << 2)
104 #define AUART_LINECTRL_PEN (1 << 1)
105 #define AUART_LINECTRL_BRK (1 << 0)
107 #define AUART_INTR_RTIEN (1 << 22)
108 #define AUART_INTR_TXIEN (1 << 21)
109 #define AUART_INTR_RXIEN (1 << 20)
110 #define AUART_INTR_CTSMIEN (1 << 17)
111 #define AUART_INTR_RTIS (1 << 6)
112 #define AUART_INTR_TXIS (1 << 5)
113 #define AUART_INTR_RXIS (1 << 4)
114 #define AUART_INTR_CTSMIS (1 << 1)
116 #define AUART_STAT_BUSY (1 << 29)
117 #define AUART_STAT_CTS (1 << 28)
118 #define AUART_STAT_TXFE (1 << 27)
119 #define AUART_STAT_TXFF (1 << 25)
120 #define AUART_STAT_RXFE (1 << 24)
121 #define AUART_STAT_OERR (1 << 19)
122 #define AUART_STAT_BERR (1 << 18)
123 #define AUART_STAT_PERR (1 << 17)
124 #define AUART_STAT_FERR (1 << 16)
125 #define AUART_STAT_RXCOUNT_MASK 0xffff
127 static struct uart_driver auart_driver;
129 enum mxs_auart_type {
130 IMX23_AUART,
131 IMX28_AUART,
134 struct mxs_auart_port {
135 struct uart_port port;
137 #define MXS_AUART_DMA_ENABLED 0x2
138 #define MXS_AUART_DMA_TX_SYNC 2 /* bit 2 */
139 #define MXS_AUART_DMA_RX_READY 3 /* bit 3 */
140 #define MXS_AUART_RTSCTS 4 /* bit 4 */
141 unsigned long flags;
142 unsigned int ctrl;
143 enum mxs_auart_type devtype;
145 unsigned int irq;
147 struct clk *clk;
148 struct device *dev;
150 /* for DMA */
151 struct scatterlist tx_sgl;
152 struct dma_chan *tx_dma_chan;
153 void *tx_dma_buf;
155 struct scatterlist rx_sgl;
156 struct dma_chan *rx_dma_chan;
157 void *rx_dma_buf;
160 static struct platform_device_id mxs_auart_devtype[] = {
161 { .name = "mxs-auart-imx23", .driver_data = IMX23_AUART },
162 { .name = "mxs-auart-imx28", .driver_data = IMX28_AUART },
163 { /* sentinel */ }
165 MODULE_DEVICE_TABLE(platform, mxs_auart_devtype);
167 static struct of_device_id mxs_auart_dt_ids[] = {
169 .compatible = "fsl,imx28-auart",
170 .data = &mxs_auart_devtype[IMX28_AUART]
171 }, {
172 .compatible = "fsl,imx23-auart",
173 .data = &mxs_auart_devtype[IMX23_AUART]
174 }, { /* sentinel */ }
176 MODULE_DEVICE_TABLE(of, mxs_auart_dt_ids);
178 static inline int is_imx28_auart(struct mxs_auart_port *s)
180 return s->devtype == IMX28_AUART;
183 static inline bool auart_dma_enabled(struct mxs_auart_port *s)
185 return s->flags & MXS_AUART_DMA_ENABLED;
188 static void mxs_auart_stop_tx(struct uart_port *u);
190 #define to_auart_port(u) container_of(u, struct mxs_auart_port, port)
192 static void mxs_auart_tx_chars(struct mxs_auart_port *s);
194 static void dma_tx_callback(void *param)
196 struct mxs_auart_port *s = param;
197 struct circ_buf *xmit = &s->port.state->xmit;
199 dma_unmap_sg(s->dev, &s->tx_sgl, 1, DMA_TO_DEVICE);
201 /* clear the bit used to serialize the DMA tx. */
202 clear_bit(MXS_AUART_DMA_TX_SYNC, &s->flags);
203 smp_mb__after_clear_bit();
205 /* wake up the possible processes. */
206 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
207 uart_write_wakeup(&s->port);
209 mxs_auart_tx_chars(s);
212 static int mxs_auart_dma_tx(struct mxs_auart_port *s, int size)
214 struct dma_async_tx_descriptor *desc;
215 struct scatterlist *sgl = &s->tx_sgl;
216 struct dma_chan *channel = s->tx_dma_chan;
217 u32 pio;
219 /* [1] : send PIO. Note, the first pio word is CTRL1. */
220 pio = AUART_CTRL1_XFER_COUNT(size);
221 desc = dmaengine_prep_slave_sg(channel, (struct scatterlist *)&pio,
222 1, DMA_TRANS_NONE, 0);
223 if (!desc) {
224 dev_err(s->dev, "step 1 error\n");
225 return -EINVAL;
228 /* [2] : set DMA buffer. */
229 sg_init_one(sgl, s->tx_dma_buf, size);
230 dma_map_sg(s->dev, sgl, 1, DMA_TO_DEVICE);
231 desc = dmaengine_prep_slave_sg(channel, sgl,
232 1, DMA_MEM_TO_DEV, DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
233 if (!desc) {
234 dev_err(s->dev, "step 2 error\n");
235 return -EINVAL;
238 /* [3] : submit the DMA */
239 desc->callback = dma_tx_callback;
240 desc->callback_param = s;
241 dmaengine_submit(desc);
242 dma_async_issue_pending(channel);
243 return 0;
246 static void mxs_auart_tx_chars(struct mxs_auart_port *s)
248 struct circ_buf *xmit = &s->port.state->xmit;
250 if (auart_dma_enabled(s)) {
251 u32 i = 0;
252 int size;
253 void *buffer = s->tx_dma_buf;
255 if (test_and_set_bit(MXS_AUART_DMA_TX_SYNC, &s->flags))
256 return;
258 while (!uart_circ_empty(xmit) && !uart_tx_stopped(&s->port)) {
259 size = min_t(u32, UART_XMIT_SIZE - i,
260 CIRC_CNT_TO_END(xmit->head,
261 xmit->tail,
262 UART_XMIT_SIZE));
263 memcpy(buffer + i, xmit->buf + xmit->tail, size);
264 xmit->tail = (xmit->tail + size) & (UART_XMIT_SIZE - 1);
266 i += size;
267 if (i >= UART_XMIT_SIZE)
268 break;
271 if (uart_tx_stopped(&s->port))
272 mxs_auart_stop_tx(&s->port);
274 if (i) {
275 mxs_auart_dma_tx(s, i);
276 } else {
277 clear_bit(MXS_AUART_DMA_TX_SYNC, &s->flags);
278 smp_mb__after_clear_bit();
280 return;
284 while (!(readl(s->port.membase + AUART_STAT) &
285 AUART_STAT_TXFF)) {
286 if (s->port.x_char) {
287 s->port.icount.tx++;
288 writel(s->port.x_char,
289 s->port.membase + AUART_DATA);
290 s->port.x_char = 0;
291 continue;
293 if (!uart_circ_empty(xmit) && !uart_tx_stopped(&s->port)) {
294 s->port.icount.tx++;
295 writel(xmit->buf[xmit->tail],
296 s->port.membase + AUART_DATA);
297 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
298 } else
299 break;
301 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
302 uart_write_wakeup(&s->port);
304 if (uart_circ_empty(&(s->port.state->xmit)))
305 writel(AUART_INTR_TXIEN,
306 s->port.membase + AUART_INTR_CLR);
307 else
308 writel(AUART_INTR_TXIEN,
309 s->port.membase + AUART_INTR_SET);
311 if (uart_tx_stopped(&s->port))
312 mxs_auart_stop_tx(&s->port);
315 static void mxs_auart_rx_char(struct mxs_auart_port *s)
317 int flag;
318 u32 stat;
319 u8 c;
321 c = readl(s->port.membase + AUART_DATA);
322 stat = readl(s->port.membase + AUART_STAT);
324 flag = TTY_NORMAL;
325 s->port.icount.rx++;
327 if (stat & AUART_STAT_BERR) {
328 s->port.icount.brk++;
329 if (uart_handle_break(&s->port))
330 goto out;
331 } else if (stat & AUART_STAT_PERR) {
332 s->port.icount.parity++;
333 } else if (stat & AUART_STAT_FERR) {
334 s->port.icount.frame++;
338 * Mask off conditions which should be ingored.
340 stat &= s->port.read_status_mask;
342 if (stat & AUART_STAT_BERR) {
343 flag = TTY_BREAK;
344 } else if (stat & AUART_STAT_PERR)
345 flag = TTY_PARITY;
346 else if (stat & AUART_STAT_FERR)
347 flag = TTY_FRAME;
349 if (stat & AUART_STAT_OERR)
350 s->port.icount.overrun++;
352 if (uart_handle_sysrq_char(&s->port, c))
353 goto out;
355 uart_insert_char(&s->port, stat, AUART_STAT_OERR, c, flag);
356 out:
357 writel(stat, s->port.membase + AUART_STAT);
360 static void mxs_auart_rx_chars(struct mxs_auart_port *s)
362 u32 stat = 0;
364 for (;;) {
365 stat = readl(s->port.membase + AUART_STAT);
366 if (stat & AUART_STAT_RXFE)
367 break;
368 mxs_auart_rx_char(s);
371 writel(stat, s->port.membase + AUART_STAT);
372 tty_flip_buffer_push(&s->port.state->port);
375 static int mxs_auart_request_port(struct uart_port *u)
377 return 0;
380 static int mxs_auart_verify_port(struct uart_port *u,
381 struct serial_struct *ser)
383 if (u->type != PORT_UNKNOWN && u->type != PORT_IMX)
384 return -EINVAL;
385 return 0;
388 static void mxs_auart_config_port(struct uart_port *u, int flags)
392 static const char *mxs_auart_type(struct uart_port *u)
394 struct mxs_auart_port *s = to_auart_port(u);
396 return dev_name(s->dev);
399 static void mxs_auart_release_port(struct uart_port *u)
403 static void mxs_auart_set_mctrl(struct uart_port *u, unsigned mctrl)
405 struct mxs_auart_port *s = to_auart_port(u);
407 u32 ctrl = readl(u->membase + AUART_CTRL2);
409 ctrl &= ~(AUART_CTRL2_RTSEN | AUART_CTRL2_RTS);
410 if (mctrl & TIOCM_RTS) {
411 if (tty_port_cts_enabled(&u->state->port))
412 ctrl |= AUART_CTRL2_RTSEN;
413 else
414 ctrl |= AUART_CTRL2_RTS;
417 s->ctrl = mctrl;
418 writel(ctrl, u->membase + AUART_CTRL2);
421 static u32 mxs_auart_get_mctrl(struct uart_port *u)
423 struct mxs_auart_port *s = to_auart_port(u);
424 u32 stat = readl(u->membase + AUART_STAT);
425 int ctrl2 = readl(u->membase + AUART_CTRL2);
426 u32 mctrl = s->ctrl;
428 mctrl &= ~TIOCM_CTS;
429 if (stat & AUART_STAT_CTS)
430 mctrl |= TIOCM_CTS;
432 if (ctrl2 & AUART_CTRL2_RTS)
433 mctrl |= TIOCM_RTS;
435 return mctrl;
438 static int mxs_auart_dma_prep_rx(struct mxs_auart_port *s);
439 static void dma_rx_callback(void *arg)
441 struct mxs_auart_port *s = (struct mxs_auart_port *) arg;
442 struct tty_port *port = &s->port.state->port;
443 int count;
444 u32 stat;
446 dma_unmap_sg(s->dev, &s->rx_sgl, 1, DMA_FROM_DEVICE);
448 stat = readl(s->port.membase + AUART_STAT);
449 stat &= ~(AUART_STAT_OERR | AUART_STAT_BERR |
450 AUART_STAT_PERR | AUART_STAT_FERR);
452 count = stat & AUART_STAT_RXCOUNT_MASK;
453 tty_insert_flip_string(port, s->rx_dma_buf, count);
455 writel(stat, s->port.membase + AUART_STAT);
456 tty_flip_buffer_push(port);
458 /* start the next DMA for RX. */
459 mxs_auart_dma_prep_rx(s);
462 static int mxs_auart_dma_prep_rx(struct mxs_auart_port *s)
464 struct dma_async_tx_descriptor *desc;
465 struct scatterlist *sgl = &s->rx_sgl;
466 struct dma_chan *channel = s->rx_dma_chan;
467 u32 pio[1];
469 /* [1] : send PIO */
470 pio[0] = AUART_CTRL0_RXTO_ENABLE
471 | AUART_CTRL0_RXTIMEOUT(0x80)
472 | AUART_CTRL0_XFER_COUNT(UART_XMIT_SIZE);
473 desc = dmaengine_prep_slave_sg(channel, (struct scatterlist *)pio,
474 1, DMA_TRANS_NONE, 0);
475 if (!desc) {
476 dev_err(s->dev, "step 1 error\n");
477 return -EINVAL;
480 /* [2] : send DMA request */
481 sg_init_one(sgl, s->rx_dma_buf, UART_XMIT_SIZE);
482 dma_map_sg(s->dev, sgl, 1, DMA_FROM_DEVICE);
483 desc = dmaengine_prep_slave_sg(channel, sgl, 1, DMA_DEV_TO_MEM,
484 DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
485 if (!desc) {
486 dev_err(s->dev, "step 2 error\n");
487 return -1;
490 /* [3] : submit the DMA, but do not issue it. */
491 desc->callback = dma_rx_callback;
492 desc->callback_param = s;
493 dmaengine_submit(desc);
494 dma_async_issue_pending(channel);
495 return 0;
498 static void mxs_auart_dma_exit_channel(struct mxs_auart_port *s)
500 if (s->tx_dma_chan) {
501 dma_release_channel(s->tx_dma_chan);
502 s->tx_dma_chan = NULL;
504 if (s->rx_dma_chan) {
505 dma_release_channel(s->rx_dma_chan);
506 s->rx_dma_chan = NULL;
509 kfree(s->tx_dma_buf);
510 kfree(s->rx_dma_buf);
511 s->tx_dma_buf = NULL;
512 s->rx_dma_buf = NULL;
515 static void mxs_auart_dma_exit(struct mxs_auart_port *s)
518 writel(AUART_CTRL2_TXDMAE | AUART_CTRL2_RXDMAE | AUART_CTRL2_DMAONERR,
519 s->port.membase + AUART_CTRL2_CLR);
521 mxs_auart_dma_exit_channel(s);
522 s->flags &= ~MXS_AUART_DMA_ENABLED;
523 clear_bit(MXS_AUART_DMA_TX_SYNC, &s->flags);
524 clear_bit(MXS_AUART_DMA_RX_READY, &s->flags);
527 static int mxs_auart_dma_init(struct mxs_auart_port *s)
529 if (auart_dma_enabled(s))
530 return 0;
532 /* init for RX */
533 s->rx_dma_chan = dma_request_slave_channel(s->dev, "rx");
534 if (!s->rx_dma_chan)
535 goto err_out;
536 s->rx_dma_buf = kzalloc(UART_XMIT_SIZE, GFP_KERNEL | GFP_DMA);
537 if (!s->rx_dma_buf)
538 goto err_out;
540 /* init for TX */
541 s->tx_dma_chan = dma_request_slave_channel(s->dev, "tx");
542 if (!s->tx_dma_chan)
543 goto err_out;
544 s->tx_dma_buf = kzalloc(UART_XMIT_SIZE, GFP_KERNEL | GFP_DMA);
545 if (!s->tx_dma_buf)
546 goto err_out;
548 /* set the flags */
549 s->flags |= MXS_AUART_DMA_ENABLED;
550 dev_dbg(s->dev, "enabled the DMA support.");
552 /* The DMA buffer is now the FIFO the TTY subsystem can use */
553 s->port.fifosize = UART_XMIT_SIZE;
555 return 0;
557 err_out:
558 mxs_auart_dma_exit_channel(s);
559 return -EINVAL;
563 static void mxs_auart_settermios(struct uart_port *u,
564 struct ktermios *termios,
565 struct ktermios *old)
567 struct mxs_auart_port *s = to_auart_port(u);
568 u32 bm, ctrl, ctrl2, div;
569 unsigned int cflag, baud;
571 cflag = termios->c_cflag;
573 ctrl = AUART_LINECTRL_FEN;
574 ctrl2 = readl(u->membase + AUART_CTRL2);
576 /* byte size */
577 switch (cflag & CSIZE) {
578 case CS5:
579 bm = 0;
580 break;
581 case CS6:
582 bm = 1;
583 break;
584 case CS7:
585 bm = 2;
586 break;
587 case CS8:
588 bm = 3;
589 break;
590 default:
591 return;
594 ctrl |= AUART_LINECTRL_WLEN(bm);
596 /* parity */
597 if (cflag & PARENB) {
598 ctrl |= AUART_LINECTRL_PEN;
599 if ((cflag & PARODD) == 0)
600 ctrl |= AUART_LINECTRL_EPS;
603 u->read_status_mask = 0;
605 if (termios->c_iflag & INPCK)
606 u->read_status_mask |= AUART_STAT_PERR;
607 if (termios->c_iflag & (BRKINT | PARMRK))
608 u->read_status_mask |= AUART_STAT_BERR;
611 * Characters to ignore
613 u->ignore_status_mask = 0;
614 if (termios->c_iflag & IGNPAR)
615 u->ignore_status_mask |= AUART_STAT_PERR;
616 if (termios->c_iflag & IGNBRK) {
617 u->ignore_status_mask |= AUART_STAT_BERR;
619 * If we're ignoring parity and break indicators,
620 * ignore overruns too (for real raw support).
622 if (termios->c_iflag & IGNPAR)
623 u->ignore_status_mask |= AUART_STAT_OERR;
627 * ignore all characters if CREAD is not set
629 if (cflag & CREAD)
630 ctrl2 |= AUART_CTRL2_RXE;
631 else
632 ctrl2 &= ~AUART_CTRL2_RXE;
634 /* figure out the stop bits requested */
635 if (cflag & CSTOPB)
636 ctrl |= AUART_LINECTRL_STP2;
638 /* figure out the hardware flow control settings */
639 if (cflag & CRTSCTS) {
641 * The DMA has a bug(see errata:2836) in mx23.
642 * So we can not implement the DMA for auart in mx23,
643 * we can only implement the DMA support for auart
644 * in mx28.
646 if (is_imx28_auart(s)
647 && test_bit(MXS_AUART_RTSCTS, &s->flags)) {
648 if (!mxs_auart_dma_init(s))
649 /* enable DMA tranfer */
650 ctrl2 |= AUART_CTRL2_TXDMAE | AUART_CTRL2_RXDMAE
651 | AUART_CTRL2_DMAONERR;
653 ctrl2 |= AUART_CTRL2_CTSEN | AUART_CTRL2_RTSEN;
654 } else {
655 ctrl2 &= ~(AUART_CTRL2_CTSEN | AUART_CTRL2_RTSEN);
658 /* set baud rate */
659 baud = uart_get_baud_rate(u, termios, old, 0, u->uartclk);
660 div = u->uartclk * 32 / baud;
661 ctrl |= AUART_LINECTRL_BAUD_DIVFRAC(div & 0x3F);
662 ctrl |= AUART_LINECTRL_BAUD_DIVINT(div >> 6);
664 writel(ctrl, u->membase + AUART_LINECTRL);
665 writel(ctrl2, u->membase + AUART_CTRL2);
667 uart_update_timeout(u, termios->c_cflag, baud);
669 /* prepare for the DMA RX. */
670 if (auart_dma_enabled(s) &&
671 !test_and_set_bit(MXS_AUART_DMA_RX_READY, &s->flags)) {
672 if (!mxs_auart_dma_prep_rx(s)) {
673 /* Disable the normal RX interrupt. */
674 writel(AUART_INTR_RXIEN | AUART_INTR_RTIEN,
675 u->membase + AUART_INTR_CLR);
676 } else {
677 mxs_auart_dma_exit(s);
678 dev_err(s->dev, "We can not start up the DMA.\n");
683 static irqreturn_t mxs_auart_irq_handle(int irq, void *context)
685 u32 istat;
686 struct mxs_auart_port *s = context;
687 u32 stat = readl(s->port.membase + AUART_STAT);
689 istat = readl(s->port.membase + AUART_INTR);
691 /* ack irq */
692 writel(istat & (AUART_INTR_RTIS
693 | AUART_INTR_TXIS
694 | AUART_INTR_RXIS
695 | AUART_INTR_CTSMIS),
696 s->port.membase + AUART_INTR_CLR);
698 if (istat & AUART_INTR_CTSMIS) {
699 uart_handle_cts_change(&s->port, stat & AUART_STAT_CTS);
700 writel(AUART_INTR_CTSMIS,
701 s->port.membase + AUART_INTR_CLR);
702 istat &= ~AUART_INTR_CTSMIS;
705 if (istat & (AUART_INTR_RTIS | AUART_INTR_RXIS)) {
706 if (!auart_dma_enabled(s))
707 mxs_auart_rx_chars(s);
708 istat &= ~(AUART_INTR_RTIS | AUART_INTR_RXIS);
711 if (istat & AUART_INTR_TXIS) {
712 mxs_auart_tx_chars(s);
713 istat &= ~AUART_INTR_TXIS;
716 return IRQ_HANDLED;
719 static void mxs_auart_reset(struct uart_port *u)
721 int i;
722 unsigned int reg;
724 writel(AUART_CTRL0_SFTRST, u->membase + AUART_CTRL0_CLR);
726 for (i = 0; i < 10000; i++) {
727 reg = readl(u->membase + AUART_CTRL0);
728 if (!(reg & AUART_CTRL0_SFTRST))
729 break;
730 udelay(3);
732 writel(AUART_CTRL0_CLKGATE, u->membase + AUART_CTRL0_CLR);
735 static int mxs_auart_startup(struct uart_port *u)
737 int ret;
738 struct mxs_auart_port *s = to_auart_port(u);
740 ret = clk_prepare_enable(s->clk);
741 if (ret)
742 return ret;
744 writel(AUART_CTRL0_CLKGATE, u->membase + AUART_CTRL0_CLR);
746 writel(AUART_CTRL2_UARTEN, u->membase + AUART_CTRL2_SET);
748 writel(AUART_INTR_RXIEN | AUART_INTR_RTIEN | AUART_INTR_CTSMIEN,
749 u->membase + AUART_INTR);
751 /* Reset FIFO size (it could have changed if DMA was enabled) */
752 u->fifosize = MXS_AUART_FIFO_SIZE;
755 * Enable fifo so all four bytes of a DMA word are written to
756 * output (otherwise, only the LSB is written, ie. 1 in 4 bytes)
758 writel(AUART_LINECTRL_FEN, u->membase + AUART_LINECTRL_SET);
760 return 0;
763 static void mxs_auart_shutdown(struct uart_port *u)
765 struct mxs_auart_port *s = to_auart_port(u);
767 if (auart_dma_enabled(s))
768 mxs_auart_dma_exit(s);
770 writel(AUART_CTRL2_UARTEN, u->membase + AUART_CTRL2_CLR);
772 writel(AUART_INTR_RXIEN | AUART_INTR_RTIEN | AUART_INTR_CTSMIEN,
773 u->membase + AUART_INTR_CLR);
775 writel(AUART_CTRL0_CLKGATE, u->membase + AUART_CTRL0_SET);
777 clk_disable_unprepare(s->clk);
780 static unsigned int mxs_auart_tx_empty(struct uart_port *u)
782 if (readl(u->membase + AUART_STAT) & AUART_STAT_TXFE)
783 return TIOCSER_TEMT;
784 else
785 return 0;
788 static void mxs_auart_start_tx(struct uart_port *u)
790 struct mxs_auart_port *s = to_auart_port(u);
792 /* enable transmitter */
793 writel(AUART_CTRL2_TXE, u->membase + AUART_CTRL2_SET);
795 mxs_auart_tx_chars(s);
798 static void mxs_auart_stop_tx(struct uart_port *u)
800 writel(AUART_CTRL2_TXE, u->membase + AUART_CTRL2_CLR);
803 static void mxs_auart_stop_rx(struct uart_port *u)
805 writel(AUART_CTRL2_RXE, u->membase + AUART_CTRL2_CLR);
808 static void mxs_auart_break_ctl(struct uart_port *u, int ctl)
810 if (ctl)
811 writel(AUART_LINECTRL_BRK,
812 u->membase + AUART_LINECTRL_SET);
813 else
814 writel(AUART_LINECTRL_BRK,
815 u->membase + AUART_LINECTRL_CLR);
818 static void mxs_auart_enable_ms(struct uart_port *port)
820 /* just empty */
823 static struct uart_ops mxs_auart_ops = {
824 .tx_empty = mxs_auart_tx_empty,
825 .start_tx = mxs_auart_start_tx,
826 .stop_tx = mxs_auart_stop_tx,
827 .stop_rx = mxs_auart_stop_rx,
828 .enable_ms = mxs_auart_enable_ms,
829 .break_ctl = mxs_auart_break_ctl,
830 .set_mctrl = mxs_auart_set_mctrl,
831 .get_mctrl = mxs_auart_get_mctrl,
832 .startup = mxs_auart_startup,
833 .shutdown = mxs_auart_shutdown,
834 .set_termios = mxs_auart_settermios,
835 .type = mxs_auart_type,
836 .release_port = mxs_auart_release_port,
837 .request_port = mxs_auart_request_port,
838 .config_port = mxs_auart_config_port,
839 .verify_port = mxs_auart_verify_port,
842 static struct mxs_auart_port *auart_port[MXS_AUART_PORTS];
844 #ifdef CONFIG_SERIAL_MXS_AUART_CONSOLE
845 static void mxs_auart_console_putchar(struct uart_port *port, int ch)
847 unsigned int to = 1000;
849 while (readl(port->membase + AUART_STAT) & AUART_STAT_TXFF) {
850 if (!to--)
851 break;
852 udelay(1);
855 writel(ch, port->membase + AUART_DATA);
858 static void
859 auart_console_write(struct console *co, const char *str, unsigned int count)
861 struct mxs_auart_port *s;
862 struct uart_port *port;
863 unsigned int old_ctrl0, old_ctrl2;
864 unsigned int to = 20000;
866 if (co->index >= MXS_AUART_PORTS || co->index < 0)
867 return;
869 s = auart_port[co->index];
870 port = &s->port;
872 clk_enable(s->clk);
874 /* First save the CR then disable the interrupts */
875 old_ctrl2 = readl(port->membase + AUART_CTRL2);
876 old_ctrl0 = readl(port->membase + AUART_CTRL0);
878 writel(AUART_CTRL0_CLKGATE,
879 port->membase + AUART_CTRL0_CLR);
880 writel(AUART_CTRL2_UARTEN | AUART_CTRL2_TXE,
881 port->membase + AUART_CTRL2_SET);
883 uart_console_write(port, str, count, mxs_auart_console_putchar);
885 /* Finally, wait for transmitter to become empty ... */
886 while (readl(port->membase + AUART_STAT) & AUART_STAT_BUSY) {
887 udelay(1);
888 if (!to--)
889 break;
893 * ... and restore the TCR if we waited long enough for the transmitter
894 * to be idle. This might keep the transmitter enabled although it is
895 * unused, but that is better than to disable it while it is still
896 * transmitting.
898 if (!(readl(port->membase + AUART_STAT) & AUART_STAT_BUSY)) {
899 writel(old_ctrl0, port->membase + AUART_CTRL0);
900 writel(old_ctrl2, port->membase + AUART_CTRL2);
903 clk_disable(s->clk);
906 static void __init
907 auart_console_get_options(struct uart_port *port, int *baud,
908 int *parity, int *bits)
910 unsigned int lcr_h, quot;
912 if (!(readl(port->membase + AUART_CTRL2) & AUART_CTRL2_UARTEN))
913 return;
915 lcr_h = readl(port->membase + AUART_LINECTRL);
917 *parity = 'n';
918 if (lcr_h & AUART_LINECTRL_PEN) {
919 if (lcr_h & AUART_LINECTRL_EPS)
920 *parity = 'e';
921 else
922 *parity = 'o';
925 if ((lcr_h & AUART_LINECTRL_WLEN_MASK) == AUART_LINECTRL_WLEN(2))
926 *bits = 7;
927 else
928 *bits = 8;
930 quot = ((readl(port->membase + AUART_LINECTRL)
931 & AUART_LINECTRL_BAUD_DIVINT_MASK))
932 >> (AUART_LINECTRL_BAUD_DIVINT_SHIFT - 6);
933 quot |= ((readl(port->membase + AUART_LINECTRL)
934 & AUART_LINECTRL_BAUD_DIVFRAC_MASK))
935 >> AUART_LINECTRL_BAUD_DIVFRAC_SHIFT;
936 if (quot == 0)
937 quot = 1;
939 *baud = (port->uartclk << 2) / quot;
942 static int __init
943 auart_console_setup(struct console *co, char *options)
945 struct mxs_auart_port *s;
946 int baud = 9600;
947 int bits = 8;
948 int parity = 'n';
949 int flow = 'n';
950 int ret;
953 * Check whether an invalid uart number has been specified, and
954 * if so, search for the first available port that does have
955 * console support.
957 if (co->index == -1 || co->index >= ARRAY_SIZE(auart_port))
958 co->index = 0;
959 s = auart_port[co->index];
960 if (!s)
961 return -ENODEV;
963 ret = clk_prepare_enable(s->clk);
964 if (ret)
965 return ret;
967 if (options)
968 uart_parse_options(options, &baud, &parity, &bits, &flow);
969 else
970 auart_console_get_options(&s->port, &baud, &parity, &bits);
972 ret = uart_set_options(&s->port, co, baud, parity, bits, flow);
974 clk_disable_unprepare(s->clk);
976 return ret;
979 static struct console auart_console = {
980 .name = "ttyAPP",
981 .write = auart_console_write,
982 .device = uart_console_device,
983 .setup = auart_console_setup,
984 .flags = CON_PRINTBUFFER,
985 .index = -1,
986 .data = &auart_driver,
988 #endif
990 static struct uart_driver auart_driver = {
991 .owner = THIS_MODULE,
992 .driver_name = "ttyAPP",
993 .dev_name = "ttyAPP",
994 .major = 0,
995 .minor = 0,
996 .nr = MXS_AUART_PORTS,
997 #ifdef CONFIG_SERIAL_MXS_AUART_CONSOLE
998 .cons = &auart_console,
999 #endif
1003 * This function returns 1 if pdev isn't a device instatiated by dt, 0 if it
1004 * could successfully get all information from dt or a negative errno.
1006 static int serial_mxs_probe_dt(struct mxs_auart_port *s,
1007 struct platform_device *pdev)
1009 struct device_node *np = pdev->dev.of_node;
1010 int ret;
1012 if (!np)
1013 /* no device tree device */
1014 return 1;
1016 ret = of_alias_get_id(np, "serial");
1017 if (ret < 0) {
1018 dev_err(&pdev->dev, "failed to get alias id: %d\n", ret);
1019 return ret;
1021 s->port.line = ret;
1023 if (of_get_property(np, "fsl,uart-has-rtscts", NULL))
1024 set_bit(MXS_AUART_RTSCTS, &s->flags);
1026 return 0;
1029 static int mxs_auart_probe(struct platform_device *pdev)
1031 const struct of_device_id *of_id =
1032 of_match_device(mxs_auart_dt_ids, &pdev->dev);
1033 struct mxs_auart_port *s;
1034 u32 version;
1035 int ret = 0;
1036 struct resource *r;
1038 s = kzalloc(sizeof(struct mxs_auart_port), GFP_KERNEL);
1039 if (!s) {
1040 ret = -ENOMEM;
1041 goto out;
1044 ret = serial_mxs_probe_dt(s, pdev);
1045 if (ret > 0)
1046 s->port.line = pdev->id < 0 ? 0 : pdev->id;
1047 else if (ret < 0)
1048 goto out_free;
1050 if (of_id) {
1051 pdev->id_entry = of_id->data;
1052 s->devtype = pdev->id_entry->driver_data;
1055 s->clk = clk_get(&pdev->dev, NULL);
1056 if (IS_ERR(s->clk)) {
1057 ret = PTR_ERR(s->clk);
1058 goto out_free;
1061 r = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1062 if (!r) {
1063 ret = -ENXIO;
1064 goto out_free_clk;
1067 s->port.mapbase = r->start;
1068 s->port.membase = ioremap(r->start, resource_size(r));
1069 s->port.ops = &mxs_auart_ops;
1070 s->port.iotype = UPIO_MEM;
1071 s->port.fifosize = MXS_AUART_FIFO_SIZE;
1072 s->port.uartclk = clk_get_rate(s->clk);
1073 s->port.type = PORT_IMX;
1074 s->port.dev = s->dev = &pdev->dev;
1076 s->ctrl = 0;
1078 s->irq = platform_get_irq(pdev, 0);
1079 s->port.irq = s->irq;
1080 ret = request_irq(s->irq, mxs_auart_irq_handle, 0, dev_name(&pdev->dev), s);
1081 if (ret)
1082 goto out_free_clk;
1084 platform_set_drvdata(pdev, s);
1086 auart_port[s->port.line] = s;
1088 mxs_auart_reset(&s->port);
1090 ret = uart_add_one_port(&auart_driver, &s->port);
1091 if (ret)
1092 goto out_free_irq;
1094 version = readl(s->port.membase + AUART_VERSION);
1095 dev_info(&pdev->dev, "Found APPUART %d.%d.%d\n",
1096 (version >> 24) & 0xff,
1097 (version >> 16) & 0xff, version & 0xffff);
1099 return 0;
1101 out_free_irq:
1102 auart_port[pdev->id] = NULL;
1103 free_irq(s->irq, s);
1104 out_free_clk:
1105 clk_put(s->clk);
1106 out_free:
1107 kfree(s);
1108 out:
1109 return ret;
1112 static int mxs_auart_remove(struct platform_device *pdev)
1114 struct mxs_auart_port *s = platform_get_drvdata(pdev);
1116 uart_remove_one_port(&auart_driver, &s->port);
1118 auart_port[pdev->id] = NULL;
1120 clk_put(s->clk);
1121 free_irq(s->irq, s);
1122 kfree(s);
1124 return 0;
1127 static struct platform_driver mxs_auart_driver = {
1128 .probe = mxs_auart_probe,
1129 .remove = mxs_auart_remove,
1130 .driver = {
1131 .name = "mxs-auart",
1132 .owner = THIS_MODULE,
1133 .of_match_table = mxs_auart_dt_ids,
1137 static int __init mxs_auart_init(void)
1139 int r;
1141 r = uart_register_driver(&auart_driver);
1142 if (r)
1143 goto out;
1145 r = platform_driver_register(&mxs_auart_driver);
1146 if (r)
1147 goto out_err;
1149 return 0;
1150 out_err:
1151 uart_unregister_driver(&auart_driver);
1152 out:
1153 return r;
1156 static void __exit mxs_auart_exit(void)
1158 platform_driver_unregister(&mxs_auart_driver);
1159 uart_unregister_driver(&auart_driver);
1162 module_init(mxs_auart_init);
1163 module_exit(mxs_auart_exit);
1164 MODULE_LICENSE("GPL");
1165 MODULE_DESCRIPTION("Freescale MXS application uart driver");
1166 MODULE_ALIAS("platform:mxs-auart");