1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#if defined(CONFIG_SERIAL_IMX_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
21#define SUPPORT_SYSRQ
22#endif
23
24#include <linux/module.h>
25#include <linux/ioport.h>
26#include <linux/init.h>
27#include <linux/console.h>
28#include <linux/sysrq.h>
29#include <linux/platform_device.h>
30#include <linux/tty.h>
31#include <linux/tty_flip.h>
32#include <linux/serial_core.h>
33#include <linux/serial.h>
34#include <linux/clk.h>
35#include <linux/delay.h>
36#include <linux/rational.h>
37#include <linux/slab.h>
38#include <linux/of.h>
39#include <linux/of_device.h>
40#include <linux/io.h>
41#include <linux/dma-mapping.h>
42
43#include <asm/irq.h>
44#include <linux/platform_data/serial-imx.h>
45#include <linux/platform_data/dma-imx.h>
46
47#include "serial_mctrl_gpio.h"
48
49
50#define URXD0 0x0
51#define URTX0 0x40
52#define UCR1 0x80
53#define UCR2 0x84
54#define UCR3 0x88
55#define UCR4 0x8c
56#define UFCR 0x90
57#define USR1 0x94
58#define USR2 0x98
59#define UESC 0x9c
60#define UTIM 0xa0
61#define UBIR 0xa4
62#define UBMR 0xa8
63#define UBRC 0xac
64#define IMX21_ONEMS 0xb0
65#define IMX1_UTS 0xd0
66#define IMX21_UTS 0xb4
67
68
69#define URXD_DUMMY_READ (1<<16)
70#define URXD_CHARRDY (1<<15)
71#define URXD_ERR (1<<14)
72#define URXD_OVRRUN (1<<13)
73#define URXD_FRMERR (1<<12)
74#define URXD_BRK (1<<11)
75#define URXD_PRERR (1<<10)
76#define URXD_RX_DATA (0xFF<<0)
77#define UCR1_ADEN (1<<15)
78#define UCR1_ADBR (1<<14)
79#define UCR1_TRDYEN (1<<13)
80#define UCR1_IDEN (1<<12)
81#define UCR1_ICD_REG(x) (((x) & 3) << 10)
82#define UCR1_RRDYEN (1<<9)
83#define UCR1_RDMAEN (1<<8)
84#define UCR1_IREN (1<<7)
85#define UCR1_TXMPTYEN (1<<6)
86#define UCR1_RTSDEN (1<<5)
87#define UCR1_SNDBRK (1<<4)
88#define UCR1_TDMAEN (1<<3)
89#define IMX1_UCR1_UARTCLKEN (1<<2)
90#define UCR1_ATDMAEN (1<<2)
91#define UCR1_DOZE (1<<1)
92#define UCR1_UARTEN (1<<0)
93#define UCR2_ESCI (1<<15)
94#define UCR2_IRTS (1<<14)
95#define UCR2_CTSC (1<<13)
96#define UCR2_CTS (1<<12)
97#define UCR2_ESCEN (1<<11)
98#define UCR2_PREN (1<<8)
99#define UCR2_PROE (1<<7)
100#define UCR2_STPB (1<<6)
101#define UCR2_WS (1<<5)
102#define UCR2_RTSEN (1<<4)
103#define UCR2_ATEN (1<<3)
104#define UCR2_TXEN (1<<2)
105#define UCR2_RXEN (1<<1)
106#define UCR2_SRST (1<<0)
107#define UCR3_DTREN (1<<13)
108#define UCR3_PARERREN (1<<12)
109#define UCR3_FRAERREN (1<<11)
110#define UCR3_DSR (1<<10)
111#define UCR3_DCD (1<<9)
112#define UCR3_RI (1<<8)
113#define UCR3_ADNIMP (1<<7)
114#define UCR3_RXDSEN (1<<6)
115#define UCR3_AIRINTEN (1<<5)
116#define UCR3_AWAKEN (1<<4)
117#define UCR3_DTRDEN (1<<3)
118#define IMX21_UCR3_RXDMUXSEL (1<<2)
119#define UCR3_INVT (1<<1)
120#define UCR3_BPEN (1<<0)
121#define UCR4_CTSTL_SHF 10
122#define UCR4_CTSTL_MASK 0x3F
123#define UCR4_INVR (1<<9)
124#define UCR4_ENIRI (1<<8)
125#define UCR4_WKEN (1<<7)
126#define UCR4_REF16 (1<<6)
127#define UCR4_IDDMAEN (1<<6)
128#define UCR4_IRSC (1<<5)
129#define UCR4_TCEN (1<<3)
130#define UCR4_BKEN (1<<2)
131#define UCR4_OREN (1<<1)
132#define UCR4_DREN (1<<0)
133#define UFCR_RXTL_SHF 0
134#define UFCR_DCEDTE (1<<6)
135#define UFCR_RFDIV (7<<7)
136#define UFCR_RFDIV_REG(x) (((x) < 7 ? 6 - (x) : 6) << 7)
137#define UFCR_TXTL_SHF 10
138#define USR1_PARITYERR (1<<15)
139#define USR1_RTSS (1<<14)
140#define USR1_TRDY (1<<13)
141#define USR1_RTSD (1<<12)
142#define USR1_ESCF (1<<11)
143#define USR1_FRAMERR (1<<10)
144#define USR1_RRDY (1<<9)
145#define USR1_AGTIM (1<<8)
146#define USR1_DTRD (1<<7)
147#define USR1_RXDS (1<<6)
148#define USR1_AIRINT (1<<5)
149#define USR1_AWAKE (1<<4)
150#define USR2_ADET (1<<15)
151#define USR2_TXFE (1<<14)
152#define USR2_DTRF (1<<13)
153#define USR2_IDLE (1<<12)
154#define USR2_RIDELT (1<<10)
155#define USR2_RIIN (1<<9)
156#define USR2_IRINT (1<<8)
157#define USR2_WAKE (1<<7)
158#define USR2_DCDIN (1<<5)
159#define USR2_RTSF (1<<4)
160#define USR2_TXDC (1<<3)
161#define USR2_BRCD (1<<2)
162#define USR2_ORE (1<<1)
163#define USR2_RDR (1<<0)
164#define UTS_FRCPERR (1<<13)
165#define UTS_LOOP (1<<12)
166#define UTS_TXEMPTY (1<<6)
167#define UTS_RXEMPTY (1<<5)
168#define UTS_TXFULL (1<<4)
169#define UTS_RXFULL (1<<3)
170#define UTS_SOFTRST (1<<0)
171
172
173#define SERIAL_IMX_MAJOR 207
174#define MINOR_START 16
175#define DEV_NAME "ttymxc"
176
177
178
179
180
181
182
183#define MCTRL_TIMEOUT (250*HZ/1000)
184
185#define DRIVER_NAME "IMX-uart"
186
187#define UART_NR 8
188
189
190enum imx_uart_type {
191 IMX1_UART,
192 IMX21_UART,
193 IMX53_UART,
194 IMX6Q_UART,
195};
196
197
198struct imx_uart_data {
199 unsigned uts_reg;
200 enum imx_uart_type devtype;
201};
202
203struct imx_port {
204 struct uart_port port;
205 struct timer_list timer;
206 unsigned int old_status;
207 unsigned int have_rtscts:1;
208 unsigned int have_rtsgpio:1;
209 unsigned int dte_mode:1;
210 struct clk *clk_ipg;
211 struct clk *clk_per;
212 const struct imx_uart_data *devdata;
213
214 struct mctrl_gpios *gpios;
215
216
217 unsigned int dma_is_inited:1;
218 unsigned int dma_is_enabled:1;
219 unsigned int dma_is_rxing:1;
220 unsigned int dma_is_txing:1;
221 struct dma_chan *dma_chan_rx, *dma_chan_tx;
222 struct scatterlist rx_sgl, tx_sgl[2];
223 void *rx_buf;
224 struct circ_buf rx_ring;
225 unsigned int rx_periods;
226 dma_cookie_t rx_cookie;
227 unsigned int tx_bytes;
228 unsigned int dma_tx_nents;
229 wait_queue_head_t dma_wait;
230 unsigned int saved_reg[10];
231 bool context_saved;
232};
233
234struct imx_port_ucrs {
235 unsigned int ucr1;
236 unsigned int ucr2;
237 unsigned int ucr3;
238};
239
240static struct imx_uart_data imx_uart_devdata[] = {
241 [IMX1_UART] = {
242 .uts_reg = IMX1_UTS,
243 .devtype = IMX1_UART,
244 },
245 [IMX21_UART] = {
246 .uts_reg = IMX21_UTS,
247 .devtype = IMX21_UART,
248 },
249 [IMX53_UART] = {
250 .uts_reg = IMX21_UTS,
251 .devtype = IMX53_UART,
252 },
253 [IMX6Q_UART] = {
254 .uts_reg = IMX21_UTS,
255 .devtype = IMX6Q_UART,
256 },
257};
258
259static const struct platform_device_id imx_uart_devtype[] = {
260 {
261 .name = "imx1-uart",
262 .driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX1_UART],
263 }, {
264 .name = "imx21-uart",
265 .driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX21_UART],
266 }, {
267 .name = "imx53-uart",
268 .driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX53_UART],
269 }, {
270 .name = "imx6q-uart",
271 .driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX6Q_UART],
272 }, {
273
274 }
275};
276MODULE_DEVICE_TABLE(platform, imx_uart_devtype);
277
278static const struct of_device_id imx_uart_dt_ids[] = {
279 { .compatible = "fsl,imx6q-uart", .data = &imx_uart_devdata[IMX6Q_UART], },
280 { .compatible = "fsl,imx53-uart", .data = &imx_uart_devdata[IMX53_UART], },
281 { .compatible = "fsl,imx1-uart", .data = &imx_uart_devdata[IMX1_UART], },
282 { .compatible = "fsl,imx21-uart", .data = &imx_uart_devdata[IMX21_UART], },
283 { }
284};
285MODULE_DEVICE_TABLE(of, imx_uart_dt_ids);
286
287static inline unsigned uts_reg(struct imx_port *sport)
288{
289 return sport->devdata->uts_reg;
290}
291
292static inline int is_imx1_uart(struct imx_port *sport)
293{
294 return sport->devdata->devtype == IMX1_UART;
295}
296
297static inline int is_imx21_uart(struct imx_port *sport)
298{
299 return sport->devdata->devtype == IMX21_UART;
300}
301
302static inline int is_imx53_uart(struct imx_port *sport)
303{
304 return sport->devdata->devtype == IMX53_UART;
305}
306
307static inline int is_imx6q_uart(struct imx_port *sport)
308{
309 return sport->devdata->devtype == IMX6Q_UART;
310}
311
312
313
314#if defined(CONFIG_SERIAL_IMX_CONSOLE)
315static void imx_port_ucrs_save(struct uart_port *port,
316 struct imx_port_ucrs *ucr)
317{
318
319 ucr->ucr1 = readl(port->membase + UCR1);
320 ucr->ucr2 = readl(port->membase + UCR2);
321 ucr->ucr3 = readl(port->membase + UCR3);
322}
323
324static void imx_port_ucrs_restore(struct uart_port *port,
325 struct imx_port_ucrs *ucr)
326{
327
328 writel(ucr->ucr1, port->membase + UCR1);
329 writel(ucr->ucr2, port->membase + UCR2);
330 writel(ucr->ucr3, port->membase + UCR3);
331}
332#endif
333
334static void imx_port_rts_active(struct imx_port *sport, unsigned long *ucr2)
335{
336 *ucr2 &= ~(UCR2_CTSC | UCR2_CTS);
337
338 mctrl_gpio_set(sport->gpios, sport->port.mctrl | TIOCM_RTS);
339}
340
341static void imx_port_rts_inactive(struct imx_port *sport, unsigned long *ucr2)
342{
343 *ucr2 &= ~UCR2_CTSC;
344 *ucr2 |= UCR2_CTS;
345
346 mctrl_gpio_set(sport->gpios, sport->port.mctrl & ~TIOCM_RTS);
347}
348
349static void imx_port_rts_auto(struct imx_port *sport, unsigned long *ucr2)
350{
351 *ucr2 |= UCR2_CTSC;
352}
353
354
355
356
357static void imx_stop_tx(struct uart_port *port)
358{
359 struct imx_port *sport = (struct imx_port *)port;
360 unsigned long temp;
361
362
363
364
365
366 if (sport->dma_is_enabled && sport->dma_is_txing)
367 return;
368
369 temp = readl(port->membase + UCR1);
370 writel(temp & ~UCR1_TXMPTYEN, port->membase + UCR1);
371
372
373 if (port->rs485.flags & SER_RS485_ENABLED &&
374 readl(port->membase + USR2) & USR2_TXDC) {
375 temp = readl(port->membase + UCR2);
376 if (port->rs485.flags & SER_RS485_RTS_AFTER_SEND)
377 imx_port_rts_active(sport, &temp);
378 else
379 imx_port_rts_inactive(sport, &temp);
380 temp |= UCR2_RXEN;
381 writel(temp, port->membase + UCR2);
382
383 temp = readl(port->membase + UCR4);
384 temp &= ~UCR4_TCEN;
385 writel(temp, port->membase + UCR4);
386 }
387}
388
389
390
391
392static void imx_stop_rx(struct uart_port *port)
393{
394 struct imx_port *sport = (struct imx_port *)port;
395 unsigned long temp;
396
397 if (sport->dma_is_enabled && sport->dma_is_rxing) {
398 if (sport->port.suspended) {
399 dmaengine_terminate_all(sport->dma_chan_rx);
400 sport->dma_is_rxing = 0;
401 } else {
402 return;
403 }
404 }
405
406 temp = readl(sport->port.membase + UCR2);
407 writel(temp & ~UCR2_RXEN, sport->port.membase + UCR2);
408
409
410 temp = readl(sport->port.membase + UCR1);
411 writel(temp & ~UCR1_RRDYEN, sport->port.membase + UCR1);
412}
413
414
415
416
417static void imx_enable_ms(struct uart_port *port)
418{
419 struct imx_port *sport = (struct imx_port *)port;
420
421 mod_timer(&sport->timer, jiffies);
422
423 mctrl_gpio_enable_ms(sport->gpios);
424}
425
426static void imx_dma_tx(struct imx_port *sport);
427static inline void imx_transmit_buffer(struct imx_port *sport)
428{
429 struct circ_buf *xmit = &sport->port.state->xmit;
430 unsigned long temp;
431
432 if (sport->port.x_char) {
433
434 writel(sport->port.x_char, sport->port.membase + URTX0);
435 sport->port.icount.tx++;
436 sport->port.x_char = 0;
437 return;
438 }
439
440 if (uart_circ_empty(xmit) || uart_tx_stopped(&sport->port)) {
441 imx_stop_tx(&sport->port);
442 return;
443 }
444
445 if (sport->dma_is_enabled) {
446
447
448
449
450 temp = readl(sport->port.membase + UCR1);
451 temp &= ~UCR1_TXMPTYEN;
452 if (sport->dma_is_txing) {
453 temp |= UCR1_TDMAEN;
454 writel(temp, sport->port.membase + UCR1);
455 } else {
456 writel(temp, sport->port.membase + UCR1);
457 imx_dma_tx(sport);
458 }
459 }
460
461 while (!uart_circ_empty(xmit) && !sport->dma_is_txing &&
462 !(readl(sport->port.membase + uts_reg(sport)) & UTS_TXFULL)) {
463
464
465 writel(xmit->buf[xmit->tail], sport->port.membase + URTX0);
466 xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
467 sport->port.icount.tx++;
468 }
469
470 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
471 uart_write_wakeup(&sport->port);
472
473 if (uart_circ_empty(xmit))
474 imx_stop_tx(&sport->port);
475}
476
477static void dma_tx_callback(void *data)
478{
479 struct imx_port *sport = data;
480 struct scatterlist *sgl = &sport->tx_sgl[0];
481 struct circ_buf *xmit = &sport->port.state->xmit;
482 unsigned long flags;
483 unsigned long temp;
484
485 spin_lock_irqsave(&sport->port.lock, flags);
486
487 dma_unmap_sg(sport->port.dev, sgl, sport->dma_tx_nents, DMA_TO_DEVICE);
488
489 temp = readl(sport->port.membase + UCR1);
490 temp &= ~UCR1_TDMAEN;
491 writel(temp, sport->port.membase + UCR1);
492
493
494 xmit->tail = (xmit->tail + sport->tx_bytes) & (UART_XMIT_SIZE - 1);
495 sport->port.icount.tx += sport->tx_bytes;
496
497 dev_dbg(sport->port.dev, "we finish the TX DMA.\n");
498
499 sport->dma_is_txing = 0;
500
501 spin_unlock_irqrestore(&sport->port.lock, flags);
502
503 if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
504 uart_write_wakeup(&sport->port);
505
506 if (waitqueue_active(&sport->dma_wait)) {
507 wake_up(&sport->dma_wait);
508 dev_dbg(sport->port.dev, "exit in %s.\n", __func__);
509 return;
510 }
511
512 spin_lock_irqsave(&sport->port.lock, flags);
513 if (!uart_circ_empty(xmit) && !uart_tx_stopped(&sport->port))
514 imx_dma_tx(sport);
515 spin_unlock_irqrestore(&sport->port.lock, flags);
516}
517
518static void imx_dma_tx(struct imx_port *sport)
519{
520 struct circ_buf *xmit = &sport->port.state->xmit;
521 struct scatterlist *sgl = sport->tx_sgl;
522 struct dma_async_tx_descriptor *desc;
523 struct dma_chan *chan = sport->dma_chan_tx;
524 struct device *dev = sport->port.dev;
525 unsigned long temp;
526 int ret;
527
528 if (sport->dma_is_txing)
529 return;
530
531 sport->tx_bytes = uart_circ_chars_pending(xmit);
532
533 if (xmit->tail < xmit->head) {
534 sport->dma_tx_nents = 1;
535 sg_init_one(sgl, xmit->buf + xmit->tail, sport->tx_bytes);
536 } else {
537 sport->dma_tx_nents = 2;
538 sg_init_table(sgl, 2);
539 sg_set_buf(sgl, xmit->buf + xmit->tail,
540 UART_XMIT_SIZE - xmit->tail);
541 sg_set_buf(sgl + 1, xmit->buf, xmit->head);
542 }
543
544 ret = dma_map_sg(dev, sgl, sport->dma_tx_nents, DMA_TO_DEVICE);
545 if (ret == 0) {
546 dev_err(dev, "DMA mapping error for TX.\n");
547 return;
548 }
549 desc = dmaengine_prep_slave_sg(chan, sgl, sport->dma_tx_nents,
550 DMA_MEM_TO_DEV, DMA_PREP_INTERRUPT);
551 if (!desc) {
552 dma_unmap_sg(dev, sgl, sport->dma_tx_nents,
553 DMA_TO_DEVICE);
554 dev_err(dev, "We cannot prepare for the TX slave dma!\n");
555 return;
556 }
557 desc->callback = dma_tx_callback;
558 desc->callback_param = sport;
559
560 dev_dbg(dev, "TX: prepare to send %lu bytes by DMA.\n",
561 uart_circ_chars_pending(xmit));
562
563 temp = readl(sport->port.membase + UCR1);
564 temp |= UCR1_TDMAEN;
565 writel(temp, sport->port.membase + UCR1);
566
567
568 sport->dma_is_txing = 1;
569 dmaengine_submit(desc);
570 dma_async_issue_pending(chan);
571 return;
572}
573
574
575
576
577static void imx_start_tx(struct uart_port *port)
578{
579 struct imx_port *sport = (struct imx_port *)port;
580 unsigned long temp;
581
582 if (port->rs485.flags & SER_RS485_ENABLED) {
583 temp = readl(port->membase + UCR2);
584 if (port->rs485.flags & SER_RS485_RTS_ON_SEND)
585 imx_port_rts_active(sport, &temp);
586 else
587 imx_port_rts_inactive(sport, &temp);
588 if (!(port->rs485.flags & SER_RS485_RX_DURING_TX))
589 temp &= ~UCR2_RXEN;
590 writel(temp, port->membase + UCR2);
591
592
593 temp = readl(port->membase + UCR4);
594 temp |= UCR4_TCEN;
595 writel(temp, port->membase + UCR4);
596 }
597
598 if (!sport->dma_is_enabled) {
599 temp = readl(sport->port.membase + UCR1);
600 writel(temp | UCR1_TXMPTYEN, sport->port.membase + UCR1);
601 }
602
603 if (sport->dma_is_enabled) {
604 if (sport->port.x_char) {
605
606
607 temp = readl(sport->port.membase + UCR1);
608 temp &= ~UCR1_TDMAEN;
609 temp |= UCR1_TXMPTYEN;
610 writel(temp, sport->port.membase + UCR1);
611 return;
612 }
613
614 if (!uart_circ_empty(&port->state->xmit) &&
615 !uart_tx_stopped(port))
616 imx_dma_tx(sport);
617 return;
618 }
619}
620
621static irqreturn_t imx_rtsint(int irq, void *dev_id)
622{
623 struct imx_port *sport = dev_id;
624 unsigned int val;
625 unsigned long flags;
626
627 spin_lock_irqsave(&sport->port.lock, flags);
628
629 writel(USR1_RTSD, sport->port.membase + USR1);
630 val = readl(sport->port.membase + USR1) & USR1_RTSS;
631 uart_handle_cts_change(&sport->port, !!val);
632 wake_up_interruptible(&sport->port.state->port.delta_msr_wait);
633
634 spin_unlock_irqrestore(&sport->port.lock, flags);
635 return IRQ_HANDLED;
636}
637
638static irqreturn_t imx_txint(int irq, void *dev_id)
639{
640 struct imx_port *sport = dev_id;
641 unsigned long flags;
642
643 spin_lock_irqsave(&sport->port.lock, flags);
644 imx_transmit_buffer(sport);
645 spin_unlock_irqrestore(&sport->port.lock, flags);
646 return IRQ_HANDLED;
647}
648
649static irqreturn_t imx_rxint(int irq, void *dev_id)
650{
651 struct imx_port *sport = dev_id;
652 unsigned int rx, flg, ignored = 0;
653 struct tty_port *port = &sport->port.state->port;
654 unsigned long flags, temp;
655
656 spin_lock_irqsave(&sport->port.lock, flags);
657
658 while (readl(sport->port.membase + USR2) & USR2_RDR) {
659 flg = TTY_NORMAL;
660 sport->port.icount.rx++;
661
662 rx = readl(sport->port.membase + URXD0);
663
664 temp = readl(sport->port.membase + USR2);
665 if (temp & USR2_BRCD) {
666 writel(USR2_BRCD, sport->port.membase + USR2);
667 if (uart_handle_break(&sport->port))
668 continue;
669 }
670
671 if (uart_handle_sysrq_char(&sport->port, (unsigned char)rx))
672 continue;
673
674 if (unlikely(rx & URXD_ERR)) {
675 if (rx & URXD_BRK)
676 sport->port.icount.brk++;
677 else if (rx & URXD_PRERR)
678 sport->port.icount.parity++;
679 else if (rx & URXD_FRMERR)
680 sport->port.icount.frame++;
681 if (rx & URXD_OVRRUN)
682 sport->port.icount.overrun++;
683
684 if (rx & sport->port.ignore_status_mask) {
685 if (++ignored > 100)
686 goto out;
687 continue;
688 }
689
690 rx &= (sport->port.read_status_mask | 0xFF);
691
692 if (rx & URXD_BRK)
693 flg = TTY_BREAK;
694 else if (rx & URXD_PRERR)
695 flg = TTY_PARITY;
696 else if (rx & URXD_FRMERR)
697 flg = TTY_FRAME;
698 if (rx & URXD_OVRRUN)
699 flg = TTY_OVERRUN;
700
701#ifdef SUPPORT_SYSRQ
702 sport->port.sysrq = 0;
703#endif
704 }
705
706 if (sport->port.ignore_status_mask & URXD_DUMMY_READ)
707 goto out;
708
709 if (tty_insert_flip_char(port, rx, flg) == 0)
710 sport->port.icount.buf_overrun++;
711 }
712
713out:
714 spin_unlock_irqrestore(&sport->port.lock, flags);
715 tty_flip_buffer_push(port);
716 return IRQ_HANDLED;
717}
718
719static void imx_disable_rx_int(struct imx_port *sport)
720{
721 unsigned long temp;
722
723 sport->dma_is_rxing = 1;
724
725
726 temp = readl(sport->port.membase + UCR1);
727 temp &= ~(UCR1_RRDYEN);
728 writel(temp, sport->port.membase + UCR1);
729
730 temp = readl(sport->port.membase + UCR2);
731 temp &= ~(UCR2_ATEN);
732 writel(temp, sport->port.membase + UCR2);
733
734
735 temp = readl(sport->port.membase + UCR4);
736 temp &= ~UCR4_OREN;
737 writel(temp, sport->port.membase + UCR4);
738}
739
740static void clear_rx_errors(struct imx_port *sport);
741static int start_rx_dma(struct imx_port *sport);
742
743
744
745
746static void imx_dma_rxint(struct imx_port *sport)
747{
748 unsigned long temp;
749 unsigned long flags;
750
751 spin_lock_irqsave(&sport->port.lock, flags);
752
753 temp = readl(sport->port.membase + USR2);
754 if ((temp & USR2_RDR) && !sport->dma_is_rxing) {
755
756 imx_disable_rx_int(sport);
757
758
759 start_rx_dma(sport);
760 }
761
762 spin_unlock_irqrestore(&sport->port.lock, flags);
763}
764
765
766
767
768static unsigned int imx_get_hwmctrl(struct imx_port *sport)
769{
770 unsigned int tmp = TIOCM_DSR;
771 unsigned usr1 = readl(sport->port.membase + USR1);
772 unsigned usr2 = readl(sport->port.membase + USR2);
773
774 if (usr1 & USR1_RTSS)
775 tmp |= TIOCM_CTS;
776
777
778 if (!(usr2 & USR2_DCDIN))
779 tmp |= TIOCM_CAR;
780
781 if (sport->dte_mode)
782 if (!(readl(sport->port.membase + USR2) & USR2_RIIN))
783 tmp |= TIOCM_RI;
784
785 return tmp;
786}
787
788
789
790
791static void imx_mctrl_check(struct imx_port *sport)
792{
793 unsigned int status, changed;
794
795 status = imx_get_hwmctrl(sport);
796 changed = status ^ sport->old_status;
797
798 if (changed == 0)
799 return;
800
801 sport->old_status = status;
802
803 if (changed & TIOCM_RI && status & TIOCM_RI)
804 sport->port.icount.rng++;
805 if (changed & TIOCM_DSR)
806 sport->port.icount.dsr++;
807 if (changed & TIOCM_CAR)
808 uart_handle_dcd_change(&sport->port, status & TIOCM_CAR);
809 if (changed & TIOCM_CTS)
810 uart_handle_cts_change(&sport->port, status & TIOCM_CTS);
811
812 wake_up_interruptible(&sport->port.state->port.delta_msr_wait);
813}
814
815static irqreturn_t imx_int(int irq, void *dev_id)
816{
817 struct imx_port *sport = dev_id;
818 unsigned int sts;
819 unsigned int sts2;
820 irqreturn_t ret = IRQ_NONE;
821
822 sts = readl(sport->port.membase + USR1);
823 sts2 = readl(sport->port.membase + USR2);
824
825 if (sts & (USR1_RRDY | USR1_AGTIM)) {
826 if (sport->dma_is_enabled)
827 imx_dma_rxint(sport);
828 else
829 imx_rxint(irq, dev_id);
830 ret = IRQ_HANDLED;
831 }
832
833 if ((sts & USR1_TRDY &&
834 readl(sport->port.membase + UCR1) & UCR1_TXMPTYEN) ||
835 (sts2 & USR2_TXDC &&
836 readl(sport->port.membase + UCR4) & UCR4_TCEN)) {
837 imx_txint(irq, dev_id);
838 ret = IRQ_HANDLED;
839 }
840
841 if (sts & USR1_DTRD) {
842 unsigned long flags;
843
844 if (sts & USR1_DTRD)
845 writel(USR1_DTRD, sport->port.membase + USR1);
846
847 spin_lock_irqsave(&sport->port.lock, flags);
848 imx_mctrl_check(sport);
849 spin_unlock_irqrestore(&sport->port.lock, flags);
850
851 ret = IRQ_HANDLED;
852 }
853
854 if (sts & USR1_RTSD) {
855 imx_rtsint(irq, dev_id);
856 ret = IRQ_HANDLED;
857 }
858
859 if (sts & USR1_AWAKE) {
860 writel(USR1_AWAKE, sport->port.membase + USR1);
861 ret = IRQ_HANDLED;
862 }
863
864 if (sts2 & USR2_ORE) {
865 sport->port.icount.overrun++;
866 writel(USR2_ORE, sport->port.membase + USR2);
867 ret = IRQ_HANDLED;
868 }
869
870 return ret;
871}
872
873
874
875
876static unsigned int imx_tx_empty(struct uart_port *port)
877{
878 struct imx_port *sport = (struct imx_port *)port;
879 unsigned int ret;
880
881 ret = (readl(sport->port.membase + USR2) & USR2_TXDC) ? TIOCSER_TEMT : 0;
882
883
884 if (sport->dma_is_enabled && sport->dma_is_txing)
885 ret = 0;
886
887 return ret;
888}
889
890static unsigned int imx_get_mctrl(struct uart_port *port)
891{
892 struct imx_port *sport = (struct imx_port *)port;
893 unsigned int ret = imx_get_hwmctrl(sport);
894
895 mctrl_gpio_get(sport->gpios, &ret);
896
897 return ret;
898}
899
900static void imx_set_mctrl(struct uart_port *port, unsigned int mctrl)
901{
902 struct imx_port *sport = (struct imx_port *)port;
903 unsigned long temp;
904
905 if (!(port->rs485.flags & SER_RS485_ENABLED)) {
906 temp = readl(sport->port.membase + UCR2);
907 temp &= ~(UCR2_CTS | UCR2_CTSC);
908 if (mctrl & TIOCM_RTS)
909 temp |= UCR2_CTS | UCR2_CTSC;
910 writel(temp, sport->port.membase + UCR2);
911 }
912
913 temp = readl(sport->port.membase + UCR3) & ~UCR3_DSR;
914 if (!(mctrl & TIOCM_DTR))
915 temp |= UCR3_DSR;
916 writel(temp, sport->port.membase + UCR3);
917
918 temp = readl(sport->port.membase + uts_reg(sport)) & ~UTS_LOOP;
919 if (mctrl & TIOCM_LOOP)
920 temp |= UTS_LOOP;
921 writel(temp, sport->port.membase + uts_reg(sport));
922
923 mctrl_gpio_set(sport->gpios, mctrl);
924}
925
926
927
928
929static void imx_break_ctl(struct uart_port *port, int break_state)
930{
931 struct imx_port *sport = (struct imx_port *)port;
932 unsigned long flags, temp;
933
934 spin_lock_irqsave(&sport->port.lock, flags);
935
936 temp = readl(sport->port.membase + UCR1) & ~UCR1_SNDBRK;
937
938 if (break_state != 0)
939 temp |= UCR1_SNDBRK;
940
941 writel(temp, sport->port.membase + UCR1);
942
943 spin_unlock_irqrestore(&sport->port.lock, flags);
944}
945
946
947
948
949
950static void imx_timeout(unsigned long data)
951{
952 struct imx_port *sport = (struct imx_port *)data;
953 unsigned long flags;
954
955 if (sport->port.state) {
956 spin_lock_irqsave(&sport->port.lock, flags);
957 imx_mctrl_check(sport);
958 spin_unlock_irqrestore(&sport->port.lock, flags);
959
960 mod_timer(&sport->timer, jiffies + MCTRL_TIMEOUT);
961 }
962}
963
964#define RX_BUF_SIZE (PAGE_SIZE)
965
966
967
968
969
970
971
972
973
974static void dma_rx_callback(void *data)
975{
976 struct imx_port *sport = data;
977 struct dma_chan *chan = sport->dma_chan_rx;
978 struct scatterlist *sgl = &sport->rx_sgl;
979 struct tty_port *port = &sport->port.state->port;
980 struct dma_tx_state state;
981 struct circ_buf *rx_ring = &sport->rx_ring;
982 enum dma_status status;
983 unsigned int w_bytes = 0;
984 unsigned int r_bytes;
985 unsigned int bd_size;
986
987 status = dmaengine_tx_status(chan, (dma_cookie_t)0, &state);
988
989 if (status == DMA_ERROR) {
990 dev_err(sport->port.dev, "DMA transaction error.\n");
991 clear_rx_errors(sport);
992 return;
993 }
994
995 if (!(sport->port.ignore_status_mask & URXD_DUMMY_READ)) {
996
997
998
999
1000
1001
1002
1003
1004
1005
1006
1007
1008
1009 rx_ring->head = sg_dma_len(sgl) - state.residue;
1010
1011
1012 bd_size = sg_dma_len(sgl) / sport->rx_periods;
1013 rx_ring->tail = ((rx_ring->head-1) / bd_size) * bd_size;
1014
1015 if (rx_ring->head <= sg_dma_len(sgl) &&
1016 rx_ring->head > rx_ring->tail) {
1017
1018
1019 r_bytes = rx_ring->head - rx_ring->tail;
1020
1021
1022 dma_sync_sg_for_cpu(sport->port.dev, sgl, 1,
1023 DMA_FROM_DEVICE);
1024
1025 w_bytes = tty_insert_flip_string(port,
1026 sport->rx_buf + rx_ring->tail, r_bytes);
1027
1028
1029 dma_sync_sg_for_device(sport->port.dev, sgl, 1,
1030 DMA_FROM_DEVICE);
1031
1032 if (w_bytes != r_bytes)
1033 sport->port.icount.buf_overrun++;
1034
1035 sport->port.icount.rx += w_bytes;
1036 } else {
1037 WARN_ON(rx_ring->head > sg_dma_len(sgl));
1038 WARN_ON(rx_ring->head <= rx_ring->tail);
1039 }
1040 }
1041
1042 if (w_bytes) {
1043 tty_flip_buffer_push(port);
1044 dev_dbg(sport->port.dev, "We get %d bytes.\n", w_bytes);
1045 }
1046}
1047
1048
1049#define RX_DMA_PERIODS 4
1050
1051static int start_rx_dma(struct imx_port *sport)
1052{
1053 struct scatterlist *sgl = &sport->rx_sgl;
1054 struct dma_chan *chan = sport->dma_chan_rx;
1055 struct device *dev = sport->port.dev;
1056 struct dma_async_tx_descriptor *desc;
1057 int ret;
1058
1059 sport->rx_ring.head = 0;
1060 sport->rx_ring.tail = 0;
1061 sport->rx_periods = RX_DMA_PERIODS;
1062
1063 sg_init_one(sgl, sport->rx_buf, RX_BUF_SIZE);
1064 ret = dma_map_sg(dev, sgl, 1, DMA_FROM_DEVICE);
1065 if (ret == 0) {
1066 dev_err(dev, "DMA mapping error for RX.\n");
1067 return -EINVAL;
1068 }
1069
1070 desc = dmaengine_prep_dma_cyclic(chan, sg_dma_address(sgl),
1071 sg_dma_len(sgl), sg_dma_len(sgl) / sport->rx_periods,
1072 DMA_DEV_TO_MEM, DMA_PREP_INTERRUPT);
1073
1074 if (!desc) {
1075 dma_unmap_sg(dev, sgl, 1, DMA_FROM_DEVICE);
1076 dev_err(dev, "We cannot prepare for the RX slave dma!\n");
1077 return -EINVAL;
1078 }
1079 desc->callback = dma_rx_callback;
1080 desc->callback_param = sport;
1081
1082 dev_dbg(dev, "RX: prepare for the DMA.\n");
1083 sport->rx_cookie = dmaengine_submit(desc);
1084 dma_async_issue_pending(chan);
1085 return 0;
1086}
1087
1088static void clear_rx_errors(struct imx_port *sport)
1089{
1090 unsigned int status_usr1, status_usr2;
1091
1092 status_usr1 = readl(sport->port.membase + USR1);
1093 status_usr2 = readl(sport->port.membase + USR2);
1094
1095 if (status_usr2 & USR2_BRCD) {
1096 sport->port.icount.brk++;
1097 writel(USR2_BRCD, sport->port.membase + USR2);
1098 } else if (status_usr1 & USR1_FRAMERR) {
1099 sport->port.icount.frame++;
1100 writel(USR1_FRAMERR, sport->port.membase + USR1);
1101 } else if (status_usr1 & USR1_PARITYERR) {
1102 sport->port.icount.parity++;
1103 writel(USR1_PARITYERR, sport->port.membase + USR1);
1104 }
1105
1106 if (status_usr2 & USR2_ORE) {
1107 sport->port.icount.overrun++;
1108 writel(USR2_ORE, sport->port.membase + USR2);
1109 }
1110
1111}
1112
1113#define TXTL_DEFAULT 2
1114#define RXTL_DEFAULT 1
1115#define TXTL_DMA 8
1116#define RXTL_DMA 9
1117
1118static void imx_setup_ufcr(struct imx_port *sport,
1119 unsigned char txwl, unsigned char rxwl)
1120{
1121 unsigned int val;
1122
1123
1124 val = readl(sport->port.membase + UFCR) & (UFCR_RFDIV | UFCR_DCEDTE);
1125 val |= txwl << UFCR_TXTL_SHF | rxwl;
1126 writel(val, sport->port.membase + UFCR);
1127}
1128
1129static void imx_uart_dma_exit(struct imx_port *sport)
1130{
1131 if (sport->dma_chan_rx) {
1132 dmaengine_terminate_sync(sport->dma_chan_rx);
1133 dma_release_channel(sport->dma_chan_rx);
1134 sport->dma_chan_rx = NULL;
1135 sport->rx_cookie = -EINVAL;
1136 kfree(sport->rx_buf);
1137 sport->rx_buf = NULL;
1138 }
1139
1140 if (sport->dma_chan_tx) {
1141 dmaengine_terminate_sync(sport->dma_chan_tx);
1142 dma_release_channel(sport->dma_chan_tx);
1143 sport->dma_chan_tx = NULL;
1144 }
1145
1146 sport->dma_is_inited = 0;
1147}
1148
1149static int imx_uart_dma_init(struct imx_port *sport)
1150{
1151 struct dma_slave_config slave_config = {};
1152 struct device *dev = sport->port.dev;
1153 int ret;
1154
1155
1156 sport->dma_chan_rx = dma_request_slave_channel(dev, "rx");
1157 if (!sport->dma_chan_rx) {
1158 dev_dbg(dev, "cannot get the DMA channel.\n");
1159 ret = -EINVAL;
1160 goto err;
1161 }
1162
1163 slave_config.direction = DMA_DEV_TO_MEM;
1164 slave_config.src_addr = sport->port.mapbase + URXD0;
1165 slave_config.src_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
1166
1167 slave_config.src_maxburst = RXTL_DMA - 1;
1168 ret = dmaengine_slave_config(sport->dma_chan_rx, &slave_config);
1169 if (ret) {
1170 dev_err(dev, "error in RX dma configuration.\n");
1171 goto err;
1172 }
1173
1174 sport->rx_buf = kzalloc(PAGE_SIZE, GFP_KERNEL);
1175 if (!sport->rx_buf) {
1176 ret = -ENOMEM;
1177 goto err;
1178 }
1179 sport->rx_ring.buf = sport->rx_buf;
1180
1181
1182 sport->dma_chan_tx = dma_request_slave_channel(dev, "tx");
1183 if (!sport->dma_chan_tx) {
1184 dev_err(dev, "cannot get the TX DMA channel!\n");
1185 ret = -EINVAL;
1186 goto err;
1187 }
1188
1189 slave_config.direction = DMA_MEM_TO_DEV;
1190 slave_config.dst_addr = sport->port.mapbase + URTX0;
1191 slave_config.dst_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
1192 slave_config.dst_maxburst = TXTL_DMA;
1193 ret = dmaengine_slave_config(sport->dma_chan_tx, &slave_config);
1194 if (ret) {
1195 dev_err(dev, "error in TX dma configuration.");
1196 goto err;
1197 }
1198
1199 sport->dma_is_inited = 1;
1200
1201 return 0;
1202err:
1203 imx_uart_dma_exit(sport);
1204 return ret;
1205}
1206
1207static void imx_enable_dma(struct imx_port *sport)
1208{
1209 unsigned long temp;
1210
1211 init_waitqueue_head(&sport->dma_wait);
1212
1213
1214 temp = readl(sport->port.membase + UCR1);
1215 temp |= UCR1_RDMAEN | UCR1_TDMAEN | UCR1_ATDMAEN;
1216 writel(temp, sport->port.membase + UCR1);
1217
1218 temp = readl(sport->port.membase + UCR2);
1219 temp |= UCR2_ATEN;
1220 writel(temp, sport->port.membase + UCR2);
1221
1222 imx_setup_ufcr(sport, TXTL_DMA, RXTL_DMA);
1223
1224 sport->dma_is_enabled = 1;
1225}
1226
1227static void imx_disable_dma(struct imx_port *sport)
1228{
1229 unsigned long temp;
1230
1231
1232 temp = readl(sport->port.membase + UCR1);
1233 temp &= ~(UCR1_RDMAEN | UCR1_TDMAEN | UCR1_ATDMAEN);
1234 writel(temp, sport->port.membase + UCR1);
1235
1236
1237 temp = readl(sport->port.membase + UCR2);
1238 temp &= ~(UCR2_CTSC | UCR2_CTS | UCR2_ATEN);
1239 writel(temp, sport->port.membase + UCR2);
1240
1241 imx_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1242
1243 sport->dma_is_enabled = 0;
1244}
1245
1246
1247#define CTSTL 16
1248
1249static int imx_startup(struct uart_port *port)
1250{
1251 struct imx_port *sport = (struct imx_port *)port;
1252 int retval, i;
1253 unsigned long flags, temp;
1254
1255 retval = clk_prepare_enable(sport->clk_per);
1256 if (retval)
1257 return retval;
1258 retval = clk_prepare_enable(sport->clk_ipg);
1259 if (retval) {
1260 clk_disable_unprepare(sport->clk_per);
1261 return retval;
1262 }
1263
1264 imx_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1265
1266
1267
1268
1269 temp = readl(sport->port.membase + UCR4);
1270
1271
1272 temp &= ~(UCR4_CTSTL_MASK << UCR4_CTSTL_SHF);
1273 temp |= CTSTL << UCR4_CTSTL_SHF;
1274
1275 writel(temp & ~UCR4_DREN, sport->port.membase + UCR4);
1276
1277
1278 if (!uart_console(port) && !sport->dma_is_inited)
1279 imx_uart_dma_init(sport);
1280
1281 spin_lock_irqsave(&sport->port.lock, flags);
1282
1283 i = 100;
1284
1285 temp = readl(sport->port.membase + UCR2);
1286 temp &= ~UCR2_SRST;
1287 writel(temp, sport->port.membase + UCR2);
1288
1289 while (!(readl(sport->port.membase + UCR2) & UCR2_SRST) && (--i > 0))
1290 udelay(1);
1291
1292
1293
1294
1295 writel(USR1_RTSD | USR1_DTRD, sport->port.membase + USR1);
1296 writel(USR2_ORE, sport->port.membase + USR2);
1297
1298 if (sport->dma_is_inited && !sport->dma_is_enabled)
1299 imx_enable_dma(sport);
1300
1301 temp = readl(sport->port.membase + UCR1);
1302 temp |= UCR1_RRDYEN | UCR1_UARTEN;
1303 if (sport->have_rtscts)
1304 temp |= UCR1_RTSDEN;
1305
1306 writel(temp, sport->port.membase + UCR1);
1307
1308 temp = readl(sport->port.membase + UCR4);
1309 temp |= UCR4_OREN;
1310 writel(temp, sport->port.membase + UCR4);
1311
1312 temp = readl(sport->port.membase + UCR2);
1313 temp |= (UCR2_RXEN | UCR2_TXEN);
1314 if (!sport->have_rtscts)
1315 temp |= UCR2_IRTS;
1316
1317
1318
1319
1320 if (!is_imx1_uart(sport))
1321 temp &= ~UCR2_RTSEN;
1322 writel(temp, sport->port.membase + UCR2);
1323
1324 if (!is_imx1_uart(sport)) {
1325 temp = readl(sport->port.membase + UCR3);
1326
1327 temp |= UCR3_DTRDEN | UCR3_RI | UCR3_DCD;
1328
1329 if (sport->dte_mode)
1330
1331 temp &= ~(UCR3_RI | UCR3_DCD);
1332
1333 writel(temp, sport->port.membase + UCR3);
1334 }
1335
1336
1337
1338
1339 imx_enable_ms(&sport->port);
1340
1341
1342
1343
1344
1345
1346 if (sport->dma_is_enabled) {
1347 imx_disable_rx_int(sport);
1348 start_rx_dma(sport);
1349 }
1350
1351 spin_unlock_irqrestore(&sport->port.lock, flags);
1352
1353 return 0;
1354}
1355
1356static void imx_shutdown(struct uart_port *port)
1357{
1358 struct imx_port *sport = (struct imx_port *)port;
1359 unsigned long temp;
1360 unsigned long flags;
1361
1362 if (sport->dma_is_enabled) {
1363 sport->dma_is_rxing = 0;
1364 sport->dma_is_txing = 0;
1365 dmaengine_terminate_sync(sport->dma_chan_tx);
1366 dmaengine_terminate_sync(sport->dma_chan_rx);
1367
1368 spin_lock_irqsave(&sport->port.lock, flags);
1369 imx_stop_tx(port);
1370 imx_stop_rx(port);
1371 imx_disable_dma(sport);
1372 spin_unlock_irqrestore(&sport->port.lock, flags);
1373 imx_uart_dma_exit(sport);
1374 }
1375
1376 mctrl_gpio_disable_ms(sport->gpios);
1377
1378 spin_lock_irqsave(&sport->port.lock, flags);
1379 temp = readl(sport->port.membase + UCR2);
1380 temp &= ~(UCR2_TXEN);
1381 writel(temp, sport->port.membase + UCR2);
1382 spin_unlock_irqrestore(&sport->port.lock, flags);
1383
1384
1385
1386
1387 del_timer_sync(&sport->timer);
1388
1389
1390
1391
1392
1393 spin_lock_irqsave(&sport->port.lock, flags);
1394 temp = readl(sport->port.membase + UCR1);
1395 temp &= ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN | UCR1_UARTEN);
1396
1397 writel(temp, sport->port.membase + UCR1);
1398 spin_unlock_irqrestore(&sport->port.lock, flags);
1399
1400 clk_disable_unprepare(sport->clk_per);
1401 clk_disable_unprepare(sport->clk_ipg);
1402}
1403
1404static void imx_flush_buffer(struct uart_port *port)
1405{
1406 struct imx_port *sport = (struct imx_port *)port;
1407 struct scatterlist *sgl = &sport->tx_sgl[0];
1408 unsigned long temp;
1409 int i = 100, ubir, ubmr, uts;
1410
1411 if (!sport->dma_chan_tx)
1412 return;
1413
1414 sport->tx_bytes = 0;
1415 dmaengine_terminate_all(sport->dma_chan_tx);
1416 if (sport->dma_is_txing) {
1417 dma_unmap_sg(sport->port.dev, sgl, sport->dma_tx_nents,
1418 DMA_TO_DEVICE);
1419 temp = readl(sport->port.membase + UCR1);
1420 temp &= ~UCR1_TDMAEN;
1421 writel(temp, sport->port.membase + UCR1);
1422 sport->dma_is_txing = false;
1423 }
1424
1425
1426
1427
1428
1429
1430
1431
1432 ubir = readl(sport->port.membase + UBIR);
1433 ubmr = readl(sport->port.membase + UBMR);
1434 uts = readl(sport->port.membase + IMX21_UTS);
1435
1436 temp = readl(sport->port.membase + UCR2);
1437 temp &= ~UCR2_SRST;
1438 writel(temp, sport->port.membase + UCR2);
1439
1440 while (!(readl(sport->port.membase + UCR2) & UCR2_SRST) && (--i > 0))
1441 udelay(1);
1442
1443
1444 writel(ubir, sport->port.membase + UBIR);
1445 writel(ubmr, sport->port.membase + UBMR);
1446 writel(uts, sport->port.membase + IMX21_UTS);
1447}
1448
1449static void
1450imx_set_termios(struct uart_port *port, struct ktermios *termios,
1451 struct ktermios *old)
1452{
1453 struct imx_port *sport = (struct imx_port *)port;
1454 unsigned long flags;
1455 unsigned long ucr2, old_ucr1, old_ucr2;
1456 unsigned int baud, quot;
1457 unsigned int old_csize = old ? old->c_cflag & CSIZE : CS8;
1458 unsigned long div, ufcr;
1459 unsigned long num, denom;
1460 uint64_t tdiv64;
1461
1462
1463
1464
1465 while ((termios->c_cflag & CSIZE) != CS7 &&
1466 (termios->c_cflag & CSIZE) != CS8) {
1467 termios->c_cflag &= ~CSIZE;
1468 termios->c_cflag |= old_csize;
1469 old_csize = CS8;
1470 }
1471
1472 if ((termios->c_cflag & CSIZE) == CS8)
1473 ucr2 = UCR2_WS | UCR2_SRST | UCR2_IRTS;
1474 else
1475 ucr2 = UCR2_SRST | UCR2_IRTS;
1476
1477 if (termios->c_cflag & CRTSCTS) {
1478 if (sport->have_rtscts) {
1479 ucr2 &= ~UCR2_IRTS;
1480
1481 if (port->rs485.flags & SER_RS485_ENABLED) {
1482
1483
1484
1485
1486
1487 if (port->rs485.flags &
1488 SER_RS485_RTS_AFTER_SEND)
1489 imx_port_rts_active(sport, &ucr2);
1490 else
1491 imx_port_rts_inactive(sport, &ucr2);
1492 } else {
1493 imx_port_rts_auto(sport, &ucr2);
1494 }
1495 } else {
1496 termios->c_cflag &= ~CRTSCTS;
1497 }
1498 } else if (port->rs485.flags & SER_RS485_ENABLED) {
1499
1500 if (port->rs485.flags & SER_RS485_RTS_AFTER_SEND)
1501 imx_port_rts_active(sport, &ucr2);
1502 else
1503 imx_port_rts_inactive(sport, &ucr2);
1504 }
1505
1506
1507 if (termios->c_cflag & CSTOPB)
1508 ucr2 |= UCR2_STPB;
1509 if (termios->c_cflag & PARENB) {
1510 ucr2 |= UCR2_PREN;
1511 if (termios->c_cflag & PARODD)
1512 ucr2 |= UCR2_PROE;
1513 }
1514
1515 del_timer_sync(&sport->timer);
1516
1517
1518
1519
1520 baud = uart_get_baud_rate(port, termios, old, 50, port->uartclk / 16);
1521 quot = uart_get_divisor(port, baud);
1522
1523 spin_lock_irqsave(&sport->port.lock, flags);
1524
1525 sport->port.read_status_mask = 0;
1526 if (termios->c_iflag & INPCK)
1527 sport->port.read_status_mask |= (URXD_FRMERR | URXD_PRERR);
1528 if (termios->c_iflag & (BRKINT | PARMRK))
1529 sport->port.read_status_mask |= URXD_BRK;
1530
1531
1532
1533
1534 sport->port.ignore_status_mask = 0;
1535 if (termios->c_iflag & IGNPAR)
1536 sport->port.ignore_status_mask |= URXD_PRERR | URXD_FRMERR;
1537 if (termios->c_iflag & IGNBRK) {
1538 sport->port.ignore_status_mask |= URXD_BRK;
1539
1540
1541
1542
1543 if (termios->c_iflag & IGNPAR)
1544 sport->port.ignore_status_mask |= URXD_OVRRUN;
1545 }
1546
1547 if ((termios->c_cflag & CREAD) == 0)
1548 sport->port.ignore_status_mask |= URXD_DUMMY_READ;
1549
1550
1551
1552
1553 uart_update_timeout(port, termios->c_cflag, baud);
1554
1555
1556
1557
1558 old_ucr1 = readl(sport->port.membase + UCR1);
1559 writel(old_ucr1 & ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN),
1560 sport->port.membase + UCR1);
1561
1562 while (!(readl(sport->port.membase + USR2) & USR2_TXDC))
1563 barrier();
1564
1565
1566 old_ucr2 = readl(sport->port.membase + UCR2);
1567 writel(old_ucr2 & ~(UCR2_TXEN | UCR2_RXEN),
1568 sport->port.membase + UCR2);
1569 old_ucr2 &= (UCR2_TXEN | UCR2_RXEN | UCR2_ATEN);
1570
1571
1572 div = sport->port.uartclk / (baud * 16);
1573 if (baud == 38400 && quot != div)
1574 baud = sport->port.uartclk / (quot * 16);
1575
1576 div = sport->port.uartclk / (baud * 16);
1577 if (div > 7)
1578 div = 7;
1579 if (!div)
1580 div = 1;
1581
1582 rational_best_approximation(16 * div * baud, sport->port.uartclk,
1583 1 << 16, 1 << 16, &num, &denom);
1584
1585 tdiv64 = sport->port.uartclk;
1586 tdiv64 *= num;
1587 do_div(tdiv64, denom * 16 * div);
1588 tty_termios_encode_baud_rate(termios,
1589 (speed_t)tdiv64, (speed_t)tdiv64);
1590
1591 num -= 1;
1592 denom -= 1;
1593
1594 ufcr = readl(sport->port.membase + UFCR);
1595 ufcr = (ufcr & (~UFCR_RFDIV)) | UFCR_RFDIV_REG(div);
1596 writel(ufcr, sport->port.membase + UFCR);
1597
1598 writel(num, sport->port.membase + UBIR);
1599 writel(denom, sport->port.membase + UBMR);
1600
1601 if (!is_imx1_uart(sport))
1602 writel(sport->port.uartclk / div / 1000,
1603 sport->port.membase + IMX21_ONEMS);
1604
1605 writel(old_ucr1, sport->port.membase + UCR1);
1606
1607
1608 writel(ucr2 | old_ucr2, sport->port.membase + UCR2);
1609
1610 if (UART_ENABLE_MS(&sport->port, termios->c_cflag))
1611 imx_enable_ms(&sport->port);
1612
1613 spin_unlock_irqrestore(&sport->port.lock, flags);
1614}
1615
1616static const char *imx_type(struct uart_port *port)
1617{
1618 struct imx_port *sport = (struct imx_port *)port;
1619
1620 return sport->port.type == PORT_IMX ? "IMX" : NULL;
1621}
1622
1623
1624
1625
1626static void imx_config_port(struct uart_port *port, int flags)
1627{
1628 struct imx_port *sport = (struct imx_port *)port;
1629
1630 if (flags & UART_CONFIG_TYPE)
1631 sport->port.type = PORT_IMX;
1632}
1633
1634
1635
1636
1637
1638
1639static int
1640imx_verify_port(struct uart_port *port, struct serial_struct *ser)
1641{
1642 struct imx_port *sport = (struct imx_port *)port;
1643 int ret = 0;
1644
1645 if (ser->type != PORT_UNKNOWN && ser->type != PORT_IMX)
1646 ret = -EINVAL;
1647 if (sport->port.irq != ser->irq)
1648 ret = -EINVAL;
1649 if (ser->io_type != UPIO_MEM)
1650 ret = -EINVAL;
1651 if (sport->port.uartclk / 16 != ser->baud_base)
1652 ret = -EINVAL;
1653 if (sport->port.mapbase != (unsigned long)ser->iomem_base)
1654 ret = -EINVAL;
1655 if (sport->port.iobase != ser->port)
1656 ret = -EINVAL;
1657 if (ser->hub6 != 0)
1658 ret = -EINVAL;
1659 return ret;
1660}
1661
1662#if defined(CONFIG_CONSOLE_POLL)
1663
1664static int imx_poll_init(struct uart_port *port)
1665{
1666 struct imx_port *sport = (struct imx_port *)port;
1667 unsigned long flags;
1668 unsigned long temp;
1669 int retval;
1670
1671 retval = clk_prepare_enable(sport->clk_ipg);
1672 if (retval)
1673 return retval;
1674 retval = clk_prepare_enable(sport->clk_per);
1675 if (retval)
1676 clk_disable_unprepare(sport->clk_ipg);
1677
1678 imx_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1679
1680 spin_lock_irqsave(&sport->port.lock, flags);
1681
1682 temp = readl(sport->port.membase + UCR1);
1683 if (is_imx1_uart(sport))
1684 temp |= IMX1_UCR1_UARTCLKEN;
1685 temp |= UCR1_UARTEN | UCR1_RRDYEN;
1686 temp &= ~(UCR1_TXMPTYEN | UCR1_RTSDEN);
1687 writel(temp, sport->port.membase + UCR1);
1688
1689 temp = readl(sport->port.membase + UCR2);
1690 temp |= UCR2_RXEN;
1691 writel(temp, sport->port.membase + UCR2);
1692
1693 spin_unlock_irqrestore(&sport->port.lock, flags);
1694
1695 return 0;
1696}
1697
1698static int imx_poll_get_char(struct uart_port *port)
1699{
1700 if (!(readl_relaxed(port->membase + USR2) & USR2_RDR))
1701 return NO_POLL_CHAR;
1702
1703 return readl_relaxed(port->membase + URXD0) & URXD_RX_DATA;
1704}
1705
1706static void imx_poll_put_char(struct uart_port *port, unsigned char c)
1707{
1708 unsigned int status;
1709
1710
1711 do {
1712 status = readl_relaxed(port->membase + USR1);
1713 } while (~status & USR1_TRDY);
1714
1715
1716 writel_relaxed(c, port->membase + URTX0);
1717
1718
1719 do {
1720 status = readl_relaxed(port->membase + USR2);
1721 } while (~status & USR2_TXDC);
1722}
1723#endif
1724
1725static int imx_rs485_config(struct uart_port *port,
1726 struct serial_rs485 *rs485conf)
1727{
1728 struct imx_port *sport = (struct imx_port *)port;
1729 unsigned long temp;
1730
1731
1732 rs485conf->delay_rts_before_send = 0;
1733 rs485conf->delay_rts_after_send = 0;
1734
1735
1736 if (!sport->have_rtscts && !sport->have_rtsgpio)
1737 rs485conf->flags &= ~SER_RS485_ENABLED;
1738
1739 if (rs485conf->flags & SER_RS485_ENABLED) {
1740
1741 temp = readl(sport->port.membase + UCR2);
1742 if (rs485conf->flags & SER_RS485_RTS_AFTER_SEND)
1743 imx_port_rts_active(sport, &temp);
1744 else
1745 imx_port_rts_inactive(sport, &temp);
1746 writel(temp, sport->port.membase + UCR2);
1747 }
1748
1749
1750 if (!(rs485conf->flags & SER_RS485_ENABLED) ||
1751 rs485conf->flags & SER_RS485_RX_DURING_TX) {
1752 temp = readl(sport->port.membase + UCR2);
1753 temp |= UCR2_RXEN;
1754 writel(temp, sport->port.membase + UCR2);
1755 }
1756
1757 port->rs485 = *rs485conf;
1758
1759 return 0;
1760}
1761
1762static const struct uart_ops imx_pops = {
1763 .tx_empty = imx_tx_empty,
1764 .set_mctrl = imx_set_mctrl,
1765 .get_mctrl = imx_get_mctrl,
1766 .stop_tx = imx_stop_tx,
1767 .start_tx = imx_start_tx,
1768 .stop_rx = imx_stop_rx,
1769 .enable_ms = imx_enable_ms,
1770 .break_ctl = imx_break_ctl,
1771 .startup = imx_startup,
1772 .shutdown = imx_shutdown,
1773 .flush_buffer = imx_flush_buffer,
1774 .set_termios = imx_set_termios,
1775 .type = imx_type,
1776 .config_port = imx_config_port,
1777 .verify_port = imx_verify_port,
1778#if defined(CONFIG_CONSOLE_POLL)
1779 .poll_init = imx_poll_init,
1780 .poll_get_char = imx_poll_get_char,
1781 .poll_put_char = imx_poll_put_char,
1782#endif
1783};
1784
1785static struct imx_port *imx_ports[UART_NR];
1786
1787#ifdef CONFIG_SERIAL_IMX_CONSOLE
1788static void imx_console_putchar(struct uart_port *port, int ch)
1789{
1790 struct imx_port *sport = (struct imx_port *)port;
1791
1792 while (readl(sport->port.membase + uts_reg(sport)) & UTS_TXFULL)
1793 barrier();
1794
1795 writel(ch, sport->port.membase + URTX0);
1796}
1797
1798
1799
1800
1801static void
1802imx_console_write(struct console *co, const char *s, unsigned int count)
1803{
1804 struct imx_port *sport = imx_ports[co->index];
1805 struct imx_port_ucrs old_ucr;
1806 unsigned int ucr1;
1807 unsigned long flags = 0;
1808 int locked = 1;
1809 int retval;
1810
1811 retval = clk_enable(sport->clk_per);
1812 if (retval)
1813 return;
1814 retval = clk_enable(sport->clk_ipg);
1815 if (retval) {
1816 clk_disable(sport->clk_per);
1817 return;
1818 }
1819
1820 if (sport->port.sysrq)
1821 locked = 0;
1822 else if (oops_in_progress)
1823 locked = spin_trylock_irqsave(&sport->port.lock, flags);
1824 else
1825 spin_lock_irqsave(&sport->port.lock, flags);
1826
1827
1828
1829
1830 imx_port_ucrs_save(&sport->port, &old_ucr);
1831 ucr1 = old_ucr.ucr1;
1832
1833 if (is_imx1_uart(sport))
1834 ucr1 |= IMX1_UCR1_UARTCLKEN;
1835 ucr1 |= UCR1_UARTEN;
1836 ucr1 &= ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN);
1837
1838 writel(ucr1, sport->port.membase + UCR1);
1839
1840 writel(old_ucr.ucr2 | UCR2_TXEN, sport->port.membase + UCR2);
1841
1842 uart_console_write(&sport->port, s, count, imx_console_putchar);
1843
1844
1845
1846
1847
1848 while (!(readl(sport->port.membase + USR2) & USR2_TXDC));
1849
1850 imx_port_ucrs_restore(&sport->port, &old_ucr);
1851
1852 if (locked)
1853 spin_unlock_irqrestore(&sport->port.lock, flags);
1854
1855 clk_disable(sport->clk_ipg);
1856 clk_disable(sport->clk_per);
1857}
1858
1859
1860
1861
1862
1863static void __init
1864imx_console_get_options(struct imx_port *sport, int *baud,
1865 int *parity, int *bits)
1866{
1867
1868 if (readl(sport->port.membase + UCR1) & UCR1_UARTEN) {
1869
1870 unsigned int ucr2, ubir, ubmr, uartclk;
1871 unsigned int baud_raw;
1872 unsigned int ucfr_rfdiv;
1873
1874 ucr2 = readl(sport->port.membase + UCR2);
1875
1876 *parity = 'n';
1877 if (ucr2 & UCR2_PREN) {
1878 if (ucr2 & UCR2_PROE)
1879 *parity = 'o';
1880 else
1881 *parity = 'e';
1882 }
1883
1884 if (ucr2 & UCR2_WS)
1885 *bits = 8;
1886 else
1887 *bits = 7;
1888
1889 ubir = readl(sport->port.membase + UBIR) & 0xffff;
1890 ubmr = readl(sport->port.membase + UBMR) & 0xffff;
1891
1892 ucfr_rfdiv = (readl(sport->port.membase + UFCR) & UFCR_RFDIV) >> 7;
1893 if (ucfr_rfdiv == 6)
1894 ucfr_rfdiv = 7;
1895 else
1896 ucfr_rfdiv = 6 - ucfr_rfdiv;
1897
1898 uartclk = clk_get_rate(sport->clk_per);
1899 uartclk /= ucfr_rfdiv;
1900
1901 {
1902
1903
1904
1905
1906
1907 unsigned int mul = ubir + 1;
1908 unsigned int div = 16 * (ubmr + 1);
1909 unsigned int rem = uartclk % div;
1910
1911 baud_raw = (uartclk / div) * mul;
1912 baud_raw += (rem * mul + div / 2) / div;
1913 *baud = (baud_raw + 50) / 100 * 100;
1914 }
1915
1916 if (*baud != baud_raw)
1917 pr_info("Console IMX rounded baud rate from %d to %d\n",
1918 baud_raw, *baud);
1919 }
1920}
1921
1922static int __init
1923imx_console_setup(struct console *co, char *options)
1924{
1925 struct imx_port *sport;
1926 int baud = 9600;
1927 int bits = 8;
1928 int parity = 'n';
1929 int flow = 'n';
1930 int retval;
1931
1932
1933
1934
1935
1936
1937 if (co->index == -1 || co->index >= ARRAY_SIZE(imx_ports))
1938 co->index = 0;
1939 sport = imx_ports[co->index];
1940 if (sport == NULL)
1941 return -ENODEV;
1942
1943
1944 retval = clk_prepare_enable(sport->clk_ipg);
1945 if (retval)
1946 goto error_console;
1947
1948 if (options)
1949 uart_parse_options(options, &baud, &parity, &bits, &flow);
1950 else
1951 imx_console_get_options(sport, &baud, &parity, &bits);
1952
1953 imx_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1954
1955 retval = uart_set_options(&sport->port, co, baud, parity, bits, flow);
1956
1957 clk_disable(sport->clk_ipg);
1958 if (retval) {
1959 clk_unprepare(sport->clk_ipg);
1960 goto error_console;
1961 }
1962
1963 retval = clk_prepare(sport->clk_per);
1964 if (retval)
1965 clk_disable_unprepare(sport->clk_ipg);
1966
1967error_console:
1968 return retval;
1969}
1970
1971static struct uart_driver imx_reg;
1972static struct console imx_console = {
1973 .name = DEV_NAME,
1974 .write = imx_console_write,
1975 .device = uart_console_device,
1976 .setup = imx_console_setup,
1977 .flags = CON_PRINTBUFFER,
1978 .index = -1,
1979 .data = &imx_reg,
1980};
1981
1982#define IMX_CONSOLE &imx_console
1983
1984#ifdef CONFIG_OF
1985static void imx_console_early_putchar(struct uart_port *port, int ch)
1986{
1987 while (readl_relaxed(port->membase + IMX21_UTS) & UTS_TXFULL)
1988 cpu_relax();
1989
1990 writel_relaxed(ch, port->membase + URTX0);
1991}
1992
1993static void imx_console_early_write(struct console *con, const char *s,
1994 unsigned count)
1995{
1996 struct earlycon_device *dev = con->data;
1997
1998 uart_console_write(&dev->port, s, count, imx_console_early_putchar);
1999}
2000
2001static int __init
2002imx_console_early_setup(struct earlycon_device *dev, const char *opt)
2003{
2004 if (!dev->port.membase)
2005 return -ENODEV;
2006
2007 dev->con->write = imx_console_early_write;
2008
2009 return 0;
2010}
2011OF_EARLYCON_DECLARE(ec_imx6q, "fsl,imx6q-uart", imx_console_early_setup);
2012OF_EARLYCON_DECLARE(ec_imx21, "fsl,imx21-uart", imx_console_early_setup);
2013#endif
2014
2015#else
2016#define IMX_CONSOLE NULL
2017#endif
2018
2019static struct uart_driver imx_reg = {
2020 .owner = THIS_MODULE,
2021 .driver_name = DRIVER_NAME,
2022 .dev_name = DEV_NAME,
2023 .major = SERIAL_IMX_MAJOR,
2024 .minor = MINOR_START,
2025 .nr = ARRAY_SIZE(imx_ports),
2026 .cons = IMX_CONSOLE,
2027};
2028
2029#ifdef CONFIG_OF
2030
2031
2032
2033
2034static int serial_imx_probe_dt(struct imx_port *sport,
2035 struct platform_device *pdev)
2036{
2037 struct device_node *np = pdev->dev.of_node;
2038 int ret;
2039
2040 sport->devdata = of_device_get_match_data(&pdev->dev);
2041 if (!sport->devdata)
2042
2043 return 1;
2044
2045 ret = of_alias_get_id(np, "serial");
2046 if (ret < 0) {
2047 dev_err(&pdev->dev, "failed to get alias id, errno %d\n", ret);
2048 return ret;
2049 }
2050 sport->port.line = ret;
2051
2052 if (of_get_property(np, "uart-has-rtscts", NULL) ||
2053 of_get_property(np, "fsl,uart-has-rtscts", NULL) )
2054 sport->have_rtscts = 1;
2055
2056 if (of_get_property(np, "fsl,dte-mode", NULL))
2057 sport->dte_mode = 1;
2058
2059 if (of_get_property(np, "rts-gpios", NULL))
2060 sport->have_rtsgpio = 1;
2061
2062 return 0;
2063}
2064#else
2065static inline int serial_imx_probe_dt(struct imx_port *sport,
2066 struct platform_device *pdev)
2067{
2068 return 1;
2069}
2070#endif
2071
2072static void serial_imx_probe_pdata(struct imx_port *sport,
2073 struct platform_device *pdev)
2074{
2075 struct imxuart_platform_data *pdata = dev_get_platdata(&pdev->dev);
2076
2077 sport->port.line = pdev->id;
2078 sport->devdata = (struct imx_uart_data *) pdev->id_entry->driver_data;
2079
2080 if (!pdata)
2081 return;
2082
2083 if (pdata->flags & IMXUART_HAVE_RTSCTS)
2084 sport->have_rtscts = 1;
2085}
2086
2087static int serial_imx_probe(struct platform_device *pdev)
2088{
2089 struct imx_port *sport;
2090 void __iomem *base;
2091 int ret = 0, reg;
2092 struct resource *res;
2093 int txirq, rxirq, rtsirq;
2094
2095 sport = devm_kzalloc(&pdev->dev, sizeof(*sport), GFP_KERNEL);
2096 if (!sport)
2097 return -ENOMEM;
2098
2099 ret = serial_imx_probe_dt(sport, pdev);
2100 if (ret > 0)
2101 serial_imx_probe_pdata(sport, pdev);
2102 else if (ret < 0)
2103 return ret;
2104
2105 res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2106 base = devm_ioremap_resource(&pdev->dev, res);
2107 if (IS_ERR(base))
2108 return PTR_ERR(base);
2109
2110 rxirq = platform_get_irq(pdev, 0);
2111 txirq = platform_get_irq(pdev, 1);
2112 rtsirq = platform_get_irq(pdev, 2);
2113
2114 sport->port.dev = &pdev->dev;
2115 sport->port.mapbase = res->start;
2116 sport->port.membase = base;
2117 sport->port.type = PORT_IMX,
2118 sport->port.iotype = UPIO_MEM;
2119 sport->port.irq = rxirq;
2120 sport->port.fifosize = 32;
2121 sport->port.ops = &imx_pops;
2122 sport->port.rs485_config = imx_rs485_config;
2123 sport->port.rs485.flags =
2124 SER_RS485_RTS_ON_SEND | SER_RS485_RX_DURING_TX;
2125 sport->port.flags = UPF_BOOT_AUTOCONF;
2126 init_timer(&sport->timer);
2127 sport->timer.function = imx_timeout;
2128 sport->timer.data = (unsigned long)sport;
2129
2130 sport->gpios = mctrl_gpio_init(&sport->port, 0);
2131 if (IS_ERR(sport->gpios))
2132 return PTR_ERR(sport->gpios);
2133
2134 sport->clk_ipg = devm_clk_get(&pdev->dev, "ipg");
2135 if (IS_ERR(sport->clk_ipg)) {
2136 ret = PTR_ERR(sport->clk_ipg);
2137 dev_err(&pdev->dev, "failed to get ipg clk: %d\n", ret);
2138 return ret;
2139 }
2140
2141 sport->clk_per = devm_clk_get(&pdev->dev, "per");
2142 if (IS_ERR(sport->clk_per)) {
2143 ret = PTR_ERR(sport->clk_per);
2144 dev_err(&pdev->dev, "failed to get per clk: %d\n", ret);
2145 return ret;
2146 }
2147
2148 sport->port.uartclk = clk_get_rate(sport->clk_per);
2149
2150
2151 ret = clk_prepare_enable(sport->clk_ipg);
2152 if (ret) {
2153 dev_err(&pdev->dev, "failed to enable per clk: %d\n", ret);
2154 return ret;
2155 }
2156
2157
2158 reg = readl_relaxed(sport->port.membase + UCR1);
2159 reg &= ~(UCR1_ADEN | UCR1_TRDYEN | UCR1_IDEN | UCR1_RRDYEN |
2160 UCR1_TXMPTYEN | UCR1_RTSDEN);
2161 writel_relaxed(reg, sport->port.membase + UCR1);
2162
2163 if (!is_imx1_uart(sport) && sport->dte_mode) {
2164
2165
2166
2167
2168
2169
2170 reg = readl(sport->port.membase + UFCR);
2171 if (!(reg & UFCR_DCEDTE))
2172 writel(reg | UFCR_DCEDTE, sport->port.membase + UFCR);
2173
2174
2175
2176
2177
2178
2179 writel(IMX21_UCR3_RXDMUXSEL | UCR3_ADNIMP | UCR3_DSR,
2180 sport->port.membase + UCR3);
2181
2182 } else {
2183 unsigned long ucr3 = UCR3_DSR;
2184
2185 reg = readl(sport->port.membase + UFCR);
2186 if (reg & UFCR_DCEDTE)
2187 writel(reg & ~UFCR_DCEDTE, sport->port.membase + UFCR);
2188
2189 if (!is_imx1_uart(sport))
2190 ucr3 |= IMX21_UCR3_RXDMUXSEL | UCR3_ADNIMP;
2191 writel(ucr3, sport->port.membase + UCR3);
2192 }
2193
2194 clk_disable_unprepare(sport->clk_ipg);
2195
2196
2197
2198
2199
2200 if (txirq > 0) {
2201 ret = devm_request_irq(&pdev->dev, rxirq, imx_rxint, 0,
2202 dev_name(&pdev->dev), sport);
2203 if (ret) {
2204 dev_err(&pdev->dev, "failed to request rx irq: %d\n",
2205 ret);
2206 return ret;
2207 }
2208
2209 ret = devm_request_irq(&pdev->dev, txirq, imx_txint, 0,
2210 dev_name(&pdev->dev), sport);
2211 if (ret) {
2212 dev_err(&pdev->dev, "failed to request tx irq: %d\n",
2213 ret);
2214 return ret;
2215 }
2216 } else {
2217 ret = devm_request_irq(&pdev->dev, rxirq, imx_int, 0,
2218 dev_name(&pdev->dev), sport);
2219 if (ret) {
2220 dev_err(&pdev->dev, "failed to request irq: %d\n", ret);
2221 return ret;
2222 }
2223 }
2224
2225 imx_ports[sport->port.line] = sport;
2226
2227 platform_set_drvdata(pdev, sport);
2228
2229 return uart_add_one_port(&imx_reg, &sport->port);
2230}
2231
2232static int serial_imx_remove(struct platform_device *pdev)
2233{
2234 struct imx_port *sport = platform_get_drvdata(pdev);
2235
2236 return uart_remove_one_port(&imx_reg, &sport->port);
2237}
2238
2239static void serial_imx_restore_context(struct imx_port *sport)
2240{
2241 if (!sport->context_saved)
2242 return;
2243
2244 writel(sport->saved_reg[4], sport->port.membase + UFCR);
2245 writel(sport->saved_reg[5], sport->port.membase + UESC);
2246 writel(sport->saved_reg[6], sport->port.membase + UTIM);
2247 writel(sport->saved_reg[7], sport->port.membase + UBIR);
2248 writel(sport->saved_reg[8], sport->port.membase + UBMR);
2249 writel(sport->saved_reg[9], sport->port.membase + IMX21_UTS);
2250 writel(sport->saved_reg[0], sport->port.membase + UCR1);
2251 writel(sport->saved_reg[1] | UCR2_SRST, sport->port.membase + UCR2);
2252 writel(sport->saved_reg[2], sport->port.membase + UCR3);
2253 writel(sport->saved_reg[3], sport->port.membase + UCR4);
2254 sport->context_saved = false;
2255}
2256
2257static void serial_imx_save_context(struct imx_port *sport)
2258{
2259
2260 sport->saved_reg[0] = readl(sport->port.membase + UCR1);
2261 sport->saved_reg[1] = readl(sport->port.membase + UCR2);
2262 sport->saved_reg[2] = readl(sport->port.membase + UCR3);
2263 sport->saved_reg[3] = readl(sport->port.membase + UCR4);
2264 sport->saved_reg[4] = readl(sport->port.membase + UFCR);
2265 sport->saved_reg[5] = readl(sport->port.membase + UESC);
2266 sport->saved_reg[6] = readl(sport->port.membase + UTIM);
2267 sport->saved_reg[7] = readl(sport->port.membase + UBIR);
2268 sport->saved_reg[8] = readl(sport->port.membase + UBMR);
2269 sport->saved_reg[9] = readl(sport->port.membase + IMX21_UTS);
2270 sport->context_saved = true;
2271}
2272
2273static void serial_imx_enable_wakeup(struct imx_port *sport, bool on)
2274{
2275 unsigned int val;
2276
2277 val = readl(sport->port.membase + UCR3);
2278 if (on)
2279 val |= UCR3_AWAKEN;
2280 else
2281 val &= ~UCR3_AWAKEN;
2282 writel(val, sport->port.membase + UCR3);
2283
2284 val = readl(sport->port.membase + UCR1);
2285 if (on)
2286 val |= UCR1_RTSDEN;
2287 else
2288 val &= ~UCR1_RTSDEN;
2289 writel(val, sport->port.membase + UCR1);
2290}
2291
2292static int imx_serial_port_suspend_noirq(struct device *dev)
2293{
2294 struct platform_device *pdev = to_platform_device(dev);
2295 struct imx_port *sport = platform_get_drvdata(pdev);
2296 int ret;
2297
2298 ret = clk_enable(sport->clk_ipg);
2299 if (ret)
2300 return ret;
2301
2302 serial_imx_save_context(sport);
2303
2304 clk_disable(sport->clk_ipg);
2305
2306 return 0;
2307}
2308
2309static int imx_serial_port_resume_noirq(struct device *dev)
2310{
2311 struct platform_device *pdev = to_platform_device(dev);
2312 struct imx_port *sport = platform_get_drvdata(pdev);
2313 int ret;
2314
2315 ret = clk_enable(sport->clk_ipg);
2316 if (ret)
2317 return ret;
2318
2319 serial_imx_restore_context(sport);
2320
2321 clk_disable(sport->clk_ipg);
2322
2323 return 0;
2324}
2325
2326static int imx_serial_port_suspend(struct device *dev)
2327{
2328 struct platform_device *pdev = to_platform_device(dev);
2329 struct imx_port *sport = platform_get_drvdata(pdev);
2330
2331
2332 serial_imx_enable_wakeup(sport, true);
2333
2334 uart_suspend_port(&imx_reg, &sport->port);
2335
2336
2337 return clk_prepare(sport->clk_ipg);
2338}
2339
2340static int imx_serial_port_resume(struct device *dev)
2341{
2342 struct platform_device *pdev = to_platform_device(dev);
2343 struct imx_port *sport = platform_get_drvdata(pdev);
2344
2345
2346 serial_imx_enable_wakeup(sport, false);
2347
2348 uart_resume_port(&imx_reg, &sport->port);
2349
2350 clk_unprepare(sport->clk_ipg);
2351
2352 return 0;
2353}
2354
2355static const struct dev_pm_ops imx_serial_port_pm_ops = {
2356 .suspend_noirq = imx_serial_port_suspend_noirq,
2357 .resume_noirq = imx_serial_port_resume_noirq,
2358 .suspend = imx_serial_port_suspend,
2359 .resume = imx_serial_port_resume,
2360};
2361
2362static struct platform_driver serial_imx_driver = {
2363 .probe = serial_imx_probe,
2364 .remove = serial_imx_remove,
2365
2366 .id_table = imx_uart_devtype,
2367 .driver = {
2368 .name = "imx-uart",
2369 .of_match_table = imx_uart_dt_ids,
2370 .pm = &imx_serial_port_pm_ops,
2371 },
2372};
2373
2374static int __init imx_serial_init(void)
2375{
2376 int ret = uart_register_driver(&imx_reg);
2377
2378 if (ret)
2379 return ret;
2380
2381 ret = platform_driver_register(&serial_imx_driver);
2382 if (ret != 0)
2383 uart_unregister_driver(&imx_reg);
2384
2385 return ret;
2386}
2387
2388static void __exit imx_serial_exit(void)
2389{
2390 platform_driver_unregister(&serial_imx_driver);
2391 uart_unregister_driver(&imx_reg);
2392}
2393
2394module_init(imx_serial_init);
2395module_exit(imx_serial_exit);
2396
2397MODULE_AUTHOR("Sascha Hauer");
2398MODULE_DESCRIPTION("IMX generic serial port driver");
2399MODULE_LICENSE("GPL");
2400MODULE_ALIAS("platform:imx-uart");
2401