sh-sci.c 53.1 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 * SuperH on-chip serial module support.  (SCI with no FIFO / with FIFO)
 *
P
Paul Mundt 已提交
4
 *  Copyright (C) 2002 - 2011  Paul Mundt
M
Markus Brunner 已提交
5
 *  Modified to support SH7720 SCIF. Markus Brunner, Mark Jonas (Jul 2007).
L
Linus Torvalds 已提交
6 7 8 9 10 11 12 13
 *
 * based off of the old drivers/char/sh-sci.c by:
 *
 *   Copyright (C) 1999, 2000  Niibe Yutaka
 *   Copyright (C) 2000  Sugioka Toshinobu
 *   Modified to support multiple serial ports. Stuart Menefy (May 2000).
 *   Modified to support SecureEdge. David McCullough (2002)
 *   Modified to support SH7300 SCIF. Takashi Kusuda (Jun 2003).
14
 *   Removed SH7300 support (Jul 2007).
L
Linus Torvalds 已提交
15 16 17 18 19
 *
 * This file is subject to the terms and conditions of the GNU General Public
 * License.  See the file "COPYING" in the main directory of this archive
 * for more details.
 */
20 21 22
#if defined(CONFIG_SERIAL_SH_SCI_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
#define SUPPORT_SYSRQ
#endif
L
Linus Torvalds 已提交
23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40

#undef DEBUG

#include <linux/module.h>
#include <linux/errno.h>
#include <linux/timer.h>
#include <linux/interrupt.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <linux/serial.h>
#include <linux/major.h>
#include <linux/string.h>
#include <linux/sysrq.h>
#include <linux/ioport.h>
#include <linux/mm.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/console.h>
41
#include <linux/platform_device.h>
42
#include <linux/serial_sci.h>
L
Linus Torvalds 已提交
43
#include <linux/notifier.h>
M
Magnus Damm 已提交
44
#include <linux/pm_runtime.h>
L
Linus Torvalds 已提交
45
#include <linux/cpufreq.h>
46
#include <linux/clk.h>
P
Paul Mundt 已提交
47
#include <linux/ctype.h>
48
#include <linux/err.h>
49
#include <linux/dmaengine.h>
50
#include <linux/dma-mapping.h>
51
#include <linux/scatterlist.h>
52
#include <linux/slab.h>
53 54

#ifdef CONFIG_SUPERH
L
Linus Torvalds 已提交
55 56 57 58 59
#include <asm/sh_bios.h>
#endif

#include "sh-sci.h"

60 61 62
struct sci_port {
	struct uart_port	port;

63 64
	/* Platform configuration */
	struct plat_sci_port	*cfg;
65 66 67 68

	/* Break timer */
	struct timer_list	break_timer;
	int			break_flag;
69

70 71
	/* Interface clock */
	struct clk		*iclk;
72 73
	/* Function clock */
	struct clk		*fclk;
74

75 76
	char			*irqstr[SCIx_NR_IRQS];

77 78
	struct dma_chan			*chan_tx;
	struct dma_chan			*chan_rx;
P
Paul Mundt 已提交
79

80 81 82 83 84 85 86 87 88 89 90 91 92 93 94
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	struct dma_async_tx_descriptor	*desc_tx;
	struct dma_async_tx_descriptor	*desc_rx[2];
	dma_cookie_t			cookie_tx;
	dma_cookie_t			cookie_rx[2];
	dma_cookie_t			active_rx;
	struct scatterlist		sg_tx;
	unsigned int			sg_len_tx;
	struct scatterlist		sg_rx[2];
	size_t				buf_len_rx;
	struct sh_dmae_slave		param_tx;
	struct sh_dmae_slave		param_rx;
	struct work_struct		work_tx;
	struct work_struct		work_rx;
	struct timer_list		rx_timer;
95
	unsigned int			rx_timeout;
96
#endif
97

98
	struct notifier_block		freq_transition;
99 100 101 102 103 104

#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
	unsigned short saved_smr;
	unsigned short saved_fcr;
	unsigned char saved_brr;
#endif
105 106
};

L
Linus Torvalds 已提交
107
/* Function prototypes */
108
static void sci_start_tx(struct uart_port *port);
109
static void sci_stop_tx(struct uart_port *port);
110
static void sci_start_rx(struct uart_port *port);
L
Linus Torvalds 已提交
111

112
#define SCI_NPORTS CONFIG_SERIAL_SH_SCI_NR_UARTS
113

114 115
static struct sci_port sci_ports[SCI_NPORTS];
static struct uart_driver sci_uart_driver;
L
Linus Torvalds 已提交
116

117 118 119 120 121 122
static inline struct sci_port *
to_sci_port(struct uart_port *uart)
{
	return container_of(uart, struct sci_port, port);
}

123 124 125 126 127 128 129 130 131 132 133 134 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 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208
struct plat_sci_reg {
	u8 offset, size;
};

/* Helper for invalidating specific entries of an inherited map. */
#define sci_reg_invalid	{ .offset = 0, .size = 0 }

static struct plat_sci_reg sci_regmap[SCIx_NR_REGTYPES][SCIx_NR_REGS] = {
	[SCIx_PROBE_REGTYPE] = {
		[0 ... SCIx_NR_REGS - 1] = sci_reg_invalid,
	},

	/*
	 * Common SCI definitions, dependent on the port's regshift
	 * value.
	 */
	[SCIx_SCI_REGTYPE] = {
		[SCSMR]		= { 0x00,  8 },
		[SCBRR]		= { 0x01,  8 },
		[SCSCR]		= { 0x02,  8 },
		[SCxTDR]	= { 0x03,  8 },
		[SCxSR]		= { 0x04,  8 },
		[SCxRDR]	= { 0x05,  8 },
		[SCFCR]		= sci_reg_invalid,
		[SCFDR]		= sci_reg_invalid,
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= sci_reg_invalid,
		[SCLSR]		= sci_reg_invalid,
	},

	/*
	 * Common definitions for legacy IrDA ports, dependent on
	 * regshift value.
	 */
	[SCIx_IRDA_REGTYPE] = {
		[SCSMR]		= { 0x00,  8 },
		[SCBRR]		= { 0x01,  8 },
		[SCSCR]		= { 0x02,  8 },
		[SCxTDR]	= { 0x03,  8 },
		[SCxSR]		= { 0x04,  8 },
		[SCxRDR]	= { 0x05,  8 },
		[SCFCR]		= { 0x06,  8 },
		[SCFDR]		= { 0x07, 16 },
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= sci_reg_invalid,
		[SCLSR]		= sci_reg_invalid,
	},

	/*
	 * Common SCIFA definitions.
	 */
	[SCIx_SCIFA_REGTYPE] = {
		[SCSMR]		= { 0x00, 16 },
		[SCBRR]		= { 0x04,  8 },
		[SCSCR]		= { 0x08, 16 },
		[SCxTDR]	= { 0x20,  8 },
		[SCxSR]		= { 0x14, 16 },
		[SCxRDR]	= { 0x24,  8 },
		[SCFCR]		= { 0x18, 16 },
		[SCFDR]		= { 0x1c, 16 },
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= sci_reg_invalid,
		[SCLSR]		= sci_reg_invalid,
	},

	/*
	 * Common SCIFB definitions.
	 */
	[SCIx_SCIFB_REGTYPE] = {
		[SCSMR]		= { 0x00, 16 },
		[SCBRR]		= { 0x04,  8 },
		[SCSCR]		= { 0x08, 16 },
		[SCxTDR]	= { 0x40,  8 },
		[SCxSR]		= { 0x14, 16 },
		[SCxRDR]	= { 0x60,  8 },
		[SCFCR]		= { 0x18, 16 },
		[SCFDR]		= { 0x1c, 16 },
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= sci_reg_invalid,
		[SCLSR]		= sci_reg_invalid,
	},

209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227
	/*
	 * Common SH-2(A) SCIF definitions for ports with FIFO data
	 * count registers.
	 */
	[SCIx_SH2_SCIF_FIFODATA_REGTYPE] = {
		[SCSMR]		= { 0x00, 16 },
		[SCBRR]		= { 0x04,  8 },
		[SCSCR]		= { 0x08, 16 },
		[SCxTDR]	= { 0x0c,  8 },
		[SCxSR]		= { 0x10, 16 },
		[SCxRDR]	= { 0x14,  8 },
		[SCFCR]		= { 0x18, 16 },
		[SCFDR]		= { 0x1c, 16 },
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= { 0x20, 16 },
		[SCLSR]		= { 0x24, 16 },
	},

228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321
	/*
	 * Common SH-3 SCIF definitions.
	 */
	[SCIx_SH3_SCIF_REGTYPE] = {
		[SCSMR]		= { 0x00,  8 },
		[SCBRR]		= { 0x02,  8 },
		[SCSCR]		= { 0x04,  8 },
		[SCxTDR]	= { 0x06,  8 },
		[SCxSR]		= { 0x08, 16 },
		[SCxRDR]	= { 0x0a,  8 },
		[SCFCR]		= { 0x0c,  8 },
		[SCFDR]		= { 0x0e, 16 },
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= sci_reg_invalid,
		[SCLSR]		= sci_reg_invalid,
	},

	/*
	 * Common SH-4(A) SCIF(B) definitions.
	 */
	[SCIx_SH4_SCIF_REGTYPE] = {
		[SCSMR]		= { 0x00, 16 },
		[SCBRR]		= { 0x04,  8 },
		[SCSCR]		= { 0x08, 16 },
		[SCxTDR]	= { 0x0c,  8 },
		[SCxSR]		= { 0x10, 16 },
		[SCxRDR]	= { 0x14,  8 },
		[SCFCR]		= { 0x18, 16 },
		[SCFDR]		= { 0x1c, 16 },
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= { 0x20, 16 },
		[SCLSR]		= { 0x24, 16 },
	},

	/*
	 * Common SH-4(A) SCIF(B) definitions for ports without an SCSPTR
	 * register.
	 */
	[SCIx_SH4_SCIF_NO_SCSPTR_REGTYPE] = {
		[SCSMR]		= { 0x00, 16 },
		[SCBRR]		= { 0x04,  8 },
		[SCSCR]		= { 0x08, 16 },
		[SCxTDR]	= { 0x0c,  8 },
		[SCxSR]		= { 0x10, 16 },
		[SCxRDR]	= { 0x14,  8 },
		[SCFCR]		= { 0x18, 16 },
		[SCFDR]		= { 0x1c, 16 },
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= sci_reg_invalid,
		[SCLSR]		= { 0x24, 16 },
	},

	/*
	 * Common SH-4(A) SCIF(B) definitions for ports with FIFO data
	 * count registers.
	 */
	[SCIx_SH4_SCIF_FIFODATA_REGTYPE] = {
		[SCSMR]		= { 0x00, 16 },
		[SCBRR]		= { 0x04,  8 },
		[SCSCR]		= { 0x08, 16 },
		[SCxTDR]	= { 0x0c,  8 },
		[SCxSR]		= { 0x10, 16 },
		[SCxRDR]	= { 0x14,  8 },
		[SCFCR]		= { 0x18, 16 },
		[SCFDR]		= { 0x1c, 16 },
		[SCTFDR]	= { 0x1c, 16 },	/* aliased to SCFDR */
		[SCRFDR]	= { 0x20, 16 },
		[SCSPTR]	= { 0x24, 16 },
		[SCLSR]		= { 0x28, 16 },
	},

	/*
	 * SH7705-style SCIF(B) ports, lacking both SCSPTR and SCLSR
	 * registers.
	 */
	[SCIx_SH7705_SCIF_REGTYPE] = {
		[SCSMR]		= { 0x00, 16 },
		[SCBRR]		= { 0x04,  8 },
		[SCSCR]		= { 0x08, 16 },
		[SCxTDR]	= { 0x20,  8 },
		[SCxSR]		= { 0x14, 16 },
		[SCxRDR]	= { 0x24,  8 },
		[SCFCR]		= { 0x18, 16 },
		[SCFDR]		= { 0x1c, 16 },
		[SCTFDR]	= sci_reg_invalid,
		[SCRFDR]	= sci_reg_invalid,
		[SCSPTR]	= sci_reg_invalid,
		[SCLSR]		= sci_reg_invalid,
	},
};

322 323
#define sci_getreg(up, offset)		(sci_regmap[to_sci_port(up)->cfg->regtype] + offset)

324 325 326 327 328 329 330 331
/*
 * The "offset" here is rather misleading, in that it refers to an enum
 * value relative to the port mapping rather than the fixed offset
 * itself, which needs to be manually retrieved from the platform's
 * register map for the given port.
 */
static unsigned int sci_serial_in(struct uart_port *p, int offset)
{
332
	struct plat_sci_reg *reg = sci_getreg(p, offset);
333 334 335 336 337 338 339 340 341 342 343 344 345

	if (reg->size == 8)
		return ioread8(p->membase + (reg->offset << p->regshift));
	else if (reg->size == 16)
		return ioread16(p->membase + (reg->offset << p->regshift));
	else
		WARN(1, "Invalid register access\n");

	return 0;
}

static void sci_serial_out(struct uart_port *p, int offset, int value)
{
346
	struct plat_sci_reg *reg = sci_getreg(p, offset);
347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390

	if (reg->size == 8)
		iowrite8(value, p->membase + (reg->offset << p->regshift));
	else if (reg->size == 16)
		iowrite16(value, p->membase + (reg->offset << p->regshift));
	else
		WARN(1, "Invalid register access\n");
}

#define sci_in(up, offset)		(up->serial_in(up, offset))
#define sci_out(up, offset, value)	(up->serial_out(up, offset, value))

static int sci_probe_regmap(struct plat_sci_port *cfg)
{
	switch (cfg->type) {
	case PORT_SCI:
		cfg->regtype = SCIx_SCI_REGTYPE;
		break;
	case PORT_IRDA:
		cfg->regtype = SCIx_IRDA_REGTYPE;
		break;
	case PORT_SCIFA:
		cfg->regtype = SCIx_SCIFA_REGTYPE;
		break;
	case PORT_SCIFB:
		cfg->regtype = SCIx_SCIFB_REGTYPE;
		break;
	case PORT_SCIF:
		/*
		 * The SH-4 is a bit of a misnomer here, although that's
		 * where this particular port layout originated. This
		 * configuration (or some slight variation thereof)
		 * remains the dominant model for all SCIFs.
		 */
		cfg->regtype = SCIx_SH4_SCIF_REGTYPE;
		break;
	default:
		printk(KERN_ERR "Can't probe register map for given port\n");
		return -EINVAL;
	}

	return 0;
}

391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413
static void sci_port_enable(struct sci_port *sci_port)
{
	if (!sci_port->port.dev)
		return;

	pm_runtime_get_sync(sci_port->port.dev);

	clk_enable(sci_port->iclk);
	sci_port->port.uartclk = clk_get_rate(sci_port->iclk);
	clk_enable(sci_port->fclk);
}

static void sci_port_disable(struct sci_port *sci_port)
{
	if (!sci_port->port.dev)
		return;

	clk_disable(sci_port->fclk);
	clk_disable(sci_port->iclk);

	pm_runtime_put_sync(sci_port->port.dev);
}

414
#if defined(CONFIG_CONSOLE_POLL) || defined(CONFIG_SERIAL_SH_SCI_CONSOLE)
415 416

#ifdef CONFIG_CONSOLE_POLL
417
static int sci_poll_get_char(struct uart_port *port)
L
Linus Torvalds 已提交
418 419 420 421
{
	unsigned short status;
	int c;

422
	do {
L
Linus Torvalds 已提交
423 424
		status = sci_in(port, SCxSR);
		if (status & SCxSR_ERRORS(port)) {
425
			sci_out(port, SCxSR, SCxSR_ERROR_CLEAR(port));
L
Linus Torvalds 已提交
426 427
			continue;
		}
428 429 430 431 432
		break;
	} while (1);

	if (!(status & SCxSR_RDxF(port)))
		return NO_POLL_CHAR;
433

L
Linus Torvalds 已提交
434
	c = sci_in(port, SCxRDR);
435

436 437
	/* Dummy read */
	sci_in(port, SCxSR);
L
Linus Torvalds 已提交
438 439 440 441
	sci_out(port, SCxSR, SCxSR_RDxF_CLEAR(port));

	return c;
}
442
#endif
L
Linus Torvalds 已提交
443

444
static void sci_poll_put_char(struct uart_port *port, unsigned char c)
L
Linus Torvalds 已提交
445 446 447 448 449 450 451
{
	unsigned short status;

	do {
		status = sci_in(port, SCxSR);
	} while (!(status & SCxSR_TDxE(port)));

452
	sci_out(port, SCxTDR, c);
453
	sci_out(port, SCxSR, SCxSR_TDxE_CLEAR(port) & ~SCxSR_TEND(port));
L
Linus Torvalds 已提交
454
}
455
#endif /* CONFIG_CONSOLE_POLL || CONFIG_SERIAL_SH_SCI_CONSOLE */
L
Linus Torvalds 已提交
456

457
static void sci_init_pins(struct uart_port *port, unsigned int cflag)
L
Linus Torvalds 已提交
458
{
459 460
	struct sci_port *s = to_sci_port(port);
	struct plat_sci_reg *reg = sci_regmap[s->cfg->regtype] + SCSPTR;
L
Linus Torvalds 已提交
461

462 463 464 465 466 467
	/*
	 * Use port-specific handler if provided.
	 */
	if (s->cfg->ops && s->cfg->ops->init_pins) {
		s->cfg->ops->init_pins(port, cflag);
		return;
L
Linus Torvalds 已提交
468
	}
P
Paul Mundt 已提交
469

470 471 472 473 474 475
	/*
	 * For the generic path SCSPTR is necessary. Bail out if that's
	 * unavailable, too.
	 */
	if (!reg->size)
		return;
P
Paul Mundt 已提交
476

477
	if (!(cflag & CRTSCTS))
478
		sci_out(port, SCSPTR, 0x0080); /* Set RTS = 1 */
479
}
480

481
static int sci_txfill(struct uart_port *port)
482
{
483
	struct plat_sci_reg *reg;
484

485 486
	reg = sci_getreg(port, SCTFDR);
	if (reg->size)
487
		return sci_in(port, SCTFDR) & 0xff;
488

489 490
	reg = sci_getreg(port, SCFDR);
	if (reg->size)
491 492
		return sci_in(port, SCFDR) >> 8;

493
	return !(sci_in(port, SCxSR) & SCI_TDRE);
494 495
}

496 497
static int sci_txroom(struct uart_port *port)
{
498
	return port->fifosize - sci_txfill(port);
499 500 501
}

static int sci_rxfill(struct uart_port *port)
502
{
503 504 505 506 507 508 509 510 511 512
	struct plat_sci_reg *reg;

	reg = sci_getreg(port, SCRFDR);
	if (reg->size)
		return sci_in(port, SCRFDR) & 0xff;

	reg = sci_getreg(port, SCFDR);
	if (reg->size)
		return sci_in(port, SCFDR) & ((port->fifosize << 1) - 1);

513
	return (sci_in(port, SCxSR) & SCxSR_RDxF(port)) != 0;
514 515
}

516 517 518 519 520 521 522 523 524 525 526 527 528
/*
 * SCI helper for checking the state of the muxed port/RXD pins.
 */
static inline int sci_rxd_in(struct uart_port *port)
{
	struct sci_port *s = to_sci_port(port);

	if (s->cfg->port_reg <= 0)
		return 1;

	return !!__raw_readb(s->cfg->port_reg);
}

L
Linus Torvalds 已提交
529 530 531 532 533 534
/* ********************************************************************** *
 *                   the interrupt related routines                       *
 * ********************************************************************** */

static void sci_transmit_chars(struct uart_port *port)
{
A
Alan Cox 已提交
535
	struct circ_buf *xmit = &port->state->xmit;
L
Linus Torvalds 已提交
536 537 538
	unsigned int stopped = uart_tx_stopped(port);
	unsigned short status;
	unsigned short ctrl;
539
	int count;
L
Linus Torvalds 已提交
540 541 542 543

	status = sci_in(port, SCxSR);
	if (!(status & SCxSR_TDxE(port))) {
		ctrl = sci_in(port, SCSCR);
544
		if (uart_circ_empty(xmit))
545
			ctrl &= ~SCSCR_TIE;
546
		else
547
			ctrl |= SCSCR_TIE;
L
Linus Torvalds 已提交
548 549 550 551
		sci_out(port, SCSCR, ctrl);
		return;
	}

552
	count = sci_txroom(port);
L
Linus Torvalds 已提交
553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576

	do {
		unsigned char c;

		if (port->x_char) {
			c = port->x_char;
			port->x_char = 0;
		} else if (!uart_circ_empty(xmit) && !stopped) {
			c = xmit->buf[xmit->tail];
			xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
		} else {
			break;
		}

		sci_out(port, SCxTDR, c);

		port->icount.tx++;
	} while (--count > 0);

	sci_out(port, SCxSR, SCxSR_TDxE_CLEAR(port));

	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(port);
	if (uart_circ_empty(xmit)) {
577
		sci_stop_tx(port);
L
Linus Torvalds 已提交
578 579 580
	} else {
		ctrl = sci_in(port, SCSCR);

581
		if (port->type != PORT_SCI) {
L
Linus Torvalds 已提交
582 583 584 585
			sci_in(port, SCxSR); /* Dummy read */
			sci_out(port, SCxSR, SCxSR_TDxE_CLEAR(port));
		}

586
		ctrl |= SCSCR_TIE;
L
Linus Torvalds 已提交
587 588 589 590 591
		sci_out(port, SCSCR, ctrl);
	}
}

/* On SH3, SCIF may read end-of-break as a space->mark char */
592
#define STEPFN(c)  ({int __c = (c); (((__c-1)|(__c)) == -1); })
L
Linus Torvalds 已提交
593

594
static void sci_receive_chars(struct uart_port *port)
L
Linus Torvalds 已提交
595
{
596
	struct sci_port *sci_port = to_sci_port(port);
A
Alan Cox 已提交
597
	struct tty_struct *tty = port->state->port.tty;
L
Linus Torvalds 已提交
598 599
	int i, count, copied = 0;
	unsigned short status;
A
Alan Cox 已提交
600
	unsigned char flag;
L
Linus Torvalds 已提交
601 602 603 604 605 606 607

	status = sci_in(port, SCxSR);
	if (!(status & SCxSR_RDxF(port)))
		return;

	while (1) {
		/* Don't copy more bytes than there is room for in the buffer */
608
		count = tty_buffer_request_room(tty, sci_rxfill(port));
L
Linus Torvalds 已提交
609 610 611 612 613 614 615

		/* If for any reason we can't copy more data, we're done! */
		if (count == 0)
			break;

		if (port->type == PORT_SCI) {
			char c = sci_in(port, SCxRDR);
616 617
			if (uart_handle_sysrq_char(port, c) ||
			    sci_port->break_flag)
L
Linus Torvalds 已提交
618
				count = 0;
619
			else
620
				tty_insert_flip_char(tty, c, TTY_NORMAL);
L
Linus Torvalds 已提交
621
		} else {
622
			for (i = 0; i < count; i++) {
L
Linus Torvalds 已提交
623 624 625 626
				char c = sci_in(port, SCxRDR);
				status = sci_in(port, SCxSR);
#if defined(CONFIG_CPU_SH3)
				/* Skip "chars" during break */
627
				if (sci_port->break_flag) {
L
Linus Torvalds 已提交
628 629 630 631 632
					if ((c == 0) &&
					    (status & SCxSR_FER(port))) {
						count--; i--;
						continue;
					}
633

L
Linus Torvalds 已提交
634
					/* Nonzero => end-of-break */
635
					dev_dbg(port->dev, "debounce<%02x>\n", c);
636 637
					sci_port->break_flag = 0;

L
Linus Torvalds 已提交
638 639 640 641 642 643
					if (STEPFN(c)) {
						count--; i--;
						continue;
					}
				}
#endif /* CONFIG_CPU_SH3 */
644
				if (uart_handle_sysrq_char(port, c)) {
L
Linus Torvalds 已提交
645 646 647 648 649
					count--; i--;
					continue;
				}

				/* Store data and status */
650
				if (status & SCxSR_FER(port)) {
A
Alan Cox 已提交
651
					flag = TTY_FRAME;
652
					dev_notice(port->dev, "frame error\n");
653
				} else if (status & SCxSR_PER(port)) {
A
Alan Cox 已提交
654
					flag = TTY_PARITY;
655
					dev_notice(port->dev, "parity error\n");
A
Alan Cox 已提交
656 657
				} else
					flag = TTY_NORMAL;
658

A
Alan Cox 已提交
659
				tty_insert_flip_char(tty, c, flag);
L
Linus Torvalds 已提交
660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678 679
			}
		}

		sci_in(port, SCxSR); /* dummy read */
		sci_out(port, SCxSR, SCxSR_RDxF_CLEAR(port));

		copied += count;
		port->icount.rx += count;
	}

	if (copied) {
		/* Tell the rest of the system the news. New characters! */
		tty_flip_buffer_push(tty);
	} else {
		sci_in(port, SCxSR); /* dummy read */
		sci_out(port, SCxSR, SCxSR_RDxF_CLEAR(port));
	}
}

#define SCI_BREAK_JIFFIES (HZ/20)
680 681 682

/*
 * The sci generates interrupts during the break,
L
Linus Torvalds 已提交
683 684 685 686 687 688
 * 1 per millisecond or so during the break period, for 9600 baud.
 * So dont bother disabling interrupts.
 * But dont want more than 1 break event.
 * Use a kernel timer to periodically poll the rx line until
 * the break is finished.
 */
689
static inline void sci_schedule_break_timer(struct sci_port *port)
L
Linus Torvalds 已提交
690
{
691
	mod_timer(&port->break_timer, jiffies + SCI_BREAK_JIFFIES);
L
Linus Torvalds 已提交
692
}
693

L
Linus Torvalds 已提交
694 695 696
/* Ensure that two consecutive samples find the break over. */
static void sci_break_timer(unsigned long data)
{
697 698
	struct sci_port *port = (struct sci_port *)data;

699
	sci_port_enable(port);
M
Magnus Damm 已提交
700

701
	if (sci_rxd_in(&port->port) == 0) {
L
Linus Torvalds 已提交
702
		port->break_flag = 1;
703 704
		sci_schedule_break_timer(port);
	} else if (port->break_flag == 1) {
L
Linus Torvalds 已提交
705 706
		/* break is over. */
		port->break_flag = 2;
707 708 709
		sci_schedule_break_timer(port);
	} else
		port->break_flag = 0;
M
Magnus Damm 已提交
710

711
	sci_port_disable(port);
L
Linus Torvalds 已提交
712 713
}

714
static int sci_handle_errors(struct uart_port *port)
L
Linus Torvalds 已提交
715 716 717
{
	int copied = 0;
	unsigned short status = sci_in(port, SCxSR);
A
Alan Cox 已提交
718
	struct tty_struct *tty = port->state->port.tty;
719
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
720

721 722 723 724 725 726 727 728
	/*
	 * Handle overruns, if supported.
	 */
	if (s->cfg->overrun_bit != SCIx_NOT_SUPPORTED) {
		if (status & (1 << s->cfg->overrun_bit)) {
			/* overrun error */
			if (tty_insert_flip_char(tty, 0, TTY_OVERRUN))
				copied++;
729

730 731
			dev_notice(port->dev, "overrun error");
		}
L
Linus Torvalds 已提交
732 733
	}

734
	if (status & SCxSR_FER(port)) {
L
Linus Torvalds 已提交
735 736
		if (sci_rxd_in(port) == 0) {
			/* Notify of BREAK */
737
			struct sci_port *sci_port = to_sci_port(port);
738 739 740 741 742

			if (!sci_port->break_flag) {
				sci_port->break_flag = 1;
				sci_schedule_break_timer(sci_port);

L
Linus Torvalds 已提交
743
				/* Do sysrq handling. */
744
				if (uart_handle_break(port))
L
Linus Torvalds 已提交
745
					return 0;
746 747 748

				dev_dbg(port->dev, "BREAK detected\n");

749
				if (tty_insert_flip_char(tty, 0, TTY_BREAK))
750 751 752
					copied++;
			}

753
		} else {
L
Linus Torvalds 已提交
754
			/* frame error */
755
			if (tty_insert_flip_char(tty, 0, TTY_FRAME))
A
Alan Cox 已提交
756
				copied++;
757 758

			dev_notice(port->dev, "frame error\n");
L
Linus Torvalds 已提交
759 760 761
		}
	}

762
	if (status & SCxSR_PER(port)) {
L
Linus Torvalds 已提交
763
		/* parity error */
764 765
		if (tty_insert_flip_char(tty, 0, TTY_PARITY))
			copied++;
766 767

		dev_notice(port->dev, "parity error");
L
Linus Torvalds 已提交
768 769
	}

A
Alan Cox 已提交
770
	if (copied)
L
Linus Torvalds 已提交
771 772 773 774 775
		tty_flip_buffer_push(tty);

	return copied;
}

776
static int sci_handle_fifo_overrun(struct uart_port *port)
777
{
A
Alan Cox 已提交
778
	struct tty_struct *tty = port->state->port.tty;
779
	struct sci_port *s = to_sci_port(port);
780
	struct plat_sci_reg *reg;
781 782
	int copied = 0;

783 784
	reg = sci_getreg(port, SCLSR);
	if (!reg->size)
785 786
		return 0;

787
	if ((sci_in(port, SCLSR) & (1 << s->cfg->overrun_bit))) {
788 789 790 791 792 793 794 795 796 797 798 799
		sci_out(port, SCLSR, 0);

		tty_insert_flip_char(tty, 0, TTY_OVERRUN);
		tty_flip_buffer_push(tty);

		dev_notice(port->dev, "overrun error\n");
		copied++;
	}

	return copied;
}

800
static int sci_handle_breaks(struct uart_port *port)
L
Linus Torvalds 已提交
801 802 803
{
	int copied = 0;
	unsigned short status = sci_in(port, SCxSR);
A
Alan Cox 已提交
804
	struct tty_struct *tty = port->state->port.tty;
805
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
806

807 808 809
	if (uart_handle_break(port))
		return 0;

810
	if (!s->break_flag && status & SCxSR_BRK(port)) {
L
Linus Torvalds 已提交
811 812 813 814 815
#if defined(CONFIG_CPU_SH3)
		/* Debounce break */
		s->break_flag = 1;
#endif
		/* Notify of BREAK */
816
		if (tty_insert_flip_char(tty, 0, TTY_BREAK))
A
Alan Cox 已提交
817
			copied++;
818 819

		dev_dbg(port->dev, "BREAK detected\n");
L
Linus Torvalds 已提交
820 821
	}

A
Alan Cox 已提交
822
	if (copied)
L
Linus Torvalds 已提交
823
		tty_flip_buffer_push(tty);
824

825 826
	copied += sci_handle_fifo_overrun(port);

L
Linus Torvalds 已提交
827 828 829
	return copied;
}

830
static irqreturn_t sci_rx_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
831
{
832 833 834 835 836 837 838 839 840
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	struct uart_port *port = ptr;
	struct sci_port *s = to_sci_port(port);

	if (s->chan_rx) {
		u16 scr = sci_in(port, SCSCR);
		u16 ssr = sci_in(port, SCxSR);

		/* Disable future Rx interrupts */
841
		if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
842 843 844
			disable_irq_nosync(irq);
			scr |= 0x4000;
		} else {
P
Paul Mundt 已提交
845
			scr &= ~SCSCR_RIE;
846 847
		}
		sci_out(port, SCSCR, scr);
848 849
		/* Clear current interrupt */
		sci_out(port, SCxSR, ssr & ~(1 | SCxSR_RDxF(port)));
850 851 852
		dev_dbg(port->dev, "Rx IRQ %lu: setup t-out in %u jiffies\n",
			jiffies, s->rx_timeout);
		mod_timer(&s->rx_timer, jiffies + s->rx_timeout);
853 854 855 856 857

		return IRQ_HANDLED;
	}
#endif

L
Linus Torvalds 已提交
858 859 860 861
	/* I think sci_receive_chars has to be called irrespective
	 * of whether the I_IXOFF is set, otherwise, how is the interrupt
	 * to be disabled?
	 */
862
	sci_receive_chars(ptr);
L
Linus Torvalds 已提交
863 864 865 866

	return IRQ_HANDLED;
}

867
static irqreturn_t sci_tx_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
868 869
{
	struct uart_port *port = ptr;
870
	unsigned long flags;
L
Linus Torvalds 已提交
871

872
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
873
	sci_transmit_chars(port);
874
	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
875 876 877 878

	return IRQ_HANDLED;
}

879
static irqreturn_t sci_er_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
880 881 882 883 884 885 886 887 888 889 890
{
	struct uart_port *port = ptr;

	/* Handle errors */
	if (port->type == PORT_SCI) {
		if (sci_handle_errors(port)) {
			/* discard character in rx buffer */
			sci_in(port, SCxSR);
			sci_out(port, SCxSR, SCxSR_RDxF_CLEAR(port));
		}
	} else {
891
		sci_handle_fifo_overrun(port);
892
		sci_rx_interrupt(irq, ptr);
L
Linus Torvalds 已提交
893 894 895 896 897
	}

	sci_out(port, SCxSR, SCxSR_ERROR_CLEAR(port));

	/* Kick the transmission */
898
	sci_tx_interrupt(irq, ptr);
L
Linus Torvalds 已提交
899 900 901 902

	return IRQ_HANDLED;
}

903
static irqreturn_t sci_br_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
904 905 906 907 908 909 910 911 912 913
{
	struct uart_port *port = ptr;

	/* Handle BREAKs */
	sci_handle_breaks(port);
	sci_out(port, SCxSR, SCxSR_BREAK_CLEAR(port));

	return IRQ_HANDLED;
}

P
Paul Mundt 已提交
914 915 916 917 918 919 920 921 922
static inline unsigned long port_rx_irq_mask(struct uart_port *port)
{
	/*
	 * Not all ports (such as SCIFA) will support REIE. Rather than
	 * special-casing the port type, we check the port initialization
	 * IRQ enable mask to see whether the IRQ is desired at all. If
	 * it's unset, it's logically inferred that there's no point in
	 * testing for it.
	 */
923
	return SCSCR_RIE | (to_sci_port(port)->cfg->scscr & SCSCR_REIE);
P
Paul Mundt 已提交
924 925
}

926
static irqreturn_t sci_mpxed_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
927
{
928
	unsigned short ssr_status, scr_status, err_enabled;
929
	struct uart_port *port = ptr;
930
	struct sci_port *s = to_sci_port(port);
931
	irqreturn_t ret = IRQ_NONE;
L
Linus Torvalds 已提交
932

933 934
	ssr_status = sci_in(port, SCxSR);
	scr_status = sci_in(port, SCSCR);
P
Paul Mundt 已提交
935
	err_enabled = scr_status & port_rx_irq_mask(port);
L
Linus Torvalds 已提交
936 937

	/* Tx Interrupt */
P
Paul Mundt 已提交
938
	if ((ssr_status & SCxSR_TDxE(port)) && (scr_status & SCSCR_TIE) &&
939
	    !s->chan_tx)
940
		ret = sci_tx_interrupt(irq, ptr);
P
Paul Mundt 已提交
941

942 943 944 945 946
	/*
	 * Rx Interrupt: if we're using DMA, the DMA controller clears RDF /
	 * DR flags
	 */
	if (((ssr_status & SCxSR_RDxF(port)) || s->chan_rx) &&
P
Paul Mundt 已提交
947
	    (scr_status & SCSCR_RIE))
948
		ret = sci_rx_interrupt(irq, ptr);
P
Paul Mundt 已提交
949

L
Linus Torvalds 已提交
950
	/* Error Interrupt */
951
	if ((ssr_status & SCxSR_ERRORS(port)) && err_enabled)
952
		ret = sci_er_interrupt(irq, ptr);
P
Paul Mundt 已提交
953

L
Linus Torvalds 已提交
954
	/* Break Interrupt */
955
	if ((ssr_status & SCxSR_BRK(port)) && err_enabled)
956
		ret = sci_br_interrupt(irq, ptr);
L
Linus Torvalds 已提交
957

958
	return ret;
L
Linus Torvalds 已提交
959 960 961
}

/*
L
Lucas De Marchi 已提交
962
 * Here we define a transition notifier so that we can update all of our
L
Linus Torvalds 已提交
963 964
 * ports' baud rate when the peripheral clock changes.
 */
965 966
static int sci_notifier(struct notifier_block *self,
			unsigned long phase, void *p)
L
Linus Torvalds 已提交
967
{
968 969
	struct sci_port *sci_port;
	unsigned long flags;
L
Linus Torvalds 已提交
970

971 972
	sci_port = container_of(self, struct sci_port, freq_transition);

L
Linus Torvalds 已提交
973
	if ((phase == CPUFREQ_POSTCHANGE) ||
974
	    (phase == CPUFREQ_RESUMECHANGE)) {
975
		struct uart_port *port = &sci_port->port;
976

977 978 979
		spin_lock_irqsave(&port->lock, flags);
		port->uartclk = clk_get_rate(sci_port->iclk);
		spin_unlock_irqrestore(&port->lock, flags);
980
	}
L
Linus Torvalds 已提交
981 982 983

	return NOTIFY_OK;
}
984

985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020
static struct sci_irq_desc {
	const char	*desc;
	irq_handler_t	handler;
} sci_irq_desc[] = {
	/*
	 * Split out handlers, the default case.
	 */
	[SCIx_ERI_IRQ] = {
		.desc = "rx err",
		.handler = sci_er_interrupt,
	},

	[SCIx_RXI_IRQ] = {
		.desc = "rx full",
		.handler = sci_rx_interrupt,
	},

	[SCIx_TXI_IRQ] = {
		.desc = "tx empty",
		.handler = sci_tx_interrupt,
	},

	[SCIx_BRI_IRQ] = {
		.desc = "break",
		.handler = sci_br_interrupt,
	},

	/*
	 * Special muxed handler.
	 */
	[SCIx_MUX_IRQ] = {
		.desc = "mux",
		.handler = sci_mpxed_interrupt,
	},
};

L
Linus Torvalds 已提交
1021 1022
static int sci_request_irq(struct sci_port *port)
{
1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042
	struct uart_port *up = &port->port;
	int i, j, ret = 0;

	for (i = j = 0; i < SCIx_NR_IRQS; i++, j++) {
		struct sci_irq_desc *desc;
		unsigned int irq;

		if (SCIx_IRQ_IS_MUXED(port)) {
			i = SCIx_MUX_IRQ;
			irq = up->irq;
		} else
			irq = port->cfg->irqs[i];

		desc = sci_irq_desc + i;
		port->irqstr[j] = kasprintf(GFP_KERNEL, "%s:%s",
					    dev_name(up->dev), desc->desc);
		if (!port->irqstr[j]) {
			dev_err(up->dev, "Failed to allocate %s IRQ string\n",
				desc->desc);
			goto out_nomem;
L
Linus Torvalds 已提交
1043
		}
1044 1045 1046 1047 1048 1049

		ret = request_irq(irq, desc->handler, up->irqflags,
				  port->irqstr[j], port);
		if (unlikely(ret)) {
			dev_err(up->dev, "Can't allocate %s IRQ\n", desc->desc);
			goto out_noirq;
L
Linus Torvalds 已提交
1050 1051 1052 1053
		}
	}

	return 0;
1054 1055 1056 1057 1058 1059 1060 1061 1062 1063

out_noirq:
	while (--i >= 0)
		free_irq(port->cfg->irqs[i], port);

out_nomem:
	while (--j >= 0)
		kfree(port->irqstr[j]);

	return ret;
L
Linus Torvalds 已提交
1064 1065 1066 1067 1068 1069
}

static void sci_free_irq(struct sci_port *port)
{
	int i;

1070 1071 1072 1073 1074 1075 1076
	/*
	 * Intentionally in reverse order so we iterate over the muxed
	 * IRQ first.
	 */
	for (i = 0; i < SCIx_NR_IRQS; i++) {
		free_irq(port->cfg->irqs[i], port);
		kfree(port->irqstr[i]);
L
Linus Torvalds 已提交
1077

1078 1079 1080
		if (SCIx_IRQ_IS_MUXED(port)) {
			/* If there's only one IRQ, we're done. */
			return;
L
Linus Torvalds 已提交
1081 1082 1083 1084 1085 1086
		}
	}
}

static unsigned int sci_tx_empty(struct uart_port *port)
{
1087
	unsigned short status = sci_in(port, SCxSR);
1088
	unsigned short in_tx_fifo = sci_txfill(port);
1089 1090

	return (status & SCxSR_TEND(port)) && !in_tx_fifo ? TIOCSER_TEMT : 0;
L
Linus Torvalds 已提交
1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101
}

static void sci_set_mctrl(struct uart_port *port, unsigned int mctrl)
{
	/* This routine is used for seting signals of: DTR, DCD, CTS/RTS */
	/* We use SCIF's hardware for CTS/RTS, so don't need any for that. */
	/* If you have signals for DTR and DCD, please implement here. */
}

static unsigned int sci_get_mctrl(struct uart_port *port)
{
1102
	/* This routine is used for getting signals of: DTR, DCD, DSR, RI,
L
Linus Torvalds 已提交
1103 1104
	   and CTS/RTS */

1105
	return TIOCM_DTR | TIOCM_RTS | TIOCM_CTS | TIOCM_DSR;
L
Linus Torvalds 已提交
1106 1107
}

1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119
#ifdef CONFIG_SERIAL_SH_SCI_DMA
static void sci_dma_tx_complete(void *arg)
{
	struct sci_port *s = arg;
	struct uart_port *port = &s->port;
	struct circ_buf *xmit = &port->state->xmit;
	unsigned long flags;

	dev_dbg(port->dev, "%s(%d)\n", __func__, port->line);

	spin_lock_irqsave(&port->lock, flags);

1120
	xmit->tail += sg_dma_len(&s->sg_tx);
1121 1122
	xmit->tail &= UART_XMIT_SIZE - 1;

1123
	port->icount.tx += sg_dma_len(&s->sg_tx);
1124 1125 1126 1127 1128 1129 1130 1131

	async_tx_ack(s->desc_tx);
	s->cookie_tx = -EINVAL;
	s->desc_tx = NULL;

	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(port);

1132
	if (!uart_circ_empty(xmit)) {
1133
		schedule_work(&s->work_tx);
1134
	} else if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
1135
		u16 ctrl = sci_in(port, SCSCR);
P
Paul Mundt 已提交
1136
		sci_out(port, SCSCR, ctrl & ~SCSCR_TIE);
1137 1138 1139
	}

	spin_unlock_irqrestore(&port->lock, flags);
1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182
}

/* Locking: called with port lock held */
static int sci_dma_rx_push(struct sci_port *s, struct tty_struct *tty,
			   size_t count)
{
	struct uart_port *port = &s->port;
	int i, active, room;

	room = tty_buffer_request_room(tty, count);

	if (s->active_rx == s->cookie_rx[0]) {
		active = 0;
	} else if (s->active_rx == s->cookie_rx[1]) {
		active = 1;
	} else {
		dev_err(port->dev, "cookie %d not found!\n", s->active_rx);
		return 0;
	}

	if (room < count)
		dev_warn(port->dev, "Rx overrun: dropping %u bytes\n",
			 count - room);
	if (!room)
		return room;

	for (i = 0; i < room; i++)
		tty_insert_flip_char(tty, ((u8 *)sg_virt(&s->sg_rx[active]))[i],
				     TTY_NORMAL);

	port->icount.rx += room;

	return room;
}

static void sci_dma_rx_complete(void *arg)
{
	struct sci_port *s = arg;
	struct uart_port *port = &s->port;
	struct tty_struct *tty = port->state->port.tty;
	unsigned long flags;
	int count;

1183
	dev_dbg(port->dev, "%s(%d) active #%d\n", __func__, port->line, s->active_rx);
1184 1185 1186 1187 1188

	spin_lock_irqsave(&port->lock, flags);

	count = sci_dma_rx_push(s, tty, s->buf_len_rx);

1189
	mod_timer(&s->rx_timer, jiffies + s->rx_timeout);
1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202 1203 1204 1205 1206

	spin_unlock_irqrestore(&port->lock, flags);

	if (count)
		tty_flip_buffer_push(tty);

	schedule_work(&s->work_rx);
}

static void sci_rx_dma_release(struct sci_port *s, bool enable_pio)
{
	struct dma_chan *chan = s->chan_rx;
	struct uart_port *port = &s->port;

	s->chan_rx = NULL;
	s->cookie_rx[0] = s->cookie_rx[1] = -EINVAL;
	dma_release_channel(chan);
1207 1208 1209
	if (sg_dma_address(&s->sg_rx[0]))
		dma_free_coherent(port->dev, s->buf_len_rx * 2,
				  sg_virt(&s->sg_rx[0]), sg_dma_address(&s->sg_rx[0]));
1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258
	if (enable_pio)
		sci_start_rx(port);
}

static void sci_tx_dma_release(struct sci_port *s, bool enable_pio)
{
	struct dma_chan *chan = s->chan_tx;
	struct uart_port *port = &s->port;

	s->chan_tx = NULL;
	s->cookie_tx = -EINVAL;
	dma_release_channel(chan);
	if (enable_pio)
		sci_start_tx(port);
}

static void sci_submit_rx(struct sci_port *s)
{
	struct dma_chan *chan = s->chan_rx;
	int i;

	for (i = 0; i < 2; i++) {
		struct scatterlist *sg = &s->sg_rx[i];
		struct dma_async_tx_descriptor *desc;

		desc = chan->device->device_prep_slave_sg(chan,
			sg, 1, DMA_FROM_DEVICE, DMA_PREP_INTERRUPT);

		if (desc) {
			s->desc_rx[i] = desc;
			desc->callback = sci_dma_rx_complete;
			desc->callback_param = s;
			s->cookie_rx[i] = desc->tx_submit(desc);
		}

		if (!desc || s->cookie_rx[i] < 0) {
			if (i) {
				async_tx_ack(s->desc_rx[0]);
				s->cookie_rx[0] = -EINVAL;
			}
			if (desc) {
				async_tx_ack(desc);
				s->cookie_rx[i] = -EINVAL;
			}
			dev_warn(s->port.dev,
				 "failed to re-start DMA, using PIO\n");
			sci_rx_dma_release(s, true);
			return;
		}
1259 1260
		dev_dbg(s->port.dev, "%s(): cookie %d to #%d\n", __func__,
			s->cookie_rx[i], i);
1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294
	}

	s->active_rx = s->cookie_rx[0];

	dma_async_issue_pending(chan);
}

static void work_fn_rx(struct work_struct *work)
{
	struct sci_port *s = container_of(work, struct sci_port, work_rx);
	struct uart_port *port = &s->port;
	struct dma_async_tx_descriptor *desc;
	int new;

	if (s->active_rx == s->cookie_rx[0]) {
		new = 0;
	} else if (s->active_rx == s->cookie_rx[1]) {
		new = 1;
	} else {
		dev_err(port->dev, "cookie %d not found!\n", s->active_rx);
		return;
	}
	desc = s->desc_rx[new];

	if (dma_async_is_tx_complete(s->chan_rx, s->active_rx, NULL, NULL) !=
	    DMA_SUCCESS) {
		/* Handle incomplete DMA receive */
		struct tty_struct *tty = port->state->port.tty;
		struct dma_chan *chan = s->chan_rx;
		struct sh_desc *sh_desc = container_of(desc, struct sh_desc,
						       async_tx);
		unsigned long flags;
		int count;

1295
		chan->device->device_control(chan, DMA_TERMINATE_ALL, 0);
1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318
		dev_dbg(port->dev, "Read %u bytes with cookie %d\n",
			sh_desc->partial, sh_desc->cookie);

		spin_lock_irqsave(&port->lock, flags);
		count = sci_dma_rx_push(s, tty, sh_desc->partial);
		spin_unlock_irqrestore(&port->lock, flags);

		if (count)
			tty_flip_buffer_push(tty);

		sci_submit_rx(s);

		return;
	}

	s->cookie_rx[new] = desc->tx_submit(desc);
	if (s->cookie_rx[new] < 0) {
		dev_warn(port->dev, "Failed submitting Rx DMA descriptor\n");
		sci_rx_dma_release(s, true);
		return;
	}

	s->active_rx = s->cookie_rx[!new];
1319 1320 1321

	dev_dbg(port->dev, "%s: cookie %d #%d, new active #%d\n", __func__,
		s->cookie_rx[new], new, s->active_rx);
1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341
}

static void work_fn_tx(struct work_struct *work)
{
	struct sci_port *s = container_of(work, struct sci_port, work_tx);
	struct dma_async_tx_descriptor *desc;
	struct dma_chan *chan = s->chan_tx;
	struct uart_port *port = &s->port;
	struct circ_buf *xmit = &port->state->xmit;
	struct scatterlist *sg = &s->sg_tx;

	/*
	 * DMA is idle now.
	 * Port xmit buffer is already mapped, and it is one page... Just adjust
	 * offsets and lengths. Since it is a circular buffer, we have to
	 * transmit till the end, and then the rest. Take the port lock to get a
	 * consistent xmit buffer state.
	 */
	spin_lock_irq(&port->lock);
	sg->offset = xmit->tail & (UART_XMIT_SIZE - 1);
1342
	sg_dma_address(sg) = (sg_dma_address(sg) & ~(UART_XMIT_SIZE - 1)) +
1343
		sg->offset;
1344
	sg_dma_len(sg) = min((int)CIRC_CNT(xmit->head, xmit->tail, UART_XMIT_SIZE),
1345 1346 1347
		CIRC_CNT_TO_END(xmit->head, xmit->tail, UART_XMIT_SIZE));
	spin_unlock_irq(&port->lock);

1348
	BUG_ON(!sg_dma_len(sg));
1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380

	desc = chan->device->device_prep_slave_sg(chan,
			sg, s->sg_len_tx, DMA_TO_DEVICE,
			DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
	if (!desc) {
		/* switch to PIO */
		sci_tx_dma_release(s, true);
		return;
	}

	dma_sync_sg_for_device(port->dev, sg, 1, DMA_TO_DEVICE);

	spin_lock_irq(&port->lock);
	s->desc_tx = desc;
	desc->callback = sci_dma_tx_complete;
	desc->callback_param = s;
	spin_unlock_irq(&port->lock);
	s->cookie_tx = desc->tx_submit(desc);
	if (s->cookie_tx < 0) {
		dev_warn(port->dev, "Failed submitting Tx DMA descriptor\n");
		/* switch to PIO */
		sci_tx_dma_release(s, true);
		return;
	}

	dev_dbg(port->dev, "%s: %p: %d...%d, cookie %d\n", __func__,
		xmit->buf, xmit->tail, xmit->head, s->cookie_tx);

	dma_async_issue_pending(chan);
}
#endif

1381
static void sci_start_tx(struct uart_port *port)
L
Linus Torvalds 已提交
1382
{
1383
	struct sci_port *s = to_sci_port(port);
1384
	unsigned short ctrl;
L
Linus Torvalds 已提交
1385

1386
#ifdef CONFIG_SERIAL_SH_SCI_DMA
1387
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
1388 1389 1390 1391 1392 1393 1394
		u16 new, scr = sci_in(port, SCSCR);
		if (s->chan_tx)
			new = scr | 0x8000;
		else
			new = scr & ~0x8000;
		if (new != scr)
			sci_out(port, SCSCR, new);
1395
	}
P
Paul Mundt 已提交
1396

1397 1398 1399
	if (s->chan_tx && !uart_circ_empty(&s->port.state->xmit) &&
	    s->cookie_tx < 0)
		schedule_work(&s->work_tx);
1400
#endif
P
Paul Mundt 已提交
1401

1402
	if (!s->chan_tx || port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
1403 1404
		/* Set TIE (Transmit Interrupt Enable) bit in SCSCR */
		ctrl = sci_in(port, SCSCR);
P
Paul Mundt 已提交
1405
		sci_out(port, SCSCR, ctrl | SCSCR_TIE);
1406
	}
L
Linus Torvalds 已提交
1407 1408
}

1409
static void sci_stop_tx(struct uart_port *port)
L
Linus Torvalds 已提交
1410 1411 1412 1413 1414
{
	unsigned short ctrl;

	/* Clear TIE (Transmit Interrupt Enable) bit in SCSCR */
	ctrl = sci_in(port, SCSCR);
P
Paul Mundt 已提交
1415

1416
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
1417
		ctrl &= ~0x8000;
P
Paul Mundt 已提交
1418

1419
	ctrl &= ~SCSCR_TIE;
P
Paul Mundt 已提交
1420

L
Linus Torvalds 已提交
1421 1422 1423
	sci_out(port, SCSCR, ctrl);
}

1424
static void sci_start_rx(struct uart_port *port)
L
Linus Torvalds 已提交
1425 1426 1427
{
	unsigned short ctrl;

P
Paul Mundt 已提交
1428
	ctrl = sci_in(port, SCSCR) | port_rx_irq_mask(port);
L
Linus Torvalds 已提交
1429

1430
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
1431
		ctrl &= ~0x4000;
P
Paul Mundt 已提交
1432

L
Linus Torvalds 已提交
1433 1434 1435 1436 1437 1438 1439 1440
	sci_out(port, SCSCR, ctrl);
}

static void sci_stop_rx(struct uart_port *port)
{
	unsigned short ctrl;

	ctrl = sci_in(port, SCSCR);
P
Paul Mundt 已提交
1441

1442
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
1443
		ctrl &= ~0x4000;
P
Paul Mundt 已提交
1444 1445 1446

	ctrl &= ~port_rx_irq_mask(port);

L
Linus Torvalds 已提交
1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459
	sci_out(port, SCSCR, ctrl);
}

static void sci_enable_ms(struct uart_port *port)
{
	/* Nothing here yet .. */
}

static void sci_break_ctl(struct uart_port *port, int break_state)
{
	/* Nothing here yet .. */
}

1460 1461 1462 1463 1464 1465 1466 1467
#ifdef CONFIG_SERIAL_SH_SCI_DMA
static bool filter(struct dma_chan *chan, void *slave)
{
	struct sh_dmae_slave *param = slave;

	dev_dbg(chan->device->dev, "%s: slave ID %d\n", __func__,
		param->slave_id);

1468 1469
	chan->private = param;
	return true;
1470 1471 1472 1473 1474 1475 1476
}

static void rx_timer_fn(unsigned long arg)
{
	struct sci_port *s = (struct sci_port *)arg;
	struct uart_port *port = &s->port;
	u16 scr = sci_in(port, SCSCR);
1477

1478
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
1479
		scr &= ~0x4000;
1480
		enable_irq(s->cfg->irqs[1]);
1481
	}
P
Paul Mundt 已提交
1482
	sci_out(port, SCSCR, scr | SCSCR_RIE);
1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494
	dev_dbg(port->dev, "DMA Rx timed out\n");
	schedule_work(&s->work_rx);
}

static void sci_request_dma(struct uart_port *port)
{
	struct sci_port *s = to_sci_port(port);
	struct sh_dmae_slave *param;
	struct dma_chan *chan;
	dma_cap_mask_t mask;
	int nent;

1495 1496
	dev_dbg(port->dev, "%s: port %d\n", __func__,
		port->line);
1497

1498
	if (s->cfg->dma_slave_tx <= 0 || s->cfg->dma_slave_rx <= 0)
1499 1500 1501 1502 1503 1504 1505 1506
		return;

	dma_cap_zero(mask);
	dma_cap_set(DMA_SLAVE, mask);

	param = &s->param_tx;

	/* Slave ID, e.g., SHDMA_SLAVE_SCIF0_TX */
1507
	param->slave_id = s->cfg->dma_slave_tx;
1508 1509 1510 1511 1512 1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534

	s->cookie_tx = -EINVAL;
	chan = dma_request_channel(mask, filter, param);
	dev_dbg(port->dev, "%s: TX: got channel %p\n", __func__, chan);
	if (chan) {
		s->chan_tx = chan;
		sg_init_table(&s->sg_tx, 1);
		/* UART circular tx buffer is an aligned page. */
		BUG_ON((int)port->state->xmit.buf & ~PAGE_MASK);
		sg_set_page(&s->sg_tx, virt_to_page(port->state->xmit.buf),
			    UART_XMIT_SIZE, (int)port->state->xmit.buf & ~PAGE_MASK);
		nent = dma_map_sg(port->dev, &s->sg_tx, 1, DMA_TO_DEVICE);
		if (!nent)
			sci_tx_dma_release(s, false);
		else
			dev_dbg(port->dev, "%s: mapped %d@%p to %x\n", __func__,
				sg_dma_len(&s->sg_tx),
				port->state->xmit.buf, sg_dma_address(&s->sg_tx));

		s->sg_len_tx = nent;

		INIT_WORK(&s->work_tx, work_fn_tx);
	}

	param = &s->param_rx;

	/* Slave ID, e.g., SHDMA_SLAVE_SCIF0_RX */
1535
	param->slave_id = s->cfg->dma_slave_rx;
1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565

	chan = dma_request_channel(mask, filter, param);
	dev_dbg(port->dev, "%s: RX: got channel %p\n", __func__, chan);
	if (chan) {
		dma_addr_t dma[2];
		void *buf[2];
		int i;

		s->chan_rx = chan;

		s->buf_len_rx = 2 * max(16, (int)port->fifosize);
		buf[0] = dma_alloc_coherent(port->dev, s->buf_len_rx * 2,
					    &dma[0], GFP_KERNEL);

		if (!buf[0]) {
			dev_warn(port->dev,
				 "failed to allocate dma buffer, using PIO\n");
			sci_rx_dma_release(s, true);
			return;
		}

		buf[1] = buf[0] + s->buf_len_rx;
		dma[1] = dma[0] + s->buf_len_rx;

		for (i = 0; i < 2; i++) {
			struct scatterlist *sg = &s->sg_rx[i];

			sg_init_table(sg, 1);
			sg_set_page(sg, virt_to_page(buf[i]), s->buf_len_rx,
				    (int)buf[i] & ~PAGE_MASK);
1566
			sg_dma_address(sg) = dma[i];
1567 1568 1569 1570 1571 1572 1573 1574 1575 1576 1577 1578 1579 1580 1581 1582 1583 1584
		}

		INIT_WORK(&s->work_rx, work_fn_rx);
		setup_timer(&s->rx_timer, rx_timer_fn, (unsigned long)s);

		sci_submit_rx(s);
	}
}

static void sci_free_dma(struct uart_port *port)
{
	struct sci_port *s = to_sci_port(port);

	if (s->chan_tx)
		sci_tx_dma_release(s, false);
	if (s->chan_rx)
		sci_rx_dma_release(s, false);
}
1585 1586 1587 1588 1589 1590 1591 1592
#else
static inline void sci_request_dma(struct uart_port *port)
{
}

static inline void sci_free_dma(struct uart_port *port)
{
}
1593 1594
#endif

L
Linus Torvalds 已提交
1595 1596
static int sci_startup(struct uart_port *port)
{
1597
	struct sci_port *s = to_sci_port(port);
1598
	int ret;
L
Linus Torvalds 已提交
1599

1600 1601
	dev_dbg(port->dev, "%s(%d)\n", __func__, port->line);

1602
	sci_port_enable(s);
L
Linus Torvalds 已提交
1603

1604 1605 1606 1607
	ret = sci_request_irq(s);
	if (unlikely(ret < 0))
		return ret;

1608
	sci_request_dma(port);
1609

1610
	sci_start_tx(port);
1611
	sci_start_rx(port);
L
Linus Torvalds 已提交
1612 1613 1614 1615 1616 1617

	return 0;
}

static void sci_shutdown(struct uart_port *port)
{
1618
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
1619

1620 1621
	dev_dbg(port->dev, "%s(%d)\n", __func__, port->line);

L
Linus Torvalds 已提交
1622
	sci_stop_rx(port);
1623
	sci_stop_tx(port);
1624

1625
	sci_free_dma(port);
L
Linus Torvalds 已提交
1626 1627
	sci_free_irq(s);

1628
	sci_port_disable(s);
L
Linus Torvalds 已提交
1629 1630
}

1631 1632 1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644 1645 1646 1647 1648
static unsigned int sci_scbrr_calc(unsigned int algo_id, unsigned int bps,
				   unsigned long freq)
{
	switch (algo_id) {
	case SCBRR_ALGO_1:
		return ((freq + 16 * bps) / (16 * bps) - 1);
	case SCBRR_ALGO_2:
		return ((freq + 16 * bps) / (32 * bps) - 1);
	case SCBRR_ALGO_3:
		return (((freq * 2) + 16 * bps) / (16 * bps) - 1);
	case SCBRR_ALGO_4:
		return (((freq * 2) + 16 * bps) / (32 * bps) - 1);
	case SCBRR_ALGO_5:
		return (((freq * 1000 / 32) / bps) - 1);
	}

	/* Warn, but use a safe default */
	WARN_ON(1);
1649

1650 1651 1652
	return ((freq + 16 * bps) / (32 * bps) - 1);
}

1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664 1665 1666
static void sci_reset(struct uart_port *port)
{
	unsigned int status;

	do {
		status = sci_in(port, SCxSR);
	} while (!(status & SCxSR_TEND(port)));

	sci_out(port, SCSCR, 0x00);	/* TE=0, RE=0, CKE1=0 */

	if (port->type != PORT_SCI)
		sci_out(port, SCFCR, SCFCR_RFRST | SCFCR_TFRST);
}

A
Alan Cox 已提交
1667 1668
static void sci_set_termios(struct uart_port *port, struct ktermios *termios,
			    struct ktermios *old)
L
Linus Torvalds 已提交
1669
{
1670
	struct sci_port *s = to_sci_port(port);
1671
	unsigned int baud, smr_val, max_baud;
1672
	int t = -1;
1673
	u16 scfcr = 0;
L
Linus Torvalds 已提交
1674

1675 1676 1677 1678 1679 1680 1681 1682 1683
	/*
	 * earlyprintk comes here early on with port->uartclk set to zero.
	 * the clock framework is not up and running at this point so here
	 * we assume that 115200 is the maximum baud rate. please note that
	 * the baud rate is not programmed during earlyprintk - it is assumed
	 * that the previous boot loader has enabled required clocks and
	 * setup the baud rate generator hardware for us already.
	 */
	max_baud = port->uartclk ? port->uartclk / 16 : 115200;
L
Linus Torvalds 已提交
1684

1685 1686
	baud = uart_get_baud_rate(port, termios, old, 0, max_baud);
	if (likely(baud && port->uartclk))
1687
		t = sci_scbrr_calc(s->cfg->scbrr_algo_id, baud, port->uartclk);
1688

1689
	sci_port_enable(s);
1690

1691
	sci_reset(port);
L
Linus Torvalds 已提交
1692 1693

	smr_val = sci_in(port, SCSMR) & 3;
1694

L
Linus Torvalds 已提交
1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707
	if ((termios->c_cflag & CSIZE) == CS7)
		smr_val |= 0x40;
	if (termios->c_cflag & PARENB)
		smr_val |= 0x20;
	if (termios->c_cflag & PARODD)
		smr_val |= 0x30;
	if (termios->c_cflag & CSTOPB)
		smr_val |= 0x08;

	uart_update_timeout(port, termios->c_cflag, baud);

	sci_out(port, SCSMR, smr_val);

1708
	dev_dbg(port->dev, "%s: SMR %x, t %x, SCSCR %x\n", __func__, smr_val, t,
1709
		s->cfg->scscr);
1710

L
Linus Torvalds 已提交
1711
	if (t > 0) {
1712
		if (t >= 256) {
L
Linus Torvalds 已提交
1713 1714
			sci_out(port, SCSMR, (sci_in(port, SCSMR) & ~3) | 1);
			t >>= 2;
1715
		} else
L
Linus Torvalds 已提交
1716
			sci_out(port, SCSMR, sci_in(port, SCSMR) & ~3);
1717

L
Linus Torvalds 已提交
1718 1719 1720 1721
		sci_out(port, SCBRR, t);
		udelay((1000000+(baud-1)) / baud); /* Wait one bit interval */
	}

1722
	sci_init_pins(port, termios->c_cflag);
1723
	sci_out(port, SCFCR, scfcr | ((termios->c_cflag & CRTSCTS) ? SCFCR_MCE : 0));
1724

1725
	sci_out(port, SCSCR, s->cfg->scscr);
L
Linus Torvalds 已提交
1726

1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	/*
	 * Calculate delay for 1.5 DMA buffers: see
	 * drivers/serial/serial_core.c::uart_update_timeout(). With 10 bits
	 * (CS8), 250Hz, 115200 baud and 64 bytes FIFO, the above function
	 * calculates 1 jiffie for the data plus 5 jiffies for the "slop(e)."
	 * Then below we calculate 3 jiffies (12ms) for 1.5 DMA buffers (3 FIFO
	 * sizes), but it has been found out experimentally, that this is not
	 * enough: the driver too often needlessly runs on a DMA timeout. 20ms
	 * as a minimum seem to work perfectly.
	 */
	if (s->chan_rx) {
		s->rx_timeout = (port->timeout - HZ / 50) * s->buf_len_rx * 3 /
			port->fifosize / 2;
		dev_dbg(port->dev,
			"DMA Rx t-out %ums, tty t-out %u jiffies\n",
			s->rx_timeout * 1000 / HZ, port->timeout);
		if (s->rx_timeout < msecs_to_jiffies(20))
			s->rx_timeout = msecs_to_jiffies(20);
	}
#endif

L
Linus Torvalds 已提交
1749
	if ((termios->c_cflag & CREAD) != 0)
1750
		sci_start_rx(port);
1751

1752
	sci_port_disable(s);
L
Linus Torvalds 已提交
1753 1754 1755 1756 1757
}

static const char *sci_type(struct uart_port *port)
{
	switch (port->type) {
1758 1759 1760 1761 1762 1763 1764 1765
	case PORT_IRDA:
		return "irda";
	case PORT_SCI:
		return "sci";
	case PORT_SCIF:
		return "scif";
	case PORT_SCIFA:
		return "scifa";
1766 1767
	case PORT_SCIFB:
		return "scifb";
L
Linus Torvalds 已提交
1768 1769
	}

P
Paul Mundt 已提交
1770
	return NULL;
L
Linus Torvalds 已提交
1771 1772
}

1773
static inline unsigned long sci_port_size(struct uart_port *port)
L
Linus Torvalds 已提交
1774
{
1775 1776 1777 1778 1779 1780 1781
	/*
	 * Pick an arbitrary size that encapsulates all of the base
	 * registers by default. This can be optimized later, or derived
	 * from platform resource data at such a time that ports begin to
	 * behave more erratically.
	 */
	return 64;
L
Linus Torvalds 已提交
1782 1783
}

1784 1785 1786 1787 1788 1789 1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811
static int sci_remap_port(struct uart_port *port)
{
	unsigned long size = sci_port_size(port);

	/*
	 * Nothing to do if there's already an established membase.
	 */
	if (port->membase)
		return 0;

	if (port->flags & UPF_IOREMAP) {
		port->membase = ioremap_nocache(port->mapbase, size);
		if (unlikely(!port->membase)) {
			dev_err(port->dev, "can't remap port#%d\n", port->line);
			return -ENXIO;
		}
	} else {
		/*
		 * For the simple (and majority of) cases where we don't
		 * need to do any remapping, just cast the cookie
		 * directly.
		 */
		port->membase = (void __iomem *)port->mapbase;
	}

	return 0;
}

1812
static void sci_release_port(struct uart_port *port)
L
Linus Torvalds 已提交
1813
{
1814 1815 1816 1817 1818 1819
	if (port->flags & UPF_IOREMAP) {
		iounmap(port->membase);
		port->membase = NULL;
	}

	release_mem_region(port->mapbase, sci_port_size(port));
L
Linus Torvalds 已提交
1820 1821
}

1822
static int sci_request_port(struct uart_port *port)
L
Linus Torvalds 已提交
1823
{
1824 1825
	unsigned long size = sci_port_size(port);
	struct resource *res;
1826
	int ret;
L
Linus Torvalds 已提交
1827

1828
	res = request_mem_region(port->mapbase, size, dev_name(port->dev));
1829 1830
	if (unlikely(res == NULL))
		return -EBUSY;
L
Linus Torvalds 已提交
1831

1832 1833 1834 1835
	ret = sci_remap_port(port);
	if (unlikely(ret != 0)) {
		release_resource(res);
		return ret;
1836
	}
1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848

	return 0;
}

static void sci_config_port(struct uart_port *port, int flags)
{
	if (flags & UART_CONFIG_TYPE) {
		struct sci_port *sport = to_sci_port(port);

		port->type = sport->cfg->type;
		sci_request_port(port);
	}
L
Linus Torvalds 已提交
1849 1850 1851 1852
}

static int sci_verify_port(struct uart_port *port, struct serial_struct *ser)
{
1853
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
1854

1855
	if (ser->irq != s->cfg->irqs[SCIx_TXI_IRQ] || ser->irq > nr_irqs)
L
Linus Torvalds 已提交
1856 1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880
		return -EINVAL;
	if (ser->baud_base < 2400)
		/* No paper tape reader for Mitch.. */
		return -EINVAL;

	return 0;
}

static struct uart_ops sci_uart_ops = {
	.tx_empty	= sci_tx_empty,
	.set_mctrl	= sci_set_mctrl,
	.get_mctrl	= sci_get_mctrl,
	.start_tx	= sci_start_tx,
	.stop_tx	= sci_stop_tx,
	.stop_rx	= sci_stop_rx,
	.enable_ms	= sci_enable_ms,
	.break_ctl	= sci_break_ctl,
	.startup	= sci_startup,
	.shutdown	= sci_shutdown,
	.set_termios	= sci_set_termios,
	.type		= sci_type,
	.release_port	= sci_release_port,
	.request_port	= sci_request_port,
	.config_port	= sci_config_port,
	.verify_port	= sci_verify_port,
1881 1882 1883 1884
#ifdef CONFIG_CONSOLE_POLL
	.poll_get_char	= sci_poll_get_char,
	.poll_put_char	= sci_poll_put_char,
#endif
L
Linus Torvalds 已提交
1885 1886
};

1887 1888 1889 1890
static int __devinit sci_init_single(struct platform_device *dev,
				     struct sci_port *sci_port,
				     unsigned int index,
				     struct plat_sci_port *p)
1891
{
1892
	struct uart_port *port = &sci_port->port;
1893
	int ret;
1894

1895 1896 1897
	port->ops	= &sci_uart_ops;
	port->iotype	= UPIO_MEM;
	port->line	= index;
1898 1899

	switch (p->type) {
1900 1901 1902
	case PORT_SCIFB:
		port->fifosize = 256;
		break;
1903
	case PORT_SCIFA:
1904
		port->fifosize = 64;
1905 1906
		break;
	case PORT_SCIF:
1907
		port->fifosize = 16;
1908 1909
		break;
	default:
1910
		port->fifosize = 1;
1911 1912
		break;
	}
1913

1914 1915
	if (p->regtype == SCIx_PROBE_REGTYPE) {
		ret = sci_probe_regmap(p);
1916
		if (unlikely(ret))
1917 1918
			return ret;
	}
1919

1920
	if (dev) {
1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937
		sci_port->iclk = clk_get(&dev->dev, "sci_ick");
		if (IS_ERR(sci_port->iclk)) {
			sci_port->iclk = clk_get(&dev->dev, "peripheral_clk");
			if (IS_ERR(sci_port->iclk)) {
				dev_err(&dev->dev, "can't get iclk\n");
				return PTR_ERR(sci_port->iclk);
			}
		}

		/*
		 * The function clock is optional, ignore it if we can't
		 * find it.
		 */
		sci_port->fclk = clk_get(&dev->dev, "sci_fck");
		if (IS_ERR(sci_port->fclk))
			sci_port->fclk = NULL;

1938
		port->dev = &dev->dev;
M
Magnus Damm 已提交
1939

1940
		pm_runtime_irq_safe(&dev->dev);
M
Magnus Damm 已提交
1941
		pm_runtime_enable(&dev->dev);
1942
	}
1943

M
Magnus Damm 已提交
1944 1945 1946 1947
	sci_port->break_timer.data = (unsigned long)sci_port;
	sci_port->break_timer.function = sci_break_timer;
	init_timer(&sci_port->break_timer);

1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973
	/*
	 * Establish some sensible defaults for the error detection.
	 */
	if (!p->error_mask)
		p->error_mask = (p->type == PORT_SCI) ?
			SCI_DEFAULT_ERROR_MASK : SCIF_DEFAULT_ERROR_MASK;

	/*
	 * Establish sensible defaults for the overrun detection, unless
	 * the part has explicitly disabled support for it.
	 */
	if (p->overrun_bit != SCIx_NOT_SUPPORTED) {
		if (p->type == PORT_SCI)
			p->overrun_bit = 5;
		else if (p->scbrr_algo_id == SCBRR_ALGO_4)
			p->overrun_bit = 9;
		else
			p->overrun_bit = 0;

		/*
		 * Make the error mask inclusive of overrun detection, if
		 * supported.
		 */
		p->error_mask |= (1 << p->overrun_bit);
	}

1974
	sci_port->cfg		= p;
M
Magnus Damm 已提交
1975

1976 1977
	port->mapbase		= p->mapbase;
	port->type		= p->type;
P
Paul Mundt 已提交
1978
	port->flags		= p->flags;
1979
	port->regshift		= p->regshift;
1980

1981
	/*
1982
	 * The UART port needs an IRQ value, so we peg this to the RX IRQ
1983 1984 1985 1986 1987
	 * for the multi-IRQ ports, which is where we are primarily
	 * concerned with the shutdown path synchronization.
	 *
	 * For the muxed case there's nothing more to do.
	 */
1988
	port->irq		= p->irqs[SCIx_RXI_IRQ];
Y
Yong Zhang 已提交
1989
	port->irqflags		= 0;
1990

1991 1992 1993
	port->serial_in		= sci_serial_in;
	port->serial_out	= sci_serial_out;

1994 1995 1996
	if (p->dma_slave_tx > 0 && p->dma_slave_rx > 0)
		dev_dbg(port->dev, "DMA tx %d, rx %d\n",
			p->dma_slave_tx, p->dma_slave_rx);
M
Magnus Damm 已提交
1997

1998
	return 0;
1999 2000
}

L
Linus Torvalds 已提交
2001
#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
2002 2003 2004 2005 2006
static void serial_console_putchar(struct uart_port *port, int ch)
{
	sci_poll_put_char(port, ch);
}

L
Linus Torvalds 已提交
2007 2008 2009 2010 2011 2012 2013
/*
 *	Print a string to the serial port trying not to disturb
 *	any possible real use of the port...
 */
static void serial_console_write(struct console *co, const char *s,
				 unsigned count)
{
2014 2015
	struct sci_port *sci_port = &sci_ports[co->index];
	struct uart_port *port = &sci_port->port;
M
Magnus Damm 已提交
2016
	unsigned short bits;
2017

2018
	sci_port_enable(sci_port);
2019 2020

	uart_console_write(port, s, count, serial_console_putchar);
M
Magnus Damm 已提交
2021 2022 2023 2024 2025

	/* wait until fifo is empty and last bit has been transmitted */
	bits = SCxSR_TDxE(port) | SCxSR_TEND(port);
	while ((sci_in(port, SCxSR) & bits) != bits)
		cpu_relax();
2026

2027
	sci_port_disable(sci_port);
L
Linus Torvalds 已提交
2028 2029
}

2030
static int __devinit serial_console_setup(struct console *co, char *options)
L
Linus Torvalds 已提交
2031
{
2032
	struct sci_port *sci_port;
L
Linus Torvalds 已提交
2033 2034 2035 2036 2037 2038 2039
	struct uart_port *port;
	int baud = 115200;
	int bits = 8;
	int parity = 'n';
	int flow = 'n';
	int ret;

2040
	/*
2041
	 * Refuse to handle any bogus ports.
L
Linus Torvalds 已提交
2042
	 */
2043
	if (co->index < 0 || co->index >= SCI_NPORTS)
2044 2045
		return -ENODEV;

2046 2047 2048
	sci_port = &sci_ports[co->index];
	port = &sci_port->port;

2049 2050 2051 2052 2053 2054
	/*
	 * Refuse to handle uninitialized ports.
	 */
	if (!port->ops)
		return -ENODEV;

2055 2056 2057
	ret = sci_remap_port(port);
	if (unlikely(ret != 0))
		return ret;
2058

2059
	sci_port_enable(sci_port);
2060

L
Linus Torvalds 已提交
2061 2062 2063
	if (options)
		uart_parse_options(options, &baud, &parity, &bits, &flow);

2064 2065
	sci_port_disable(sci_port);

2066
	return uart_set_options(port, co, baud, parity, bits, flow);
L
Linus Torvalds 已提交
2067 2068 2069 2070
}

static struct console serial_console = {
	.name		= "ttySC",
2071
	.device		= uart_console_device,
L
Linus Torvalds 已提交
2072 2073
	.write		= serial_console_write,
	.setup		= serial_console_setup,
P
Paul Mundt 已提交
2074
	.flags		= CON_PRINTBUFFER,
L
Linus Torvalds 已提交
2075
	.index		= -1,
2076
	.data		= &sci_uart_driver,
L
Linus Torvalds 已提交
2077 2078
};

2079 2080 2081 2082
static struct console early_serial_console = {
	.name           = "early_ttySC",
	.write          = serial_console_write,
	.flags          = CON_PRINTBUFFER,
2083
	.index		= -1,
2084
};
2085

2086 2087
static char early_serial_buf[32];

2088 2089 2090 2091 2092 2093 2094 2095 2096
static int __devinit sci_probe_earlyprintk(struct platform_device *pdev)
{
	struct plat_sci_port *cfg = pdev->dev.platform_data;

	if (early_serial_console.data)
		return -EEXIST;

	early_serial_console.index = pdev->id;

2097
	sci_init_single(NULL, &sci_ports[pdev->id], pdev->id, cfg);
2098 2099 2100 2101 2102 2103 2104 2105 2106

	serial_console_setup(&early_serial_console, early_serial_buf);

	if (!strstr(early_serial_buf, "keep"))
		early_serial_console.flags |= CON_BOOT;

	register_console(&early_serial_console);
	return 0;
}
2107

2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137
#define uart_console(port)	((port)->cons->index == (port)->line)

static int sci_runtime_suspend(struct device *dev)
{
	struct sci_port *sci_port = dev_get_drvdata(dev);
	struct uart_port *port = &sci_port->port;

	if (uart_console(port)) {
		sci_port->saved_smr = sci_in(port, SCSMR);
		sci_port->saved_brr = sci_in(port, SCBRR);
		sci_port->saved_fcr = sci_in(port, SCFCR);
	}
	return 0;
}

static int sci_runtime_resume(struct device *dev)
{
	struct sci_port *sci_port = dev_get_drvdata(dev);
	struct uart_port *port = &sci_port->port;

	if (uart_console(port)) {
		sci_reset(port);
		sci_out(port, SCSMR, sci_port->saved_smr);
		sci_out(port, SCBRR, sci_port->saved_brr);
		sci_out(port, SCFCR, sci_port->saved_fcr);
		sci_out(port, SCSCR, sci_port->cfg->scscr);
	}
	return 0;
}

2138 2139
#define SCI_CONSOLE	(&serial_console)

2140 2141 2142 2143 2144
#else
static inline int __devinit sci_probe_earlyprintk(struct platform_device *pdev)
{
	return -EINVAL;
}
L
Linus Torvalds 已提交
2145

2146
#define SCI_CONSOLE	NULL
2147 2148
#define sci_runtime_suspend	NULL
#define sci_runtime_resume	NULL
2149 2150

#endif /* CONFIG_SERIAL_SH_SCI_CONSOLE */
L
Linus Torvalds 已提交
2151 2152 2153 2154 2155 2156 2157 2158 2159 2160

static char banner[] __initdata =
	KERN_INFO "SuperH SCI(F) driver initialized\n";

static struct uart_driver sci_uart_driver = {
	.owner		= THIS_MODULE,
	.driver_name	= "sci",
	.dev_name	= "ttySC",
	.major		= SCI_MAJOR,
	.minor		= SCI_MINOR_START,
2161
	.nr		= SCI_NPORTS,
L
Linus Torvalds 已提交
2162 2163 2164
	.cons		= SCI_CONSOLE,
};

2165
static int sci_remove(struct platform_device *dev)
2166
{
2167
	struct sci_port *port = platform_get_drvdata(dev);
2168

2169 2170
	cpufreq_unregister_notifier(&port->freq_transition,
				    CPUFREQ_TRANSITION_NOTIFIER);
2171

2172 2173 2174 2175
	uart_remove_one_port(&sci_uart_driver, &port->port);

	clk_put(port->iclk);
	clk_put(port->fclk);
2176

M
Magnus Damm 已提交
2177
	pm_runtime_disable(&dev->dev);
2178 2179 2180
	return 0;
}

2181 2182 2183 2184 2185 2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196 2197
static int __devinit sci_probe_single(struct platform_device *dev,
				      unsigned int index,
				      struct plat_sci_port *p,
				      struct sci_port *sciport)
{
	int ret;

	/* Sanity check */
	if (unlikely(index >= SCI_NPORTS)) {
		dev_notice(&dev->dev, "Attempting to register port "
			   "%d when only %d are available.\n",
			   index+1, SCI_NPORTS);
		dev_notice(&dev->dev, "Consider bumping "
			   "CONFIG_SERIAL_SH_SCI_NR_UARTS!\n");
		return 0;
	}

2198 2199 2200
	ret = sci_init_single(dev, sciport, index, p);
	if (ret)
		return ret;
2201

2202
	return uart_add_one_port(&sci_uart_driver, &sciport->port);
2203 2204
}

2205
static int __devinit sci_probe(struct platform_device *dev)
L
Linus Torvalds 已提交
2206
{
2207
	struct plat_sci_port *p = dev->dev.platform_data;
2208
	struct sci_port *sp = &sci_ports[dev->id];
2209
	int ret;
2210

2211 2212 2213 2214 2215 2216 2217
	/*
	 * If we've come here via earlyprintk initialization, head off to
	 * the special early probe. We don't have sufficient device state
	 * to make it beyond this yet.
	 */
	if (is_early_platform_device(dev))
		return sci_probe_earlyprintk(dev);
2218

2219
	platform_set_drvdata(dev, sp);
2220

2221
	ret = sci_probe_single(dev, dev->id, p, sp);
2222 2223
	if (ret)
		goto err_unreg;
2224

2225
	sp->freq_transition.notifier_call = sci_notifier;
L
Linus Torvalds 已提交
2226

2227 2228 2229 2230
	ret = cpufreq_register_notifier(&sp->freq_transition,
					CPUFREQ_TRANSITION_NOTIFIER);
	if (unlikely(ret < 0))
		goto err_unreg;
L
Linus Torvalds 已提交
2231 2232 2233 2234 2235

#ifdef CONFIG_SH_STANDARD_BIOS
	sh_bios_gdb_detach();
#endif

2236
	return 0;
2237 2238

err_unreg:
2239
	sci_remove(dev);
2240
	return ret;
L
Linus Torvalds 已提交
2241 2242
}

2243
static int sci_suspend(struct device *dev)
L
Linus Torvalds 已提交
2244
{
2245
	struct sci_port *sport = dev_get_drvdata(dev);
2246

2247 2248
	if (sport)
		uart_suspend_port(&sci_uart_driver, &sport->port);
L
Linus Torvalds 已提交
2249

2250 2251
	return 0;
}
L
Linus Torvalds 已提交
2252

2253
static int sci_resume(struct device *dev)
2254
{
2255
	struct sci_port *sport = dev_get_drvdata(dev);
2256

2257 2258
	if (sport)
		uart_resume_port(&sci_uart_driver, &sport->port);
2259 2260 2261 2262

	return 0;
}

2263
static const struct dev_pm_ops sci_dev_pm_ops = {
2264 2265
	.runtime_suspend = sci_runtime_suspend,
	.runtime_resume = sci_runtime_resume,
2266 2267 2268 2269
	.suspend	= sci_suspend,
	.resume		= sci_resume,
};

2270 2271
static struct platform_driver sci_driver = {
	.probe		= sci_probe,
2272
	.remove		= sci_remove,
2273 2274 2275
	.driver		= {
		.name	= "sh-sci",
		.owner	= THIS_MODULE,
2276
		.pm	= &sci_dev_pm_ops,
2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295 2296 2297 2298
	},
};

static int __init sci_init(void)
{
	int ret;

	printk(banner);

	ret = uart_register_driver(&sci_uart_driver);
	if (likely(ret == 0)) {
		ret = platform_driver_register(&sci_driver);
		if (unlikely(ret))
			uart_unregister_driver(&sci_uart_driver);
	}

	return ret;
}

static void __exit sci_exit(void)
{
	platform_driver_unregister(&sci_driver);
L
Linus Torvalds 已提交
2299 2300 2301
	uart_unregister_driver(&sci_uart_driver);
}

2302 2303 2304 2305
#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
early_platform_init_buffer("earlyprintk", &sci_driver,
			   early_serial_buf, ARRAY_SIZE(early_serial_buf));
#endif
L
Linus Torvalds 已提交
2306 2307 2308
module_init(sci_init);
module_exit(sci_exit);

2309
MODULE_LICENSE("GPL");
2310
MODULE_ALIAS("platform:sh-sci");
2311 2312
MODULE_AUTHOR("Paul Mundt");
MODULE_DESCRIPTION("SuperH SCI(F) serial driver");