imx.c 38.0 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8
/*
 *  Driver for Motorola IMX serial ports
 *
 *  Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
 *
 *  Author: Sascha Hauer <sascha@saschahauer.de>
 *  Copyright (C) 2004 Pengutronix
 *
9 10 11
 *  Copyright (C) 2009 emlix GmbH
 *  Author: Fabian Godehardt (added IrDA support for iMX)
 *
L
Linus Torvalds 已提交
12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
 *
 * [29-Mar-2005] Mike Lee
 * Added hardware handshake
 */

#if defined(CONFIG_SERIAL_IMX_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
#define SUPPORT_SYSRQ
#endif

#include <linux/module.h>
#include <linux/ioport.h>
#include <linux/init.h>
#include <linux/console.h>
#include <linux/sysrq.h>
39
#include <linux/platform_device.h>
L
Linus Torvalds 已提交
40 41 42 43
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <linux/serial_core.h>
#include <linux/serial.h>
S
Sascha Hauer 已提交
44
#include <linux/clk.h>
45
#include <linux/delay.h>
46
#include <linux/rational.h>
47
#include <linux/slab.h>
48 49
#include <linux/of.h>
#include <linux/of_device.h>
L
Linus Torvalds 已提交
50 51 52

#include <asm/io.h>
#include <asm/irq.h>
53
#include <mach/imx-uart.h>
L
Linus Torvalds 已提交
54

55 56 57 58 59 60 61 62 63 64 65 66 67 68 69
/* Register definitions */
#define URXD0 0x0  /* Receiver Register */
#define URTX0 0x40 /* Transmitter Register */
#define UCR1  0x80 /* Control Register 1 */
#define UCR2  0x84 /* Control Register 2 */
#define UCR3  0x88 /* Control Register 3 */
#define UCR4  0x8c /* Control Register 4 */
#define UFCR  0x90 /* FIFO Control Register */
#define USR1  0x94 /* Status Register 1 */
#define USR2  0x98 /* Status Register 2 */
#define UESC  0x9c /* Escape Character Register */
#define UTIM  0xa0 /* Escape Timer Register */
#define UBIR  0xa4 /* BRM Incremental Register */
#define UBMR  0xa8 /* BRM Modulator Register */
#define UBRC  0xac /* Baud Rate Count Register */
70 71 72
#define IMX21_ONEMS 0xb0 /* One Millisecond register */
#define IMX1_UTS 0xd0 /* UART Test Register on i.mx1 */
#define IMX21_UTS 0xb4 /* UART Test Register on all other i.mx*/
73 74 75 76 77 78 79 80

/* UART Control Register Bit Fields.*/
#define  URXD_CHARRDY    (1<<15)
#define  URXD_ERR        (1<<14)
#define  URXD_OVRRUN     (1<<13)
#define  URXD_FRMERR     (1<<12)
#define  URXD_BRK        (1<<11)
#define  URXD_PRERR      (1<<10)
L
Lucas De Marchi 已提交
81
#define  UCR1_ADEN       (1<<15) /* Auto detect interrupt */
82 83 84 85 86 87 88 89 90 91
#define  UCR1_ADBR       (1<<14) /* Auto detect baud rate */
#define  UCR1_TRDYEN     (1<<13) /* Transmitter ready interrupt enable */
#define  UCR1_IDEN       (1<<12) /* Idle condition interrupt */
#define  UCR1_RRDYEN     (1<<9)	 /* Recv ready interrupt enable */
#define  UCR1_RDMAEN     (1<<8)	 /* Recv ready DMA enable */
#define  UCR1_IREN       (1<<7)	 /* Infrared interface enable */
#define  UCR1_TXMPTYEN   (1<<6)	 /* Transimitter empty interrupt enable */
#define  UCR1_RTSDEN     (1<<5)	 /* RTS delta interrupt enable */
#define  UCR1_SNDBRK     (1<<4)	 /* Send break */
#define  UCR1_TDMAEN     (1<<3)	 /* Transmitter ready DMA enable */
92
#define  IMX1_UCR1_UARTCLKEN  (1<<2)  /* UART clock enabled, i.mx1 only */
93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117
#define  UCR1_DOZE       (1<<1)	 /* Doze */
#define  UCR1_UARTEN     (1<<0)	 /* UART enabled */
#define  UCR2_ESCI     	 (1<<15) /* Escape seq interrupt enable */
#define  UCR2_IRTS  	 (1<<14) /* Ignore RTS pin */
#define  UCR2_CTSC  	 (1<<13) /* CTS pin control */
#define  UCR2_CTS        (1<<12) /* Clear to send */
#define  UCR2_ESCEN      (1<<11) /* Escape enable */
#define  UCR2_PREN       (1<<8)  /* Parity enable */
#define  UCR2_PROE       (1<<7)  /* Parity odd/even */
#define  UCR2_STPB       (1<<6)	 /* Stop */
#define  UCR2_WS         (1<<5)	 /* Word size */
#define  UCR2_RTSEN      (1<<4)	 /* Request to send interrupt enable */
#define  UCR2_TXEN       (1<<2)	 /* Transmitter enabled */
#define  UCR2_RXEN       (1<<1)	 /* Receiver enabled */
#define  UCR2_SRST 	 (1<<0)	 /* SW reset */
#define  UCR3_DTREN 	 (1<<13) /* DTR interrupt enable */
#define  UCR3_PARERREN   (1<<12) /* Parity enable */
#define  UCR3_FRAERREN   (1<<11) /* Frame error interrupt enable */
#define  UCR3_DSR        (1<<10) /* Data set ready */
#define  UCR3_DCD        (1<<9)  /* Data carrier detect */
#define  UCR3_RI         (1<<8)  /* Ring indicator */
#define  UCR3_TIMEOUTEN  (1<<7)  /* Timeout interrupt enable */
#define  UCR3_RXDSEN	 (1<<6)  /* Receive status interrupt enable */
#define  UCR3_AIRINTEN   (1<<5)  /* Async IR wake interrupt enable */
#define  UCR3_AWAKEN	 (1<<4)  /* Async wake interrupt enable */
118
#define  IMX21_UCR3_RXDMUXSEL	 (1<<2)  /* RXD Muxed Input Select */
119 120
#define  UCR3_INVT  	 (1<<1)  /* Inverted Infrared transmission */
#define  UCR3_BPEN  	 (1<<0)  /* Preset registers enable */
121 122
#define  UCR4_CTSTL_SHF  10      /* CTS trigger level shift */
#define  UCR4_CTSTL_MASK 0x3F    /* CTS trigger is 6 bits wide */
123 124 125 126 127 128 129 130 131 132 133
#define  UCR4_INVR  	 (1<<9)  /* Inverted infrared reception */
#define  UCR4_ENIRI 	 (1<<8)  /* Serial infrared interrupt enable */
#define  UCR4_WKEN  	 (1<<7)  /* Wake interrupt enable */
#define  UCR4_REF16 	 (1<<6)  /* Ref freq 16 MHz */
#define  UCR4_IRSC  	 (1<<5)  /* IR special case */
#define  UCR4_TCEN  	 (1<<3)  /* Transmit complete interrupt enable */
#define  UCR4_BKEN  	 (1<<2)  /* Break condition interrupt enable */
#define  UCR4_OREN  	 (1<<1)  /* Receiver overrun interrupt enable */
#define  UCR4_DREN  	 (1<<0)  /* Recv data ready interrupt enable */
#define  UFCR_RXTL_SHF   0       /* Receiver trigger level shift */
#define  UFCR_RFDIV      (7<<7)  /* Reference freq divider mask */
134
#define  UFCR_RFDIV_REG(x)	(((x) < 7 ? 6 - (x) : 6) << 7)
135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165
#define  UFCR_TXTL_SHF   10      /* Transmitter trigger level shift */
#define  USR1_PARITYERR  (1<<15) /* Parity error interrupt flag */
#define  USR1_RTSS  	 (1<<14) /* RTS pin status */
#define  USR1_TRDY  	 (1<<13) /* Transmitter ready interrupt/dma flag */
#define  USR1_RTSD  	 (1<<12) /* RTS delta */
#define  USR1_ESCF  	 (1<<11) /* Escape seq interrupt flag */
#define  USR1_FRAMERR    (1<<10) /* Frame error interrupt flag */
#define  USR1_RRDY       (1<<9)	 /* Receiver ready interrupt/dma flag */
#define  USR1_TIMEOUT    (1<<7)	 /* Receive timeout interrupt status */
#define  USR1_RXDS  	 (1<<6)	 /* Receiver idle interrupt flag */
#define  USR1_AIRINT	 (1<<5)	 /* Async IR wake interrupt flag */
#define  USR1_AWAKE 	 (1<<4)	 /* Aysnc wake interrupt flag */
#define  USR2_ADET  	 (1<<15) /* Auto baud rate detect complete */
#define  USR2_TXFE  	 (1<<14) /* Transmit buffer FIFO empty */
#define  USR2_DTRF  	 (1<<13) /* DTR edge interrupt flag */
#define  USR2_IDLE  	 (1<<12) /* Idle condition */
#define  USR2_IRINT 	 (1<<8)	 /* Serial infrared interrupt flag */
#define  USR2_WAKE  	 (1<<7)	 /* Wake */
#define  USR2_RTSF  	 (1<<4)	 /* RTS edge interrupt flag */
#define  USR2_TXDC  	 (1<<3)	 /* Transmitter complete */
#define  USR2_BRCD  	 (1<<2)	 /* Break condition */
#define  USR2_ORE        (1<<1)	 /* Overrun error */
#define  USR2_RDR        (1<<0)	 /* Recv data ready */
#define  UTS_FRCPERR	 (1<<13) /* Force parity error */
#define  UTS_LOOP        (1<<12) /* Loop tx and rx */
#define  UTS_TXEMPTY	 (1<<6)	 /* TxFIFO empty */
#define  UTS_RXEMPTY	 (1<<5)	 /* RxFIFO empty */
#define  UTS_TXFULL 	 (1<<4)	 /* TxFIFO full */
#define  UTS_RXFULL 	 (1<<3)	 /* RxFIFO full */
#define  UTS_SOFTRST	 (1<<0)	 /* Software reset */

L
Linus Torvalds 已提交
166
/* We've been assigned a range on the "Low-density serial ports" major */
167 168 169
#define SERIAL_IMX_MAJOR        207
#define MINOR_START	        16
#define DEV_NAME		"ttymxc"
170
#define MAX_INTERNAL_IRQ	MXC_INTERNAL_IRQS
L
Linus Torvalds 已提交
171 172 173 174 175 176 177 178 179 180 181

/*
 * This determines how often we check the modem status signals
 * for any change.  They generally aren't connected to an IRQ
 * so we have to poll them.  We also check immediately before
 * filling the TX fifo incase CTS has been dropped.
 */
#define MCTRL_TIMEOUT	(250*HZ/1000)

#define DRIVER_NAME "IMX-uart"

182 183
#define UART_NR 8

184 185 186 187 188 189 190 191 192 193 194 195
/* i.mx21 type uart runs on all i.mx except i.mx1 */
enum imx_uart_type {
	IMX1_UART,
	IMX21_UART,
};

/* device type dependent stuff */
struct imx_uart_data {
	unsigned uts_reg;
	enum imx_uart_type devtype;
};

L
Linus Torvalds 已提交
196 197 198 199
struct imx_port {
	struct uart_port	port;
	struct timer_list	timer;
	unsigned int		old_status;
200
	int			txirq,rxirq,rtsirq;
201
	unsigned int		have_rtscts:1;
202 203 204 205
	unsigned int		use_irda:1;
	unsigned int		irda_inv_rx:1;
	unsigned int		irda_inv_tx:1;
	unsigned short		trcv_delay; /* transceiver delay */
S
Sascha Hauer 已提交
206
	struct clk		*clk;
207
	struct imx_uart_data	*devdata;
L
Linus Torvalds 已提交
208 209
};

210 211 212 213 214 215
#ifdef CONFIG_IRDA
#define USE_IRDA(sport)	((sport)->use_irda)
#else
#define USE_IRDA(sport)	(0)
#endif

216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239
static struct imx_uart_data imx_uart_devdata[] = {
	[IMX1_UART] = {
		.uts_reg = IMX1_UTS,
		.devtype = IMX1_UART,
	},
	[IMX21_UART] = {
		.uts_reg = IMX21_UTS,
		.devtype = IMX21_UART,
	},
};

static struct platform_device_id imx_uart_devtype[] = {
	{
		.name = "imx1-uart",
		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX1_UART],
	}, {
		.name = "imx21-uart",
		.driver_data = (kernel_ulong_t) &imx_uart_devdata[IMX21_UART],
	}, {
		/* sentinel */
	}
};
MODULE_DEVICE_TABLE(platform, imx_uart_devtype);

240 241 242 243 244 245 246
static struct of_device_id imx_uart_dt_ids[] = {
	{ .compatible = "fsl,imx1-uart", .data = &imx_uart_devdata[IMX1_UART], },
	{ .compatible = "fsl,imx21-uart", .data = &imx_uart_devdata[IMX21_UART], },
	{ /* sentinel */ }
};
MODULE_DEVICE_TABLE(of, imx_uart_dt_ids);

247 248 249 250 251 252 253 254 255 256 257 258 259 260 261
static inline unsigned uts_reg(struct imx_port *sport)
{
	return sport->devdata->uts_reg;
}

static inline int is_imx1_uart(struct imx_port *sport)
{
	return sport->devdata->devtype == IMX1_UART;
}

static inline int is_imx21_uart(struct imx_port *sport)
{
	return sport->devdata->devtype == IMX21_UART;
}

L
Linus Torvalds 已提交
262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285
/*
 * Handle any change of modem status signal since we were last called.
 */
static void imx_mctrl_check(struct imx_port *sport)
{
	unsigned int status, changed;

	status = sport->port.ops->get_mctrl(&sport->port);
	changed = status ^ sport->old_status;

	if (changed == 0)
		return;

	sport->old_status = status;

	if (changed & TIOCM_RI)
		sport->port.icount.rng++;
	if (changed & TIOCM_DSR)
		sport->port.icount.dsr++;
	if (changed & TIOCM_CAR)
		uart_handle_dcd_change(&sport->port, status & TIOCM_CAR);
	if (changed & TIOCM_CTS)
		uart_handle_cts_change(&sport->port, status & TIOCM_CTS);

286
	wake_up_interruptible(&sport->port.state->port.delta_msr_wait);
L
Linus Torvalds 已提交
287 288 289 290 291 292 293 294 295 296 297
}

/*
 * This is our per-port timeout handler, for checking the
 * modem status signals.
 */
static void imx_timeout(unsigned long data)
{
	struct imx_port *sport = (struct imx_port *)data;
	unsigned long flags;

A
Alan Cox 已提交
298
	if (sport->port.state) {
L
Linus Torvalds 已提交
299 300 301 302 303 304 305 306 307 308 309
		spin_lock_irqsave(&sport->port.lock, flags);
		imx_mctrl_check(sport);
		spin_unlock_irqrestore(&sport->port.lock, flags);

		mod_timer(&sport->timer, jiffies + MCTRL_TIMEOUT);
	}
}

/*
 * interrupts disabled on entry
 */
310
static void imx_stop_tx(struct uart_port *port)
L
Linus Torvalds 已提交
311 312
{
	struct imx_port *sport = (struct imx_port *)port;
313 314
	unsigned long temp;

315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356
	if (USE_IRDA(sport)) {
		/* half duplex - wait for end of transmission */
		int n = 256;
		while ((--n > 0) &&
		      !(readl(sport->port.membase + USR2) & USR2_TXDC)) {
			udelay(5);
			barrier();
		}
		/*
		 * irda transceiver - wait a bit more to avoid
		 * cutoff, hardware dependent
		 */
		udelay(sport->trcv_delay);

		/*
		 * half duplex - reactivate receive mode,
		 * flush receive pipe echo crap
		 */
		if (readl(sport->port.membase + USR2) & USR2_TXDC) {
			temp = readl(sport->port.membase + UCR1);
			temp &= ~(UCR1_TXMPTYEN | UCR1_TRDYEN);
			writel(temp, sport->port.membase + UCR1);

			temp = readl(sport->port.membase + UCR4);
			temp &= ~(UCR4_TCEN);
			writel(temp, sport->port.membase + UCR4);

			while (readl(sport->port.membase + URXD0) &
			       URXD_CHARRDY)
				barrier();

			temp = readl(sport->port.membase + UCR1);
			temp |= UCR1_RRDYEN;
			writel(temp, sport->port.membase + UCR1);

			temp = readl(sport->port.membase + UCR4);
			temp |= UCR4_DREN;
			writel(temp, sport->port.membase + UCR4);
		}
		return;
	}

357 358
	temp = readl(sport->port.membase + UCR1);
	writel(temp & ~UCR1_TXMPTYEN, sport->port.membase + UCR1);
L
Linus Torvalds 已提交
359 360 361 362 363 364 365 366
}

/*
 * interrupts disabled on entry
 */
static void imx_stop_rx(struct uart_port *port)
{
	struct imx_port *sport = (struct imx_port *)port;
367 368 369 370
	unsigned long temp;

	temp = readl(sport->port.membase + UCR2);
	writel(temp &~ UCR2_RXEN, sport->port.membase + UCR2);
L
Linus Torvalds 已提交
371 372 373 374 375 376 377 378 379 380 381 382 383 384
}

/*
 * Set the modem control timer to fire immediately.
 */
static void imx_enable_ms(struct uart_port *port)
{
	struct imx_port *sport = (struct imx_port *)port;

	mod_timer(&sport->timer, jiffies);
}

static inline void imx_transmit_buffer(struct imx_port *sport)
{
A
Alan Cox 已提交
385
	struct circ_buf *xmit = &sport->port.state->xmit;
L
Linus Torvalds 已提交
386

387
	while (!uart_circ_empty(xmit) &&
388 389
			!(readl(sport->port.membase + uts_reg(sport))
				& UTS_TXFULL)) {
L
Linus Torvalds 已提交
390 391
		/* send xmit->buf[xmit->tail]
		 * out the port here */
392
		writel(xmit->buf[xmit->tail], sport->port.membase + URTX0);
393
		xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
L
Linus Torvalds 已提交
394
		sport->port.icount.tx++;
395
	}
L
Linus Torvalds 已提交
396

397 398 399
	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(&sport->port);

L
Linus Torvalds 已提交
400
	if (uart_circ_empty(xmit))
401
		imx_stop_tx(&sport->port);
L
Linus Torvalds 已提交
402 403 404 405 406
}

/*
 * interrupts disabled on entry
 */
407
static void imx_start_tx(struct uart_port *port)
L
Linus Torvalds 已提交
408 409
{
	struct imx_port *sport = (struct imx_port *)port;
410
	unsigned long temp;
L
Linus Torvalds 已提交
411

412 413 414 415 416 417 418 419 420 421 422
	if (USE_IRDA(sport)) {
		/* half duplex in IrDA mode; have to disable receive mode */
		temp = readl(sport->port.membase + UCR4);
		temp &= ~(UCR4_DREN);
		writel(temp, sport->port.membase + UCR4);

		temp = readl(sport->port.membase + UCR1);
		temp &= ~(UCR1_RRDYEN);
		writel(temp, sport->port.membase + UCR1);
	}

423 424
	temp = readl(sport->port.membase + UCR1);
	writel(temp | UCR1_TXMPTYEN, sport->port.membase + UCR1);
L
Linus Torvalds 已提交
425

426 427 428 429 430 431 432 433 434 435
	if (USE_IRDA(sport)) {
		temp = readl(sport->port.membase + UCR1);
		temp |= UCR1_TRDYEN;
		writel(temp, sport->port.membase + UCR1);

		temp = readl(sport->port.membase + UCR4);
		temp |= UCR4_TCEN;
		writel(temp, sport->port.membase + UCR4);
	}

436
	if (readl(sport->port.membase + uts_reg(sport)) & UTS_TXEMPTY)
437
		imx_transmit_buffer(sport);
L
Linus Torvalds 已提交
438 439
}

440
static irqreturn_t imx_rtsint(int irq, void *dev_id)
441
{
442
	struct imx_port *sport = dev_id;
443
	unsigned int val;
444 445 446 447
	unsigned long flags;

	spin_lock_irqsave(&sport->port.lock, flags);

448
	writel(USR1_RTSD, sport->port.membase + USR1);
449
	val = readl(sport->port.membase + USR1) & USR1_RTSS;
450
	uart_handle_cts_change(&sport->port, !!val);
451
	wake_up_interruptible(&sport->port.state->port.delta_msr_wait);
452 453 454 455 456

	spin_unlock_irqrestore(&sport->port.lock, flags);
	return IRQ_HANDLED;
}

457
static irqreturn_t imx_txint(int irq, void *dev_id)
L
Linus Torvalds 已提交
458
{
459
	struct imx_port *sport = dev_id;
A
Alan Cox 已提交
460
	struct circ_buf *xmit = &sport->port.state->xmit;
L
Linus Torvalds 已提交
461 462 463 464 465 466
	unsigned long flags;

	spin_lock_irqsave(&sport->port.lock,flags);
	if (sport->port.x_char)
	{
		/* Send next char */
467
		writel(sport->port.x_char, sport->port.membase + URTX0);
L
Linus Torvalds 已提交
468 469 470 471
		goto out;
	}

	if (uart_circ_empty(xmit) || uart_tx_stopped(&sport->port)) {
472
		imx_stop_tx(&sport->port);
L
Linus Torvalds 已提交
473 474 475 476 477 478 479 480 481 482 483 484 485
		goto out;
	}

	imx_transmit_buffer(sport);

	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(&sport->port);

out:
	spin_unlock_irqrestore(&sport->port.lock,flags);
	return IRQ_HANDLED;
}

486
static irqreturn_t imx_rxint(int irq, void *dev_id)
L
Linus Torvalds 已提交
487 488 489
{
	struct imx_port *sport = dev_id;
	unsigned int rx,flg,ignored = 0;
A
Alan Cox 已提交
490
	struct tty_struct *tty = sport->port.state->port.tty;
491
	unsigned long flags, temp;
L
Linus Torvalds 已提交
492 493 494

	spin_lock_irqsave(&sport->port.lock,flags);

495
	while (readl(sport->port.membase + USR2) & USR2_RDR) {
L
Linus Torvalds 已提交
496 497 498
		flg = TTY_NORMAL;
		sport->port.icount.rx++;

499 500
		rx = readl(sport->port.membase + URXD0);

501
		temp = readl(sport->port.membase + USR2);
502
		if (temp & USR2_BRCD) {
503
			writel(USR2_BRCD, sport->port.membase + USR2);
504 505
			if (uart_handle_break(&sport->port))
				continue;
L
Linus Torvalds 已提交
506 507
		}

508
		if (uart_handle_sysrq_char(&sport->port, (unsigned char)rx))
509 510
			continue;

511 512 513 514
		if (unlikely(rx & URXD_ERR)) {
			if (rx & URXD_BRK)
				sport->port.icount.brk++;
			else if (rx & URXD_PRERR)
515 516 517 518 519 520 521 522 523 524 525 526 527 528
				sport->port.icount.parity++;
			else if (rx & URXD_FRMERR)
				sport->port.icount.frame++;
			if (rx & URXD_OVRRUN)
				sport->port.icount.overrun++;

			if (rx & sport->port.ignore_status_mask) {
				if (++ignored > 100)
					goto out;
				continue;
			}

			rx &= sport->port.read_status_mask;

529 530 531
			if (rx & URXD_BRK)
				flg = TTY_BREAK;
			else if (rx & URXD_PRERR)
532 533 534 535 536
				flg = TTY_PARITY;
			else if (rx & URXD_FRMERR)
				flg = TTY_FRAME;
			if (rx & URXD_OVRRUN)
				flg = TTY_OVERRUN;
L
Linus Torvalds 已提交
537

538 539 540 541
#ifdef SUPPORT_SYSRQ
			sport->port.sysrq = 0;
#endif
		}
L
Linus Torvalds 已提交
542 543

		tty_insert_flip_char(tty, rx, flg);
544
	}
L
Linus Torvalds 已提交
545 546 547 548 549 550 551

out:
	spin_unlock_irqrestore(&sport->port.lock,flags);
	tty_flip_buffer_push(tty);
	return IRQ_HANDLED;
}

552 553 554 555 556 557 558 559 560 561 562 563 564 565
static irqreturn_t imx_int(int irq, void *dev_id)
{
	struct imx_port *sport = dev_id;
	unsigned int sts;

	sts = readl(sport->port.membase + USR1);

	if (sts & USR1_RRDY)
		imx_rxint(irq, dev_id);

	if (sts & USR1_TRDY &&
			readl(sport->port.membase + UCR1) & UCR1_TXMPTYEN)
		imx_txint(irq, dev_id);

566
	if (sts & USR1_RTSD)
567 568 569 570 571
		imx_rtsint(irq, dev_id);

	return IRQ_HANDLED;
}

L
Linus Torvalds 已提交
572 573 574 575 576 577 578
/*
 * Return TIOCSER_TEMT when transmitter is not busy.
 */
static unsigned int imx_tx_empty(struct uart_port *port)
{
	struct imx_port *sport = (struct imx_port *)port;

579
	return (readl(sport->port.membase + USR2) & USR2_TXDC) ?  TIOCSER_TEMT : 0;
L
Linus Torvalds 已提交
580 581
}

582 583 584
/*
 * We have a modem side uart, so the meanings of RTS and CTS are inverted.
 */
L
Linus Torvalds 已提交
585 586
static unsigned int imx_get_mctrl(struct uart_port *port)
{
587 588
	struct imx_port *sport = (struct imx_port *)port;
	unsigned int tmp = TIOCM_DSR | TIOCM_CAR;
589

590 591
	if (readl(sport->port.membase + USR1) & USR1_RTSS)
		tmp |= TIOCM_CTS;
592

593 594
	if (readl(sport->port.membase + UCR2) & UCR2_CTS)
		tmp |= TIOCM_RTS;
595

596
	return tmp;
L
Linus Torvalds 已提交
597 598 599 600
}

static void imx_set_mctrl(struct uart_port *port, unsigned int mctrl)
{
601
	struct imx_port *sport = (struct imx_port *)port;
602 603 604
	unsigned long temp;

	temp = readl(sport->port.membase + UCR2) & ~UCR2_CTS;
605

606
	if (mctrl & TIOCM_RTS)
607 608 609
		temp |= UCR2_CTS;

	writel(temp, sport->port.membase + UCR2);
L
Linus Torvalds 已提交
610 611 612 613 614 615 616 617
}

/*
 * Interrupts always disabled.
 */
static void imx_break_ctl(struct uart_port *port, int break_state)
{
	struct imx_port *sport = (struct imx_port *)port;
618
	unsigned long flags, temp;
L
Linus Torvalds 已提交
619 620 621

	spin_lock_irqsave(&sport->port.lock, flags);

622 623
	temp = readl(sport->port.membase + UCR1) & ~UCR1_SNDBRK;

L
Linus Torvalds 已提交
624
	if ( break_state != 0 )
625 626 627
		temp |= UCR1_SNDBRK;

	writel(temp, sport->port.membase + UCR1);
L
Linus Torvalds 已提交
628 629 630 631 632 633 634

	spin_unlock_irqrestore(&sport->port.lock, flags);
}

#define TXTL 2 /* reset default */
#define RXTL 1 /* reset default */

635 636 637 638 639 640 641 642
static int imx_setup_ufcr(struct imx_port *sport, unsigned int mode)
{
	unsigned int val;
	unsigned int ufcr_rfdiv;

	/* set receiver / transmitter trigger level.
	 * RFDIV is set such way to satisfy requested uartclk value
	 */
643
	val = TXTL << 10 | RXTL;
S
Sascha Hauer 已提交
644 645
	ufcr_rfdiv = (clk_get_rate(sport->clk) + sport->port.uartclk / 2)
			/ sport->port.uartclk;
646 647 648 649

	if(!ufcr_rfdiv)
		ufcr_rfdiv = 1;

650
	val |= UFCR_RFDIV_REG(ufcr_rfdiv);
651

652
	writel(val, sport->port.membase + UFCR);
653 654 655 656

	return 0;
}

657 658 659
/* half the RX buffer size */
#define CTSTL 16

L
Linus Torvalds 已提交
660 661 662 663
static int imx_startup(struct uart_port *port)
{
	struct imx_port *sport = (struct imx_port *)port;
	int retval;
664
	unsigned long flags, temp;
L
Linus Torvalds 已提交
665

666
	imx_setup_ufcr(sport, 0);
L
Linus Torvalds 已提交
667 668 669 670

	/* disable the DREN bit (Data Ready interrupt enable) before
	 * requesting IRQs
	 */
671
	temp = readl(sport->port.membase + UCR4);
672 673 674 675

	if (USE_IRDA(sport))
		temp |= UCR4_IRSC;

676 677 678 679
	/* set the trigger level for CTS */
	temp &= ~(UCR4_CTSTL_MASK<<  UCR4_CTSTL_SHF);
	temp |= CTSTL<<  UCR4_CTSTL_SHF;

680
	writel(temp & ~UCR4_DREN, sport->port.membase + UCR4);
L
Linus Torvalds 已提交
681

682 683 684 685 686 687 688 689 690 691 692 693
	if (USE_IRDA(sport)) {
		/* reset fifo's and state machines */
		int i = 100;
		temp = readl(sport->port.membase + UCR2);
		temp &= ~UCR2_SRST;
		writel(temp, sport->port.membase + UCR2);
		while (!(readl(sport->port.membase + UCR2) & UCR2_SRST) &&
		    (--i > 0)) {
			udelay(1);
		}
	}

L
Linus Torvalds 已提交
694
	/*
695 696
	 * Allocate the IRQ(s) i.MX1 has three interrupts whereas later
	 * chips only have one interrupt.
L
Linus Torvalds 已提交
697
	 */
698 699 700 701 702 703 704 705 706 707 708
	if (sport->txirq > 0) {
		retval = request_irq(sport->rxirq, imx_rxint, 0,
				DRIVER_NAME, sport);
		if (retval)
			goto error_out1;

		retval = request_irq(sport->txirq, imx_txint, 0,
				DRIVER_NAME, sport);
		if (retval)
			goto error_out2;

709 710 711 712 713 714 715 716 717 718
		/* do not use RTS IRQ on IrDA */
		if (!USE_IRDA(sport)) {
			retval = request_irq(sport->rtsirq, imx_rtsint,
				     (sport->rtsirq < MAX_INTERNAL_IRQ) ? 0 :
				       IRQF_TRIGGER_FALLING |
				       IRQF_TRIGGER_RISING,
					DRIVER_NAME, sport);
			if (retval)
				goto error_out3;
		}
719 720 721 722 723 724 725 726
	} else {
		retval = request_irq(sport->port.irq, imx_int, 0,
				DRIVER_NAME, sport);
		if (retval) {
			free_irq(sport->port.irq, sport);
			goto error_out1;
		}
	}
727

L
Linus Torvalds 已提交
728 729 730
	/*
	 * Finally, clear and enable interrupts
	 */
731 732 733
	writel(USR1_RTSD, sport->port.membase + USR1);

	temp = readl(sport->port.membase + UCR1);
734
	temp |= UCR1_RRDYEN | UCR1_RTSDEN | UCR1_UARTEN;
735 736 737 738 739 740

	if (USE_IRDA(sport)) {
		temp |= UCR1_IREN;
		temp &= ~(UCR1_RTSDEN);
	}

741
	writel(temp, sport->port.membase + UCR1);
L
Linus Torvalds 已提交
742

743 744 745
	temp = readl(sport->port.membase + UCR2);
	temp |= (UCR2_RXEN | UCR2_TXEN);
	writel(temp, sport->port.membase + UCR2);
L
Linus Torvalds 已提交
746

747 748 749 750 751 752 753 754 755
	if (USE_IRDA(sport)) {
		/* clear RX-FIFO */
		int i = 64;
		while ((--i > 0) &&
			(readl(sport->port.membase + URXD0) & URXD_CHARRDY)) {
			barrier();
		}
	}

756
	if (is_imx21_uart(sport)) {
757
		temp = readl(sport->port.membase + UCR3);
758
		temp |= IMX21_UCR3_RXDMUXSEL;
759 760
		writel(temp, sport->port.membase + UCR3);
	}
761

762 763 764 765 766 767 768 769 770 771 772 773 774 775 776 777
	if (USE_IRDA(sport)) {
		temp = readl(sport->port.membase + UCR4);
		if (sport->irda_inv_rx)
			temp |= UCR4_INVR;
		else
			temp &= ~(UCR4_INVR);
		writel(temp | UCR4_DREN, sport->port.membase + UCR4);

		temp = readl(sport->port.membase + UCR3);
		if (sport->irda_inv_tx)
			temp |= UCR3_INVT;
		else
			temp &= ~(UCR3_INVT);
		writel(temp, sport->port.membase + UCR3);
	}

L
Linus Torvalds 已提交
778 779 780 781 782 783 784
	/*
	 * Enable modem status interrupts
	 */
	spin_lock_irqsave(&sport->port.lock,flags);
	imx_enable_ms(&sport->port);
	spin_unlock_irqrestore(&sport->port.lock,flags);

785 786 787 788 789 790 791 792 793 794
	if (USE_IRDA(sport)) {
		struct imxuart_platform_data *pdata;
		pdata = sport->port.dev->platform_data;
		sport->irda_inv_rx = pdata->irda_inv_rx;
		sport->irda_inv_tx = pdata->irda_inv_tx;
		sport->trcv_delay = pdata->transceiver_delay;
		if (pdata->irda_enable)
			pdata->irda_enable(1);
	}

L
Linus Torvalds 已提交
795 796
	return 0;

797
error_out3:
798 799
	if (sport->txirq)
		free_irq(sport->txirq, sport);
L
Linus Torvalds 已提交
800
error_out2:
801 802
	if (sport->rxirq)
		free_irq(sport->rxirq, sport);
803
error_out1:
L
Linus Torvalds 已提交
804 805 806 807 808 809
	return retval;
}

static void imx_shutdown(struct uart_port *port)
{
	struct imx_port *sport = (struct imx_port *)port;
810
	unsigned long temp;
L
Linus Torvalds 已提交
811

812 813 814 815
	temp = readl(sport->port.membase + UCR2);
	temp &= ~(UCR2_TXEN);
	writel(temp, sport->port.membase + UCR2);

816 817 818 819 820 821 822
	if (USE_IRDA(sport)) {
		struct imxuart_platform_data *pdata;
		pdata = sport->port.dev->platform_data;
		if (pdata->irda_enable)
			pdata->irda_enable(0);
	}

L
Linus Torvalds 已提交
823 824 825 826 827 828 829 830
	/*
	 * Stop our timer.
	 */
	del_timer_sync(&sport->timer);

	/*
	 * Free the interrupts
	 */
831
	if (sport->txirq > 0) {
832 833
		if (!USE_IRDA(sport))
			free_irq(sport->rtsirq, sport);
834 835 836 837
		free_irq(sport->txirq, sport);
		free_irq(sport->rxirq, sport);
	} else
		free_irq(sport->port.irq, sport);
L
Linus Torvalds 已提交
838 839 840 841 842

	/*
	 * Disable all interrupts, port and break condition.
	 */

843 844
	temp = readl(sport->port.membase + UCR1);
	temp &= ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN | UCR1_UARTEN);
845 846 847
	if (USE_IRDA(sport))
		temp &= ~(UCR1_IREN);

848
	writel(temp, sport->port.membase + UCR1);
L
Linus Torvalds 已提交
849 850 851
}

static void
A
Alan Cox 已提交
852 853
imx_set_termios(struct uart_port *port, struct ktermios *termios,
		   struct ktermios *old)
L
Linus Torvalds 已提交
854 855 856 857 858
{
	struct imx_port *sport = (struct imx_port *)port;
	unsigned long flags;
	unsigned int ucr2, old_ucr1, old_txrxen, baud, quot;
	unsigned int old_csize = old ? old->c_cflag & CSIZE : CS8;
859 860
	unsigned int div, ufcr;
	unsigned long num, denom;
861
	uint64_t tdiv64;
L
Linus Torvalds 已提交
862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887

	/*
	 * If we don't support modem control lines, don't allow
	 * these to be set.
	 */
	if (0) {
		termios->c_cflag &= ~(HUPCL | CRTSCTS | CMSPAR);
		termios->c_cflag |= CLOCAL;
	}

	/*
	 * We only support CS7 and CS8.
	 */
	while ((termios->c_cflag & CSIZE) != CS7 &&
	       (termios->c_cflag & CSIZE) != CS8) {
		termios->c_cflag &= ~CSIZE;
		termios->c_cflag |= old_csize;
		old_csize = CS8;
	}

	if ((termios->c_cflag & CSIZE) == CS8)
		ucr2 = UCR2_WS | UCR2_SRST | UCR2_IRTS;
	else
		ucr2 = UCR2_SRST | UCR2_IRTS;

	if (termios->c_cflag & CRTSCTS) {
888 889 890 891 892 893
		if( sport->have_rtscts ) {
			ucr2 &= ~UCR2_IRTS;
			ucr2 |= UCR2_CTSC;
		} else {
			termios->c_cflag &= ~CRTSCTS;
		}
L
Linus Torvalds 已提交
894 895 896 897 898 899
	}

	if (termios->c_cflag & CSTOPB)
		ucr2 |= UCR2_STPB;
	if (termios->c_cflag & PARENB) {
		ucr2 |= UCR2_PREN;
900
		if (termios->c_cflag & PARODD)
L
Linus Torvalds 已提交
901 902 903 904 905 906
			ucr2 |= UCR2_PROE;
	}

	/*
	 * Ask the core to calculate the divisor for us.
	 */
907
	baud = uart_get_baud_rate(port, termios, old, 50, port->uartclk / 16);
L
Linus Torvalds 已提交
908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943
	quot = uart_get_divisor(port, baud);

	spin_lock_irqsave(&sport->port.lock, flags);

	sport->port.read_status_mask = 0;
	if (termios->c_iflag & INPCK)
		sport->port.read_status_mask |= (URXD_FRMERR | URXD_PRERR);
	if (termios->c_iflag & (BRKINT | PARMRK))
		sport->port.read_status_mask |= URXD_BRK;

	/*
	 * Characters to ignore
	 */
	sport->port.ignore_status_mask = 0;
	if (termios->c_iflag & IGNPAR)
		sport->port.ignore_status_mask |= URXD_PRERR;
	if (termios->c_iflag & IGNBRK) {
		sport->port.ignore_status_mask |= URXD_BRK;
		/*
		 * If we're ignoring parity and break indicators,
		 * ignore overruns too (for real raw support).
		 */
		if (termios->c_iflag & IGNPAR)
			sport->port.ignore_status_mask |= URXD_OVRRUN;
	}

	del_timer_sync(&sport->timer);

	/*
	 * Update the per-port timeout.
	 */
	uart_update_timeout(port, termios->c_cflag, baud);

	/*
	 * disable interrupts and drain transmitter
	 */
944 945 946
	old_ucr1 = readl(sport->port.membase + UCR1);
	writel(old_ucr1 & ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN),
			sport->port.membase + UCR1);
L
Linus Torvalds 已提交
947

948
	while ( !(readl(sport->port.membase + USR2) & USR2_TXDC))
L
Linus Torvalds 已提交
949 950 951
		barrier();

	/* then, disable everything */
952 953 954 955
	old_txrxen = readl(sport->port.membase + UCR2);
	writel(old_txrxen & ~( UCR2_TXEN | UCR2_RXEN),
			sport->port.membase + UCR2);
	old_txrxen &= (UCR2_TXEN | UCR2_RXEN);
L
Linus Torvalds 已提交
956

957 958 959 960 961
	if (USE_IRDA(sport)) {
		/*
		 * use maximum available submodule frequency to
		 * avoid missing short pulses due to low sampling rate
		 */
962
		div = 1;
963 964 965 966 967 968 969
	} else {
		div = sport->port.uartclk / (baud * 16);
		if (div > 7)
			div = 7;
		if (!div)
			div = 1;
	}
970

971 972
	rational_best_approximation(16 * div * baud, sport->port.uartclk,
		1 << 16, 1 << 16, &num, &denom);
973

974 975 976 977
	tdiv64 = sport->port.uartclk;
	tdiv64 *= num;
	do_div(tdiv64, denom * 16 * div);
	tty_termios_encode_baud_rate(termios,
978
				(speed_t)tdiv64, (speed_t)tdiv64);
979

980 981
	num -= 1;
	denom -= 1;
982 983

	ufcr = readl(sport->port.membase + UFCR);
984
	ufcr = (ufcr & (~UFCR_RFDIV)) | UFCR_RFDIV_REG(div);
985 986
	writel(ufcr, sport->port.membase + UFCR);

987 988 989
	writel(num, sport->port.membase + UBIR);
	writel(denom, sport->port.membase + UBMR);

990
	if (is_imx21_uart(sport))
991
		writel(sport->port.uartclk / div / 1000,
992
				sport->port.membase + IMX21_ONEMS);
993 994

	writel(old_ucr1, sport->port.membase + UCR1);
L
Linus Torvalds 已提交
995

996 997
	/* set the parity, stop bits and data size */
	writel(ucr2 | old_txrxen, sport->port.membase + UCR2);
L
Linus Torvalds 已提交
998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016

	if (UART_ENABLE_MS(&sport->port, termios->c_cflag))
		imx_enable_ms(&sport->port);

	spin_unlock_irqrestore(&sport->port.lock, flags);
}

static const char *imx_type(struct uart_port *port)
{
	struct imx_port *sport = (struct imx_port *)port;

	return sport->port.type == PORT_IMX ? "IMX" : NULL;
}

/*
 * Release the memory region(s) being used by 'port'.
 */
static void imx_release_port(struct uart_port *port)
{
1017 1018
	struct platform_device *pdev = to_platform_device(port->dev);
	struct resource *mmres;
L
Linus Torvalds 已提交
1019

1020
	mmres = platform_get_resource(pdev, IORESOURCE_MEM, 0);
1021
	release_mem_region(mmres->start, resource_size(mmres));
L
Linus Torvalds 已提交
1022 1023 1024 1025 1026 1027 1028
}

/*
 * Request the memory region(s) being used by 'port'.
 */
static int imx_request_port(struct uart_port *port)
{
1029 1030 1031 1032 1033 1034 1035 1036
	struct platform_device *pdev = to_platform_device(port->dev);
	struct resource *mmres;
	void *ret;

	mmres = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!mmres)
		return -ENODEV;

1037
	ret = request_mem_region(mmres->start, resource_size(mmres), "imx-uart");
L
Linus Torvalds 已提交
1038

1039
	return  ret ? 0 : -EBUSY;
L
Linus Torvalds 已提交
1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100
}

/*
 * Configure/autoconfigure the port.
 */
static void imx_config_port(struct uart_port *port, int flags)
{
	struct imx_port *sport = (struct imx_port *)port;

	if (flags & UART_CONFIG_TYPE &&
	    imx_request_port(&sport->port) == 0)
		sport->port.type = PORT_IMX;
}

/*
 * Verify the new serial_struct (for TIOCSSERIAL).
 * The only change we allow are to the flags and type, and
 * even then only between PORT_IMX and PORT_UNKNOWN
 */
static int
imx_verify_port(struct uart_port *port, struct serial_struct *ser)
{
	struct imx_port *sport = (struct imx_port *)port;
	int ret = 0;

	if (ser->type != PORT_UNKNOWN && ser->type != PORT_IMX)
		ret = -EINVAL;
	if (sport->port.irq != ser->irq)
		ret = -EINVAL;
	if (ser->io_type != UPIO_MEM)
		ret = -EINVAL;
	if (sport->port.uartclk / 16 != ser->baud_base)
		ret = -EINVAL;
	if ((void *)sport->port.mapbase != ser->iomem_base)
		ret = -EINVAL;
	if (sport->port.iobase != ser->port)
		ret = -EINVAL;
	if (ser->hub6 != 0)
		ret = -EINVAL;
	return ret;
}

static struct uart_ops imx_pops = {
	.tx_empty	= imx_tx_empty,
	.set_mctrl	= imx_set_mctrl,
	.get_mctrl	= imx_get_mctrl,
	.stop_tx	= imx_stop_tx,
	.start_tx	= imx_start_tx,
	.stop_rx	= imx_stop_rx,
	.enable_ms	= imx_enable_ms,
	.break_ctl	= imx_break_ctl,
	.startup	= imx_startup,
	.shutdown	= imx_shutdown,
	.set_termios	= imx_set_termios,
	.type		= imx_type,
	.release_port	= imx_release_port,
	.request_port	= imx_request_port,
	.config_port	= imx_config_port,
	.verify_port	= imx_verify_port,
};

1101
static struct imx_port *imx_ports[UART_NR];
L
Linus Torvalds 已提交
1102 1103

#ifdef CONFIG_SERIAL_IMX_CONSOLE
1104 1105 1106
static void imx_console_putchar(struct uart_port *port, int ch)
{
	struct imx_port *sport = (struct imx_port *)port;
1107

1108
	while (readl(sport->port.membase + uts_reg(sport)) & UTS_TXFULL)
1109
		barrier();
1110 1111

	writel(ch, sport->port.membase + URTX0);
1112
}
L
Linus Torvalds 已提交
1113 1114 1115 1116 1117 1118 1119

/*
 * Interrupts are disabled on entering
 */
static void
imx_console_write(struct console *co, const char *s, unsigned int count)
{
1120
	struct imx_port *sport = imx_ports[co->index];
1121
	unsigned int old_ucr1, old_ucr2, ucr1;
L
Linus Torvalds 已提交
1122 1123 1124 1125

	/*
	 *	First, save UCR1/2 and then disable interrupts
	 */
1126
	ucr1 = old_ucr1 = readl(sport->port.membase + UCR1);
1127
	old_ucr2 = readl(sport->port.membase + UCR2);
L
Linus Torvalds 已提交
1128

1129 1130
	if (is_imx1_uart(sport))
		ucr1 |= IMX1_UCR1_UARTCLKEN;
1131 1132 1133 1134
	ucr1 |= UCR1_UARTEN;
	ucr1 &= ~(UCR1_TXMPTYEN | UCR1_RRDYEN | UCR1_RTSDEN);

	writel(ucr1, sport->port.membase + UCR1);
1135 1136

	writel(old_ucr2 | UCR2_TXEN, sport->port.membase + UCR2);
L
Linus Torvalds 已提交
1137

1138
	uart_console_write(&sport->port, s, count, imx_console_putchar);
L
Linus Torvalds 已提交
1139 1140 1141 1142 1143

	/*
	 *	Finally, wait for transmitter to become empty
	 *	and restore UCR1/2
	 */
1144
	while (!(readl(sport->port.membase + USR2) & USR2_TXDC));
L
Linus Torvalds 已提交
1145

1146 1147
	writel(old_ucr1, sport->port.membase + UCR1);
	writel(old_ucr2, sport->port.membase + UCR2);
L
Linus Torvalds 已提交
1148 1149 1150 1151 1152 1153 1154 1155 1156 1157
}

/*
 * If the port was already initialised (eg, by a boot loader),
 * try to determine the current setup.
 */
static void __init
imx_console_get_options(struct imx_port *sport, int *baud,
			   int *parity, int *bits)
{
1158

R
Roel Kluin 已提交
1159
	if (readl(sport->port.membase + UCR1) & UCR1_UARTEN) {
L
Linus Torvalds 已提交
1160 1161
		/* ok, the port was enabled */
		unsigned int ucr2, ubir,ubmr, uartclk;
1162 1163
		unsigned int baud_raw;
		unsigned int ucfr_rfdiv;
L
Linus Torvalds 已提交
1164

1165
		ucr2 = readl(sport->port.membase + UCR2);
L
Linus Torvalds 已提交
1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179

		*parity = 'n';
		if (ucr2 & UCR2_PREN) {
			if (ucr2 & UCR2_PROE)
				*parity = 'o';
			else
				*parity = 'e';
		}

		if (ucr2 & UCR2_WS)
			*bits = 8;
		else
			*bits = 7;

1180 1181
		ubir = readl(sport->port.membase + UBIR) & 0xffff;
		ubmr = readl(sport->port.membase + UBMR) & 0xffff;
1182

1183
		ucfr_rfdiv = (readl(sport->port.membase + UFCR) & UFCR_RFDIV) >> 7;
1184 1185 1186 1187 1188
		if (ucfr_rfdiv == 6)
			ucfr_rfdiv = 7;
		else
			ucfr_rfdiv = 6 - ucfr_rfdiv;

S
Sascha Hauer 已提交
1189
		uartclk = clk_get_rate(sport->clk);
1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206 1207 1208 1209
		uartclk /= ucfr_rfdiv;

		{	/*
			 * The next code provides exact computation of
			 *   baud_raw = round(((uartclk/16) * (ubir + 1)) / (ubmr + 1))
			 * without need of float support or long long division,
			 * which would be required to prevent 32bit arithmetic overflow
			 */
			unsigned int mul = ubir + 1;
			unsigned int div = 16 * (ubmr + 1);
			unsigned int rem = uartclk % div;

			baud_raw = (uartclk / div) * mul;
			baud_raw += (rem * mul + div / 2) / div;
			*baud = (baud_raw + 50) / 100 * 100;
		}

		if(*baud != baud_raw)
			printk(KERN_INFO "Serial: Console IMX rounded baud rate from %d to %d\n",
				baud_raw, *baud);
L
Linus Torvalds 已提交
1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228
	}
}

static int __init
imx_console_setup(struct console *co, char *options)
{
	struct imx_port *sport;
	int baud = 9600;
	int bits = 8;
	int parity = 'n';
	int flow = 'n';

	/*
	 * Check whether an invalid uart number has been specified, and
	 * if so, search for the first available port that does have
	 * console support.
	 */
	if (co->index == -1 || co->index >= ARRAY_SIZE(imx_ports))
		co->index = 0;
1229
	sport = imx_ports[co->index];
1230 1231
	if(sport == NULL)
		return -ENODEV;
L
Linus Torvalds 已提交
1232 1233 1234 1235 1236 1237

	if (options)
		uart_parse_options(options, &baud, &parity, &bits, &flow);
	else
		imx_console_get_options(sport, &baud, &parity, &bits);

1238 1239
	imx_setup_ufcr(sport, 0);

L
Linus Torvalds 已提交
1240 1241 1242
	return uart_set_options(&sport->port, co, baud, parity, bits, flow);
}

1243
static struct uart_driver imx_reg;
L
Linus Torvalds 已提交
1244
static struct console imx_console = {
1245
	.name		= DEV_NAME,
L
Linus Torvalds 已提交
1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261
	.write		= imx_console_write,
	.device		= uart_console_device,
	.setup		= imx_console_setup,
	.flags		= CON_PRINTBUFFER,
	.index		= -1,
	.data		= &imx_reg,
};

#define IMX_CONSOLE	&imx_console
#else
#define IMX_CONSOLE	NULL
#endif

static struct uart_driver imx_reg = {
	.owner          = THIS_MODULE,
	.driver_name    = DRIVER_NAME,
1262
	.dev_name       = DEV_NAME,
L
Linus Torvalds 已提交
1263 1264 1265 1266 1267 1268
	.major          = SERIAL_IMX_MAJOR,
	.minor          = MINOR_START,
	.nr             = ARRAY_SIZE(imx_ports),
	.cons           = IMX_CONSOLE,
};

1269
static int serial_imx_suspend(struct platform_device *dev, pm_message_t state)
L
Linus Torvalds 已提交
1270
{
1271
	struct imx_port *sport = platform_get_drvdata(dev);
L
Linus Torvalds 已提交
1272

1273 1274
	if (sport)
		uart_suspend_port(&imx_reg, &sport->port);
L
Linus Torvalds 已提交
1275

1276
	return 0;
L
Linus Torvalds 已提交
1277 1278
}

1279
static int serial_imx_resume(struct platform_device *dev)
L
Linus Torvalds 已提交
1280
{
1281
	struct imx_port *sport = platform_get_drvdata(dev);
L
Linus Torvalds 已提交
1282

1283 1284
	if (sport)
		uart_resume_port(&imx_reg, &sport->port);
L
Linus Torvalds 已提交
1285

1286
	return 0;
L
Linus Torvalds 已提交
1287 1288
}

1289 1290 1291 1292 1293 1294 1295
#ifdef CONFIG_OF
static int serial_imx_probe_dt(struct imx_port *sport,
		struct platform_device *pdev)
{
	struct device_node *np = pdev->dev.of_node;
	const struct of_device_id *of_id =
			of_match_device(imx_uart_dt_ids, &pdev->dev);
1296
	int ret;
1297 1298 1299 1300

	if (!np)
		return -ENODEV;

1301 1302 1303 1304 1305 1306
	ret = of_alias_get_id(np, "serial");
	if (ret < 0) {
		dev_err(&pdev->dev, "failed to get alias id, errno %d\n", ret);
		return -ENODEV;
	}
	sport->port.line = ret;
1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343

	if (of_get_property(np, "fsl,uart-has-rtscts", NULL))
		sport->have_rtscts = 1;

	if (of_get_property(np, "fsl,irda-mode", NULL))
		sport->use_irda = 1;

	sport->devdata = of_id->data;

	return 0;
}
#else
static inline int serial_imx_probe_dt(struct imx_port *sport,
		struct platform_device *pdev)
{
	return -ENODEV;
}
#endif

static void serial_imx_probe_pdata(struct imx_port *sport,
		struct platform_device *pdev)
{
	struct imxuart_platform_data *pdata = pdev->dev.platform_data;

	sport->port.line = pdev->id;
	sport->devdata = (struct imx_uart_data	*) pdev->id_entry->driver_data;

	if (!pdata)
		return;

	if (pdata->flags & IMXUART_HAVE_RTSCTS)
		sport->have_rtscts = 1;

	if (pdata->flags & IMXUART_IRDA)
		sport->use_irda = 1;
}

1344
static int serial_imx_probe(struct platform_device *pdev)
L
Linus Torvalds 已提交
1345
{
1346
	struct imx_port *sport;
1347
	struct imxuart_platform_data *pdata;
1348 1349 1350 1351 1352 1353 1354
	void __iomem *base;
	int ret = 0;
	struct resource *res;

	sport = kzalloc(sizeof(*sport), GFP_KERNEL);
	if (!sport)
		return -ENOMEM;
1355

1356 1357 1358 1359
	ret = serial_imx_probe_dt(sport, pdev);
	if (ret == -ENODEV)
		serial_imx_probe_pdata(sport, pdev);

1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386
	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
	if (!res) {
		ret = -ENODEV;
		goto free;
	}

	base = ioremap(res->start, PAGE_SIZE);
	if (!base) {
		ret = -ENOMEM;
		goto free;
	}

	sport->port.dev = &pdev->dev;
	sport->port.mapbase = res->start;
	sport->port.membase = base;
	sport->port.type = PORT_IMX,
	sport->port.iotype = UPIO_MEM;
	sport->port.irq = platform_get_irq(pdev, 0);
	sport->rxirq = platform_get_irq(pdev, 0);
	sport->txirq = platform_get_irq(pdev, 1);
	sport->rtsirq = platform_get_irq(pdev, 2);
	sport->port.fifosize = 32;
	sport->port.ops = &imx_pops;
	sport->port.flags = UPF_BOOT_AUTOCONF;
	init_timer(&sport->timer);
	sport->timer.function = imx_timeout;
	sport->timer.data     = (unsigned long)sport;
S
Sascha Hauer 已提交
1387

1388
	sport->clk = clk_get(&pdev->dev, "uart");
S
Sascha Hauer 已提交
1389 1390 1391 1392 1393 1394 1395
	if (IS_ERR(sport->clk)) {
		ret = PTR_ERR(sport->clk);
		goto unmap;
	}
	clk_enable(sport->clk);

	sport->port.uartclk = clk_get_rate(sport->clk);
1396

1397
	imx_ports[sport->port.line] = sport;
1398

1399
	pdata = pdev->dev.platform_data;
1400
	if (pdata && pdata->init) {
D
Darius Augulis 已提交
1401 1402 1403 1404
		ret = pdata->init(pdev);
		if (ret)
			goto clkput;
	}
1405

1406 1407 1408
	ret = uart_add_one_port(&imx_reg, &sport->port);
	if (ret)
		goto deinit;
1409
	platform_set_drvdata(pdev, &sport->port);
1410

L
Linus Torvalds 已提交
1411
	return 0;
1412
deinit:
1413
	if (pdata && pdata->exit)
1414
		pdata->exit(pdev);
D
Darius Augulis 已提交
1415 1416 1417
clkput:
	clk_put(sport->clk);
	clk_disable(sport->clk);
S
Sascha Hauer 已提交
1418 1419
unmap:
	iounmap(sport->port.membase);
1420 1421 1422 1423
free:
	kfree(sport);

	return ret;
L
Linus Torvalds 已提交
1424 1425
}

1426
static int serial_imx_remove(struct platform_device *pdev)
L
Linus Torvalds 已提交
1427
{
1428 1429
	struct imxuart_platform_data *pdata;
	struct imx_port *sport = platform_get_drvdata(pdev);
L
Linus Torvalds 已提交
1430

1431 1432 1433
	pdata = pdev->dev.platform_data;

	platform_set_drvdata(pdev, NULL);
L
Linus Torvalds 已提交
1434

S
Sascha Hauer 已提交
1435
	if (sport) {
L
Linus Torvalds 已提交
1436
		uart_remove_one_port(&imx_reg, &sport->port);
S
Sascha Hauer 已提交
1437 1438 1439 1440
		clk_put(sport->clk);
	}

	clk_disable(sport->clk);
L
Linus Torvalds 已提交
1441

1442
	if (pdata && pdata->exit)
1443 1444
		pdata->exit(pdev);

1445 1446 1447
	iounmap(sport->port.membase);
	kfree(sport);

L
Linus Torvalds 已提交
1448 1449 1450
	return 0;
}

1451
static struct platform_driver serial_imx_driver = {
1452 1453
	.probe		= serial_imx_probe,
	.remove		= serial_imx_remove,
L
Linus Torvalds 已提交
1454 1455 1456

	.suspend	= serial_imx_suspend,
	.resume		= serial_imx_resume,
1457
	.id_table	= imx_uart_devtype,
1458
	.driver		= {
1459
		.name	= "imx-uart",
1460
		.owner	= THIS_MODULE,
1461
		.of_match_table = imx_uart_dt_ids,
1462
	},
L
Linus Torvalds 已提交
1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474
};

static int __init imx_serial_init(void)
{
	int ret;

	printk(KERN_INFO "Serial: IMX driver\n");

	ret = uart_register_driver(&imx_reg);
	if (ret)
		return ret;

1475
	ret = platform_driver_register(&serial_imx_driver);
L
Linus Torvalds 已提交
1476 1477 1478 1479 1480 1481 1482 1483
	if (ret != 0)
		uart_unregister_driver(&imx_reg);

	return 0;
}

static void __exit imx_serial_exit(void)
{
1484
	platform_driver_unregister(&serial_imx_driver);
1485
	uart_unregister_driver(&imx_reg);
L
Linus Torvalds 已提交
1486 1487 1488 1489 1490 1491 1492 1493
}

module_init(imx_serial_init);
module_exit(imx_serial_exit);

MODULE_AUTHOR("Sascha Hauer");
MODULE_DESCRIPTION("IMX generic serial port driver");
MODULE_LICENSE("GPL");
1494
MODULE_ALIAS("platform:imx-uart");