Linux Audio

Check our new training course

Loading...
v4.6
 
   1/*
   2 * Driver for Motorola/Freescale IMX serial ports
   3 *
   4 * Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
   5 *
   6 * Author: Sascha Hauer <sascha@saschahauer.de>
   7 * Copyright (C) 2004 Pengutronix
   8 *
   9 * This program is free software; you can redistribute it and/or modify
  10 * it under the terms of the GNU General Public License as published by
  11 * the Free Software Foundation; either version 2 of the License, or
  12 * (at your option) any later version.
  13 *
  14 * This program is distributed in the hope that it will be useful,
  15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17 * GNU General Public License for more details.
  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/* Register definitions */
  50#define URXD0 0x0  /* Receiver Register */
  51#define URTX0 0x40 /* Transmitter Register */
  52#define UCR1  0x80 /* Control Register 1 */
  53#define UCR2  0x84 /* Control Register 2 */
  54#define UCR3  0x88 /* Control Register 3 */
  55#define UCR4  0x8c /* Control Register 4 */
  56#define UFCR  0x90 /* FIFO Control Register */
  57#define USR1  0x94 /* Status Register 1 */
  58#define USR2  0x98 /* Status Register 2 */
  59#define UESC  0x9c /* Escape Character Register */
  60#define UTIM  0xa0 /* Escape Timer Register */
  61#define UBIR  0xa4 /* BRM Incremental Register */
  62#define UBMR  0xa8 /* BRM Modulator Register */
  63#define UBRC  0xac /* Baud Rate Count Register */
  64#define IMX21_ONEMS 0xb0 /* One Millisecond register */
  65#define IMX1_UTS 0xd0 /* UART Test Register on i.mx1 */
  66#define IMX21_UTS 0xb4 /* UART Test Register on all other i.mx*/
  67
  68/* UART Control Register Bit Fields.*/
  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) /* Auto detect interrupt */
  78#define UCR1_ADBR	(1<<14) /* Auto detect baud rate */
  79#define UCR1_TRDYEN	(1<<13) /* Transmitter ready interrupt enable */
  80#define UCR1_IDEN	(1<<12) /* Idle condition interrupt */
  81#define UCR1_ICD_REG(x) (((x) & 3) << 10) /* idle condition detect */
  82#define UCR1_RRDYEN	(1<<9)	/* Recv ready interrupt enable */
  83#define UCR1_RDMAEN	(1<<8)	/* Recv ready DMA enable */
  84#define UCR1_IREN	(1<<7)	/* Infrared interface enable */
  85#define UCR1_TXMPTYEN	(1<<6)	/* Transimitter empty interrupt enable */
  86#define UCR1_RTSDEN	(1<<5)	/* RTS delta interrupt enable */
  87#define UCR1_SNDBRK	(1<<4)	/* Send break */
  88#define UCR1_TDMAEN	(1<<3)	/* Transmitter ready DMA enable */
  89#define IMX1_UCR1_UARTCLKEN (1<<2) /* UART clock enabled, i.mx1 only */
  90#define UCR1_ATDMAEN    (1<<2)  /* Aging DMA Timer Enable */
  91#define UCR1_DOZE	(1<<1)	/* Doze */
  92#define UCR1_UARTEN	(1<<0)	/* UART enabled */
  93#define UCR2_ESCI	(1<<15)	/* Escape seq interrupt enable */
  94#define UCR2_IRTS	(1<<14)	/* Ignore RTS pin */
  95#define UCR2_CTSC	(1<<13)	/* CTS pin control */
  96#define UCR2_CTS	(1<<12)	/* Clear to send */
  97#define UCR2_ESCEN	(1<<11)	/* Escape enable */
  98#define UCR2_PREN	(1<<8)	/* Parity enable */
  99#define UCR2_PROE	(1<<7)	/* Parity odd/even */
 100#define UCR2_STPB	(1<<6)	/* Stop */
 101#define UCR2_WS		(1<<5)	/* Word size */
 102#define UCR2_RTSEN	(1<<4)	/* Request to send interrupt enable */
 103#define UCR2_ATEN	(1<<3)	/* Aging Timer Enable */
 104#define UCR2_TXEN	(1<<2)	/* Transmitter enabled */
 105#define UCR2_RXEN	(1<<1)	/* Receiver enabled */
 106#define UCR2_SRST	(1<<0)	/* SW reset */
 107#define UCR3_DTREN	(1<<13) /* DTR interrupt enable */
 108#define UCR3_PARERREN	(1<<12) /* Parity enable */
 109#define UCR3_FRAERREN	(1<<11) /* Frame error interrupt enable */
 110#define UCR3_DSR	(1<<10) /* Data set ready */
 111#define UCR3_DCD	(1<<9)	/* Data carrier detect */
 112#define UCR3_RI		(1<<8)	/* Ring indicator */
 113#define UCR3_ADNIMP	(1<<7)	/* Autobaud Detection Not Improved */
 114#define UCR3_RXDSEN	(1<<6)	/* Receive status interrupt enable */
 115#define UCR3_AIRINTEN	(1<<5)	/* Async IR wake interrupt enable */
 116#define UCR3_AWAKEN	(1<<4)	/* Async wake interrupt enable */
 
 117#define IMX21_UCR3_RXDMUXSEL	(1<<2)	/* RXD Muxed Input Select */
 118#define UCR3_INVT	(1<<1)	/* Inverted Infrared transmission */
 119#define UCR3_BPEN	(1<<0)	/* Preset registers enable */
 120#define UCR4_CTSTL_SHF	10	/* CTS trigger level shift */
 121#define UCR4_CTSTL_MASK	0x3F	/* CTS trigger is 6 bits wide */
 122#define UCR4_INVR	(1<<9)	/* Inverted infrared reception */
 123#define UCR4_ENIRI	(1<<8)	/* Serial infrared interrupt enable */
 124#define UCR4_WKEN	(1<<7)	/* Wake interrupt enable */
 125#define UCR4_REF16	(1<<6)	/* Ref freq 16 MHz */
 126#define UCR4_IDDMAEN    (1<<6)  /* DMA IDLE Condition Detected */
 127#define UCR4_IRSC	(1<<5)	/* IR special case */
 128#define UCR4_TCEN	(1<<3)	/* Transmit complete interrupt enable */
 129#define UCR4_BKEN	(1<<2)	/* Break condition interrupt enable */
 130#define UCR4_OREN	(1<<1)	/* Receiver overrun interrupt enable */
 131#define UCR4_DREN	(1<<0)	/* Recv data ready interrupt enable */
 132#define UFCR_RXTL_SHF	0	/* Receiver trigger level shift */
 133#define UFCR_DCEDTE	(1<<6)	/* DCE/DTE mode select */
 134#define UFCR_RFDIV	(7<<7)	/* Reference freq divider mask */
 135#define UFCR_RFDIV_REG(x)	(((x) < 7 ? 6 - (x) : 6) << 7)
 136#define UFCR_TXTL_SHF	10	/* Transmitter trigger level shift */
 137#define USR1_PARITYERR	(1<<15) /* Parity error interrupt flag */
 138#define USR1_RTSS	(1<<14) /* RTS pin status */
 139#define USR1_TRDY	(1<<13) /* Transmitter ready interrupt/dma flag */
 140#define USR1_RTSD	(1<<12) /* RTS delta */
 141#define USR1_ESCF	(1<<11) /* Escape seq interrupt flag */
 142#define USR1_FRAMERR	(1<<10) /* Frame error interrupt flag */
 143#define USR1_RRDY	(1<<9)	 /* Receiver ready interrupt/dma flag */
 144#define USR1_AGTIM	(1<<8)	 /* Ageing timer interrupt flag */
 145#define USR1_TIMEOUT	(1<<7)	 /* Receive timeout interrupt status */
 146#define USR1_RXDS	 (1<<6)	 /* Receiver idle interrupt flag */
 147#define USR1_AIRINT	 (1<<5)	 /* Async IR wake interrupt flag */
 148#define USR1_AWAKE	 (1<<4)	 /* Aysnc wake interrupt flag */
 149#define USR2_ADET	 (1<<15) /* Auto baud rate detect complete */
 150#define USR2_TXFE	 (1<<14) /* Transmit buffer FIFO empty */
 151#define USR2_DTRF	 (1<<13) /* DTR edge interrupt flag */
 152#define USR2_IDLE	 (1<<12) /* Idle condition */
 153#define USR2_RIDELT	 (1<<10) /* Ring Interrupt Delta */
 154#define USR2_RIIN	 (1<<9)	 /* Ring Indicator Input */
 155#define USR2_IRINT	 (1<<8)	 /* Serial infrared interrupt flag */
 156#define USR2_WAKE	 (1<<7)	 /* Wake */
 157#define USR2_DCDIN	 (1<<5)	 /* Data Carrier Detect Input */
 158#define USR2_RTSF	 (1<<4)	 /* RTS edge interrupt flag */
 159#define USR2_TXDC	 (1<<3)	 /* Transmitter complete */
 160#define USR2_BRCD	 (1<<2)	 /* Break condition */
 161#define USR2_ORE	(1<<1)	 /* Overrun error */
 162#define USR2_RDR	(1<<0)	 /* Recv data ready */
 163#define UTS_FRCPERR	(1<<13) /* Force parity error */
 164#define UTS_LOOP	(1<<12)	 /* Loop tx and rx */
 165#define UTS_TXEMPTY	 (1<<6)	 /* TxFIFO empty */
 166#define UTS_RXEMPTY	 (1<<5)	 /* RxFIFO empty */
 167#define UTS_TXFULL	 (1<<4)	 /* TxFIFO full */
 168#define UTS_RXFULL	 (1<<3)	 /* RxFIFO full */
 169#define UTS_SOFTRST	 (1<<0)	 /* Software reset */
 170
 171/* We've been assigned a range on the "Low-density serial ports" major */
 172#define SERIAL_IMX_MAJOR	207
 173#define MINOR_START		16
 174#define DEV_NAME		"ttymxc"
 175
 176/*
 177 * This determines how often we check the modem status signals
 178 * for any change.  They generally aren't connected to an IRQ
 179 * so we have to poll them.  We also check immediately before
 180 * filling the TX fifo incase CTS has been dropped.
 181 */
 182#define MCTRL_TIMEOUT	(250*HZ/1000)
 183
 184#define DRIVER_NAME "IMX-uart"
 185
 186#define UART_NR 8
 187
 188/* i.MX21 type uart runs on all i.mx except i.MX1 and i.MX6q */
 189enum imx_uart_type {
 190	IMX1_UART,
 191	IMX21_UART,
 
 192	IMX6Q_UART,
 193};
 194
 195/* device type dependent stuff */
 196struct imx_uart_data {
 197	unsigned uts_reg;
 198	enum imx_uart_type devtype;
 199};
 200
 
 
 
 
 
 
 
 201struct imx_port {
 202	struct uart_port	port;
 203	struct timer_list	timer;
 204	unsigned int		old_status;
 205	unsigned int		have_rtscts:1;
 
 206	unsigned int		dte_mode:1;
 207	unsigned int		irda_inv_rx:1;
 208	unsigned int		irda_inv_tx:1;
 209	unsigned short		trcv_delay; /* transceiver delay */
 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	/* DMA fields */
 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	unsigned int		tx_bytes;
 225	unsigned int		dma_tx_nents;
 226	wait_queue_head_t	dma_wait;
 227	unsigned int            saved_reg[10];
 228	bool			context_saved;
 
 
 
 
 229};
 230
 231struct imx_port_ucrs {
 232	unsigned int	ucr1;
 233	unsigned int	ucr2;
 234	unsigned int	ucr3;
 235};
 236
 237static struct imx_uart_data imx_uart_devdata[] = {
 238	[IMX1_UART] = {
 239		.uts_reg = IMX1_UTS,
 240		.devtype = IMX1_UART,
 241	},
 242	[IMX21_UART] = {
 243		.uts_reg = IMX21_UTS,
 244		.devtype = IMX21_UART,
 245	},
 
 
 
 
 246	[IMX6Q_UART] = {
 247		.uts_reg = IMX21_UTS,
 248		.devtype = IMX6Q_UART,
 249	},
 250};
 251
 252static const struct platform_device_id imx_uart_devtype[] = {
 253	{
 254		.name = "imx1-uart",
 255		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX1_UART],
 256	}, {
 257		.name = "imx21-uart",
 258		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX21_UART],
 259	}, {
 
 
 
 260		.name = "imx6q-uart",
 261		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX6Q_UART],
 262	}, {
 263		/* sentinel */
 264	}
 265};
 266MODULE_DEVICE_TABLE(platform, imx_uart_devtype);
 267
 268static const struct of_device_id imx_uart_dt_ids[] = {
 269	{ .compatible = "fsl,imx6q-uart", .data = &imx_uart_devdata[IMX6Q_UART], },
 
 270	{ .compatible = "fsl,imx1-uart", .data = &imx_uart_devdata[IMX1_UART], },
 271	{ .compatible = "fsl,imx21-uart", .data = &imx_uart_devdata[IMX21_UART], },
 272	{ /* sentinel */ }
 273};
 274MODULE_DEVICE_TABLE(of, imx_uart_dt_ids);
 275
 276static inline unsigned uts_reg(struct imx_port *sport)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 277{
 278	return sport->devdata->uts_reg;
 279}
 280
 281static inline int is_imx1_uart(struct imx_port *sport)
 282{
 283	return sport->devdata->devtype == IMX1_UART;
 284}
 285
 286static inline int is_imx21_uart(struct imx_port *sport)
 287{
 288	return sport->devdata->devtype == IMX21_UART;
 289}
 290
 291static inline int is_imx6q_uart(struct imx_port *sport)
 
 
 
 
 
 292{
 293	return sport->devdata->devtype == IMX6Q_UART;
 294}
 295/*
 296 * Save and restore functions for UCR1, UCR2 and UCR3 registers
 297 */
 298#if defined(CONFIG_SERIAL_IMX_CONSOLE)
 299static void imx_port_ucrs_save(struct uart_port *port,
 300			       struct imx_port_ucrs *ucr)
 301{
 302	/* save control registers */
 303	ucr->ucr1 = readl(port->membase + UCR1);
 304	ucr->ucr2 = readl(port->membase + UCR2);
 305	ucr->ucr3 = readl(port->membase + UCR3);
 306}
 307
 308static void imx_port_ucrs_restore(struct uart_port *port,
 309				  struct imx_port_ucrs *ucr)
 310{
 311	/* restore control registers */
 312	writel(ucr->ucr1, port->membase + UCR1);
 313	writel(ucr->ucr2, port->membase + UCR2);
 314	writel(ucr->ucr3, port->membase + UCR3);
 315}
 316#endif
 317
 318static void imx_port_rts_active(struct imx_port *sport, unsigned long *ucr2)
 
 
 
 
 
 
 
 
 
 
 319{
 320	*ucr2 &= ~UCR2_CTSC;
 321	*ucr2 |= UCR2_CTS;
 322
 323	mctrl_gpio_set(sport->gpios, sport->port.mctrl | TIOCM_RTS);
 
 324}
 325
 326static void imx_port_rts_inactive(struct imx_port *sport, unsigned long *ucr2)
 327{
 328	*ucr2 &= ~(UCR2_CTSC | UCR2_CTS);
 
 
 329
 330	mctrl_gpio_set(sport->gpios, sport->port.mctrl & ~TIOCM_RTS);
 331}
 332
 333static void imx_port_rts_auto(struct imx_port *sport, unsigned long *ucr2)
 
 334{
 335	*ucr2 |= UCR2_CTSC;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 336}
 337
 338/*
 339 * interrupts disabled on entry
 340 */
 341static void imx_stop_tx(struct uart_port *port)
 342{
 343	struct imx_port *sport = (struct imx_port *)port;
 344	unsigned long temp;
 
 
 
 345
 346	/*
 347	 * We are maybe in the SMP context, so if the DMA TX thread is running
 348	 * on other cpu, we have to wait for it to finish.
 349	 */
 350	if (sport->dma_is_enabled && sport->dma_is_txing)
 351		return;
 352
 353	temp = readl(port->membase + UCR1);
 354	writel(temp & ~UCR1_TXMPTYEN, port->membase + UCR1);
 355
 356	/* in rs485 mode disable transmitter if shifter is empty */
 357	if (port->rs485.flags & SER_RS485_ENABLED &&
 358	    readl(port->membase + USR2) & USR2_TXDC) {
 359		temp = readl(port->membase + UCR2);
 360		if (port->rs485.flags & SER_RS485_RTS_AFTER_SEND)
 361			imx_port_rts_inactive(sport, &temp);
 362		else
 363			imx_port_rts_active(sport, &temp);
 364		writel(temp, port->membase + UCR2);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 365
 366		temp = readl(port->membase + UCR4);
 367		temp &= ~UCR4_TCEN;
 368		writel(temp, port->membase + UCR4);
 
 369	}
 370}
 371
 372/*
 373 * interrupts disabled on entry
 374 */
 375static void imx_stop_rx(struct uart_port *port)
 376{
 377	struct imx_port *sport = (struct imx_port *)port;
 378	unsigned long temp;
 379
 380	if (sport->dma_is_enabled && sport->dma_is_rxing) {
 381		if (sport->port.suspended) {
 382			dmaengine_terminate_all(sport->dma_chan_rx);
 383			sport->dma_is_rxing = 0;
 384		} else {
 385			return;
 386		}
 387	}
 388
 389	temp = readl(sport->port.membase + UCR2);
 390	writel(temp & ~UCR2_RXEN, sport->port.membase + UCR2);
 
 
 
 
 
 391
 392	/* disable the `Receiver Ready Interrrupt` */
 393	temp = readl(sport->port.membase + UCR1);
 394	writel(temp & ~UCR1_RRDYEN, sport->port.membase + UCR1);
 395}
 396
 397/*
 398 * Set the modem control timer to fire immediately.
 399 */
 400static void imx_enable_ms(struct uart_port *port)
 401{
 402	struct imx_port *sport = (struct imx_port *)port;
 403
 404	mod_timer(&sport->timer, jiffies);
 405
 406	mctrl_gpio_enable_ms(sport->gpios);
 407}
 408
 409static void imx_dma_tx(struct imx_port *sport);
 410static inline void imx_transmit_buffer(struct imx_port *sport)
 
 
 411{
 412	struct circ_buf *xmit = &sport->port.state->xmit;
 413	unsigned long temp;
 414
 415	if (sport->port.x_char) {
 416		/* Send next char */
 417		writel(sport->port.x_char, sport->port.membase + URTX0);
 418		sport->port.icount.tx++;
 419		sport->port.x_char = 0;
 420		return;
 421	}
 422
 423	if (uart_circ_empty(xmit) || uart_tx_stopped(&sport->port)) {
 424		imx_stop_tx(&sport->port);
 425		return;
 426	}
 427
 428	if (sport->dma_is_enabled) {
 
 429		/*
 430		 * We've just sent a X-char Ensure the TX DMA is enabled
 431		 * and the TX IRQ is disabled.
 432		 **/
 433		temp = readl(sport->port.membase + UCR1);
 434		temp &= ~UCR1_TXMPTYEN;
 435		if (sport->dma_is_txing) {
 436			temp |= UCR1_TDMAEN;
 437			writel(temp, sport->port.membase + UCR1);
 438		} else {
 439			writel(temp, sport->port.membase + UCR1);
 440			imx_dma_tx(sport);
 441		}
 
 
 442	}
 443
 444	while (!uart_circ_empty(xmit) &&
 445	       !(readl(sport->port.membase + uts_reg(sport)) & UTS_TXFULL)) {
 446		/* send xmit->buf[xmit->tail]
 447		 * out the port here */
 448		writel(xmit->buf[xmit->tail], sport->port.membase + URTX0);
 449		xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
 450		sport->port.icount.tx++;
 451	}
 452
 453	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 454		uart_write_wakeup(&sport->port);
 455
 456	if (uart_circ_empty(xmit))
 457		imx_stop_tx(&sport->port);
 458}
 459
 460static void dma_tx_callback(void *data)
 461{
 462	struct imx_port *sport = data;
 463	struct scatterlist *sgl = &sport->tx_sgl[0];
 464	struct circ_buf *xmit = &sport->port.state->xmit;
 465	unsigned long flags;
 466	unsigned long temp;
 467
 468	spin_lock_irqsave(&sport->port.lock, flags);
 469
 470	dma_unmap_sg(sport->port.dev, sgl, sport->dma_tx_nents, DMA_TO_DEVICE);
 471
 472	temp = readl(sport->port.membase + UCR1);
 473	temp &= ~UCR1_TDMAEN;
 474	writel(temp, sport->port.membase + UCR1);
 475
 476	/* update the stat */
 477	xmit->tail = (xmit->tail + sport->tx_bytes) & (UART_XMIT_SIZE - 1);
 478	sport->port.icount.tx += sport->tx_bytes;
 479
 480	dev_dbg(sport->port.dev, "we finish the TX DMA.\n");
 481
 482	sport->dma_is_txing = 0;
 483
 484	spin_unlock_irqrestore(&sport->port.lock, flags);
 485
 486	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 487		uart_write_wakeup(&sport->port);
 488
 489	if (waitqueue_active(&sport->dma_wait)) {
 490		wake_up(&sport->dma_wait);
 491		dev_dbg(sport->port.dev, "exit in %s.\n", __func__);
 492		return;
 
 
 493	}
 494
 495	spin_lock_irqsave(&sport->port.lock, flags);
 496	if (!uart_circ_empty(xmit) && !uart_tx_stopped(&sport->port))
 497		imx_dma_tx(sport);
 498	spin_unlock_irqrestore(&sport->port.lock, flags);
 499}
 500
 501static void imx_dma_tx(struct imx_port *sport)
 
 502{
 503	struct circ_buf *xmit = &sport->port.state->xmit;
 504	struct scatterlist *sgl = sport->tx_sgl;
 505	struct dma_async_tx_descriptor *desc;
 506	struct dma_chan	*chan = sport->dma_chan_tx;
 507	struct device *dev = sport->port.dev;
 508	unsigned long temp;
 509	int ret;
 510
 511	if (sport->dma_is_txing)
 512		return;
 513
 
 
 
 
 514	sport->tx_bytes = uart_circ_chars_pending(xmit);
 515
 516	if (xmit->tail < xmit->head) {
 517		sport->dma_tx_nents = 1;
 518		sg_init_one(sgl, xmit->buf + xmit->tail, sport->tx_bytes);
 519	} else {
 520		sport->dma_tx_nents = 2;
 521		sg_init_table(sgl, 2);
 522		sg_set_buf(sgl, xmit->buf + xmit->tail,
 523				UART_XMIT_SIZE - xmit->tail);
 524		sg_set_buf(sgl + 1, xmit->buf, xmit->head);
 525	}
 526
 527	ret = dma_map_sg(dev, sgl, sport->dma_tx_nents, DMA_TO_DEVICE);
 528	if (ret == 0) {
 529		dev_err(dev, "DMA mapping error for TX.\n");
 530		return;
 531	}
 532	desc = dmaengine_prep_slave_sg(chan, sgl, sport->dma_tx_nents,
 533					DMA_MEM_TO_DEV, DMA_PREP_INTERRUPT);
 534	if (!desc) {
 535		dma_unmap_sg(dev, sgl, sport->dma_tx_nents,
 536			     DMA_TO_DEVICE);
 537		dev_err(dev, "We cannot prepare for the TX slave dma!\n");
 538		return;
 539	}
 540	desc->callback = dma_tx_callback;
 541	desc->callback_param = sport;
 542
 543	dev_dbg(dev, "TX: prepare to send %lu bytes by DMA.\n",
 544			uart_circ_chars_pending(xmit));
 545
 546	temp = readl(sport->port.membase + UCR1);
 547	temp |= UCR1_TDMAEN;
 548	writel(temp, sport->port.membase + UCR1);
 549
 550	/* fire it */
 551	sport->dma_is_txing = 1;
 552	dmaengine_submit(desc);
 553	dma_async_issue_pending(chan);
 554	return;
 555}
 556
 557/*
 558 * interrupts disabled on entry
 559 */
 560static void imx_start_tx(struct uart_port *port)
 561{
 562	struct imx_port *sport = (struct imx_port *)port;
 563	unsigned long temp;
 
 
 
 
 
 
 
 
 
 564
 565	if (port->rs485.flags & SER_RS485_ENABLED) {
 566		temp = readl(port->membase + UCR2);
 567		if (port->rs485.flags & SER_RS485_RTS_ON_SEND)
 568			imx_port_rts_inactive(sport, &temp);
 569		else
 570			imx_port_rts_active(sport, &temp);
 571		writel(temp, port->membase + UCR2);
 
 572
 573		/* enable transmitter and shifter empty irq */
 574		temp = readl(port->membase + UCR4);
 575		temp |= UCR4_TCEN;
 576		writel(temp, port->membase + UCR4);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 577	}
 578
 579	if (!sport->dma_is_enabled) {
 580		temp = readl(sport->port.membase + UCR1);
 581		writel(temp | UCR1_TXMPTYEN, sport->port.membase + UCR1);
 582	}
 583
 584	if (sport->dma_is_enabled) {
 585		if (sport->port.x_char) {
 586			/* We have X-char to send, so enable TX IRQ and
 587			 * disable TX DMA to let TX interrupt to send X-char */
 588			temp = readl(sport->port.membase + UCR1);
 589			temp &= ~UCR1_TDMAEN;
 590			temp |= UCR1_TXMPTYEN;
 591			writel(temp, sport->port.membase + UCR1);
 592			return;
 593		}
 594
 595		if (!uart_circ_empty(&port->state->xmit) &&
 596		    !uart_tx_stopped(port))
 597			imx_dma_tx(sport);
 598		return;
 599	}
 600}
 601
 602static irqreturn_t imx_rtsint(int irq, void *dev_id)
 603{
 604	struct imx_port *sport = dev_id;
 605	unsigned int val;
 606	unsigned long flags;
 607
 608	spin_lock_irqsave(&sport->port.lock, flags);
 609
 610	writel(USR1_RTSD, sport->port.membase + USR1);
 611	val = readl(sport->port.membase + USR1) & USR1_RTSS;
 612	uart_handle_cts_change(&sport->port, !!val);
 613	wake_up_interruptible(&sport->port.state->port.delta_msr_wait);
 614
 615	spin_unlock_irqrestore(&sport->port.lock, flags);
 616	return IRQ_HANDLED;
 617}
 618
 619static irqreturn_t imx_txint(int irq, void *dev_id)
 620{
 621	struct imx_port *sport = dev_id;
 622	unsigned long flags;
 623
 624	spin_lock_irqsave(&sport->port.lock, flags);
 625	imx_transmit_buffer(sport);
 626	spin_unlock_irqrestore(&sport->port.lock, flags);
 
 
 
 
 
 
 
 
 
 
 
 
 
 627	return IRQ_HANDLED;
 628}
 629
 630static irqreturn_t imx_rxint(int irq, void *dev_id)
 631{
 632	struct imx_port *sport = dev_id;
 633	unsigned int rx, flg, ignored = 0;
 634	struct tty_port *port = &sport->port.state->port;
 635	unsigned long flags, temp;
 636
 637	spin_lock_irqsave(&sport->port.lock, flags);
 
 638
 639	while (readl(sport->port.membase + USR2) & USR2_RDR) {
 640		flg = TTY_NORMAL;
 641		sport->port.icount.rx++;
 642
 643		rx = readl(sport->port.membase + URXD0);
 644
 645		temp = readl(sport->port.membase + USR2);
 646		if (temp & USR2_BRCD) {
 647			writel(USR2_BRCD, sport->port.membase + USR2);
 648			if (uart_handle_break(&sport->port))
 649				continue;
 650		}
 651
 652		if (uart_handle_sysrq_char(&sport->port, (unsigned char)rx))
 653			continue;
 654
 655		if (unlikely(rx & URXD_ERR)) {
 656			if (rx & URXD_BRK)
 657				sport->port.icount.brk++;
 658			else if (rx & URXD_PRERR)
 659				sport->port.icount.parity++;
 660			else if (rx & URXD_FRMERR)
 661				sport->port.icount.frame++;
 662			if (rx & URXD_OVRRUN)
 663				sport->port.icount.overrun++;
 664
 665			if (rx & sport->port.ignore_status_mask) {
 666				if (++ignored > 100)
 667					goto out;
 668				continue;
 669			}
 670
 671			rx &= (sport->port.read_status_mask | 0xFF);
 672
 673			if (rx & URXD_BRK)
 674				flg = TTY_BREAK;
 675			else if (rx & URXD_PRERR)
 676				flg = TTY_PARITY;
 677			else if (rx & URXD_FRMERR)
 678				flg = TTY_FRAME;
 679			if (rx & URXD_OVRRUN)
 680				flg = TTY_OVERRUN;
 681
 682#ifdef SUPPORT_SYSRQ
 683			sport->port.sysrq = 0;
 684#endif
 685		}
 686
 687		if (sport->port.ignore_status_mask & URXD_DUMMY_READ)
 688			goto out;
 689
 690		if (tty_insert_flip_char(port, rx, flg) == 0)
 691			sport->port.icount.buf_overrun++;
 692	}
 693
 694out:
 695	spin_unlock_irqrestore(&sport->port.lock, flags);
 696	tty_flip_buffer_push(port);
 
 697	return IRQ_HANDLED;
 698}
 699
 700static int start_rx_dma(struct imx_port *sport);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 701/*
 702 * If the RXFIFO is filled with some data, and then we
 703 * arise a DMA operation to receive them.
 704 */
 705static void imx_dma_rxint(struct imx_port *sport)
 706{
 707	unsigned long temp;
 708	unsigned long flags;
 
 709
 710	spin_lock_irqsave(&sport->port.lock, flags);
 
 711
 712	temp = readl(sport->port.membase + USR2);
 713	if ((temp & USR2_RDR) && !sport->dma_is_rxing) {
 714		sport->dma_is_rxing = 1;
 715
 716		/* disable the receiver ready and aging timer interrupts */
 717		temp = readl(sport->port.membase + UCR1);
 718		temp &= ~(UCR1_RRDYEN);
 719		writel(temp, sport->port.membase + UCR1);
 720
 721		temp = readl(sport->port.membase + UCR2);
 722		temp &= ~(UCR2_ATEN);
 723		writel(temp, sport->port.membase + UCR2);
 724
 725		/* tell the DMA to receive the data. */
 726		start_rx_dma(sport);
 727	}
 728
 729	spin_unlock_irqrestore(&sport->port.lock, flags);
 730}
 731
 732static irqreturn_t imx_int(int irq, void *dev_id)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 733{
 734	struct imx_port *sport = dev_id;
 735	unsigned int sts;
 736	unsigned int sts2;
 737
 738	sts = readl(sport->port.membase + USR1);
 739	sts2 = readl(sport->port.membase + USR2);
 740
 741	if (sts & (USR1_RRDY | USR1_AGTIM)) {
 742		if (sport->dma_is_enabled)
 743			imx_dma_rxint(sport);
 744		else
 745			imx_rxint(irq, dev_id);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 746	}
 747
 748	if ((sts & USR1_TRDY &&
 749	     readl(sport->port.membase + UCR1) & UCR1_TXMPTYEN) ||
 750	    (sts2 & USR2_TXDC &&
 751	     readl(sport->port.membase + UCR4) & UCR4_TCEN))
 752		imx_txint(irq, dev_id);
 753
 754	if (sts & USR1_RTSD)
 755		imx_rtsint(irq, dev_id);
 
 
 
 
 
 756
 757	if (sts & USR1_AWAKE)
 758		writel(USR1_AWAKE, sport->port.membase + USR1);
 
 
 759
 760	if (sts2 & USR2_ORE) {
 761		sport->port.icount.overrun++;
 762		writel(USR2_ORE, sport->port.membase + USR2);
 
 763	}
 764
 765	return IRQ_HANDLED;
 
 
 766}
 767
 768/*
 769 * Return TIOCSER_TEMT when transmitter is not busy.
 770 */
 771static unsigned int imx_tx_empty(struct uart_port *port)
 772{
 773	struct imx_port *sport = (struct imx_port *)port;
 774	unsigned int ret;
 775
 776	ret = (readl(sport->port.membase + USR2) & USR2_TXDC) ?  TIOCSER_TEMT : 0;
 777
 778	/* If the TX DMA is working, return 0. */
 779	if (sport->dma_is_enabled && sport->dma_is_txing)
 780		ret = 0;
 781
 782	return ret;
 783}
 784
 785/*
 786 * We have a modem side uart, so the meanings of RTS and CTS are inverted.
 787 */
 788static unsigned int imx_get_hwmctrl(struct imx_port *sport)
 789{
 790	unsigned int tmp = TIOCM_DSR;
 791	unsigned usr1 = readl(sport->port.membase + USR1);
 792
 793	if (usr1 & USR1_RTSS)
 794		tmp |= TIOCM_CTS;
 795
 796	/* in DCE mode DCDIN is always 0 */
 797	if (!(usr1 & USR2_DCDIN))
 798		tmp |= TIOCM_CAR;
 799
 800	/* in DCE mode RIIN is always 0 */
 801	if (readl(sport->port.membase + USR2) & USR2_RIIN)
 802		tmp |= TIOCM_RI;
 803
 804	return tmp;
 805}
 806
 807static unsigned int imx_get_mctrl(struct uart_port *port)
 808{
 809	struct imx_port *sport = (struct imx_port *)port;
 810	unsigned int ret = imx_get_hwmctrl(sport);
 811
 812	mctrl_gpio_get(sport->gpios, &ret);
 813
 814	return ret;
 815}
 816
 817static void imx_set_mctrl(struct uart_port *port, unsigned int mctrl)
 
 818{
 819	struct imx_port *sport = (struct imx_port *)port;
 820	unsigned long temp;
 821
 822	if (!(port->rs485.flags & SER_RS485_ENABLED)) {
 823		temp = readl(sport->port.membase + UCR2);
 824		temp &= ~(UCR2_CTS | UCR2_CTSC);
 825		if (mctrl & TIOCM_RTS)
 826			temp |= UCR2_CTS | UCR2_CTSC;
 827		writel(temp, sport->port.membase + UCR2);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 828	}
 829
 830	temp = readl(sport->port.membase + UCR3) & ~UCR3_DSR;
 831	if (!(mctrl & TIOCM_DTR))
 832		temp |= UCR3_DSR;
 833	writel(temp, sport->port.membase + UCR3);
 834
 835	temp = readl(sport->port.membase + uts_reg(sport)) & ~UTS_LOOP;
 836	if (mctrl & TIOCM_LOOP)
 837		temp |= UTS_LOOP;
 838	writel(temp, sport->port.membase + uts_reg(sport));
 839
 840	mctrl_gpio_set(sport->gpios, mctrl);
 841}
 842
 843/*
 844 * Interrupts always disabled.
 845 */
 846static void imx_break_ctl(struct uart_port *port, int break_state)
 847{
 848	struct imx_port *sport = (struct imx_port *)port;
 849	unsigned long flags, temp;
 
 850
 851	spin_lock_irqsave(&sport->port.lock, flags);
 852
 853	temp = readl(sport->port.membase + UCR1) & ~UCR1_SNDBRK;
 854
 855	if (break_state != 0)
 856		temp |= UCR1_SNDBRK;
 857
 858	writel(temp, sport->port.membase + UCR1);
 859
 860	spin_unlock_irqrestore(&sport->port.lock, flags);
 861}
 862
 863/*
 864 * Handle any change of modem status signal since we were last called.
 865 */
 866static void imx_mctrl_check(struct imx_port *sport)
 867{
 868	unsigned int status, changed;
 869
 870	status = imx_get_hwmctrl(sport);
 871	changed = status ^ sport->old_status;
 872
 873	if (changed == 0)
 874		return;
 875
 876	sport->old_status = status;
 877
 878	if (changed & TIOCM_RI)
 879		sport->port.icount.rng++;
 880	if (changed & TIOCM_DSR)
 881		sport->port.icount.dsr++;
 882	if (changed & TIOCM_CAR)
 883		uart_handle_dcd_change(&sport->port, status & TIOCM_CAR);
 884	if (changed & TIOCM_CTS)
 885		uart_handle_cts_change(&sport->port, status & TIOCM_CTS);
 886
 887	wake_up_interruptible(&sport->port.state->port.delta_msr_wait);
 888}
 889
 890/*
 891 * This is our per-port timeout handler, for checking the
 892 * modem status signals.
 893 */
 894static void imx_timeout(unsigned long data)
 895{
 896	struct imx_port *sport = (struct imx_port *)data;
 897	unsigned long flags;
 898
 899	if (sport->port.state) {
 900		spin_lock_irqsave(&sport->port.lock, flags);
 901		imx_mctrl_check(sport);
 902		spin_unlock_irqrestore(&sport->port.lock, flags);
 903
 904		mod_timer(&sport->timer, jiffies + MCTRL_TIMEOUT);
 905	}
 906}
 907
 908#define RX_BUF_SIZE	(PAGE_SIZE)
 909static void imx_rx_dma_done(struct imx_port *sport)
 910{
 911	unsigned long temp;
 912	unsigned long flags;
 913
 914	spin_lock_irqsave(&sport->port.lock, flags);
 915
 916	/* re-enable interrupts to get notified when new symbols are incoming */
 917	temp = readl(sport->port.membase + UCR1);
 918	temp |= UCR1_RRDYEN;
 919	writel(temp, sport->port.membase + UCR1);
 920
 921	temp = readl(sport->port.membase + UCR2);
 922	temp |= UCR2_ATEN;
 923	writel(temp, sport->port.membase + UCR2);
 924
 925	sport->dma_is_rxing = 0;
 926
 927	/* Is the shutdown waiting for us? */
 928	if (waitqueue_active(&sport->dma_wait))
 929		wake_up(&sport->dma_wait);
 930
 931	spin_unlock_irqrestore(&sport->port.lock, flags);
 932}
 933
 934/*
 935 * There are two kinds of RX DMA interrupts(such as in the MX6Q):
 936 *   [1] the RX DMA buffer is full.
 937 *   [2] the aging timer expires
 938 *
 939 * Condition [2] is triggered when a character has been sitting in the FIFO
 940 * for at least 8 byte durations.
 941 */
 942static void dma_rx_callback(void *data)
 943{
 944	struct imx_port *sport = data;
 945	struct dma_chan	*chan = sport->dma_chan_rx;
 946	struct scatterlist *sgl = &sport->rx_sgl;
 947	struct tty_port *port = &sport->port.state->port;
 948	struct dma_tx_state state;
 
 949	enum dma_status status;
 950	unsigned int count;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 951
 952	/* unmap it first */
 953	dma_unmap_sg(sport->port.dev, sgl, 1, DMA_FROM_DEVICE);
 954
 955	status = dmaengine_tx_status(chan, (dma_cookie_t)0, &state);
 956	count = RX_BUF_SIZE - state.residue;
 
 957
 958	dev_dbg(sport->port.dev, "We get %d bytes.\n", count);
 
 959
 960	if (count) {
 961		if (!(sport->port.ignore_status_mask & URXD_DUMMY_READ)) {
 962			int bytes = tty_insert_flip_string(port, sport->rx_buf,
 963					count);
 964
 965			if (bytes != count)
 
 
 
 
 
 
 
 
 
 
 
 966				sport->port.icount.buf_overrun++;
 
 
 
 
 
 967		}
 968		tty_flip_buffer_push(port);
 969		sport->port.icount.rx += count;
 970	}
 971
 972	/*
 973	 * Restart RX DMA directly if more data is available in order to skip
 974	 * the roundtrip through the IRQ handler. If there is some data already
 975	 * in the FIFO, DMA needs to be restarted soon anyways.
 976	 *
 977	 * Otherwise stop the DMA and reactivate FIFO IRQs to restart DMA once
 978	 * data starts to arrive again.
 979	 */
 980	if (readl(sport->port.membase + USR2) & USR2_RDR)
 981		start_rx_dma(sport);
 982	else
 983		imx_rx_dma_done(sport);
 984}
 985
 986static int start_rx_dma(struct imx_port *sport)
 
 
 
 
 987{
 988	struct scatterlist *sgl = &sport->rx_sgl;
 989	struct dma_chan	*chan = sport->dma_chan_rx;
 990	struct device *dev = sport->port.dev;
 991	struct dma_async_tx_descriptor *desc;
 992	int ret;
 993
 
 
 
 
 994	sg_init_one(sgl, sport->rx_buf, RX_BUF_SIZE);
 995	ret = dma_map_sg(dev, sgl, 1, DMA_FROM_DEVICE);
 996	if (ret == 0) {
 997		dev_err(dev, "DMA mapping error for RX.\n");
 998		return -EINVAL;
 999	}
1000	desc = dmaengine_prep_slave_sg(chan, sgl, 1, DMA_DEV_TO_MEM,
1001					DMA_PREP_INTERRUPT);
 
 
 
1002	if (!desc) {
1003		dma_unmap_sg(dev, sgl, 1, DMA_FROM_DEVICE);
1004		dev_err(dev, "We cannot prepare for the RX slave dma!\n");
1005		return -EINVAL;
1006	}
1007	desc->callback = dma_rx_callback;
1008	desc->callback_param = sport;
1009
1010	dev_dbg(dev, "RX: prepare for the DMA.\n");
1011	dmaengine_submit(desc);
 
1012	dma_async_issue_pending(chan);
1013	return 0;
1014}
1015
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1016#define TXTL_DEFAULT 2 /* reset default */
1017#define RXTL_DEFAULT 1 /* reset default */
1018#define TXTL_DMA 8 /* DMA burst setting */
1019#define RXTL_DMA 9 /* DMA burst setting */
1020
1021static void imx_setup_ufcr(struct imx_port *sport,
1022			  unsigned char txwl, unsigned char rxwl)
1023{
1024	unsigned int val;
1025
1026	/* set receiver / transmitter trigger level */
1027	val = readl(sport->port.membase + UFCR) & (UFCR_RFDIV | UFCR_DCEDTE);
1028	val |= txwl << UFCR_TXTL_SHF | rxwl;
1029	writel(val, sport->port.membase + UFCR);
1030}
1031
1032static void imx_uart_dma_exit(struct imx_port *sport)
1033{
1034	if (sport->dma_chan_rx) {
 
1035		dma_release_channel(sport->dma_chan_rx);
1036		sport->dma_chan_rx = NULL;
1037
1038		kfree(sport->rx_buf);
1039		sport->rx_buf = NULL;
1040	}
1041
1042	if (sport->dma_chan_tx) {
 
1043		dma_release_channel(sport->dma_chan_tx);
1044		sport->dma_chan_tx = NULL;
1045	}
1046
1047	sport->dma_is_inited = 0;
1048}
1049
1050static int imx_uart_dma_init(struct imx_port *sport)
1051{
1052	struct dma_slave_config slave_config = {};
1053	struct device *dev = sport->port.dev;
1054	int ret;
1055
1056	/* Prepare for RX : */
1057	sport->dma_chan_rx = dma_request_slave_channel(dev, "rx");
1058	if (!sport->dma_chan_rx) {
1059		dev_dbg(dev, "cannot get the DMA channel.\n");
1060		ret = -EINVAL;
1061		goto err;
1062	}
1063
1064	slave_config.direction = DMA_DEV_TO_MEM;
1065	slave_config.src_addr = sport->port.mapbase + URXD0;
1066	slave_config.src_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
1067	/* one byte less than the watermark level to enable the aging timer */
1068	slave_config.src_maxburst = RXTL_DMA - 1;
1069	ret = dmaengine_slave_config(sport->dma_chan_rx, &slave_config);
1070	if (ret) {
1071		dev_err(dev, "error in RX dma configuration.\n");
1072		goto err;
1073	}
1074
1075	sport->rx_buf = kzalloc(PAGE_SIZE, GFP_KERNEL);
1076	if (!sport->rx_buf) {
1077		ret = -ENOMEM;
1078		goto err;
1079	}
 
1080
1081	/* Prepare for TX : */
1082	sport->dma_chan_tx = dma_request_slave_channel(dev, "tx");
1083	if (!sport->dma_chan_tx) {
1084		dev_err(dev, "cannot get the TX DMA channel!\n");
1085		ret = -EINVAL;
1086		goto err;
1087	}
1088
1089	slave_config.direction = DMA_MEM_TO_DEV;
1090	slave_config.dst_addr = sport->port.mapbase + URTX0;
1091	slave_config.dst_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
1092	slave_config.dst_maxburst = TXTL_DMA;
1093	ret = dmaengine_slave_config(sport->dma_chan_tx, &slave_config);
1094	if (ret) {
1095		dev_err(dev, "error in TX dma configuration.");
1096		goto err;
1097	}
1098
1099	sport->dma_is_inited = 1;
1100
1101	return 0;
1102err:
1103	imx_uart_dma_exit(sport);
1104	return ret;
1105}
1106
1107static void imx_enable_dma(struct imx_port *sport)
1108{
1109	unsigned long temp;
1110
1111	init_waitqueue_head(&sport->dma_wait);
1112
1113	/* set UCR1 */
1114	temp = readl(sport->port.membase + UCR1);
1115	temp |= UCR1_RDMAEN | UCR1_TDMAEN | UCR1_ATDMAEN;
1116	writel(temp, sport->port.membase + UCR1);
1117
1118	temp = readl(sport->port.membase + UCR2);
1119	temp |= UCR2_ATEN;
1120	writel(temp, sport->port.membase + UCR2);
1121
1122	imx_setup_ufcr(sport, TXTL_DMA, RXTL_DMA);
1123
1124	sport->dma_is_enabled = 1;
1125}
1126
1127static void imx_disable_dma(struct imx_port *sport)
1128{
1129	unsigned long temp;
1130
1131	/* clear UCR1 */
1132	temp = readl(sport->port.membase + UCR1);
1133	temp &= ~(UCR1_RDMAEN | UCR1_TDMAEN | UCR1_ATDMAEN);
1134	writel(temp, sport->port.membase + UCR1);
1135
1136	/* clear UCR2 */
1137	temp = readl(sport->port.membase + UCR2);
1138	temp &= ~(UCR2_CTSC | UCR2_CTS | UCR2_ATEN);
1139	writel(temp, sport->port.membase + UCR2);
1140
1141	imx_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1142
1143	sport->dma_is_enabled = 0;
1144}
1145
1146/* half the RX buffer size */
1147#define CTSTL 16
1148
1149static int imx_startup(struct uart_port *port)
1150{
1151	struct imx_port *sport = (struct imx_port *)port;
1152	int retval, i;
1153	unsigned long flags, temp;
 
 
1154
1155	retval = clk_prepare_enable(sport->clk_per);
1156	if (retval)
1157		return retval;
1158	retval = clk_prepare_enable(sport->clk_ipg);
1159	if (retval) {
1160		clk_disable_unprepare(sport->clk_per);
1161		return retval;
1162	}
1163
1164	imx_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1165
1166	/* disable the DREN bit (Data Ready interrupt enable) before
1167	 * requesting IRQs
1168	 */
1169	temp = readl(sport->port.membase + UCR4);
1170
1171	/* set the trigger level for CTS */
1172	temp &= ~(UCR4_CTSTL_MASK << UCR4_CTSTL_SHF);
1173	temp |= CTSTL << UCR4_CTSTL_SHF;
1174
1175	writel(temp & ~UCR4_DREN, sport->port.membase + UCR4);
1176
1177	/* Can we enable the DMA support? */
1178	if (is_imx6q_uart(sport) && !uart_console(port) &&
1179	    !sport->dma_is_inited)
1180		imx_uart_dma_init(sport);
1181
1182	spin_lock_irqsave(&sport->port.lock, flags);
1183	/* Reset fifo's and state machines */
1184	i = 100;
1185
1186	temp = readl(sport->port.membase + UCR2);
1187	temp &= ~UCR2_SRST;
1188	writel(temp, sport->port.membase + UCR2);
1189
1190	while (!(readl(sport->port.membase + UCR2) & UCR2_SRST) && (--i > 0))
1191		udelay(1);
1192
1193	/*
1194	 * Finally, clear and enable interrupts
1195	 */
1196	writel(USR1_RTSD, sport->port.membase + USR1);
1197	writel(USR2_ORE, sport->port.membase + USR2);
1198
1199	if (sport->dma_is_inited && !sport->dma_is_enabled)
1200		imx_enable_dma(sport);
 
 
1201
1202	temp = readl(sport->port.membase + UCR1);
1203	temp |= UCR1_RRDYEN | UCR1_RTSDEN | UCR1_UARTEN;
1204
1205	writel(temp, sport->port.membase + UCR1);
 
 
 
 
 
1206
1207	temp = readl(sport->port.membase + UCR4);
1208	temp |= UCR4_OREN;
1209	writel(temp, sport->port.membase + UCR4);
 
 
 
1210
1211	temp = readl(sport->port.membase + UCR2);
1212	temp |= (UCR2_RXEN | UCR2_TXEN);
1213	if (!sport->have_rtscts)
1214		temp |= UCR2_IRTS;
1215	writel(temp, sport->port.membase + UCR2);
1216
1217	if (!is_imx1_uart(sport)) {
1218		temp = readl(sport->port.membase + UCR3);
1219		temp |= IMX21_UCR3_RXDMUXSEL | UCR3_ADNIMP;
1220		writel(temp, sport->port.membase + UCR3);
1221	}
 
 
 
 
 
 
 
 
 
 
 
 
 
1222
1223	/*
1224	 * Enable modem status interrupts
1225	 */
1226	imx_enable_ms(&sport->port);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1227	spin_unlock_irqrestore(&sport->port.lock, flags);
1228
1229	return 0;
1230}
1231
1232static void imx_shutdown(struct uart_port *port)
1233{
1234	struct imx_port *sport = (struct imx_port *)port;
1235	unsigned long temp;
1236	unsigned long flags;
 
1237
1238	if (sport->dma_is_enabled) {
1239		int ret;
1240
1241		/* We have to wait for the DMA to finish. */
1242		ret = wait_event_interruptible(sport->dma_wait,
1243			!sport->dma_is_rxing && !sport->dma_is_txing);
1244		if (ret != 0) {
1245			sport->dma_is_rxing = 0;
1246			sport->dma_is_txing = 0;
1247			dmaengine_terminate_all(sport->dma_chan_tx);
1248			dmaengine_terminate_all(sport->dma_chan_rx);
1249		}
 
 
 
 
 
 
 
1250		spin_lock_irqsave(&sport->port.lock, flags);
1251		imx_stop_tx(port);
1252		imx_stop_rx(port);
1253		imx_disable_dma(sport);
1254		spin_unlock_irqrestore(&sport->port.lock, flags);
1255		imx_uart_dma_exit(sport);
1256	}
1257
1258	mctrl_gpio_disable_ms(sport->gpios);
1259
1260	spin_lock_irqsave(&sport->port.lock, flags);
1261	temp = readl(sport->port.membase + UCR2);
1262	temp &= ~(UCR2_TXEN);
1263	writel(temp, sport->port.membase + UCR2);
 
 
 
 
1264	spin_unlock_irqrestore(&sport->port.lock, flags);
1265
1266	/*
1267	 * Stop our timer.
1268	 */
1269	del_timer_sync(&sport->timer);
1270
1271	/*
1272	 * Disable all interrupts, port and break condition.
1273	 */
1274
1275	spin_lock_irqsave(&sport->port.lock, flags);
1276	temp = readl(sport->port.membase + UCR1);
1277	temp &= ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN | UCR1_UARTEN);
1278
1279	writel(temp, sport->port.membase + UCR1);
1280	spin_unlock_irqrestore(&sport->port.lock, flags);
1281
1282	clk_disable_unprepare(sport->clk_per);
1283	clk_disable_unprepare(sport->clk_ipg);
1284}
1285
1286static void imx_flush_buffer(struct uart_port *port)
 
1287{
1288	struct imx_port *sport = (struct imx_port *)port;
1289	struct scatterlist *sgl = &sport->tx_sgl[0];
1290	unsigned long temp;
1291	int i = 100, ubir, ubmr, uts;
1292
1293	if (!sport->dma_chan_tx)
1294		return;
1295
1296	sport->tx_bytes = 0;
1297	dmaengine_terminate_all(sport->dma_chan_tx);
1298	if (sport->dma_is_txing) {
 
 
1299		dma_unmap_sg(sport->port.dev, sgl, sport->dma_tx_nents,
1300			     DMA_TO_DEVICE);
1301		temp = readl(sport->port.membase + UCR1);
1302		temp &= ~UCR1_TDMAEN;
1303		writel(temp, sport->port.membase + UCR1);
1304		sport->dma_is_txing = false;
1305	}
1306
1307	/*
1308	 * According to the Reference Manual description of the UART SRST bit:
 
1309	 * "Reset the transmit and receive state machines,
1310	 * all FIFOs and register USR1, USR2, UBIR, UBMR, UBRC, URXD, UTXD
1311	 * and UTS[6-3]". As we don't need to restore the old values from
1312	 * USR1, USR2, URXD, UTXD, only save/restore the other four registers
 
 
 
1313	 */
1314	ubir = readl(sport->port.membase + UBIR);
1315	ubmr = readl(sport->port.membase + UBMR);
1316	uts = readl(sport->port.membase + IMX21_UTS);
1317
1318	temp = readl(sport->port.membase + UCR2);
1319	temp &= ~UCR2_SRST;
1320	writel(temp, sport->port.membase + UCR2);
1321
1322	while (!(readl(sport->port.membase + UCR2) & UCR2_SRST) && (--i > 0))
1323		udelay(1);
1324
1325	/* Restore the registers */
1326	writel(ubir, sport->port.membase + UBIR);
1327	writel(ubmr, sport->port.membase + UBMR);
1328	writel(uts, sport->port.membase + IMX21_UTS);
1329}
1330
1331static void
1332imx_set_termios(struct uart_port *port, struct ktermios *termios,
1333		   struct ktermios *old)
1334{
1335	struct imx_port *sport = (struct imx_port *)port;
1336	unsigned long flags;
1337	unsigned long ucr2, old_ucr1, old_ucr2;
1338	unsigned int baud, quot;
1339	unsigned int old_csize = old ? old->c_cflag & CSIZE : CS8;
1340	unsigned long div, ufcr;
1341	unsigned long num, denom;
1342	uint64_t tdiv64;
1343
1344	/*
1345	 * We only support CS7 and CS8.
1346	 */
1347	while ((termios->c_cflag & CSIZE) != CS7 &&
1348	       (termios->c_cflag & CSIZE) != CS8) {
1349		termios->c_cflag &= ~CSIZE;
1350		termios->c_cflag |= old_csize;
1351		old_csize = CS8;
1352	}
1353
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1354	if ((termios->c_cflag & CSIZE) == CS8)
1355		ucr2 = UCR2_WS | UCR2_SRST | UCR2_IRTS;
1356	else
1357		ucr2 = UCR2_SRST | UCR2_IRTS;
1358
1359	if (termios->c_cflag & CRTSCTS) {
1360		if (sport->have_rtscts) {
1361			ucr2 &= ~UCR2_IRTS;
1362
1363			if (port->rs485.flags & SER_RS485_ENABLED) {
1364				/*
1365				 * RTS is mandatory for rs485 operation, so keep
1366				 * it under manual control and keep transmitter
1367				 * disabled.
1368				 */
1369				if (port->rs485.flags &
1370				    SER_RS485_RTS_AFTER_SEND)
1371					imx_port_rts_inactive(sport, &ucr2);
1372				else
1373					imx_port_rts_active(sport, &ucr2);
1374			} else {
1375				imx_port_rts_auto(sport, &ucr2);
1376			}
1377		} else {
1378			termios->c_cflag &= ~CRTSCTS;
1379		}
1380	} else if (port->rs485.flags & SER_RS485_ENABLED) {
1381		/* disable transmitter */
1382		if (port->rs485.flags & SER_RS485_RTS_AFTER_SEND)
1383			imx_port_rts_inactive(sport, &ucr2);
1384		else
1385			imx_port_rts_active(sport, &ucr2);
1386	}
1387
 
 
 
 
 
 
 
 
1388
 
 
1389	if (termios->c_cflag & CSTOPB)
1390		ucr2 |= UCR2_STPB;
1391	if (termios->c_cflag & PARENB) {
1392		ucr2 |= UCR2_PREN;
1393		if (termios->c_cflag & PARODD)
1394			ucr2 |= UCR2_PROE;
1395	}
1396
1397	del_timer_sync(&sport->timer);
1398
1399	/*
1400	 * Ask the core to calculate the divisor for us.
1401	 */
1402	baud = uart_get_baud_rate(port, termios, old, 50, port->uartclk / 16);
1403	quot = uart_get_divisor(port, baud);
1404
1405	spin_lock_irqsave(&sport->port.lock, flags);
1406
1407	sport->port.read_status_mask = 0;
1408	if (termios->c_iflag & INPCK)
1409		sport->port.read_status_mask |= (URXD_FRMERR | URXD_PRERR);
1410	if (termios->c_iflag & (BRKINT | PARMRK))
1411		sport->port.read_status_mask |= URXD_BRK;
1412
1413	/*
1414	 * Characters to ignore
1415	 */
1416	sport->port.ignore_status_mask = 0;
1417	if (termios->c_iflag & IGNPAR)
1418		sport->port.ignore_status_mask |= URXD_PRERR | URXD_FRMERR;
1419	if (termios->c_iflag & IGNBRK) {
1420		sport->port.ignore_status_mask |= URXD_BRK;
1421		/*
1422		 * If we're ignoring parity and break indicators,
1423		 * ignore overruns too (for real raw support).
1424		 */
1425		if (termios->c_iflag & IGNPAR)
1426			sport->port.ignore_status_mask |= URXD_OVRRUN;
1427	}
1428
1429	if ((termios->c_cflag & CREAD) == 0)
1430		sport->port.ignore_status_mask |= URXD_DUMMY_READ;
1431
1432	/*
1433	 * Update the per-port timeout.
1434	 */
1435	uart_update_timeout(port, termios->c_cflag, baud);
1436
1437	/*
1438	 * disable interrupts and drain transmitter
1439	 */
1440	old_ucr1 = readl(sport->port.membase + UCR1);
1441	writel(old_ucr1 & ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN),
1442			sport->port.membase + UCR1);
1443
1444	while (!(readl(sport->port.membase + USR2) & USR2_TXDC))
1445		barrier();
1446
1447	/* then, disable everything */
1448	old_ucr2 = readl(sport->port.membase + UCR2);
1449	writel(old_ucr2 & ~(UCR2_TXEN | UCR2_RXEN),
1450			sport->port.membase + UCR2);
1451	old_ucr2 &= (UCR2_TXEN | UCR2_RXEN | UCR2_ATEN);
1452
1453	/* custom-baudrate handling */
1454	div = sport->port.uartclk / (baud * 16);
1455	if (baud == 38400 && quot != div)
1456		baud = sport->port.uartclk / (quot * 16);
1457
1458	div = sport->port.uartclk / (baud * 16);
1459	if (div > 7)
1460		div = 7;
1461	if (!div)
1462		div = 1;
1463
1464	rational_best_approximation(16 * div * baud, sport->port.uartclk,
1465		1 << 16, 1 << 16, &num, &denom);
1466
1467	tdiv64 = sport->port.uartclk;
1468	tdiv64 *= num;
1469	do_div(tdiv64, denom * 16 * div);
1470	tty_termios_encode_baud_rate(termios,
1471				(speed_t)tdiv64, (speed_t)tdiv64);
1472
1473	num -= 1;
1474	denom -= 1;
1475
1476	ufcr = readl(sport->port.membase + UFCR);
1477	ufcr = (ufcr & (~UFCR_RFDIV)) | UFCR_RFDIV_REG(div);
1478	if (sport->dte_mode)
1479		ufcr |= UFCR_DCEDTE;
1480	writel(ufcr, sport->port.membase + UFCR);
1481
1482	writel(num, sport->port.membase + UBIR);
1483	writel(denom, sport->port.membase + UBMR);
1484
1485	if (!is_imx1_uart(sport))
1486		writel(sport->port.uartclk / div / 1000,
1487				sport->port.membase + IMX21_ONEMS);
 
 
 
 
 
 
 
 
 
 
 
 
1488
1489	writel(old_ucr1, sport->port.membase + UCR1);
 
 
1490
1491	/* set the parity, stop bits and data size */
1492	writel(ucr2 | old_ucr2, sport->port.membase + UCR2);
1493
1494	if (UART_ENABLE_MS(&sport->port, termios->c_cflag))
1495		imx_enable_ms(&sport->port);
1496
1497	spin_unlock_irqrestore(&sport->port.lock, flags);
1498}
1499
1500static const char *imx_type(struct uart_port *port)
1501{
1502	struct imx_port *sport = (struct imx_port *)port;
1503
1504	return sport->port.type == PORT_IMX ? "IMX" : NULL;
1505}
1506
1507/*
1508 * Configure/autoconfigure the port.
1509 */
1510static void imx_config_port(struct uart_port *port, int flags)
1511{
1512	struct imx_port *sport = (struct imx_port *)port;
1513
1514	if (flags & UART_CONFIG_TYPE)
1515		sport->port.type = PORT_IMX;
1516}
1517
1518/*
1519 * Verify the new serial_struct (for TIOCSSERIAL).
1520 * The only change we allow are to the flags and type, and
1521 * even then only between PORT_IMX and PORT_UNKNOWN
1522 */
1523static int
1524imx_verify_port(struct uart_port *port, struct serial_struct *ser)
1525{
1526	struct imx_port *sport = (struct imx_port *)port;
1527	int ret = 0;
1528
1529	if (ser->type != PORT_UNKNOWN && ser->type != PORT_IMX)
1530		ret = -EINVAL;
1531	if (sport->port.irq != ser->irq)
1532		ret = -EINVAL;
1533	if (ser->io_type != UPIO_MEM)
1534		ret = -EINVAL;
1535	if (sport->port.uartclk / 16 != ser->baud_base)
1536		ret = -EINVAL;
1537	if (sport->port.mapbase != (unsigned long)ser->iomem_base)
1538		ret = -EINVAL;
1539	if (sport->port.iobase != ser->port)
1540		ret = -EINVAL;
1541	if (ser->hub6 != 0)
1542		ret = -EINVAL;
1543	return ret;
1544}
1545
1546#if defined(CONFIG_CONSOLE_POLL)
1547
1548static int imx_poll_init(struct uart_port *port)
1549{
1550	struct imx_port *sport = (struct imx_port *)port;
1551	unsigned long flags;
1552	unsigned long temp;
1553	int retval;
1554
1555	retval = clk_prepare_enable(sport->clk_ipg);
1556	if (retval)
1557		return retval;
1558	retval = clk_prepare_enable(sport->clk_per);
1559	if (retval)
1560		clk_disable_unprepare(sport->clk_ipg);
1561
1562	imx_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1563
1564	spin_lock_irqsave(&sport->port.lock, flags);
1565
1566	temp = readl(sport->port.membase + UCR1);
1567	if (is_imx1_uart(sport))
1568		temp |= IMX1_UCR1_UARTCLKEN;
1569	temp |= UCR1_UARTEN | UCR1_RRDYEN;
1570	temp &= ~(UCR1_TXMPTYEN | UCR1_RTSDEN);
1571	writel(temp, sport->port.membase + UCR1);
1572
1573	temp = readl(sport->port.membase + UCR2);
1574	temp |= UCR2_RXEN;
1575	writel(temp, sport->port.membase + UCR2);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1576
1577	spin_unlock_irqrestore(&sport->port.lock, flags);
1578
1579	return 0;
1580}
1581
1582static int imx_poll_get_char(struct uart_port *port)
1583{
1584	if (!(readl_relaxed(port->membase + USR2) & USR2_RDR))
 
1585		return NO_POLL_CHAR;
1586
1587	return readl_relaxed(port->membase + URXD0) & URXD_RX_DATA;
1588}
1589
1590static void imx_poll_put_char(struct uart_port *port, unsigned char c)
1591{
 
1592	unsigned int status;
1593
1594	/* drain */
1595	do {
1596		status = readl_relaxed(port->membase + USR1);
1597	} while (~status & USR1_TRDY);
1598
1599	/* write */
1600	writel_relaxed(c, port->membase + URTX0);
1601
1602	/* flush */
1603	do {
1604		status = readl_relaxed(port->membase + USR2);
1605	} while (~status & USR2_TXDC);
1606}
1607#endif
1608
1609static int imx_rs485_config(struct uart_port *port,
1610			    struct serial_rs485 *rs485conf)
 
1611{
1612	struct imx_port *sport = (struct imx_port *)port;
1613
1614	/* unimplemented */
1615	rs485conf->delay_rts_before_send = 0;
1616	rs485conf->delay_rts_after_send = 0;
1617	rs485conf->flags |= SER_RS485_RX_DURING_TX;
1618
1619	/* RTS is required to control the transmitter */
1620	if (!sport->have_rtscts)
1621		rs485conf->flags &= ~SER_RS485_ENABLED;
1622
1623	if (rs485conf->flags & SER_RS485_ENABLED) {
1624		unsigned long temp;
 
 
 
1625
1626		/* disable transmitter */
1627		temp = readl(sport->port.membase + UCR2);
1628		if (rs485conf->flags & SER_RS485_RTS_AFTER_SEND)
1629			imx_port_rts_inactive(sport, &temp);
1630		else
1631			imx_port_rts_active(sport, &temp);
1632		writel(temp, sport->port.membase + UCR2);
1633	}
1634
 
 
 
 
 
1635	port->rs485 = *rs485conf;
1636
1637	return 0;
1638}
1639
1640static struct uart_ops imx_pops = {
1641	.tx_empty	= imx_tx_empty,
1642	.set_mctrl	= imx_set_mctrl,
1643	.get_mctrl	= imx_get_mctrl,
1644	.stop_tx	= imx_stop_tx,
1645	.start_tx	= imx_start_tx,
1646	.stop_rx	= imx_stop_rx,
1647	.enable_ms	= imx_enable_ms,
1648	.break_ctl	= imx_break_ctl,
1649	.startup	= imx_startup,
1650	.shutdown	= imx_shutdown,
1651	.flush_buffer	= imx_flush_buffer,
1652	.set_termios	= imx_set_termios,
1653	.type		= imx_type,
1654	.config_port	= imx_config_port,
1655	.verify_port	= imx_verify_port,
1656#if defined(CONFIG_CONSOLE_POLL)
1657	.poll_init      = imx_poll_init,
1658	.poll_get_char  = imx_poll_get_char,
1659	.poll_put_char  = imx_poll_put_char,
1660#endif
1661};
1662
1663static struct imx_port *imx_ports[UART_NR];
1664
1665#ifdef CONFIG_SERIAL_IMX_CONSOLE
1666static void imx_console_putchar(struct uart_port *port, int ch)
1667{
1668	struct imx_port *sport = (struct imx_port *)port;
1669
1670	while (readl(sport->port.membase + uts_reg(sport)) & UTS_TXFULL)
1671		barrier();
1672
1673	writel(ch, sport->port.membase + URTX0);
1674}
1675
1676/*
1677 * Interrupts are disabled on entering
1678 */
1679static void
1680imx_console_write(struct console *co, const char *s, unsigned int count)
1681{
1682	struct imx_port *sport = imx_ports[co->index];
1683	struct imx_port_ucrs old_ucr;
1684	unsigned int ucr1;
1685	unsigned long flags = 0;
1686	int locked = 1;
1687	int retval;
1688
1689	retval = clk_enable(sport->clk_per);
1690	if (retval)
1691		return;
1692	retval = clk_enable(sport->clk_ipg);
1693	if (retval) {
1694		clk_disable(sport->clk_per);
1695		return;
1696	}
1697
1698	if (sport->port.sysrq)
1699		locked = 0;
1700	else if (oops_in_progress)
1701		locked = spin_trylock_irqsave(&sport->port.lock, flags);
1702	else
1703		spin_lock_irqsave(&sport->port.lock, flags);
1704
1705	/*
1706	 *	First, save UCR1/2/3 and then disable interrupts
1707	 */
1708	imx_port_ucrs_save(&sport->port, &old_ucr);
1709	ucr1 = old_ucr.ucr1;
1710
1711	if (is_imx1_uart(sport))
1712		ucr1 |= IMX1_UCR1_UARTCLKEN;
1713	ucr1 |= UCR1_UARTEN;
1714	ucr1 &= ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN);
1715
1716	writel(ucr1, sport->port.membase + UCR1);
1717
1718	writel(old_ucr.ucr2 | UCR2_TXEN, sport->port.membase + UCR2);
1719
1720	uart_console_write(&sport->port, s, count, imx_console_putchar);
1721
1722	/*
1723	 *	Finally, wait for transmitter to become empty
1724	 *	and restore UCR1/2/3
1725	 */
1726	while (!(readl(sport->port.membase + USR2) & USR2_TXDC));
1727
1728	imx_port_ucrs_restore(&sport->port, &old_ucr);
1729
1730	if (locked)
1731		spin_unlock_irqrestore(&sport->port.lock, flags);
1732
1733	clk_disable(sport->clk_ipg);
1734	clk_disable(sport->clk_per);
1735}
1736
1737/*
1738 * If the port was already initialised (eg, by a boot loader),
1739 * try to determine the current setup.
1740 */
1741static void __init
1742imx_console_get_options(struct imx_port *sport, int *baud,
1743			   int *parity, int *bits)
1744{
1745
1746	if (readl(sport->port.membase + UCR1) & UCR1_UARTEN) {
1747		/* ok, the port was enabled */
1748		unsigned int ucr2, ubir, ubmr, uartclk;
1749		unsigned int baud_raw;
1750		unsigned int ucfr_rfdiv;
1751
1752		ucr2 = readl(sport->port.membase + UCR2);
1753
1754		*parity = 'n';
1755		if (ucr2 & UCR2_PREN) {
1756			if (ucr2 & UCR2_PROE)
1757				*parity = 'o';
1758			else
1759				*parity = 'e';
1760		}
1761
1762		if (ucr2 & UCR2_WS)
1763			*bits = 8;
1764		else
1765			*bits = 7;
1766
1767		ubir = readl(sport->port.membase + UBIR) & 0xffff;
1768		ubmr = readl(sport->port.membase + UBMR) & 0xffff;
1769
1770		ucfr_rfdiv = (readl(sport->port.membase + UFCR) & UFCR_RFDIV) >> 7;
1771		if (ucfr_rfdiv == 6)
1772			ucfr_rfdiv = 7;
1773		else
1774			ucfr_rfdiv = 6 - ucfr_rfdiv;
1775
1776		uartclk = clk_get_rate(sport->clk_per);
1777		uartclk /= ucfr_rfdiv;
1778
1779		{	/*
1780			 * The next code provides exact computation of
1781			 *   baud_raw = round(((uartclk/16) * (ubir + 1)) / (ubmr + 1))
1782			 * without need of float support or long long division,
1783			 * which would be required to prevent 32bit arithmetic overflow
1784			 */
1785			unsigned int mul = ubir + 1;
1786			unsigned int div = 16 * (ubmr + 1);
1787			unsigned int rem = uartclk % div;
1788
1789			baud_raw = (uartclk / div) * mul;
1790			baud_raw += (rem * mul + div / 2) / div;
1791			*baud = (baud_raw + 50) / 100 * 100;
1792		}
1793
1794		if (*baud != baud_raw)
1795			pr_info("Console IMX rounded baud rate from %d to %d\n",
1796				baud_raw, *baud);
1797	}
1798}
1799
1800static int __init
1801imx_console_setup(struct console *co, char *options)
1802{
1803	struct imx_port *sport;
1804	int baud = 9600;
1805	int bits = 8;
1806	int parity = 'n';
1807	int flow = 'n';
1808	int retval;
1809
1810	/*
1811	 * Check whether an invalid uart number has been specified, and
1812	 * if so, search for the first available port that does have
1813	 * console support.
1814	 */
1815	if (co->index == -1 || co->index >= ARRAY_SIZE(imx_ports))
1816		co->index = 0;
1817	sport = imx_ports[co->index];
1818	if (sport == NULL)
1819		return -ENODEV;
1820
1821	/* For setting the registers, we only need to enable the ipg clock. */
1822	retval = clk_prepare_enable(sport->clk_ipg);
1823	if (retval)
1824		goto error_console;
1825
1826	if (options)
1827		uart_parse_options(options, &baud, &parity, &bits, &flow);
1828	else
1829		imx_console_get_options(sport, &baud, &parity, &bits);
1830
1831	imx_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1832
1833	retval = uart_set_options(&sport->port, co, baud, parity, bits, flow);
1834
1835	clk_disable(sport->clk_ipg);
1836	if (retval) {
1837		clk_unprepare(sport->clk_ipg);
1838		goto error_console;
1839	}
1840
1841	retval = clk_prepare(sport->clk_per);
1842	if (retval)
1843		clk_disable_unprepare(sport->clk_ipg);
1844
1845error_console:
1846	return retval;
1847}
1848
1849static struct uart_driver imx_reg;
1850static struct console imx_console = {
1851	.name		= DEV_NAME,
1852	.write		= imx_console_write,
1853	.device		= uart_console_device,
1854	.setup		= imx_console_setup,
1855	.flags		= CON_PRINTBUFFER,
1856	.index		= -1,
1857	.data		= &imx_reg,
1858};
1859
1860#define IMX_CONSOLE	&imx_console
1861
1862#ifdef CONFIG_OF
1863static void imx_console_early_putchar(struct uart_port *port, int ch)
1864{
1865	while (readl_relaxed(port->membase + IMX21_UTS) & UTS_TXFULL)
1866		cpu_relax();
1867
1868	writel_relaxed(ch, port->membase + URTX0);
1869}
1870
1871static void imx_console_early_write(struct console *con, const char *s,
1872				    unsigned count)
1873{
1874	struct earlycon_device *dev = con->data;
1875
1876	uart_console_write(&dev->port, s, count, imx_console_early_putchar);
1877}
1878
1879static int __init
1880imx_console_early_setup(struct earlycon_device *dev, const char *opt)
1881{
1882	if (!dev->port.membase)
1883		return -ENODEV;
1884
1885	dev->con->write = imx_console_early_write;
1886
1887	return 0;
1888}
1889OF_EARLYCON_DECLARE(ec_imx6q, "fsl,imx6q-uart", imx_console_early_setup);
1890OF_EARLYCON_DECLARE(ec_imx21, "fsl,imx21-uart", imx_console_early_setup);
1891#endif
1892
1893#else
1894#define IMX_CONSOLE	NULL
1895#endif
1896
1897static struct uart_driver imx_reg = {
1898	.owner          = THIS_MODULE,
1899	.driver_name    = DRIVER_NAME,
1900	.dev_name       = DEV_NAME,
1901	.major          = SERIAL_IMX_MAJOR,
1902	.minor          = MINOR_START,
1903	.nr             = ARRAY_SIZE(imx_ports),
1904	.cons           = IMX_CONSOLE,
1905};
1906
1907#ifdef CONFIG_OF
1908/*
1909 * This function returns 1 iff pdev isn't a device instatiated by dt, 0 iff it
1910 * could successfully get all information from dt or a negative errno.
1911 */
1912static int serial_imx_probe_dt(struct imx_port *sport,
1913		struct platform_device *pdev)
1914{
1915	struct device_node *np = pdev->dev.of_node;
1916	int ret;
1917
1918	sport->devdata = of_device_get_match_data(&pdev->dev);
1919	if (!sport->devdata)
1920		/* no device tree device */
1921		return 1;
1922
1923	ret = of_alias_get_id(np, "serial");
1924	if (ret < 0) {
1925		dev_err(&pdev->dev, "failed to get alias id, errno %d\n", ret);
1926		return ret;
1927	}
1928	sport->port.line = ret;
1929
1930	if (of_get_property(np, "fsl,uart-has-rtscts", NULL))
 
1931		sport->have_rtscts = 1;
1932
1933	if (of_get_property(np, "fsl,dte-mode", NULL))
1934		sport->dte_mode = 1;
1935
 
 
 
 
 
 
 
 
 
1936	return 0;
1937}
1938#else
1939static inline int serial_imx_probe_dt(struct imx_port *sport,
1940		struct platform_device *pdev)
1941{
1942	return 1;
1943}
1944#endif
1945
1946static void serial_imx_probe_pdata(struct imx_port *sport,
1947		struct platform_device *pdev)
1948{
1949	struct imxuart_platform_data *pdata = dev_get_platdata(&pdev->dev);
1950
1951	sport->port.line = pdev->id;
1952	sport->devdata = (struct imx_uart_data	*) pdev->id_entry->driver_data;
1953
1954	if (!pdata)
1955		return;
1956
1957	if (pdata->flags & IMXUART_HAVE_RTSCTS)
1958		sport->have_rtscts = 1;
1959}
1960
1961static int serial_imx_probe(struct platform_device *pdev)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1962{
1963	struct imx_port *sport;
1964	void __iomem *base;
1965	int ret = 0, reg;
 
1966	struct resource *res;
1967	int txirq, rxirq, rtsirq;
1968
1969	sport = devm_kzalloc(&pdev->dev, sizeof(*sport), GFP_KERNEL);
1970	if (!sport)
1971		return -ENOMEM;
1972
1973	ret = serial_imx_probe_dt(sport, pdev);
1974	if (ret > 0)
1975		serial_imx_probe_pdata(sport, pdev);
1976	else if (ret < 0)
1977		return ret;
1978
 
 
 
 
 
 
1979	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1980	base = devm_ioremap_resource(&pdev->dev, res);
1981	if (IS_ERR(base))
1982		return PTR_ERR(base);
1983
1984	rxirq = platform_get_irq(pdev, 0);
1985	txirq = platform_get_irq(pdev, 1);
1986	rtsirq = platform_get_irq(pdev, 2);
 
 
1987
1988	sport->port.dev = &pdev->dev;
1989	sport->port.mapbase = res->start;
1990	sport->port.membase = base;
1991	sport->port.type = PORT_IMX,
1992	sport->port.iotype = UPIO_MEM;
1993	sport->port.irq = rxirq;
1994	sport->port.fifosize = 32;
1995	sport->port.ops = &imx_pops;
1996	sport->port.rs485_config = imx_rs485_config;
1997	sport->port.rs485.flags =
1998		SER_RS485_RTS_ON_SEND | SER_RS485_RX_DURING_TX;
1999	sport->port.flags = UPF_BOOT_AUTOCONF;
2000	init_timer(&sport->timer);
2001	sport->timer.function = imx_timeout;
2002	sport->timer.data     = (unsigned long)sport;
2003
2004	sport->gpios = mctrl_gpio_init(&sport->port, 0);
2005	if (IS_ERR(sport->gpios))
2006		return PTR_ERR(sport->gpios);
2007
2008	sport->clk_ipg = devm_clk_get(&pdev->dev, "ipg");
2009	if (IS_ERR(sport->clk_ipg)) {
2010		ret = PTR_ERR(sport->clk_ipg);
2011		dev_err(&pdev->dev, "failed to get ipg clk: %d\n", ret);
2012		return ret;
2013	}
2014
2015	sport->clk_per = devm_clk_get(&pdev->dev, "per");
2016	if (IS_ERR(sport->clk_per)) {
2017		ret = PTR_ERR(sport->clk_per);
2018		dev_err(&pdev->dev, "failed to get per clk: %d\n", ret);
2019		return ret;
2020	}
2021
2022	sport->port.uartclk = clk_get_rate(sport->clk_per);
2023
2024	/* For register access, we only need to enable the ipg clock. */
2025	ret = clk_prepare_enable(sport->clk_ipg);
2026	if (ret)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2027		return ret;
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2028
2029	/* Disable interrupts before requesting them */
2030	reg = readl_relaxed(sport->port.membase + UCR1);
2031	reg &= ~(UCR1_ADEN | UCR1_TRDYEN | UCR1_IDEN | UCR1_RRDYEN |
2032		 UCR1_TXMPTYEN | UCR1_RTSDEN);
2033	writel_relaxed(reg, sport->port.membase + UCR1);
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2034
2035	clk_disable_unprepare(sport->clk_ipg);
2036
 
 
 
 
 
2037	/*
2038	 * Allocate the IRQ(s) i.MX1 has three interrupts whereas later
2039	 * chips only have one interrupt.
2040	 */
2041	if (txirq > 0) {
2042		ret = devm_request_irq(&pdev->dev, rxirq, imx_rxint, 0,
 
 
 
 
 
 
 
 
2043				       dev_name(&pdev->dev), sport);
2044		if (ret)
 
 
2045			return ret;
 
2046
2047		ret = devm_request_irq(&pdev->dev, txirq, imx_txint, 0,
2048				       dev_name(&pdev->dev), sport);
2049		if (ret)
 
 
2050			return ret;
 
2051	} else {
2052		ret = devm_request_irq(&pdev->dev, rxirq, imx_int, 0,
2053				       dev_name(&pdev->dev), sport);
2054		if (ret)
 
2055			return ret;
 
2056	}
2057
2058	imx_ports[sport->port.line] = sport;
2059
2060	platform_set_drvdata(pdev, sport);
2061
2062	return uart_add_one_port(&imx_reg, &sport->port);
2063}
2064
2065static int serial_imx_remove(struct platform_device *pdev)
2066{
2067	struct imx_port *sport = platform_get_drvdata(pdev);
2068
2069	return uart_remove_one_port(&imx_reg, &sport->port);
2070}
2071
2072static void serial_imx_restore_context(struct imx_port *sport)
2073{
2074	if (!sport->context_saved)
 
 
 
 
2075		return;
 
2076
2077	writel(sport->saved_reg[4], sport->port.membase + UFCR);
2078	writel(sport->saved_reg[5], sport->port.membase + UESC);
2079	writel(sport->saved_reg[6], sport->port.membase + UTIM);
2080	writel(sport->saved_reg[7], sport->port.membase + UBIR);
2081	writel(sport->saved_reg[8], sport->port.membase + UBMR);
2082	writel(sport->saved_reg[9], sport->port.membase + IMX21_UTS);
2083	writel(sport->saved_reg[0], sport->port.membase + UCR1);
2084	writel(sport->saved_reg[1] | UCR2_SRST, sport->port.membase + UCR2);
2085	writel(sport->saved_reg[2], sport->port.membase + UCR3);
2086	writel(sport->saved_reg[3], sport->port.membase + UCR4);
2087	sport->context_saved = false;
 
2088}
2089
2090static void serial_imx_save_context(struct imx_port *sport)
2091{
 
 
2092	/* Save necessary regs */
2093	sport->saved_reg[0] = readl(sport->port.membase + UCR1);
2094	sport->saved_reg[1] = readl(sport->port.membase + UCR2);
2095	sport->saved_reg[2] = readl(sport->port.membase + UCR3);
2096	sport->saved_reg[3] = readl(sport->port.membase + UCR4);
2097	sport->saved_reg[4] = readl(sport->port.membase + UFCR);
2098	sport->saved_reg[5] = readl(sport->port.membase + UESC);
2099	sport->saved_reg[6] = readl(sport->port.membase + UTIM);
2100	sport->saved_reg[7] = readl(sport->port.membase + UBIR);
2101	sport->saved_reg[8] = readl(sport->port.membase + UBMR);
2102	sport->saved_reg[9] = readl(sport->port.membase + IMX21_UTS);
 
2103	sport->context_saved = true;
 
2104}
2105
2106static void serial_imx_enable_wakeup(struct imx_port *sport, bool on)
2107{
2108	unsigned int val;
2109
2110	val = readl(sport->port.membase + UCR3);
2111	if (on)
2112		val |= UCR3_AWAKEN;
2113	else
2114		val &= ~UCR3_AWAKEN;
2115	writel(val, sport->port.membase + UCR3);
 
 
2116
2117	val = readl(sport->port.membase + UCR1);
2118	if (on)
2119		val |= UCR1_RTSDEN;
2120	else
2121		val &= ~UCR1_RTSDEN;
2122	writel(val, sport->port.membase + UCR1);
 
 
2123}
2124
2125static int imx_serial_port_suspend_noirq(struct device *dev)
2126{
2127	struct platform_device *pdev = to_platform_device(dev);
2128	struct imx_port *sport = platform_get_drvdata(pdev);
 
 
 
 
 
 
 
 
 
 
 
 
2129	int ret;
2130
 
 
2131	ret = clk_enable(sport->clk_ipg);
2132	if (ret)
2133		return ret;
2134
2135	serial_imx_save_context(sport);
2136
2137	clk_disable(sport->clk_ipg);
2138
2139	return 0;
2140}
2141
2142static int imx_serial_port_resume_noirq(struct device *dev)
2143{
2144	struct platform_device *pdev = to_platform_device(dev);
2145	struct imx_port *sport = platform_get_drvdata(pdev);
2146	int ret;
2147
2148	ret = clk_enable(sport->clk_ipg);
 
 
 
2149	if (ret)
2150		return ret;
2151
2152	serial_imx_restore_context(sport);
2153
2154	clk_disable(sport->clk_ipg);
2155
2156	return 0;
2157}
2158
2159static int imx_serial_port_suspend(struct device *dev)
2160{
2161	struct platform_device *pdev = to_platform_device(dev);
2162	struct imx_port *sport = platform_get_drvdata(pdev);
2163
2164	/* enable wakeup from i.MX UART */
2165	serial_imx_enable_wakeup(sport, true);
 
 
 
2166
2167	uart_suspend_port(&imx_reg, &sport->port);
2168
2169	/* Needed to enable clock in suspend_noirq */
2170	return clk_prepare(sport->clk_ipg);
2171}
2172
2173static int imx_serial_port_resume(struct device *dev)
2174{
2175	struct platform_device *pdev = to_platform_device(dev);
2176	struct imx_port *sport = platform_get_drvdata(pdev);
2177
2178	/* disable wakeup from i.MX UART */
2179	serial_imx_enable_wakeup(sport, false);
2180
2181	uart_resume_port(&imx_reg, &sport->port);
 
2182
2183	clk_unprepare(sport->clk_ipg);
 
 
 
 
 
 
2184
2185	return 0;
2186}
2187
2188static const struct dev_pm_ops imx_serial_port_pm_ops = {
2189	.suspend_noirq = imx_serial_port_suspend_noirq,
2190	.resume_noirq = imx_serial_port_resume_noirq,
2191	.suspend = imx_serial_port_suspend,
2192	.resume = imx_serial_port_resume,
 
 
 
 
 
2193};
2194
2195static struct platform_driver serial_imx_driver = {
2196	.probe		= serial_imx_probe,
2197	.remove		= serial_imx_remove,
2198
2199	.id_table	= imx_uart_devtype,
2200	.driver		= {
2201		.name	= "imx-uart",
2202		.of_match_table = imx_uart_dt_ids,
2203		.pm	= &imx_serial_port_pm_ops,
2204	},
2205};
2206
2207static int __init imx_serial_init(void)
2208{
2209	int ret = uart_register_driver(&imx_reg);
2210
2211	if (ret)
2212		return ret;
2213
2214	ret = platform_driver_register(&serial_imx_driver);
2215	if (ret != 0)
2216		uart_unregister_driver(&imx_reg);
2217
2218	return ret;
2219}
2220
2221static void __exit imx_serial_exit(void)
2222{
2223	platform_driver_unregister(&serial_imx_driver);
2224	uart_unregister_driver(&imx_reg);
2225}
2226
2227module_init(imx_serial_init);
2228module_exit(imx_serial_exit);
2229
2230MODULE_AUTHOR("Sascha Hauer");
2231MODULE_DESCRIPTION("IMX generic serial port driver");
2232MODULE_LICENSE("GPL");
2233MODULE_ALIAS("platform:imx-uart");
v5.9
   1// SPDX-License-Identifier: GPL-2.0+
   2/*
   3 * Driver for Motorola/Freescale IMX serial ports
   4 *
   5 * Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
   6 *
   7 * Author: Sascha Hauer <sascha@saschahauer.de>
   8 * Copyright (C) 2004 Pengutronix
 
 
 
 
 
 
 
 
 
 
   9 */
  10
 
 
 
 
  11#include <linux/module.h>
  12#include <linux/ioport.h>
  13#include <linux/init.h>
  14#include <linux/console.h>
  15#include <linux/sysrq.h>
  16#include <linux/platform_device.h>
  17#include <linux/tty.h>
  18#include <linux/tty_flip.h>
  19#include <linux/serial_core.h>
  20#include <linux/serial.h>
  21#include <linux/clk.h>
  22#include <linux/delay.h>
  23#include <linux/ktime.h>
  24#include <linux/pinctrl/consumer.h>
  25#include <linux/rational.h>
  26#include <linux/slab.h>
  27#include <linux/of.h>
  28#include <linux/of_device.h>
  29#include <linux/io.h>
  30#include <linux/dma-mapping.h>
  31
  32#include <asm/irq.h>
  33#include <linux/platform_data/serial-imx.h>
  34#include <linux/platform_data/dma-imx.h>
  35
  36#include "serial_mctrl_gpio.h"
  37
  38/* Register definitions */
  39#define URXD0 0x0  /* Receiver Register */
  40#define URTX0 0x40 /* Transmitter Register */
  41#define UCR1  0x80 /* Control Register 1 */
  42#define UCR2  0x84 /* Control Register 2 */
  43#define UCR3  0x88 /* Control Register 3 */
  44#define UCR4  0x8c /* Control Register 4 */
  45#define UFCR  0x90 /* FIFO Control Register */
  46#define USR1  0x94 /* Status Register 1 */
  47#define USR2  0x98 /* Status Register 2 */
  48#define UESC  0x9c /* Escape Character Register */
  49#define UTIM  0xa0 /* Escape Timer Register */
  50#define UBIR  0xa4 /* BRM Incremental Register */
  51#define UBMR  0xa8 /* BRM Modulator Register */
  52#define UBRC  0xac /* Baud Rate Count Register */
  53#define IMX21_ONEMS 0xb0 /* One Millisecond register */
  54#define IMX1_UTS 0xd0 /* UART Test Register on i.mx1 */
  55#define IMX21_UTS 0xb4 /* UART Test Register on all other i.mx*/
  56
  57/* UART Control Register Bit Fields.*/
  58#define URXD_DUMMY_READ (1<<16)
  59#define URXD_CHARRDY	(1<<15)
  60#define URXD_ERR	(1<<14)
  61#define URXD_OVRRUN	(1<<13)
  62#define URXD_FRMERR	(1<<12)
  63#define URXD_BRK	(1<<11)
  64#define URXD_PRERR	(1<<10)
  65#define URXD_RX_DATA	(0xFF<<0)
  66#define UCR1_ADEN	(1<<15) /* Auto detect interrupt */
  67#define UCR1_ADBR	(1<<14) /* Auto detect baud rate */
  68#define UCR1_TRDYEN	(1<<13) /* Transmitter ready interrupt enable */
  69#define UCR1_IDEN	(1<<12) /* Idle condition interrupt */
  70#define UCR1_ICD_REG(x) (((x) & 3) << 10) /* idle condition detect */
  71#define UCR1_RRDYEN	(1<<9)	/* Recv ready interrupt enable */
  72#define UCR1_RXDMAEN	(1<<8)	/* Recv ready DMA enable */
  73#define UCR1_IREN	(1<<7)	/* Infrared interface enable */
  74#define UCR1_TXMPTYEN	(1<<6)	/* Transimitter empty interrupt enable */
  75#define UCR1_RTSDEN	(1<<5)	/* RTS delta interrupt enable */
  76#define UCR1_SNDBRK	(1<<4)	/* Send break */
  77#define UCR1_TXDMAEN	(1<<3)	/* Transmitter ready DMA enable */
  78#define IMX1_UCR1_UARTCLKEN (1<<2) /* UART clock enabled, i.mx1 only */
  79#define UCR1_ATDMAEN    (1<<2)  /* Aging DMA Timer Enable */
  80#define UCR1_DOZE	(1<<1)	/* Doze */
  81#define UCR1_UARTEN	(1<<0)	/* UART enabled */
  82#define UCR2_ESCI	(1<<15)	/* Escape seq interrupt enable */
  83#define UCR2_IRTS	(1<<14)	/* Ignore RTS pin */
  84#define UCR2_CTSC	(1<<13)	/* CTS pin control */
  85#define UCR2_CTS	(1<<12)	/* Clear to send */
  86#define UCR2_ESCEN	(1<<11)	/* Escape enable */
  87#define UCR2_PREN	(1<<8)	/* Parity enable */
  88#define UCR2_PROE	(1<<7)	/* Parity odd/even */
  89#define UCR2_STPB	(1<<6)	/* Stop */
  90#define UCR2_WS		(1<<5)	/* Word size */
  91#define UCR2_RTSEN	(1<<4)	/* Request to send interrupt enable */
  92#define UCR2_ATEN	(1<<3)	/* Aging Timer Enable */
  93#define UCR2_TXEN	(1<<2)	/* Transmitter enabled */
  94#define UCR2_RXEN	(1<<1)	/* Receiver enabled */
  95#define UCR2_SRST	(1<<0)	/* SW reset */
  96#define UCR3_DTREN	(1<<13) /* DTR interrupt enable */
  97#define UCR3_PARERREN	(1<<12) /* Parity enable */
  98#define UCR3_FRAERREN	(1<<11) /* Frame error interrupt enable */
  99#define UCR3_DSR	(1<<10) /* Data set ready */
 100#define UCR3_DCD	(1<<9)	/* Data carrier detect */
 101#define UCR3_RI		(1<<8)	/* Ring indicator */
 102#define UCR3_ADNIMP	(1<<7)	/* Autobaud Detection Not Improved */
 103#define UCR3_RXDSEN	(1<<6)	/* Receive status interrupt enable */
 104#define UCR3_AIRINTEN	(1<<5)	/* Async IR wake interrupt enable */
 105#define UCR3_AWAKEN	(1<<4)	/* Async wake interrupt enable */
 106#define UCR3_DTRDEN	(1<<3)	/* Data Terminal Ready Delta Enable. */
 107#define IMX21_UCR3_RXDMUXSEL	(1<<2)	/* RXD Muxed Input Select */
 108#define UCR3_INVT	(1<<1)	/* Inverted Infrared transmission */
 109#define UCR3_BPEN	(1<<0)	/* Preset registers enable */
 110#define UCR4_CTSTL_SHF	10	/* CTS trigger level shift */
 111#define UCR4_CTSTL_MASK	0x3F	/* CTS trigger is 6 bits wide */
 112#define UCR4_INVR	(1<<9)	/* Inverted infrared reception */
 113#define UCR4_ENIRI	(1<<8)	/* Serial infrared interrupt enable */
 114#define UCR4_WKEN	(1<<7)	/* Wake interrupt enable */
 115#define UCR4_REF16	(1<<6)	/* Ref freq 16 MHz */
 116#define UCR4_IDDMAEN    (1<<6)  /* DMA IDLE Condition Detected */
 117#define UCR4_IRSC	(1<<5)	/* IR special case */
 118#define UCR4_TCEN	(1<<3)	/* Transmit complete interrupt enable */
 119#define UCR4_BKEN	(1<<2)	/* Break condition interrupt enable */
 120#define UCR4_OREN	(1<<1)	/* Receiver overrun interrupt enable */
 121#define UCR4_DREN	(1<<0)	/* Recv data ready interrupt enable */
 122#define UFCR_RXTL_SHF	0	/* Receiver trigger level shift */
 123#define UFCR_DCEDTE	(1<<6)	/* DCE/DTE mode select */
 124#define UFCR_RFDIV	(7<<7)	/* Reference freq divider mask */
 125#define UFCR_RFDIV_REG(x)	(((x) < 7 ? 6 - (x) : 6) << 7)
 126#define UFCR_TXTL_SHF	10	/* Transmitter trigger level shift */
 127#define USR1_PARITYERR	(1<<15) /* Parity error interrupt flag */
 128#define USR1_RTSS	(1<<14) /* RTS pin status */
 129#define USR1_TRDY	(1<<13) /* Transmitter ready interrupt/dma flag */
 130#define USR1_RTSD	(1<<12) /* RTS delta */
 131#define USR1_ESCF	(1<<11) /* Escape seq interrupt flag */
 132#define USR1_FRAMERR	(1<<10) /* Frame error interrupt flag */
 133#define USR1_RRDY	(1<<9)	 /* Receiver ready interrupt/dma flag */
 134#define USR1_AGTIM	(1<<8)	 /* Ageing timer interrupt flag */
 135#define USR1_DTRD	(1<<7)	 /* DTR Delta */
 136#define USR1_RXDS	 (1<<6)	 /* Receiver idle interrupt flag */
 137#define USR1_AIRINT	 (1<<5)	 /* Async IR wake interrupt flag */
 138#define USR1_AWAKE	 (1<<4)	 /* Aysnc wake interrupt flag */
 139#define USR2_ADET	 (1<<15) /* Auto baud rate detect complete */
 140#define USR2_TXFE	 (1<<14) /* Transmit buffer FIFO empty */
 141#define USR2_DTRF	 (1<<13) /* DTR edge interrupt flag */
 142#define USR2_IDLE	 (1<<12) /* Idle condition */
 143#define USR2_RIDELT	 (1<<10) /* Ring Interrupt Delta */
 144#define USR2_RIIN	 (1<<9)	 /* Ring Indicator Input */
 145#define USR2_IRINT	 (1<<8)	 /* Serial infrared interrupt flag */
 146#define USR2_WAKE	 (1<<7)	 /* Wake */
 147#define USR2_DCDIN	 (1<<5)	 /* Data Carrier Detect Input */
 148#define USR2_RTSF	 (1<<4)	 /* RTS edge interrupt flag */
 149#define USR2_TXDC	 (1<<3)	 /* Transmitter complete */
 150#define USR2_BRCD	 (1<<2)	 /* Break condition */
 151#define USR2_ORE	(1<<1)	 /* Overrun error */
 152#define USR2_RDR	(1<<0)	 /* Recv data ready */
 153#define UTS_FRCPERR	(1<<13) /* Force parity error */
 154#define UTS_LOOP	(1<<12)	 /* Loop tx and rx */
 155#define UTS_TXEMPTY	 (1<<6)	 /* TxFIFO empty */
 156#define UTS_RXEMPTY	 (1<<5)	 /* RxFIFO empty */
 157#define UTS_TXFULL	 (1<<4)	 /* TxFIFO full */
 158#define UTS_RXFULL	 (1<<3)	 /* RxFIFO full */
 159#define UTS_SOFTRST	 (1<<0)	 /* Software reset */
 160
 161/* We've been assigned a range on the "Low-density serial ports" major */
 162#define SERIAL_IMX_MAJOR	207
 163#define MINOR_START		16
 164#define DEV_NAME		"ttymxc"
 165
 166/*
 167 * This determines how often we check the modem status signals
 168 * for any change.  They generally aren't connected to an IRQ
 169 * so we have to poll them.  We also check immediately before
 170 * filling the TX fifo incase CTS has been dropped.
 171 */
 172#define MCTRL_TIMEOUT	(250*HZ/1000)
 173
 174#define DRIVER_NAME "IMX-uart"
 175
 176#define UART_NR 8
 177
 178/* i.MX21 type uart runs on all i.mx except i.MX1 and i.MX6q */
 179enum imx_uart_type {
 180	IMX1_UART,
 181	IMX21_UART,
 182	IMX53_UART,
 183	IMX6Q_UART,
 184};
 185
 186/* device type dependent stuff */
 187struct imx_uart_data {
 188	unsigned uts_reg;
 189	enum imx_uart_type devtype;
 190};
 191
 192enum imx_tx_state {
 193	OFF,
 194	WAIT_AFTER_RTS,
 195	SEND,
 196	WAIT_AFTER_SEND,
 197};
 198
 199struct imx_port {
 200	struct uart_port	port;
 201	struct timer_list	timer;
 202	unsigned int		old_status;
 203	unsigned int		have_rtscts:1;
 204	unsigned int		have_rtsgpio:1;
 205	unsigned int		dte_mode:1;
 206	unsigned int		inverted_tx:1;
 207	unsigned int		inverted_rx:1;
 
 208	struct clk		*clk_ipg;
 209	struct clk		*clk_per;
 210	const struct imx_uart_data *devdata;
 211
 212	struct mctrl_gpios *gpios;
 213
 214	/* shadow registers */
 215	unsigned int ucr1;
 216	unsigned int ucr2;
 217	unsigned int ucr3;
 218	unsigned int ucr4;
 219	unsigned int ufcr;
 220
 221	/* DMA fields */
 
 222	unsigned int		dma_is_enabled:1;
 223	unsigned int		dma_is_rxing:1;
 224	unsigned int		dma_is_txing:1;
 225	struct dma_chan		*dma_chan_rx, *dma_chan_tx;
 226	struct scatterlist	rx_sgl, tx_sgl[2];
 227	void			*rx_buf;
 228	struct circ_buf		rx_ring;
 229	unsigned int		rx_periods;
 230	dma_cookie_t		rx_cookie;
 231	unsigned int		tx_bytes;
 232	unsigned int		dma_tx_nents;
 
 233	unsigned int            saved_reg[10];
 234	bool			context_saved;
 235
 236	enum imx_tx_state	tx_state;
 237	struct hrtimer		trigger_start_tx;
 238	struct hrtimer		trigger_stop_tx;
 239};
 240
 241struct imx_port_ucrs {
 242	unsigned int	ucr1;
 243	unsigned int	ucr2;
 244	unsigned int	ucr3;
 245};
 246
 247static struct imx_uart_data imx_uart_devdata[] = {
 248	[IMX1_UART] = {
 249		.uts_reg = IMX1_UTS,
 250		.devtype = IMX1_UART,
 251	},
 252	[IMX21_UART] = {
 253		.uts_reg = IMX21_UTS,
 254		.devtype = IMX21_UART,
 255	},
 256	[IMX53_UART] = {
 257		.uts_reg = IMX21_UTS,
 258		.devtype = IMX53_UART,
 259	},
 260	[IMX6Q_UART] = {
 261		.uts_reg = IMX21_UTS,
 262		.devtype = IMX6Q_UART,
 263	},
 264};
 265
 266static const struct platform_device_id imx_uart_devtype[] = {
 267	{
 268		.name = "imx1-uart",
 269		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX1_UART],
 270	}, {
 271		.name = "imx21-uart",
 272		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX21_UART],
 273	}, {
 274		.name = "imx53-uart",
 275		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX53_UART],
 276	}, {
 277		.name = "imx6q-uart",
 278		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX6Q_UART],
 279	}, {
 280		/* sentinel */
 281	}
 282};
 283MODULE_DEVICE_TABLE(platform, imx_uart_devtype);
 284
 285static const struct of_device_id imx_uart_dt_ids[] = {
 286	{ .compatible = "fsl,imx6q-uart", .data = &imx_uart_devdata[IMX6Q_UART], },
 287	{ .compatible = "fsl,imx53-uart", .data = &imx_uart_devdata[IMX53_UART], },
 288	{ .compatible = "fsl,imx1-uart", .data = &imx_uart_devdata[IMX1_UART], },
 289	{ .compatible = "fsl,imx21-uart", .data = &imx_uart_devdata[IMX21_UART], },
 290	{ /* sentinel */ }
 291};
 292MODULE_DEVICE_TABLE(of, imx_uart_dt_ids);
 293
 294static void imx_uart_writel(struct imx_port *sport, u32 val, u32 offset)
 295{
 296	switch (offset) {
 297	case UCR1:
 298		sport->ucr1 = val;
 299		break;
 300	case UCR2:
 301		sport->ucr2 = val;
 302		break;
 303	case UCR3:
 304		sport->ucr3 = val;
 305		break;
 306	case UCR4:
 307		sport->ucr4 = val;
 308		break;
 309	case UFCR:
 310		sport->ufcr = val;
 311		break;
 312	default:
 313		break;
 314	}
 315	writel(val, sport->port.membase + offset);
 316}
 317
 318static u32 imx_uart_readl(struct imx_port *sport, u32 offset)
 319{
 320	switch (offset) {
 321	case UCR1:
 322		return sport->ucr1;
 323		break;
 324	case UCR2:
 325		/*
 326		 * UCR2_SRST is the only bit in the cached registers that might
 327		 * differ from the value that was last written. As it only
 328		 * automatically becomes one after being cleared, reread
 329		 * conditionally.
 330		 */
 331		if (!(sport->ucr2 & UCR2_SRST))
 332			sport->ucr2 = readl(sport->port.membase + offset);
 333		return sport->ucr2;
 334		break;
 335	case UCR3:
 336		return sport->ucr3;
 337		break;
 338	case UCR4:
 339		return sport->ucr4;
 340		break;
 341	case UFCR:
 342		return sport->ufcr;
 343		break;
 344	default:
 345		return readl(sport->port.membase + offset);
 346	}
 347}
 348
 349static inline unsigned imx_uart_uts_reg(struct imx_port *sport)
 350{
 351	return sport->devdata->uts_reg;
 352}
 353
 354static inline int imx_uart_is_imx1(struct imx_port *sport)
 355{
 356	return sport->devdata->devtype == IMX1_UART;
 357}
 358
 359static inline int imx_uart_is_imx21(struct imx_port *sport)
 360{
 361	return sport->devdata->devtype == IMX21_UART;
 362}
 363
 364static inline int imx_uart_is_imx53(struct imx_port *sport)
 365{
 366	return sport->devdata->devtype == IMX53_UART;
 367}
 368
 369static inline int imx_uart_is_imx6q(struct imx_port *sport)
 370{
 371	return sport->devdata->devtype == IMX6Q_UART;
 372}
 373/*
 374 * Save and restore functions for UCR1, UCR2 and UCR3 registers
 375 */
 376#if IS_ENABLED(CONFIG_SERIAL_IMX_CONSOLE)
 377static void imx_uart_ucrs_save(struct imx_port *sport,
 378			       struct imx_port_ucrs *ucr)
 379{
 380	/* save control registers */
 381	ucr->ucr1 = imx_uart_readl(sport, UCR1);
 382	ucr->ucr2 = imx_uart_readl(sport, UCR2);
 383	ucr->ucr3 = imx_uart_readl(sport, UCR3);
 384}
 385
 386static void imx_uart_ucrs_restore(struct imx_port *sport,
 387				  struct imx_port_ucrs *ucr)
 388{
 389	/* restore control registers */
 390	imx_uart_writel(sport, ucr->ucr1, UCR1);
 391	imx_uart_writel(sport, ucr->ucr2, UCR2);
 392	imx_uart_writel(sport, ucr->ucr3, UCR3);
 393}
 394#endif
 395
 396/* called with port.lock taken and irqs caller dependent */
 397static void imx_uart_rts_active(struct imx_port *sport, u32 *ucr2)
 398{
 399	*ucr2 &= ~(UCR2_CTSC | UCR2_CTS);
 400
 401	sport->port.mctrl |= TIOCM_RTS;
 402	mctrl_gpio_set(sport->gpios, sport->port.mctrl);
 403}
 404
 405/* called with port.lock taken and irqs caller dependent */
 406static void imx_uart_rts_inactive(struct imx_port *sport, u32 *ucr2)
 407{
 408	*ucr2 &= ~UCR2_CTSC;
 409	*ucr2 |= UCR2_CTS;
 410
 411	sport->port.mctrl &= ~TIOCM_RTS;
 412	mctrl_gpio_set(sport->gpios, sport->port.mctrl);
 413}
 414
 415static void start_hrtimer_ms(struct hrtimer *hrt, unsigned long msec)
 416{
 417       long sec = msec / MSEC_PER_SEC;
 418       long nsec = (msec % MSEC_PER_SEC) * 1000000;
 419       ktime_t t = ktime_set(sec, nsec);
 420
 421       hrtimer_start(hrt, t, HRTIMER_MODE_REL);
 422}
 423
 424/* called with port.lock taken and irqs off */
 425static void imx_uart_start_rx(struct uart_port *port)
 426{
 427	struct imx_port *sport = (struct imx_port *)port;
 428	unsigned int ucr1, ucr2;
 429
 430	ucr1 = imx_uart_readl(sport, UCR1);
 431	ucr2 = imx_uart_readl(sport, UCR2);
 432
 433	ucr2 |= UCR2_RXEN;
 434
 435	if (sport->dma_is_enabled) {
 436		ucr1 |= UCR1_RXDMAEN | UCR1_ATDMAEN;
 437	} else {
 438		ucr1 |= UCR1_RRDYEN;
 439		ucr2 |= UCR2_ATEN;
 440	}
 441
 442	/* Write UCR2 first as it includes RXEN */
 443	imx_uart_writel(sport, ucr2, UCR2);
 444	imx_uart_writel(sport, ucr1, UCR1);
 445}
 446
 447/* called with port.lock taken and irqs off */
 448static void imx_uart_stop_tx(struct uart_port *port)
 
 
 449{
 450	struct imx_port *sport = (struct imx_port *)port;
 451	u32 ucr1, ucr4, usr2;
 452
 453	if (sport->tx_state == OFF)
 454		return;
 455
 456	/*
 457	 * We are maybe in the SMP context, so if the DMA TX thread is running
 458	 * on other cpu, we have to wait for it to finish.
 459	 */
 460	if (sport->dma_is_txing)
 461		return;
 462
 463	ucr1 = imx_uart_readl(sport, UCR1);
 464	imx_uart_writel(sport, ucr1 & ~UCR1_TRDYEN, UCR1);
 465
 466	usr2 = imx_uart_readl(sport, USR2);
 467	if (!(usr2 & USR2_TXDC)) {
 468		/* The shifter is still busy, so retry once TC triggers */
 469		return;
 470	}
 471
 472	ucr4 = imx_uart_readl(sport, UCR4);
 473	ucr4 &= ~UCR4_TCEN;
 474	imx_uart_writel(sport, ucr4, UCR4);
 475
 476	/* in rs485 mode disable transmitter */
 477	if (port->rs485.flags & SER_RS485_ENABLED) {
 478		if (sport->tx_state == SEND) {
 479			sport->tx_state = WAIT_AFTER_SEND;
 480			start_hrtimer_ms(&sport->trigger_stop_tx,
 481					 port->rs485.delay_rts_after_send);
 482			return;
 483		}
 484
 485		if (sport->tx_state == WAIT_AFTER_RTS ||
 486		    sport->tx_state == WAIT_AFTER_SEND) {
 487			u32 ucr2;
 488
 489			hrtimer_try_to_cancel(&sport->trigger_start_tx);
 490
 491			ucr2 = imx_uart_readl(sport, UCR2);
 492			if (port->rs485.flags & SER_RS485_RTS_AFTER_SEND)
 493				imx_uart_rts_active(sport, &ucr2);
 494			else
 495				imx_uart_rts_inactive(sport, &ucr2);
 496			imx_uart_writel(sport, ucr2, UCR2);
 497
 498			imx_uart_start_rx(port);
 499
 500			sport->tx_state = OFF;
 501		}
 502	} else {
 503		sport->tx_state = OFF;
 504	}
 505}
 506
 507/* called with port.lock taken and irqs off */
 508static void imx_uart_stop_rx(struct uart_port *port)
 
 
 509{
 510	struct imx_port *sport = (struct imx_port *)port;
 511	u32 ucr1, ucr2;
 512
 513	ucr1 = imx_uart_readl(sport, UCR1);
 514	ucr2 = imx_uart_readl(sport, UCR2);
 
 
 
 
 
 
 515
 516	if (sport->dma_is_enabled) {
 517		ucr1 &= ~(UCR1_RXDMAEN | UCR1_ATDMAEN);
 518	} else {
 519		ucr1 &= ~UCR1_RRDYEN;
 520		ucr2 &= ~UCR2_ATEN;
 521	}
 522	imx_uart_writel(sport, ucr1, UCR1);
 523
 524	ucr2 &= ~UCR2_RXEN;
 525	imx_uart_writel(sport, ucr2, UCR2);
 
 526}
 527
 528/* called with port.lock taken and irqs off */
 529static void imx_uart_enable_ms(struct uart_port *port)
 
 
 530{
 531	struct imx_port *sport = (struct imx_port *)port;
 532
 533	mod_timer(&sport->timer, jiffies);
 534
 535	mctrl_gpio_enable_ms(sport->gpios);
 536}
 537
 538static void imx_uart_dma_tx(struct imx_port *sport);
 539
 540/* called with port.lock taken and irqs off */
 541static inline void imx_uart_transmit_buffer(struct imx_port *sport)
 542{
 543	struct circ_buf *xmit = &sport->port.state->xmit;
 
 544
 545	if (sport->port.x_char) {
 546		/* Send next char */
 547		imx_uart_writel(sport, sport->port.x_char, URTX0);
 548		sport->port.icount.tx++;
 549		sport->port.x_char = 0;
 550		return;
 551	}
 552
 553	if (uart_circ_empty(xmit) || uart_tx_stopped(&sport->port)) {
 554		imx_uart_stop_tx(&sport->port);
 555		return;
 556	}
 557
 558	if (sport->dma_is_enabled) {
 559		u32 ucr1;
 560		/*
 561		 * We've just sent a X-char Ensure the TX DMA is enabled
 562		 * and the TX IRQ is disabled.
 563		 **/
 564		ucr1 = imx_uart_readl(sport, UCR1);
 565		ucr1 &= ~UCR1_TRDYEN;
 566		if (sport->dma_is_txing) {
 567			ucr1 |= UCR1_TXDMAEN;
 568			imx_uart_writel(sport, ucr1, UCR1);
 569		} else {
 570			imx_uart_writel(sport, ucr1, UCR1);
 571			imx_uart_dma_tx(sport);
 572		}
 573
 574		return;
 575	}
 576
 577	while (!uart_circ_empty(xmit) &&
 578	       !(imx_uart_readl(sport, imx_uart_uts_reg(sport)) & UTS_TXFULL)) {
 579		/* send xmit->buf[xmit->tail]
 580		 * out the port here */
 581		imx_uart_writel(sport, xmit->buf[xmit->tail], URTX0);
 582		xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
 583		sport->port.icount.tx++;
 584	}
 585
 586	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 587		uart_write_wakeup(&sport->port);
 588
 589	if (uart_circ_empty(xmit))
 590		imx_uart_stop_tx(&sport->port);
 591}
 592
 593static void imx_uart_dma_tx_callback(void *data)
 594{
 595	struct imx_port *sport = data;
 596	struct scatterlist *sgl = &sport->tx_sgl[0];
 597	struct circ_buf *xmit = &sport->port.state->xmit;
 598	unsigned long flags;
 599	u32 ucr1;
 600
 601	spin_lock_irqsave(&sport->port.lock, flags);
 602
 603	dma_unmap_sg(sport->port.dev, sgl, sport->dma_tx_nents, DMA_TO_DEVICE);
 604
 605	ucr1 = imx_uart_readl(sport, UCR1);
 606	ucr1 &= ~UCR1_TXDMAEN;
 607	imx_uart_writel(sport, ucr1, UCR1);
 608
 609	/* update the stat */
 610	xmit->tail = (xmit->tail + sport->tx_bytes) & (UART_XMIT_SIZE - 1);
 611	sport->port.icount.tx += sport->tx_bytes;
 612
 613	dev_dbg(sport->port.dev, "we finish the TX DMA.\n");
 614
 615	sport->dma_is_txing = 0;
 616
 
 
 617	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
 618		uart_write_wakeup(&sport->port);
 619
 620	if (!uart_circ_empty(xmit) && !uart_tx_stopped(&sport->port))
 621		imx_uart_dma_tx(sport);
 622	else if (sport->port.rs485.flags & SER_RS485_ENABLED) {
 623		u32 ucr4 = imx_uart_readl(sport, UCR4);
 624		ucr4 |= UCR4_TCEN;
 625		imx_uart_writel(sport, ucr4, UCR4);
 626	}
 627
 
 
 
 628	spin_unlock_irqrestore(&sport->port.lock, flags);
 629}
 630
 631/* called with port.lock taken and irqs off */
 632static void imx_uart_dma_tx(struct imx_port *sport)
 633{
 634	struct circ_buf *xmit = &sport->port.state->xmit;
 635	struct scatterlist *sgl = sport->tx_sgl;
 636	struct dma_async_tx_descriptor *desc;
 637	struct dma_chan	*chan = sport->dma_chan_tx;
 638	struct device *dev = sport->port.dev;
 639	u32 ucr1, ucr4;
 640	int ret;
 641
 642	if (sport->dma_is_txing)
 643		return;
 644
 645	ucr4 = imx_uart_readl(sport, UCR4);
 646	ucr4 &= ~UCR4_TCEN;
 647	imx_uart_writel(sport, ucr4, UCR4);
 648
 649	sport->tx_bytes = uart_circ_chars_pending(xmit);
 650
 651	if (xmit->tail < xmit->head || xmit->head == 0) {
 652		sport->dma_tx_nents = 1;
 653		sg_init_one(sgl, xmit->buf + xmit->tail, sport->tx_bytes);
 654	} else {
 655		sport->dma_tx_nents = 2;
 656		sg_init_table(sgl, 2);
 657		sg_set_buf(sgl, xmit->buf + xmit->tail,
 658				UART_XMIT_SIZE - xmit->tail);
 659		sg_set_buf(sgl + 1, xmit->buf, xmit->head);
 660	}
 661
 662	ret = dma_map_sg(dev, sgl, sport->dma_tx_nents, DMA_TO_DEVICE);
 663	if (ret == 0) {
 664		dev_err(dev, "DMA mapping error for TX.\n");
 665		return;
 666	}
 667	desc = dmaengine_prep_slave_sg(chan, sgl, ret,
 668					DMA_MEM_TO_DEV, DMA_PREP_INTERRUPT);
 669	if (!desc) {
 670		dma_unmap_sg(dev, sgl, sport->dma_tx_nents,
 671			     DMA_TO_DEVICE);
 672		dev_err(dev, "We cannot prepare for the TX slave dma!\n");
 673		return;
 674	}
 675	desc->callback = imx_uart_dma_tx_callback;
 676	desc->callback_param = sport;
 677
 678	dev_dbg(dev, "TX: prepare to send %lu bytes by DMA.\n",
 679			uart_circ_chars_pending(xmit));
 680
 681	ucr1 = imx_uart_readl(sport, UCR1);
 682	ucr1 |= UCR1_TXDMAEN;
 683	imx_uart_writel(sport, ucr1, UCR1);
 684
 685	/* fire it */
 686	sport->dma_is_txing = 1;
 687	dmaengine_submit(desc);
 688	dma_async_issue_pending(chan);
 689	return;
 690}
 691
 692/* called with port.lock taken and irqs off */
 693static void imx_uart_start_tx(struct uart_port *port)
 
 
 694{
 695	struct imx_port *sport = (struct imx_port *)port;
 696	u32 ucr1;
 697
 698	if (!sport->port.x_char && uart_circ_empty(&port->state->xmit))
 699		return;
 700
 701	/*
 702	 * We cannot simply do nothing here if sport->tx_state == SEND already
 703	 * because UCR1_TXMPTYEN might already have been cleared in
 704	 * imx_uart_stop_tx(), but tx_state is still SEND.
 705	 */
 706
 707	if (port->rs485.flags & SER_RS485_ENABLED) {
 708		if (sport->tx_state == OFF) {
 709			u32 ucr2 = imx_uart_readl(sport, UCR2);
 710			if (port->rs485.flags & SER_RS485_RTS_ON_SEND)
 711				imx_uart_rts_active(sport, &ucr2);
 712			else
 713				imx_uart_rts_inactive(sport, &ucr2);
 714			imx_uart_writel(sport, ucr2, UCR2);
 715
 716			if (!(port->rs485.flags & SER_RS485_RX_DURING_TX))
 717				imx_uart_stop_rx(port);
 718
 719			sport->tx_state = WAIT_AFTER_RTS;
 720			start_hrtimer_ms(&sport->trigger_start_tx,
 721					 port->rs485.delay_rts_before_send);
 722			return;
 723		}
 724
 725		if (sport->tx_state == WAIT_AFTER_SEND
 726		    || sport->tx_state == WAIT_AFTER_RTS) {
 727
 728			hrtimer_try_to_cancel(&sport->trigger_stop_tx);
 729
 730			/*
 731			 * Enable transmitter and shifter empty irq only if DMA
 732			 * is off.  In the DMA case this is done in the
 733			 * tx-callback.
 734			 */
 735			if (!sport->dma_is_enabled) {
 736				u32 ucr4 = imx_uart_readl(sport, UCR4);
 737				ucr4 |= UCR4_TCEN;
 738				imx_uart_writel(sport, ucr4, UCR4);
 739			}
 740
 741			sport->tx_state = SEND;
 742		}
 743	} else {
 744		sport->tx_state = SEND;
 745	}
 746
 747	if (!sport->dma_is_enabled) {
 748		ucr1 = imx_uart_readl(sport, UCR1);
 749		imx_uart_writel(sport, ucr1 | UCR1_TRDYEN, UCR1);
 750	}
 751
 752	if (sport->dma_is_enabled) {
 753		if (sport->port.x_char) {
 754			/* We have X-char to send, so enable TX IRQ and
 755			 * disable TX DMA to let TX interrupt to send X-char */
 756			ucr1 = imx_uart_readl(sport, UCR1);
 757			ucr1 &= ~UCR1_TXDMAEN;
 758			ucr1 |= UCR1_TRDYEN;
 759			imx_uart_writel(sport, ucr1, UCR1);
 760			return;
 761		}
 762
 763		if (!uart_circ_empty(&port->state->xmit) &&
 764		    !uart_tx_stopped(port))
 765			imx_uart_dma_tx(sport);
 766		return;
 767	}
 768}
 769
 770static irqreturn_t __imx_uart_rtsint(int irq, void *dev_id)
 771{
 772	struct imx_port *sport = dev_id;
 773	u32 usr1;
 
 
 
 774
 775	imx_uart_writel(sport, USR1_RTSD, USR1);
 776	usr1 = imx_uart_readl(sport, USR1) & USR1_RTSS;
 777	uart_handle_cts_change(&sport->port, !!usr1);
 778	wake_up_interruptible(&sport->port.state->port.delta_msr_wait);
 779
 
 780	return IRQ_HANDLED;
 781}
 782
 783static irqreturn_t imx_uart_rtsint(int irq, void *dev_id)
 784{
 785	struct imx_port *sport = dev_id;
 786	irqreturn_t ret;
 787
 788	spin_lock(&sport->port.lock);
 789
 790	ret = __imx_uart_rtsint(irq, dev_id);
 791
 792	spin_unlock(&sport->port.lock);
 793
 794	return ret;
 795}
 796
 797static irqreturn_t imx_uart_txint(int irq, void *dev_id)
 798{
 799	struct imx_port *sport = dev_id;
 800
 801	spin_lock(&sport->port.lock);
 802	imx_uart_transmit_buffer(sport);
 803	spin_unlock(&sport->port.lock);
 804	return IRQ_HANDLED;
 805}
 806
 807static irqreturn_t __imx_uart_rxint(int irq, void *dev_id)
 808{
 809	struct imx_port *sport = dev_id;
 810	unsigned int rx, flg, ignored = 0;
 811	struct tty_port *port = &sport->port.state->port;
 
 812
 813	while (imx_uart_readl(sport, USR2) & USR2_RDR) {
 814		u32 usr2;
 815
 
 816		flg = TTY_NORMAL;
 817		sport->port.icount.rx++;
 818
 819		rx = imx_uart_readl(sport, URXD0);
 820
 821		usr2 = imx_uart_readl(sport, USR2);
 822		if (usr2 & USR2_BRCD) {
 823			imx_uart_writel(sport, USR2_BRCD, USR2);
 824			if (uart_handle_break(&sport->port))
 825				continue;
 826		}
 827
 828		if (uart_handle_sysrq_char(&sport->port, (unsigned char)rx))
 829			continue;
 830
 831		if (unlikely(rx & URXD_ERR)) {
 832			if (rx & URXD_BRK)
 833				sport->port.icount.brk++;
 834			else if (rx & URXD_PRERR)
 835				sport->port.icount.parity++;
 836			else if (rx & URXD_FRMERR)
 837				sport->port.icount.frame++;
 838			if (rx & URXD_OVRRUN)
 839				sport->port.icount.overrun++;
 840
 841			if (rx & sport->port.ignore_status_mask) {
 842				if (++ignored > 100)
 843					goto out;
 844				continue;
 845			}
 846
 847			rx &= (sport->port.read_status_mask | 0xFF);
 848
 849			if (rx & URXD_BRK)
 850				flg = TTY_BREAK;
 851			else if (rx & URXD_PRERR)
 852				flg = TTY_PARITY;
 853			else if (rx & URXD_FRMERR)
 854				flg = TTY_FRAME;
 855			if (rx & URXD_OVRRUN)
 856				flg = TTY_OVERRUN;
 857
 
 858			sport->port.sysrq = 0;
 
 859		}
 860
 861		if (sport->port.ignore_status_mask & URXD_DUMMY_READ)
 862			goto out;
 863
 864		if (tty_insert_flip_char(port, rx, flg) == 0)
 865			sport->port.icount.buf_overrun++;
 866	}
 867
 868out:
 
 869	tty_flip_buffer_push(port);
 870
 871	return IRQ_HANDLED;
 872}
 873
 874static irqreturn_t imx_uart_rxint(int irq, void *dev_id)
 875{
 876	struct imx_port *sport = dev_id;
 877	irqreturn_t ret;
 878
 879	spin_lock(&sport->port.lock);
 880
 881	ret = __imx_uart_rxint(irq, dev_id);
 882
 883	spin_unlock(&sport->port.lock);
 884
 885	return ret;
 886}
 887
 888static void imx_uart_clear_rx_errors(struct imx_port *sport);
 889
 890/*
 891 * We have a modem side uart, so the meanings of RTS and CTS are inverted.
 
 892 */
 893static unsigned int imx_uart_get_hwmctrl(struct imx_port *sport)
 894{
 895	unsigned int tmp = TIOCM_DSR;
 896	unsigned usr1 = imx_uart_readl(sport, USR1);
 897	unsigned usr2 = imx_uart_readl(sport, USR2);
 898
 899	if (usr1 & USR1_RTSS)
 900		tmp |= TIOCM_CTS;
 901
 902	/* in DCE mode DCDIN is always 0 */
 903	if (!(usr2 & USR2_DCDIN))
 904		tmp |= TIOCM_CAR;
 
 
 
 
 
 
 
 
 
 905
 906	if (sport->dte_mode)
 907		if (!(imx_uart_readl(sport, USR2) & USR2_RIIN))
 908			tmp |= TIOCM_RI;
 909
 910	return tmp;
 911}
 912
 913/*
 914 * Handle any change of modem status signal since we were last called.
 915 */
 916static void imx_uart_mctrl_check(struct imx_port *sport)
 917{
 918	unsigned int status, changed;
 919
 920	status = imx_uart_get_hwmctrl(sport);
 921	changed = status ^ sport->old_status;
 922
 923	if (changed == 0)
 924		return;
 925
 926	sport->old_status = status;
 927
 928	if (changed & TIOCM_RI && status & TIOCM_RI)
 929		sport->port.icount.rng++;
 930	if (changed & TIOCM_DSR)
 931		sport->port.icount.dsr++;
 932	if (changed & TIOCM_CAR)
 933		uart_handle_dcd_change(&sport->port, status & TIOCM_CAR);
 934	if (changed & TIOCM_CTS)
 935		uart_handle_cts_change(&sport->port, status & TIOCM_CTS);
 936
 937	wake_up_interruptible(&sport->port.state->port.delta_msr_wait);
 938}
 939
 940static irqreturn_t imx_uart_int(int irq, void *dev_id)
 941{
 942	struct imx_port *sport = dev_id;
 943	unsigned int usr1, usr2, ucr1, ucr2, ucr3, ucr4;
 944	irqreturn_t ret = IRQ_NONE;
 945
 946	spin_lock(&sport->port.lock);
 
 947
 948	usr1 = imx_uart_readl(sport, USR1);
 949	usr2 = imx_uart_readl(sport, USR2);
 950	ucr1 = imx_uart_readl(sport, UCR1);
 951	ucr2 = imx_uart_readl(sport, UCR2);
 952	ucr3 = imx_uart_readl(sport, UCR3);
 953	ucr4 = imx_uart_readl(sport, UCR4);
 954
 955	/*
 956	 * Even if a condition is true that can trigger an irq only handle it if
 957	 * the respective irq source is enabled. This prevents some undesired
 958	 * actions, for example if a character that sits in the RX FIFO and that
 959	 * should be fetched via DMA is tried to be fetched using PIO. Or the
 960	 * receiver is currently off and so reading from URXD0 results in an
 961	 * exception. So just mask the (raw) status bits for disabled irqs.
 962	 */
 963	if ((ucr1 & UCR1_RRDYEN) == 0)
 964		usr1 &= ~USR1_RRDY;
 965	if ((ucr2 & UCR2_ATEN) == 0)
 966		usr1 &= ~USR1_AGTIM;
 967	if ((ucr1 & UCR1_TRDYEN) == 0)
 968		usr1 &= ~USR1_TRDY;
 969	if ((ucr4 & UCR4_TCEN) == 0)
 970		usr2 &= ~USR2_TXDC;
 971	if ((ucr3 & UCR3_DTRDEN) == 0)
 972		usr1 &= ~USR1_DTRD;
 973	if ((ucr1 & UCR1_RTSDEN) == 0)
 974		usr1 &= ~USR1_RTSD;
 975	if ((ucr3 & UCR3_AWAKEN) == 0)
 976		usr1 &= ~USR1_AWAKE;
 977	if ((ucr4 & UCR4_OREN) == 0)
 978		usr2 &= ~USR2_ORE;
 979
 980	if (usr1 & (USR1_RRDY | USR1_AGTIM)) {
 981		imx_uart_writel(sport, USR1_AGTIM, USR1);
 982
 983		__imx_uart_rxint(irq, dev_id);
 984		ret = IRQ_HANDLED;
 985	}
 986
 987	if ((usr1 & USR1_TRDY) || (usr2 & USR2_TXDC)) {
 988		imx_uart_transmit_buffer(sport);
 989		ret = IRQ_HANDLED;
 990	}
 991
 992	if (usr1 & USR1_DTRD) {
 993		imx_uart_writel(sport, USR1_DTRD, USR1);
 994
 995		imx_uart_mctrl_check(sport);
 
 996
 997		ret = IRQ_HANDLED;
 998	}
 999
1000	if (usr1 & USR1_RTSD) {
1001		__imx_uart_rtsint(irq, dev_id);
1002		ret = IRQ_HANDLED;
1003	}
1004
1005	if (usr1 & USR1_AWAKE) {
1006		imx_uart_writel(sport, USR1_AWAKE, USR1);
1007		ret = IRQ_HANDLED;
1008	}
1009
1010	if (usr2 & USR2_ORE) {
1011		sport->port.icount.overrun++;
1012		imx_uart_writel(sport, USR2_ORE, USR2);
1013		ret = IRQ_HANDLED;
1014	}
1015
1016	spin_unlock(&sport->port.lock);
1017
1018	return ret;
1019}
1020
1021/*
1022 * Return TIOCSER_TEMT when transmitter is not busy.
1023 */
1024static unsigned int imx_uart_tx_empty(struct uart_port *port)
1025{
1026	struct imx_port *sport = (struct imx_port *)port;
1027	unsigned int ret;
1028
1029	ret = (imx_uart_readl(sport, USR2) & USR2_TXDC) ?  TIOCSER_TEMT : 0;
1030
1031	/* If the TX DMA is working, return 0. */
1032	if (sport->dma_is_txing)
1033		ret = 0;
1034
1035	return ret;
1036}
1037
1038/* called with port.lock taken and irqs off */
1039static unsigned int imx_uart_get_mctrl(struct uart_port *port)
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1040{
1041	struct imx_port *sport = (struct imx_port *)port;
1042	unsigned int ret = imx_uart_get_hwmctrl(sport);
1043
1044	mctrl_gpio_get(sport->gpios, &ret);
1045
1046	return ret;
1047}
1048
1049/* called with port.lock taken and irqs off */
1050static void imx_uart_set_mctrl(struct uart_port *port, unsigned int mctrl)
1051{
1052	struct imx_port *sport = (struct imx_port *)port;
1053	u32 ucr3, uts;
1054
1055	if (!(port->rs485.flags & SER_RS485_ENABLED)) {
1056		u32 ucr2;
1057
1058		/*
1059		 * Turn off autoRTS if RTS is lowered and restore autoRTS
1060		 * setting if RTS is raised.
1061		 */
1062		ucr2 = imx_uart_readl(sport, UCR2);
1063		ucr2 &= ~(UCR2_CTS | UCR2_CTSC);
1064		if (mctrl & TIOCM_RTS) {
1065			ucr2 |= UCR2_CTS;
1066			/*
1067			 * UCR2_IRTS is unset if and only if the port is
1068			 * configured for CRTSCTS, so we use inverted UCR2_IRTS
1069			 * to get the state to restore to.
1070			 */
1071			if (!(ucr2 & UCR2_IRTS))
1072				ucr2 |= UCR2_CTSC;
1073		}
1074		imx_uart_writel(sport, ucr2, UCR2);
1075	}
1076
1077	ucr3 = imx_uart_readl(sport, UCR3) & ~UCR3_DSR;
1078	if (!(mctrl & TIOCM_DTR))
1079		ucr3 |= UCR3_DSR;
1080	imx_uart_writel(sport, ucr3, UCR3);
1081
1082	uts = imx_uart_readl(sport, imx_uart_uts_reg(sport)) & ~UTS_LOOP;
1083	if (mctrl & TIOCM_LOOP)
1084		uts |= UTS_LOOP;
1085	imx_uart_writel(sport, uts, imx_uart_uts_reg(sport));
1086
1087	mctrl_gpio_set(sport->gpios, mctrl);
1088}
1089
1090/*
1091 * Interrupts always disabled.
1092 */
1093static void imx_uart_break_ctl(struct uart_port *port, int break_state)
1094{
1095	struct imx_port *sport = (struct imx_port *)port;
1096	unsigned long flags;
1097	u32 ucr1;
1098
1099	spin_lock_irqsave(&sport->port.lock, flags);
1100
1101	ucr1 = imx_uart_readl(sport, UCR1) & ~UCR1_SNDBRK;
1102
1103	if (break_state != 0)
1104		ucr1 |= UCR1_SNDBRK;
1105
1106	imx_uart_writel(sport, ucr1, UCR1);
1107
1108	spin_unlock_irqrestore(&sport->port.lock, flags);
1109}
1110
1111/*
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1112 * This is our per-port timeout handler, for checking the
1113 * modem status signals.
1114 */
1115static void imx_uart_timeout(struct timer_list *t)
1116{
1117	struct imx_port *sport = from_timer(sport, t, timer);
1118	unsigned long flags;
1119
1120	if (sport->port.state) {
1121		spin_lock_irqsave(&sport->port.lock, flags);
1122		imx_uart_mctrl_check(sport);
1123		spin_unlock_irqrestore(&sport->port.lock, flags);
1124
1125		mod_timer(&sport->timer, jiffies + MCTRL_TIMEOUT);
1126	}
1127}
1128
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1129/*
1130 * There are two kinds of RX DMA interrupts(such as in the MX6Q):
1131 *   [1] the RX DMA buffer is full.
1132 *   [2] the aging timer expires
1133 *
1134 * Condition [2] is triggered when a character has been sitting in the FIFO
1135 * for at least 8 byte durations.
1136 */
1137static void imx_uart_dma_rx_callback(void *data)
1138{
1139	struct imx_port *sport = data;
1140	struct dma_chan	*chan = sport->dma_chan_rx;
1141	struct scatterlist *sgl = &sport->rx_sgl;
1142	struct tty_port *port = &sport->port.state->port;
1143	struct dma_tx_state state;
1144	struct circ_buf *rx_ring = &sport->rx_ring;
1145	enum dma_status status;
1146	unsigned int w_bytes = 0;
1147	unsigned int r_bytes;
1148	unsigned int bd_size;
1149
1150	status = dmaengine_tx_status(chan, sport->rx_cookie, &state);
1151
1152	if (status == DMA_ERROR) {
1153		imx_uart_clear_rx_errors(sport);
1154		return;
1155	}
1156
1157	if (!(sport->port.ignore_status_mask & URXD_DUMMY_READ)) {
1158
1159		/*
1160		 * The state-residue variable represents the empty space
1161		 * relative to the entire buffer. Taking this in consideration
1162		 * the head is always calculated base on the buffer total
1163		 * length - DMA transaction residue. The UART script from the
1164		 * SDMA firmware will jump to the next buffer descriptor,
1165		 * once a DMA transaction if finalized (IMX53 RM - A.4.1.2.4).
1166		 * Taking this in consideration the tail is always at the
1167		 * beginning of the buffer descriptor that contains the head.
1168		 */
1169
1170		/* Calculate the head */
1171		rx_ring->head = sg_dma_len(sgl) - state.residue;
1172
1173		/* Calculate the tail. */
1174		bd_size = sg_dma_len(sgl) / sport->rx_periods;
1175		rx_ring->tail = ((rx_ring->head-1) / bd_size) * bd_size;
1176
1177		if (rx_ring->head <= sg_dma_len(sgl) &&
1178		    rx_ring->head > rx_ring->tail) {
1179
1180			/* Move data from tail to head */
1181			r_bytes = rx_ring->head - rx_ring->tail;
 
 
1182
1183			/* CPU claims ownership of RX DMA buffer */
1184			dma_sync_sg_for_cpu(sport->port.dev, sgl, 1,
1185				DMA_FROM_DEVICE);
1186
1187			w_bytes = tty_insert_flip_string(port,
1188				sport->rx_buf + rx_ring->tail, r_bytes);
1189
1190			/* UART retrieves ownership of RX DMA buffer */
1191			dma_sync_sg_for_device(sport->port.dev, sgl, 1,
1192				DMA_FROM_DEVICE);
1193
1194			if (w_bytes != r_bytes)
1195				sport->port.icount.buf_overrun++;
1196
1197			sport->port.icount.rx += w_bytes;
1198		} else	{
1199			WARN_ON(rx_ring->head > sg_dma_len(sgl));
1200			WARN_ON(rx_ring->head <= rx_ring->tail);
1201		}
 
 
1202	}
1203
1204	if (w_bytes) {
1205		tty_flip_buffer_push(port);
1206		dev_dbg(sport->port.dev, "We get %d bytes.\n", w_bytes);
1207	}
 
 
 
 
 
 
 
 
1208}
1209
1210/* RX DMA buffer periods */
1211#define RX_DMA_PERIODS	16
1212#define RX_BUF_SIZE	(RX_DMA_PERIODS * PAGE_SIZE / 4)
1213
1214static int imx_uart_start_rx_dma(struct imx_port *sport)
1215{
1216	struct scatterlist *sgl = &sport->rx_sgl;
1217	struct dma_chan	*chan = sport->dma_chan_rx;
1218	struct device *dev = sport->port.dev;
1219	struct dma_async_tx_descriptor *desc;
1220	int ret;
1221
1222	sport->rx_ring.head = 0;
1223	sport->rx_ring.tail = 0;
1224	sport->rx_periods = RX_DMA_PERIODS;
1225
1226	sg_init_one(sgl, sport->rx_buf, RX_BUF_SIZE);
1227	ret = dma_map_sg(dev, sgl, 1, DMA_FROM_DEVICE);
1228	if (ret == 0) {
1229		dev_err(dev, "DMA mapping error for RX.\n");
1230		return -EINVAL;
1231	}
1232
1233	desc = dmaengine_prep_dma_cyclic(chan, sg_dma_address(sgl),
1234		sg_dma_len(sgl), sg_dma_len(sgl) / sport->rx_periods,
1235		DMA_DEV_TO_MEM, DMA_PREP_INTERRUPT);
1236
1237	if (!desc) {
1238		dma_unmap_sg(dev, sgl, 1, DMA_FROM_DEVICE);
1239		dev_err(dev, "We cannot prepare for the RX slave dma!\n");
1240		return -EINVAL;
1241	}
1242	desc->callback = imx_uart_dma_rx_callback;
1243	desc->callback_param = sport;
1244
1245	dev_dbg(dev, "RX: prepare for the DMA.\n");
1246	sport->dma_is_rxing = 1;
1247	sport->rx_cookie = dmaengine_submit(desc);
1248	dma_async_issue_pending(chan);
1249	return 0;
1250}
1251
1252static void imx_uart_clear_rx_errors(struct imx_port *sport)
1253{
1254	struct tty_port *port = &sport->port.state->port;
1255	u32 usr1, usr2;
1256
1257	usr1 = imx_uart_readl(sport, USR1);
1258	usr2 = imx_uart_readl(sport, USR2);
1259
1260	if (usr2 & USR2_BRCD) {
1261		sport->port.icount.brk++;
1262		imx_uart_writel(sport, USR2_BRCD, USR2);
1263		uart_handle_break(&sport->port);
1264		if (tty_insert_flip_char(port, 0, TTY_BREAK) == 0)
1265			sport->port.icount.buf_overrun++;
1266		tty_flip_buffer_push(port);
1267	} else {
1268		if (usr1 & USR1_FRAMERR) {
1269			sport->port.icount.frame++;
1270			imx_uart_writel(sport, USR1_FRAMERR, USR1);
1271		} else if (usr1 & USR1_PARITYERR) {
1272			sport->port.icount.parity++;
1273			imx_uart_writel(sport, USR1_PARITYERR, USR1);
1274		}
1275	}
1276
1277	if (usr2 & USR2_ORE) {
1278		sport->port.icount.overrun++;
1279		imx_uart_writel(sport, USR2_ORE, USR2);
1280	}
1281
1282}
1283
1284#define TXTL_DEFAULT 2 /* reset default */
1285#define RXTL_DEFAULT 1 /* reset default */
1286#define TXTL_DMA 8 /* DMA burst setting */
1287#define RXTL_DMA 9 /* DMA burst setting */
1288
1289static void imx_uart_setup_ufcr(struct imx_port *sport,
1290				unsigned char txwl, unsigned char rxwl)
1291{
1292	unsigned int val;
1293
1294	/* set receiver / transmitter trigger level */
1295	val = imx_uart_readl(sport, UFCR) & (UFCR_RFDIV | UFCR_DCEDTE);
1296	val |= txwl << UFCR_TXTL_SHF | rxwl;
1297	imx_uart_writel(sport, val, UFCR);
1298}
1299
1300static void imx_uart_dma_exit(struct imx_port *sport)
1301{
1302	if (sport->dma_chan_rx) {
1303		dmaengine_terminate_sync(sport->dma_chan_rx);
1304		dma_release_channel(sport->dma_chan_rx);
1305		sport->dma_chan_rx = NULL;
1306		sport->rx_cookie = -EINVAL;
1307		kfree(sport->rx_buf);
1308		sport->rx_buf = NULL;
1309	}
1310
1311	if (sport->dma_chan_tx) {
1312		dmaengine_terminate_sync(sport->dma_chan_tx);
1313		dma_release_channel(sport->dma_chan_tx);
1314		sport->dma_chan_tx = NULL;
1315	}
 
 
1316}
1317
1318static int imx_uart_dma_init(struct imx_port *sport)
1319{
1320	struct dma_slave_config slave_config = {};
1321	struct device *dev = sport->port.dev;
1322	int ret;
1323
1324	/* Prepare for RX : */
1325	sport->dma_chan_rx = dma_request_slave_channel(dev, "rx");
1326	if (!sport->dma_chan_rx) {
1327		dev_dbg(dev, "cannot get the DMA channel.\n");
1328		ret = -EINVAL;
1329		goto err;
1330	}
1331
1332	slave_config.direction = DMA_DEV_TO_MEM;
1333	slave_config.src_addr = sport->port.mapbase + URXD0;
1334	slave_config.src_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
1335	/* one byte less than the watermark level to enable the aging timer */
1336	slave_config.src_maxburst = RXTL_DMA - 1;
1337	ret = dmaengine_slave_config(sport->dma_chan_rx, &slave_config);
1338	if (ret) {
1339		dev_err(dev, "error in RX dma configuration.\n");
1340		goto err;
1341	}
1342
1343	sport->rx_buf = kzalloc(RX_BUF_SIZE, GFP_KERNEL);
1344	if (!sport->rx_buf) {
1345		ret = -ENOMEM;
1346		goto err;
1347	}
1348	sport->rx_ring.buf = sport->rx_buf;
1349
1350	/* Prepare for TX : */
1351	sport->dma_chan_tx = dma_request_slave_channel(dev, "tx");
1352	if (!sport->dma_chan_tx) {
1353		dev_err(dev, "cannot get the TX DMA channel!\n");
1354		ret = -EINVAL;
1355		goto err;
1356	}
1357
1358	slave_config.direction = DMA_MEM_TO_DEV;
1359	slave_config.dst_addr = sport->port.mapbase + URTX0;
1360	slave_config.dst_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
1361	slave_config.dst_maxburst = TXTL_DMA;
1362	ret = dmaengine_slave_config(sport->dma_chan_tx, &slave_config);
1363	if (ret) {
1364		dev_err(dev, "error in TX dma configuration.");
1365		goto err;
1366	}
1367
 
 
1368	return 0;
1369err:
1370	imx_uart_dma_exit(sport);
1371	return ret;
1372}
1373
1374static void imx_uart_enable_dma(struct imx_port *sport)
1375{
1376	u32 ucr1;
1377
1378	imx_uart_setup_ufcr(sport, TXTL_DMA, RXTL_DMA);
1379
1380	/* set UCR1 */
1381	ucr1 = imx_uart_readl(sport, UCR1);
1382	ucr1 |= UCR1_RXDMAEN | UCR1_TXDMAEN | UCR1_ATDMAEN;
1383	imx_uart_writel(sport, ucr1, UCR1);
 
 
 
 
 
 
1384
1385	sport->dma_is_enabled = 1;
1386}
1387
1388static void imx_uart_disable_dma(struct imx_port *sport)
1389{
1390	u32 ucr1;
1391
1392	/* clear UCR1 */
1393	ucr1 = imx_uart_readl(sport, UCR1);
1394	ucr1 &= ~(UCR1_RXDMAEN | UCR1_TXDMAEN | UCR1_ATDMAEN);
1395	imx_uart_writel(sport, ucr1, UCR1);
 
 
 
 
 
1396
1397	imx_uart_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1398
1399	sport->dma_is_enabled = 0;
1400}
1401
1402/* half the RX buffer size */
1403#define CTSTL 16
1404
1405static int imx_uart_startup(struct uart_port *port)
1406{
1407	struct imx_port *sport = (struct imx_port *)port;
1408	int retval, i;
1409	unsigned long flags;
1410	int dma_is_inited = 0;
1411	u32 ucr1, ucr2, ucr3, ucr4;
1412
1413	retval = clk_prepare_enable(sport->clk_per);
1414	if (retval)
1415		return retval;
1416	retval = clk_prepare_enable(sport->clk_ipg);
1417	if (retval) {
1418		clk_disable_unprepare(sport->clk_per);
1419		return retval;
1420	}
1421
1422	imx_uart_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1423
1424	/* disable the DREN bit (Data Ready interrupt enable) before
1425	 * requesting IRQs
1426	 */
1427	ucr4 = imx_uart_readl(sport, UCR4);
1428
1429	/* set the trigger level for CTS */
1430	ucr4 &= ~(UCR4_CTSTL_MASK << UCR4_CTSTL_SHF);
1431	ucr4 |= CTSTL << UCR4_CTSTL_SHF;
1432
1433	imx_uart_writel(sport, ucr4 & ~UCR4_DREN, UCR4);
1434
1435	/* Can we enable the DMA support? */
1436	if (!uart_console(port) && imx_uart_dma_init(sport) == 0)
1437		dma_is_inited = 1;
 
1438
1439	spin_lock_irqsave(&sport->port.lock, flags);
1440	/* Reset fifo's and state machines */
1441	i = 100;
1442
1443	ucr2 = imx_uart_readl(sport, UCR2);
1444	ucr2 &= ~UCR2_SRST;
1445	imx_uart_writel(sport, ucr2, UCR2);
1446
1447	while (!(imx_uart_readl(sport, UCR2) & UCR2_SRST) && (--i > 0))
1448		udelay(1);
1449
1450	/*
1451	 * Finally, clear and enable interrupts
1452	 */
1453	imx_uart_writel(sport, USR1_RTSD | USR1_DTRD, USR1);
1454	imx_uart_writel(sport, USR2_ORE, USR2);
1455
1456	ucr1 = imx_uart_readl(sport, UCR1) & ~UCR1_RRDYEN;
1457	ucr1 |= UCR1_UARTEN;
1458	if (sport->have_rtscts)
1459		ucr1 |= UCR1_RTSDEN;
1460
1461	imx_uart_writel(sport, ucr1, UCR1);
 
1462
1463	ucr4 = imx_uart_readl(sport, UCR4) & ~(UCR4_OREN | UCR4_INVR);
1464	if (!sport->dma_is_enabled)
1465		ucr4 |= UCR4_OREN;
1466	if (sport->inverted_rx)
1467		ucr4 |= UCR4_INVR;
1468	imx_uart_writel(sport, ucr4, UCR4);
1469
1470	ucr3 = imx_uart_readl(sport, UCR3) & ~UCR3_INVT;
1471	/*
1472	 * configure tx polarity before enabling tx
1473	 */
1474	if (sport->inverted_tx)
1475		ucr3 |= UCR3_INVT;
1476
1477	if (!imx_uart_is_imx1(sport)) {
1478		ucr3 |= UCR3_DTRDEN | UCR3_RI | UCR3_DCD;
 
 
 
1479
1480		if (sport->dte_mode)
1481			/* disable broken interrupts */
1482			ucr3 &= ~(UCR3_RI | UCR3_DCD);
 
1483	}
1484	imx_uart_writel(sport, ucr3, UCR3);
1485
1486	ucr2 = imx_uart_readl(sport, UCR2) & ~UCR2_ATEN;
1487	ucr2 |= (UCR2_RXEN | UCR2_TXEN);
1488	if (!sport->have_rtscts)
1489		ucr2 |= UCR2_IRTS;
1490	/*
1491	 * make sure the edge sensitive RTS-irq is disabled,
1492	 * we're using RTSD instead.
1493	 */
1494	if (!imx_uart_is_imx1(sport))
1495		ucr2 &= ~UCR2_RTSEN;
1496	imx_uart_writel(sport, ucr2, UCR2);
1497
1498	/*
1499	 * Enable modem status interrupts
1500	 */
1501	imx_uart_enable_ms(&sport->port);
1502
1503	if (dma_is_inited) {
1504		imx_uart_enable_dma(sport);
1505		imx_uart_start_rx_dma(sport);
1506	} else {
1507		ucr1 = imx_uart_readl(sport, UCR1);
1508		ucr1 |= UCR1_RRDYEN;
1509		imx_uart_writel(sport, ucr1, UCR1);
1510
1511		ucr2 = imx_uart_readl(sport, UCR2);
1512		ucr2 |= UCR2_ATEN;
1513		imx_uart_writel(sport, ucr2, UCR2);
1514	}
1515
1516	spin_unlock_irqrestore(&sport->port.lock, flags);
1517
1518	return 0;
1519}
1520
1521static void imx_uart_shutdown(struct uart_port *port)
1522{
1523	struct imx_port *sport = (struct imx_port *)port;
 
1524	unsigned long flags;
1525	u32 ucr1, ucr2, ucr4;
1526
1527	if (sport->dma_is_enabled) {
1528		dmaengine_terminate_sync(sport->dma_chan_tx);
1529		if (sport->dma_is_txing) {
1530			dma_unmap_sg(sport->port.dev, &sport->tx_sgl[0],
1531				     sport->dma_tx_nents, DMA_TO_DEVICE);
 
 
 
1532			sport->dma_is_txing = 0;
 
 
1533		}
1534		dmaengine_terminate_sync(sport->dma_chan_rx);
1535		if (sport->dma_is_rxing) {
1536			dma_unmap_sg(sport->port.dev, &sport->rx_sgl,
1537				     1, DMA_FROM_DEVICE);
1538			sport->dma_is_rxing = 0;
1539		}
1540
1541		spin_lock_irqsave(&sport->port.lock, flags);
1542		imx_uart_stop_tx(port);
1543		imx_uart_stop_rx(port);
1544		imx_uart_disable_dma(sport);
1545		spin_unlock_irqrestore(&sport->port.lock, flags);
1546		imx_uart_dma_exit(sport);
1547	}
1548
1549	mctrl_gpio_disable_ms(sport->gpios);
1550
1551	spin_lock_irqsave(&sport->port.lock, flags);
1552	ucr2 = imx_uart_readl(sport, UCR2);
1553	ucr2 &= ~(UCR2_TXEN | UCR2_ATEN);
1554	imx_uart_writel(sport, ucr2, UCR2);
1555
1556	ucr4 = imx_uart_readl(sport, UCR4);
1557	ucr4 &= ~UCR4_OREN;
1558	imx_uart_writel(sport, ucr4, UCR4);
1559	spin_unlock_irqrestore(&sport->port.lock, flags);
1560
1561	/*
1562	 * Stop our timer.
1563	 */
1564	del_timer_sync(&sport->timer);
1565
1566	/*
1567	 * Disable all interrupts, port and break condition.
1568	 */
1569
1570	spin_lock_irqsave(&sport->port.lock, flags);
1571	ucr1 = imx_uart_readl(sport, UCR1);
1572	ucr1 &= ~(UCR1_TRDYEN | UCR1_RRDYEN | UCR1_RTSDEN | UCR1_UARTEN | UCR1_RXDMAEN | UCR1_ATDMAEN);
1573
1574	imx_uart_writel(sport, ucr1, UCR1);
1575	spin_unlock_irqrestore(&sport->port.lock, flags);
1576
1577	clk_disable_unprepare(sport->clk_per);
1578	clk_disable_unprepare(sport->clk_ipg);
1579}
1580
1581/* called with port.lock taken and irqs off */
1582static void imx_uart_flush_buffer(struct uart_port *port)
1583{
1584	struct imx_port *sport = (struct imx_port *)port;
1585	struct scatterlist *sgl = &sport->tx_sgl[0];
1586	u32 ucr2;
1587	int i = 100, ubir, ubmr, uts;
1588
1589	if (!sport->dma_chan_tx)
1590		return;
1591
1592	sport->tx_bytes = 0;
1593	dmaengine_terminate_all(sport->dma_chan_tx);
1594	if (sport->dma_is_txing) {
1595		u32 ucr1;
1596
1597		dma_unmap_sg(sport->port.dev, sgl, sport->dma_tx_nents,
1598			     DMA_TO_DEVICE);
1599		ucr1 = imx_uart_readl(sport, UCR1);
1600		ucr1 &= ~UCR1_TXDMAEN;
1601		imx_uart_writel(sport, ucr1, UCR1);
1602		sport->dma_is_txing = 0;
1603	}
1604
1605	/*
1606	 * According to the Reference Manual description of the UART SRST bit:
1607	 *
1608	 * "Reset the transmit and receive state machines,
1609	 * all FIFOs and register USR1, USR2, UBIR, UBMR, UBRC, URXD, UTXD
1610	 * and UTS[6-3]".
1611	 *
1612	 * We don't need to restore the old values from USR1, USR2, URXD and
1613	 * UTXD. UBRC is read only, so only save/restore the other three
1614	 * registers.
1615	 */
1616	ubir = imx_uart_readl(sport, UBIR);
1617	ubmr = imx_uart_readl(sport, UBMR);
1618	uts = imx_uart_readl(sport, IMX21_UTS);
1619
1620	ucr2 = imx_uart_readl(sport, UCR2);
1621	ucr2 &= ~UCR2_SRST;
1622	imx_uart_writel(sport, ucr2, UCR2);
1623
1624	while (!(imx_uart_readl(sport, UCR2) & UCR2_SRST) && (--i > 0))
1625		udelay(1);
1626
1627	/* Restore the registers */
1628	imx_uart_writel(sport, ubir, UBIR);
1629	imx_uart_writel(sport, ubmr, UBMR);
1630	imx_uart_writel(sport, uts, IMX21_UTS);
1631}
1632
1633static void
1634imx_uart_set_termios(struct uart_port *port, struct ktermios *termios,
1635		     struct ktermios *old)
1636{
1637	struct imx_port *sport = (struct imx_port *)port;
1638	unsigned long flags;
1639	u32 ucr2, old_ucr2, ufcr;
1640	unsigned int baud, quot;
1641	unsigned int old_csize = old ? old->c_cflag & CSIZE : CS8;
1642	unsigned long div;
1643	unsigned long num, denom, old_ubir, old_ubmr;
1644	uint64_t tdiv64;
1645
1646	/*
1647	 * We only support CS7 and CS8.
1648	 */
1649	while ((termios->c_cflag & CSIZE) != CS7 &&
1650	       (termios->c_cflag & CSIZE) != CS8) {
1651		termios->c_cflag &= ~CSIZE;
1652		termios->c_cflag |= old_csize;
1653		old_csize = CS8;
1654	}
1655
1656	del_timer_sync(&sport->timer);
1657
1658	/*
1659	 * Ask the core to calculate the divisor for us.
1660	 */
1661	baud = uart_get_baud_rate(port, termios, old, 50, port->uartclk / 16);
1662	quot = uart_get_divisor(port, baud);
1663
1664	spin_lock_irqsave(&sport->port.lock, flags);
1665
1666	/*
1667	 * Read current UCR2 and save it for future use, then clear all the bits
1668	 * except those we will or may need to preserve.
1669	 */
1670	old_ucr2 = imx_uart_readl(sport, UCR2);
1671	ucr2 = old_ucr2 & (UCR2_TXEN | UCR2_RXEN | UCR2_ATEN | UCR2_CTS);
1672
1673	ucr2 |= UCR2_SRST | UCR2_IRTS;
1674	if ((termios->c_cflag & CSIZE) == CS8)
1675		ucr2 |= UCR2_WS;
 
 
1676
1677	if (!sport->have_rtscts)
1678		termios->c_cflag &= ~CRTSCTS;
1679
1680	if (port->rs485.flags & SER_RS485_ENABLED) {
1681		/*
1682		 * RTS is mandatory for rs485 operation, so keep
1683		 * it under manual control and keep transmitter
1684		 * disabled.
1685		 */
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1686		if (port->rs485.flags & SER_RS485_RTS_AFTER_SEND)
1687			imx_uart_rts_active(sport, &ucr2);
1688		else
1689			imx_uart_rts_inactive(sport, &ucr2);
 
1690
1691	} else if (termios->c_cflag & CRTSCTS) {
1692		/*
1693		 * Only let receiver control RTS output if we were not requested
1694		 * to have RTS inactive (which then should take precedence).
1695		 */
1696		if (ucr2 & UCR2_CTS)
1697			ucr2 |= UCR2_CTSC;
1698	}
1699
1700	if (termios->c_cflag & CRTSCTS)
1701		ucr2 &= ~UCR2_IRTS;
1702	if (termios->c_cflag & CSTOPB)
1703		ucr2 |= UCR2_STPB;
1704	if (termios->c_cflag & PARENB) {
1705		ucr2 |= UCR2_PREN;
1706		if (termios->c_cflag & PARODD)
1707			ucr2 |= UCR2_PROE;
1708	}
1709
 
 
 
 
 
 
 
 
 
 
1710	sport->port.read_status_mask = 0;
1711	if (termios->c_iflag & INPCK)
1712		sport->port.read_status_mask |= (URXD_FRMERR | URXD_PRERR);
1713	if (termios->c_iflag & (BRKINT | PARMRK))
1714		sport->port.read_status_mask |= URXD_BRK;
1715
1716	/*
1717	 * Characters to ignore
1718	 */
1719	sport->port.ignore_status_mask = 0;
1720	if (termios->c_iflag & IGNPAR)
1721		sport->port.ignore_status_mask |= URXD_PRERR | URXD_FRMERR;
1722	if (termios->c_iflag & IGNBRK) {
1723		sport->port.ignore_status_mask |= URXD_BRK;
1724		/*
1725		 * If we're ignoring parity and break indicators,
1726		 * ignore overruns too (for real raw support).
1727		 */
1728		if (termios->c_iflag & IGNPAR)
1729			sport->port.ignore_status_mask |= URXD_OVRRUN;
1730	}
1731
1732	if ((termios->c_cflag & CREAD) == 0)
1733		sport->port.ignore_status_mask |= URXD_DUMMY_READ;
1734
1735	/*
1736	 * Update the per-port timeout.
1737	 */
1738	uart_update_timeout(port, termios->c_cflag, baud);
1739
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
1740	/* custom-baudrate handling */
1741	div = sport->port.uartclk / (baud * 16);
1742	if (baud == 38400 && quot != div)
1743		baud = sport->port.uartclk / (quot * 16);
1744
1745	div = sport->port.uartclk / (baud * 16);
1746	if (div > 7)
1747		div = 7;
1748	if (!div)
1749		div = 1;
1750
1751	rational_best_approximation(16 * div * baud, sport->port.uartclk,
1752		1 << 16, 1 << 16, &num, &denom);
1753
1754	tdiv64 = sport->port.uartclk;
1755	tdiv64 *= num;
1756	do_div(tdiv64, denom * 16 * div);
1757	tty_termios_encode_baud_rate(termios,
1758				(speed_t)tdiv64, (speed_t)tdiv64);
1759
1760	num -= 1;
1761	denom -= 1;
1762
1763	ufcr = imx_uart_readl(sport, UFCR);
1764	ufcr = (ufcr & (~UFCR_RFDIV)) | UFCR_RFDIV_REG(div);
1765	imx_uart_writel(sport, ufcr, UFCR);
 
 
 
 
 
1766
1767	/*
1768	 *  Two registers below should always be written both and in this
1769	 *  particular order. One consequence is that we need to check if any of
1770	 *  them changes and then update both. We do need the check for change
1771	 *  as even writing the same values seem to "restart"
1772	 *  transmission/receiving logic in the hardware, that leads to data
1773	 *  breakage even when rate doesn't in fact change. E.g., user switches
1774	 *  RTS/CTS handshake and suddenly gets broken bytes.
1775	 */
1776	old_ubir = imx_uart_readl(sport, UBIR);
1777	old_ubmr = imx_uart_readl(sport, UBMR);
1778	if (old_ubir != num || old_ubmr != denom) {
1779		imx_uart_writel(sport, num, UBIR);
1780		imx_uart_writel(sport, denom, UBMR);
1781	}
1782
1783	if (!imx_uart_is_imx1(sport))
1784		imx_uart_writel(sport, sport->port.uartclk / div / 1000,
1785				IMX21_ONEMS);
1786
1787	imx_uart_writel(sport, ucr2, UCR2);
 
1788
1789	if (UART_ENABLE_MS(&sport->port, termios->c_cflag))
1790		imx_uart_enable_ms(&sport->port);
1791
1792	spin_unlock_irqrestore(&sport->port.lock, flags);
1793}
1794
1795static const char *imx_uart_type(struct uart_port *port)
1796{
1797	struct imx_port *sport = (struct imx_port *)port;
1798
1799	return sport->port.type == PORT_IMX ? "IMX" : NULL;
1800}
1801
1802/*
1803 * Configure/autoconfigure the port.
1804 */
1805static void imx_uart_config_port(struct uart_port *port, int flags)
1806{
1807	struct imx_port *sport = (struct imx_port *)port;
1808
1809	if (flags & UART_CONFIG_TYPE)
1810		sport->port.type = PORT_IMX;
1811}
1812
1813/*
1814 * Verify the new serial_struct (for TIOCSSERIAL).
1815 * The only change we allow are to the flags and type, and
1816 * even then only between PORT_IMX and PORT_UNKNOWN
1817 */
1818static int
1819imx_uart_verify_port(struct uart_port *port, struct serial_struct *ser)
1820{
1821	struct imx_port *sport = (struct imx_port *)port;
1822	int ret = 0;
1823
1824	if (ser->type != PORT_UNKNOWN && ser->type != PORT_IMX)
1825		ret = -EINVAL;
1826	if (sport->port.irq != ser->irq)
1827		ret = -EINVAL;
1828	if (ser->io_type != UPIO_MEM)
1829		ret = -EINVAL;
1830	if (sport->port.uartclk / 16 != ser->baud_base)
1831		ret = -EINVAL;
1832	if (sport->port.mapbase != (unsigned long)ser->iomem_base)
1833		ret = -EINVAL;
1834	if (sport->port.iobase != ser->port)
1835		ret = -EINVAL;
1836	if (ser->hub6 != 0)
1837		ret = -EINVAL;
1838	return ret;
1839}
1840
1841#if defined(CONFIG_CONSOLE_POLL)
1842
1843static int imx_uart_poll_init(struct uart_port *port)
1844{
1845	struct imx_port *sport = (struct imx_port *)port;
1846	unsigned long flags;
1847	u32 ucr1, ucr2;
1848	int retval;
1849
1850	retval = clk_prepare_enable(sport->clk_ipg);
1851	if (retval)
1852		return retval;
1853	retval = clk_prepare_enable(sport->clk_per);
1854	if (retval)
1855		clk_disable_unprepare(sport->clk_ipg);
1856
1857	imx_uart_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
1858
1859	spin_lock_irqsave(&sport->port.lock, flags);
1860
1861	/*
1862	 * Be careful about the order of enabling bits here. First enable the
1863	 * receiver (UARTEN + RXEN) and only then the corresponding irqs.
1864	 * This prevents that a character that already sits in the RX fifo is
1865	 * triggering an irq but the try to fetch it from there results in an
1866	 * exception because UARTEN or RXEN is still off.
1867	 */
1868	ucr1 = imx_uart_readl(sport, UCR1);
1869	ucr2 = imx_uart_readl(sport, UCR2);
1870
1871	if (imx_uart_is_imx1(sport))
1872		ucr1 |= IMX1_UCR1_UARTCLKEN;
1873
1874	ucr1 |= UCR1_UARTEN;
1875	ucr1 &= ~(UCR1_TRDYEN | UCR1_RTSDEN | UCR1_RRDYEN);
1876
1877	ucr2 |= UCR2_RXEN;
1878	ucr2 &= ~UCR2_ATEN;
1879
1880	imx_uart_writel(sport, ucr1, UCR1);
1881	imx_uart_writel(sport, ucr2, UCR2);
1882
1883	/* now enable irqs */
1884	imx_uart_writel(sport, ucr1 | UCR1_RRDYEN, UCR1);
1885	imx_uart_writel(sport, ucr2 | UCR2_ATEN, UCR2);
1886
1887	spin_unlock_irqrestore(&sport->port.lock, flags);
1888
1889	return 0;
1890}
1891
1892static int imx_uart_poll_get_char(struct uart_port *port)
1893{
1894	struct imx_port *sport = (struct imx_port *)port;
1895	if (!(imx_uart_readl(sport, USR2) & USR2_RDR))
1896		return NO_POLL_CHAR;
1897
1898	return imx_uart_readl(sport, URXD0) & URXD_RX_DATA;
1899}
1900
1901static void imx_uart_poll_put_char(struct uart_port *port, unsigned char c)
1902{
1903	struct imx_port *sport = (struct imx_port *)port;
1904	unsigned int status;
1905
1906	/* drain */
1907	do {
1908		status = imx_uart_readl(sport, USR1);
1909	} while (~status & USR1_TRDY);
1910
1911	/* write */
1912	imx_uart_writel(sport, c, URTX0);
1913
1914	/* flush */
1915	do {
1916		status = imx_uart_readl(sport, USR2);
1917	} while (~status & USR2_TXDC);
1918}
1919#endif
1920
1921/* called with port.lock taken and irqs off or from .probe without locking */
1922static int imx_uart_rs485_config(struct uart_port *port,
1923				 struct serial_rs485 *rs485conf)
1924{
1925	struct imx_port *sport = (struct imx_port *)port;
1926	u32 ucr2;
 
 
 
 
1927
1928	/* RTS is required to control the transmitter */
1929	if (!sport->have_rtscts && !sport->have_rtsgpio)
1930		rs485conf->flags &= ~SER_RS485_ENABLED;
1931
1932	if (rs485conf->flags & SER_RS485_ENABLED) {
1933		/* Enable receiver if low-active RTS signal is requested */
1934		if (sport->have_rtscts &&  !sport->have_rtsgpio &&
1935		    !(rs485conf->flags & SER_RS485_RTS_ON_SEND))
1936			rs485conf->flags |= SER_RS485_RX_DURING_TX;
1937
1938		/* disable transmitter */
1939		ucr2 = imx_uart_readl(sport, UCR2);
1940		if (rs485conf->flags & SER_RS485_RTS_AFTER_SEND)
1941			imx_uart_rts_active(sport, &ucr2);
1942		else
1943			imx_uart_rts_inactive(sport, &ucr2);
1944		imx_uart_writel(sport, ucr2, UCR2);
1945	}
1946
1947	/* Make sure Rx is enabled in case Tx is active with Rx disabled */
1948	if (!(rs485conf->flags & SER_RS485_ENABLED) ||
1949	    rs485conf->flags & SER_RS485_RX_DURING_TX)
1950		imx_uart_start_rx(port);
1951
1952	port->rs485 = *rs485conf;
1953
1954	return 0;
1955}
1956
1957static const struct uart_ops imx_uart_pops = {
1958	.tx_empty	= imx_uart_tx_empty,
1959	.set_mctrl	= imx_uart_set_mctrl,
1960	.get_mctrl	= imx_uart_get_mctrl,
1961	.stop_tx	= imx_uart_stop_tx,
1962	.start_tx	= imx_uart_start_tx,
1963	.stop_rx	= imx_uart_stop_rx,
1964	.enable_ms	= imx_uart_enable_ms,
1965	.break_ctl	= imx_uart_break_ctl,
1966	.startup	= imx_uart_startup,
1967	.shutdown	= imx_uart_shutdown,
1968	.flush_buffer	= imx_uart_flush_buffer,
1969	.set_termios	= imx_uart_set_termios,
1970	.type		= imx_uart_type,
1971	.config_port	= imx_uart_config_port,
1972	.verify_port	= imx_uart_verify_port,
1973#if defined(CONFIG_CONSOLE_POLL)
1974	.poll_init      = imx_uart_poll_init,
1975	.poll_get_char  = imx_uart_poll_get_char,
1976	.poll_put_char  = imx_uart_poll_put_char,
1977#endif
1978};
1979
1980static struct imx_port *imx_uart_ports[UART_NR];
1981
1982#if IS_ENABLED(CONFIG_SERIAL_IMX_CONSOLE)
1983static void imx_uart_console_putchar(struct uart_port *port, int ch)
1984{
1985	struct imx_port *sport = (struct imx_port *)port;
1986
1987	while (imx_uart_readl(sport, imx_uart_uts_reg(sport)) & UTS_TXFULL)
1988		barrier();
1989
1990	imx_uart_writel(sport, ch, URTX0);
1991}
1992
1993/*
1994 * Interrupts are disabled on entering
1995 */
1996static void
1997imx_uart_console_write(struct console *co, const char *s, unsigned int count)
1998{
1999	struct imx_port *sport = imx_uart_ports[co->index];
2000	struct imx_port_ucrs old_ucr;
2001	unsigned int ucr1;
2002	unsigned long flags = 0;
2003	int locked = 1;
2004	int retval;
2005
2006	retval = clk_enable(sport->clk_per);
2007	if (retval)
2008		return;
2009	retval = clk_enable(sport->clk_ipg);
2010	if (retval) {
2011		clk_disable(sport->clk_per);
2012		return;
2013	}
2014
2015	if (sport->port.sysrq)
2016		locked = 0;
2017	else if (oops_in_progress)
2018		locked = spin_trylock_irqsave(&sport->port.lock, flags);
2019	else
2020		spin_lock_irqsave(&sport->port.lock, flags);
2021
2022	/*
2023	 *	First, save UCR1/2/3 and then disable interrupts
2024	 */
2025	imx_uart_ucrs_save(sport, &old_ucr);
2026	ucr1 = old_ucr.ucr1;
2027
2028	if (imx_uart_is_imx1(sport))
2029		ucr1 |= IMX1_UCR1_UARTCLKEN;
2030	ucr1 |= UCR1_UARTEN;
2031	ucr1 &= ~(UCR1_TRDYEN | UCR1_RRDYEN | UCR1_RTSDEN);
2032
2033	imx_uart_writel(sport, ucr1, UCR1);
2034
2035	imx_uart_writel(sport, old_ucr.ucr2 | UCR2_TXEN, UCR2);
2036
2037	uart_console_write(&sport->port, s, count, imx_uart_console_putchar);
2038
2039	/*
2040	 *	Finally, wait for transmitter to become empty
2041	 *	and restore UCR1/2/3
2042	 */
2043	while (!(imx_uart_readl(sport, USR2) & USR2_TXDC));
2044
2045	imx_uart_ucrs_restore(sport, &old_ucr);
2046
2047	if (locked)
2048		spin_unlock_irqrestore(&sport->port.lock, flags);
2049
2050	clk_disable(sport->clk_ipg);
2051	clk_disable(sport->clk_per);
2052}
2053
2054/*
2055 * If the port was already initialised (eg, by a boot loader),
2056 * try to determine the current setup.
2057 */
2058static void __init
2059imx_uart_console_get_options(struct imx_port *sport, int *baud,
2060			     int *parity, int *bits)
2061{
2062
2063	if (imx_uart_readl(sport, UCR1) & UCR1_UARTEN) {
2064		/* ok, the port was enabled */
2065		unsigned int ucr2, ubir, ubmr, uartclk;
2066		unsigned int baud_raw;
2067		unsigned int ucfr_rfdiv;
2068
2069		ucr2 = imx_uart_readl(sport, UCR2);
2070
2071		*parity = 'n';
2072		if (ucr2 & UCR2_PREN) {
2073			if (ucr2 & UCR2_PROE)
2074				*parity = 'o';
2075			else
2076				*parity = 'e';
2077		}
2078
2079		if (ucr2 & UCR2_WS)
2080			*bits = 8;
2081		else
2082			*bits = 7;
2083
2084		ubir = imx_uart_readl(sport, UBIR) & 0xffff;
2085		ubmr = imx_uart_readl(sport, UBMR) & 0xffff;
2086
2087		ucfr_rfdiv = (imx_uart_readl(sport, UFCR) & UFCR_RFDIV) >> 7;
2088		if (ucfr_rfdiv == 6)
2089			ucfr_rfdiv = 7;
2090		else
2091			ucfr_rfdiv = 6 - ucfr_rfdiv;
2092
2093		uartclk = clk_get_rate(sport->clk_per);
2094		uartclk /= ucfr_rfdiv;
2095
2096		{	/*
2097			 * The next code provides exact computation of
2098			 *   baud_raw = round(((uartclk/16) * (ubir + 1)) / (ubmr + 1))
2099			 * without need of float support or long long division,
2100			 * which would be required to prevent 32bit arithmetic overflow
2101			 */
2102			unsigned int mul = ubir + 1;
2103			unsigned int div = 16 * (ubmr + 1);
2104			unsigned int rem = uartclk % div;
2105
2106			baud_raw = (uartclk / div) * mul;
2107			baud_raw += (rem * mul + div / 2) / div;
2108			*baud = (baud_raw + 50) / 100 * 100;
2109		}
2110
2111		if (*baud != baud_raw)
2112			dev_info(sport->port.dev, "Console IMX rounded baud rate from %d to %d\n",
2113				baud_raw, *baud);
2114	}
2115}
2116
2117static int __init
2118imx_uart_console_setup(struct console *co, char *options)
2119{
2120	struct imx_port *sport;
2121	int baud = 9600;
2122	int bits = 8;
2123	int parity = 'n';
2124	int flow = 'n';
2125	int retval;
2126
2127	/*
2128	 * Check whether an invalid uart number has been specified, and
2129	 * if so, search for the first available port that does have
2130	 * console support.
2131	 */
2132	if (co->index == -1 || co->index >= ARRAY_SIZE(imx_uart_ports))
2133		co->index = 0;
2134	sport = imx_uart_ports[co->index];
2135	if (sport == NULL)
2136		return -ENODEV;
2137
2138	/* For setting the registers, we only need to enable the ipg clock. */
2139	retval = clk_prepare_enable(sport->clk_ipg);
2140	if (retval)
2141		goto error_console;
2142
2143	if (options)
2144		uart_parse_options(options, &baud, &parity, &bits, &flow);
2145	else
2146		imx_uart_console_get_options(sport, &baud, &parity, &bits);
2147
2148	imx_uart_setup_ufcr(sport, TXTL_DEFAULT, RXTL_DEFAULT);
2149
2150	retval = uart_set_options(&sport->port, co, baud, parity, bits, flow);
2151
2152	clk_disable(sport->clk_ipg);
2153	if (retval) {
2154		clk_unprepare(sport->clk_ipg);
2155		goto error_console;
2156	}
2157
2158	retval = clk_prepare(sport->clk_per);
2159	if (retval)
2160		clk_unprepare(sport->clk_ipg);
2161
2162error_console:
2163	return retval;
2164}
2165
2166static struct uart_driver imx_uart_uart_driver;
2167static struct console imx_uart_console = {
2168	.name		= DEV_NAME,
2169	.write		= imx_uart_console_write,
2170	.device		= uart_console_device,
2171	.setup		= imx_uart_console_setup,
2172	.flags		= CON_PRINTBUFFER,
2173	.index		= -1,
2174	.data		= &imx_uart_uart_driver,
2175};
2176
2177#define IMX_CONSOLE	&imx_uart_console
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
 
2178
2179#else
2180#define IMX_CONSOLE	NULL
2181#endif
2182
2183static struct uart_driver imx_uart_uart_driver = {
2184	.owner          = THIS_MODULE,
2185	.driver_name    = DRIVER_NAME,
2186	.dev_name       = DEV_NAME,
2187	.major          = SERIAL_IMX_MAJOR,
2188	.minor          = MINOR_START,
2189	.nr             = ARRAY_SIZE(imx_uart_ports),
2190	.cons           = IMX_CONSOLE,
2191};
2192
2193#ifdef CONFIG_OF
2194/*
2195 * This function returns 1 iff pdev isn't a device instatiated by dt, 0 iff it
2196 * could successfully get all information from dt or a negative errno.
2197 */
2198static int imx_uart_probe_dt(struct imx_port *sport,
2199			     struct platform_device *pdev)
2200{
2201	struct device_node *np = pdev->dev.of_node;
2202	int ret;
2203
2204	sport->devdata = of_device_get_match_data(&pdev->dev);
2205	if (!sport->devdata)
2206		/* no device tree device */
2207		return 1;
2208
2209	ret = of_alias_get_id(np, "serial");
2210	if (ret < 0) {
2211		dev_err(&pdev->dev, "failed to get alias id, errno %d\n", ret);
2212		return ret;
2213	}
2214	sport->port.line = ret;
2215
2216	if (of_get_property(np, "uart-has-rtscts", NULL) ||
2217	    of_get_property(np, "fsl,uart-has-rtscts", NULL) /* deprecated */)
2218		sport->have_rtscts = 1;
2219
2220	if (of_get_property(np, "fsl,dte-mode", NULL))
2221		sport->dte_mode = 1;
2222
2223	if (of_get_property(np, "rts-gpios", NULL))
2224		sport->have_rtsgpio = 1;
2225
2226	if (of_get_property(np, "fsl,inverted-tx", NULL))
2227		sport->inverted_tx = 1;
2228
2229	if (of_get_property(np, "fsl,inverted-rx", NULL))
2230		sport->inverted_rx = 1;
2231
2232	return 0;
2233}
2234#else
2235static inline int imx_uart_probe_dt(struct imx_port *sport,
2236				    struct platform_device *pdev)
2237{
2238	return 1;
2239}
2240#endif
2241
2242static void imx_uart_probe_pdata(struct imx_port *sport,
2243				 struct platform_device *pdev)
2244{
2245	struct imxuart_platform_data *pdata = dev_get_platdata(&pdev->dev);
2246
2247	sport->port.line = pdev->id;
2248	sport->devdata = (struct imx_uart_data	*) pdev->id_entry->driver_data;
2249
2250	if (!pdata)
2251		return;
2252
2253	if (pdata->flags & IMXUART_HAVE_RTSCTS)
2254		sport->have_rtscts = 1;
2255}
2256
2257static enum hrtimer_restart imx_trigger_start_tx(struct hrtimer *t)
2258{
2259	struct imx_port *sport = container_of(t, struct imx_port, trigger_start_tx);
2260	unsigned long flags;
2261
2262	spin_lock_irqsave(&sport->port.lock, flags);
2263	if (sport->tx_state == WAIT_AFTER_RTS)
2264		imx_uart_start_tx(&sport->port);
2265	spin_unlock_irqrestore(&sport->port.lock, flags);
2266
2267	return HRTIMER_NORESTART;
2268}
2269
2270static enum hrtimer_restart imx_trigger_stop_tx(struct hrtimer *t)
2271{
2272	struct imx_port *sport = container_of(t, struct imx_port, trigger_stop_tx);
2273	unsigned long flags;
2274
2275	spin_lock_irqsave(&sport->port.lock, flags);
2276	if (sport->tx_state == WAIT_AFTER_SEND)
2277		imx_uart_stop_tx(&sport->port);
2278	spin_unlock_irqrestore(&sport->port.lock, flags);
2279
2280	return HRTIMER_NORESTART;
2281}
2282
2283static int imx_uart_probe(struct platform_device *pdev)
2284{
2285	struct imx_port *sport;
2286	void __iomem *base;
2287	int ret = 0;
2288	u32 ucr1;
2289	struct resource *res;
2290	int txirq, rxirq, rtsirq;
2291
2292	sport = devm_kzalloc(&pdev->dev, sizeof(*sport), GFP_KERNEL);
2293	if (!sport)
2294		return -ENOMEM;
2295
2296	ret = imx_uart_probe_dt(sport, pdev);
2297	if (ret > 0)
2298		imx_uart_probe_pdata(sport, pdev);
2299	else if (ret < 0)
2300		return ret;
2301
2302	if (sport->port.line >= ARRAY_SIZE(imx_uart_ports)) {
2303		dev_err(&pdev->dev, "serial%d out of range\n",
2304			sport->port.line);
2305		return -EINVAL;
2306	}
2307
2308	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
2309	base = devm_ioremap_resource(&pdev->dev, res);
2310	if (IS_ERR(base))
2311		return PTR_ERR(base);
2312
2313	rxirq = platform_get_irq(pdev, 0);
2314	if (rxirq < 0)
2315		return rxirq;
2316	txirq = platform_get_irq_optional(pdev, 1);
2317	rtsirq = platform_get_irq_optional(pdev, 2);
2318
2319	sport->port.dev = &pdev->dev;
2320	sport->port.mapbase = res->start;
2321	sport->port.membase = base;
2322	sport->port.type = PORT_IMX,
2323	sport->port.iotype = UPIO_MEM;
2324	sport->port.irq = rxirq;
2325	sport->port.fifosize = 32;
2326	sport->port.has_sysrq = IS_ENABLED(CONFIG_SERIAL_IMX_CONSOLE);
2327	sport->port.ops = &imx_uart_pops;
2328	sport->port.rs485_config = imx_uart_rs485_config;
 
2329	sport->port.flags = UPF_BOOT_AUTOCONF;
2330	timer_setup(&sport->timer, imx_uart_timeout, 0);
 
 
2331
2332	sport->gpios = mctrl_gpio_init(&sport->port, 0);
2333	if (IS_ERR(sport->gpios))
2334		return PTR_ERR(sport->gpios);
2335
2336	sport->clk_ipg = devm_clk_get(&pdev->dev, "ipg");
2337	if (IS_ERR(sport->clk_ipg)) {
2338		ret = PTR_ERR(sport->clk_ipg);
2339		dev_err(&pdev->dev, "failed to get ipg clk: %d\n", ret);
2340		return ret;
2341	}
2342
2343	sport->clk_per = devm_clk_get(&pdev->dev, "per");
2344	if (IS_ERR(sport->clk_per)) {
2345		ret = PTR_ERR(sport->clk_per);
2346		dev_err(&pdev->dev, "failed to get per clk: %d\n", ret);
2347		return ret;
2348	}
2349
2350	sport->port.uartclk = clk_get_rate(sport->clk_per);
2351
2352	/* For register access, we only need to enable the ipg clock. */
2353	ret = clk_prepare_enable(sport->clk_ipg);
2354	if (ret) {
2355		dev_err(&pdev->dev, "failed to enable per clk: %d\n", ret);
2356		return ret;
2357	}
2358
2359	/* initialize shadow register values */
2360	sport->ucr1 = readl(sport->port.membase + UCR1);
2361	sport->ucr2 = readl(sport->port.membase + UCR2);
2362	sport->ucr3 = readl(sport->port.membase + UCR3);
2363	sport->ucr4 = readl(sport->port.membase + UCR4);
2364	sport->ufcr = readl(sport->port.membase + UFCR);
2365
2366	ret = uart_get_rs485_mode(&sport->port);
2367	if (ret) {
2368		clk_disable_unprepare(sport->clk_ipg);
2369		return ret;
2370	}
2371
2372	if (sport->port.rs485.flags & SER_RS485_ENABLED &&
2373	    (!sport->have_rtscts && !sport->have_rtsgpio))
2374		dev_err(&pdev->dev, "no RTS control, disabling rs485\n");
2375
2376	/*
2377	 * If using the i.MX UART RTS/CTS control then the RTS (CTS_B)
2378	 * signal cannot be set low during transmission in case the
2379	 * receiver is off (limitation of the i.MX UART IP).
2380	 */
2381	if (sport->port.rs485.flags & SER_RS485_ENABLED &&
2382	    sport->have_rtscts && !sport->have_rtsgpio &&
2383	    (!(sport->port.rs485.flags & SER_RS485_RTS_ON_SEND) &&
2384	     !(sport->port.rs485.flags & SER_RS485_RX_DURING_TX)))
2385		dev_err(&pdev->dev,
2386			"low-active RTS not possible when receiver is off, enabling receiver\n");
2387
2388	imx_uart_rs485_config(&sport->port, &sport->port.rs485);
2389
2390	/* Disable interrupts before requesting them */
2391	ucr1 = imx_uart_readl(sport, UCR1);
2392	ucr1 &= ~(UCR1_ADEN | UCR1_TRDYEN | UCR1_IDEN | UCR1_RRDYEN |
2393		 UCR1_TRDYEN | UCR1_RTSDEN);
2394	imx_uart_writel(sport, ucr1, UCR1);
2395
2396	if (!imx_uart_is_imx1(sport) && sport->dte_mode) {
2397		/*
2398		 * The DCEDTE bit changes the direction of DSR, DCD, DTR and RI
2399		 * and influences if UCR3_RI and UCR3_DCD changes the level of RI
2400		 * and DCD (when they are outputs) or enables the respective
2401		 * irqs. So set this bit early, i.e. before requesting irqs.
2402		 */
2403		u32 ufcr = imx_uart_readl(sport, UFCR);
2404		if (!(ufcr & UFCR_DCEDTE))
2405			imx_uart_writel(sport, ufcr | UFCR_DCEDTE, UFCR);
2406
2407		/*
2408		 * Disable UCR3_RI and UCR3_DCD irqs. They are also not
2409		 * enabled later because they cannot be cleared
2410		 * (confirmed on i.MX25) which makes them unusable.
2411		 */
2412		imx_uart_writel(sport,
2413				IMX21_UCR3_RXDMUXSEL | UCR3_ADNIMP | UCR3_DSR,
2414				UCR3);
2415
2416	} else {
2417		u32 ucr3 = UCR3_DSR;
2418		u32 ufcr = imx_uart_readl(sport, UFCR);
2419		if (ufcr & UFCR_DCEDTE)
2420			imx_uart_writel(sport, ufcr & ~UFCR_DCEDTE, UFCR);
2421
2422		if (!imx_uart_is_imx1(sport))
2423			ucr3 |= IMX21_UCR3_RXDMUXSEL | UCR3_ADNIMP;
2424		imx_uart_writel(sport, ucr3, UCR3);
2425	}
2426
2427	clk_disable_unprepare(sport->clk_ipg);
2428
2429	hrtimer_init(&sport->trigger_start_tx, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
2430	hrtimer_init(&sport->trigger_stop_tx, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
2431	sport->trigger_start_tx.function = imx_trigger_start_tx;
2432	sport->trigger_stop_tx.function = imx_trigger_stop_tx;
2433
2434	/*
2435	 * Allocate the IRQ(s) i.MX1 has three interrupts whereas later
2436	 * chips only have one interrupt.
2437	 */
2438	if (txirq > 0) {
2439		ret = devm_request_irq(&pdev->dev, rxirq, imx_uart_rxint, 0,
2440				       dev_name(&pdev->dev), sport);
2441		if (ret) {
2442			dev_err(&pdev->dev, "failed to request rx irq: %d\n",
2443				ret);
2444			return ret;
2445		}
2446
2447		ret = devm_request_irq(&pdev->dev, txirq, imx_uart_txint, 0,
2448				       dev_name(&pdev->dev), sport);
2449		if (ret) {
2450			dev_err(&pdev->dev, "failed to request tx irq: %d\n",
2451				ret);
2452			return ret;
2453		}
2454
2455		ret = devm_request_irq(&pdev->dev, rtsirq, imx_uart_rtsint, 0,
2456				       dev_name(&pdev->dev), sport);
2457		if (ret) {
2458			dev_err(&pdev->dev, "failed to request rts irq: %d\n",
2459				ret);
2460			return ret;
2461		}
2462	} else {
2463		ret = devm_request_irq(&pdev->dev, rxirq, imx_uart_int, 0,
2464				       dev_name(&pdev->dev), sport);
2465		if (ret) {
2466			dev_err(&pdev->dev, "failed to request irq: %d\n", ret);
2467			return ret;
2468		}
2469	}
2470
2471	imx_uart_ports[sport->port.line] = sport;
2472
2473	platform_set_drvdata(pdev, sport);
2474
2475	return uart_add_one_port(&imx_uart_uart_driver, &sport->port);
2476}
2477
2478static int imx_uart_remove(struct platform_device *pdev)
2479{
2480	struct imx_port *sport = platform_get_drvdata(pdev);
2481
2482	return uart_remove_one_port(&imx_uart_uart_driver, &sport->port);
2483}
2484
2485static void imx_uart_restore_context(struct imx_port *sport)
2486{
2487	unsigned long flags;
2488
2489	spin_lock_irqsave(&sport->port.lock, flags);
2490	if (!sport->context_saved) {
2491		spin_unlock_irqrestore(&sport->port.lock, flags);
2492		return;
2493	}
2494
2495	imx_uart_writel(sport, sport->saved_reg[4], UFCR);
2496	imx_uart_writel(sport, sport->saved_reg[5], UESC);
2497	imx_uart_writel(sport, sport->saved_reg[6], UTIM);
2498	imx_uart_writel(sport, sport->saved_reg[7], UBIR);
2499	imx_uart_writel(sport, sport->saved_reg[8], UBMR);
2500	imx_uart_writel(sport, sport->saved_reg[9], IMX21_UTS);
2501	imx_uart_writel(sport, sport->saved_reg[0], UCR1);
2502	imx_uart_writel(sport, sport->saved_reg[1] | UCR2_SRST, UCR2);
2503	imx_uart_writel(sport, sport->saved_reg[2], UCR3);
2504	imx_uart_writel(sport, sport->saved_reg[3], UCR4);
2505	sport->context_saved = false;
2506	spin_unlock_irqrestore(&sport->port.lock, flags);
2507}
2508
2509static void imx_uart_save_context(struct imx_port *sport)
2510{
2511	unsigned long flags;
2512
2513	/* Save necessary regs */
2514	spin_lock_irqsave(&sport->port.lock, flags);
2515	sport->saved_reg[0] = imx_uart_readl(sport, UCR1);
2516	sport->saved_reg[1] = imx_uart_readl(sport, UCR2);
2517	sport->saved_reg[2] = imx_uart_readl(sport, UCR3);
2518	sport->saved_reg[3] = imx_uart_readl(sport, UCR4);
2519	sport->saved_reg[4] = imx_uart_readl(sport, UFCR);
2520	sport->saved_reg[5] = imx_uart_readl(sport, UESC);
2521	sport->saved_reg[6] = imx_uart_readl(sport, UTIM);
2522	sport->saved_reg[7] = imx_uart_readl(sport, UBIR);
2523	sport->saved_reg[8] = imx_uart_readl(sport, UBMR);
2524	sport->saved_reg[9] = imx_uart_readl(sport, IMX21_UTS);
2525	sport->context_saved = true;
2526	spin_unlock_irqrestore(&sport->port.lock, flags);
2527}
2528
2529static void imx_uart_enable_wakeup(struct imx_port *sport, bool on)
2530{
2531	u32 ucr3;
2532
2533	ucr3 = imx_uart_readl(sport, UCR3);
2534	if (on) {
2535		imx_uart_writel(sport, USR1_AWAKE, USR1);
2536		ucr3 |= UCR3_AWAKEN;
2537	} else {
2538		ucr3 &= ~UCR3_AWAKEN;
2539	}
2540	imx_uart_writel(sport, ucr3, UCR3);
2541
2542	if (sport->have_rtscts) {
2543		u32 ucr1 = imx_uart_readl(sport, UCR1);
2544		if (on)
2545			ucr1 |= UCR1_RTSDEN;
2546		else
2547			ucr1 &= ~UCR1_RTSDEN;
2548		imx_uart_writel(sport, ucr1, UCR1);
2549	}
2550}
2551
2552static int imx_uart_suspend_noirq(struct device *dev)
2553{
2554	struct imx_port *sport = dev_get_drvdata(dev);
2555
2556	imx_uart_save_context(sport);
2557
2558	clk_disable(sport->clk_ipg);
2559
2560	pinctrl_pm_select_sleep_state(dev);
2561
2562	return 0;
2563}
2564
2565static int imx_uart_resume_noirq(struct device *dev)
2566{
2567	struct imx_port *sport = dev_get_drvdata(dev);
2568	int ret;
2569
2570	pinctrl_pm_select_default_state(dev);
2571
2572	ret = clk_enable(sport->clk_ipg);
2573	if (ret)
2574		return ret;
2575
2576	imx_uart_restore_context(sport);
 
 
2577
2578	return 0;
2579}
2580
2581static int imx_uart_suspend(struct device *dev)
2582{
2583	struct imx_port *sport = dev_get_drvdata(dev);
 
2584	int ret;
2585
2586	uart_suspend_port(&imx_uart_uart_driver, &sport->port);
2587	disable_irq(sport->port.irq);
2588
2589	ret = clk_prepare_enable(sport->clk_ipg);
2590	if (ret)
2591		return ret;
2592
2593	/* enable wakeup from i.MX UART */
2594	imx_uart_enable_wakeup(sport, true);
 
2595
2596	return 0;
2597}
2598
2599static int imx_uart_resume(struct device *dev)
2600{
2601	struct imx_port *sport = dev_get_drvdata(dev);
 
2602
2603	/* disable wakeup from i.MX UART */
2604	imx_uart_enable_wakeup(sport, false);
2605
2606	uart_resume_port(&imx_uart_uart_driver, &sport->port);
2607	enable_irq(sport->port.irq);
2608
2609	clk_disable_unprepare(sport->clk_ipg);
2610
2611	return 0;
 
2612}
2613
2614static int imx_uart_freeze(struct device *dev)
2615{
2616	struct imx_port *sport = dev_get_drvdata(dev);
 
2617
2618	uart_suspend_port(&imx_uart_uart_driver, &sport->port);
 
2619
2620	return clk_prepare_enable(sport->clk_ipg);
2621}
2622
2623static int imx_uart_thaw(struct device *dev)
2624{
2625	struct imx_port *sport = dev_get_drvdata(dev);
2626
2627	uart_resume_port(&imx_uart_uart_driver, &sport->port);
2628
2629	clk_disable_unprepare(sport->clk_ipg);
2630
2631	return 0;
2632}
2633
2634static const struct dev_pm_ops imx_uart_pm_ops = {
2635	.suspend_noirq = imx_uart_suspend_noirq,
2636	.resume_noirq = imx_uart_resume_noirq,
2637	.freeze_noirq = imx_uart_suspend_noirq,
2638	.restore_noirq = imx_uart_resume_noirq,
2639	.suspend = imx_uart_suspend,
2640	.resume = imx_uart_resume,
2641	.freeze = imx_uart_freeze,
2642	.thaw = imx_uart_thaw,
2643	.restore = imx_uart_thaw,
2644};
2645
2646static struct platform_driver imx_uart_platform_driver = {
2647	.probe = imx_uart_probe,
2648	.remove = imx_uart_remove,
2649
2650	.id_table = imx_uart_devtype,
2651	.driver = {
2652		.name = "imx-uart",
2653		.of_match_table = imx_uart_dt_ids,
2654		.pm = &imx_uart_pm_ops,
2655	},
2656};
2657
2658static int __init imx_uart_init(void)
2659{
2660	int ret = uart_register_driver(&imx_uart_uart_driver);
2661
2662	if (ret)
2663		return ret;
2664
2665	ret = platform_driver_register(&imx_uart_platform_driver);
2666	if (ret != 0)
2667		uart_unregister_driver(&imx_uart_uart_driver);
2668
2669	return ret;
2670}
2671
2672static void __exit imx_uart_exit(void)
2673{
2674	platform_driver_unregister(&imx_uart_platform_driver);
2675	uart_unregister_driver(&imx_uart_uart_driver);
2676}
2677
2678module_init(imx_uart_init);
2679module_exit(imx_uart_exit);
2680
2681MODULE_AUTHOR("Sascha Hauer");
2682MODULE_DESCRIPTION("IMX generic serial port driver");
2683MODULE_LICENSE("GPL");
2684MODULE_ALIAS("platform:imx-uart");