sh-sci.c 74.6 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
5
 *  Copyright (C) 2015 Glider bvba
M
Markus Brunner 已提交
6
 *  Modified to support SH7720 SCIF. Markus Brunner, Mark Jonas (Jul 2007).
L
Linus Torvalds 已提交
7 8 9 10 11 12 13 14
 *
 * 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).
15
 *   Removed SH7300 support (Jul 2007).
L
Linus Torvalds 已提交
16 17 18 19 20
 *
 * 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.
 */
21 22 23
#if defined(CONFIG_SERIAL_SH_SCI_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
#define SUPPORT_SYSRQ
#endif
L
Linus Torvalds 已提交
24 25 26

#undef DEBUG

27 28 29 30 31 32 33 34
#include <linux/clk.h>
#include <linux/console.h>
#include <linux/ctype.h>
#include <linux/cpufreq.h>
#include <linux/delay.h>
#include <linux/dmaengine.h>
#include <linux/dma-mapping.h>
#include <linux/err.h>
L
Linus Torvalds 已提交
35
#include <linux/errno.h>
36
#include <linux/init.h>
L
Linus Torvalds 已提交
37 38
#include <linux/interrupt.h>
#include <linux/ioport.h>
39 40
#include <linux/major.h>
#include <linux/module.h>
L
Linus Torvalds 已提交
41
#include <linux/mm.h>
B
Bastian Hecht 已提交
42
#include <linux/of.h>
43
#include <linux/platform_device.h>
M
Magnus Damm 已提交
44
#include <linux/pm_runtime.h>
45
#include <linux/scatterlist.h>
46 47 48
#include <linux/serial.h>
#include <linux/serial_sci.h>
#include <linux/sh_dma.h>
49
#include <linux/slab.h>
50 51 52 53 54
#include <linux/string.h>
#include <linux/sysrq.h>
#include <linux/timer.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
55 56

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

#include "sh-sci.h"

62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78
/* Offsets into the sci_port->irqs array */
enum {
	SCIx_ERI_IRQ,
	SCIx_RXI_IRQ,
	SCIx_TXI_IRQ,
	SCIx_BRI_IRQ,
	SCIx_NR_IRQS,

	SCIx_MUX_IRQ = SCIx_NR_IRQS,	/* special case */
};

#define SCIx_IRQ_IS_MUXED(port)			\
	((port)->irqs[SCIx_ERI_IRQ] ==	\
	 (port)->irqs[SCIx_RXI_IRQ]) ||	\
	((port)->irqs[SCIx_ERI_IRQ] &&	\
	 ((port)->irqs[SCIx_RXI_IRQ] < 0))

79 80
enum SCI_CLKS {
	SCI_FCK,		/* Functional Clock */
81
	SCI_SCK,		/* Optional External Clock */
82 83
	SCI_BRG_INT,		/* Optional BRG Internal Clock Source */
	SCI_SCIF_CLK,		/* Optional BRG External Clock Source */
84 85 86
	SCI_NUM_CLKS
};

87 88 89 90
/* Bit x set means sampling rate x + 1 is supported */
#define SCI_SR(x)		BIT((x) - 1)
#define SCI_SR_RANGE(x, y)	GENMASK((y) - 1, (x) - 1)

91 92 93 94
#define SCI_SR_SCIFAB		SCI_SR(5) | SCI_SR(7) | SCI_SR(11) | \
				SCI_SR(13) | SCI_SR(16) | SCI_SR(17) | \
				SCI_SR(19) | SCI_SR(27)

95 96 97 98 99 100 101 102
#define min_sr(_port)		ffs((_port)->sampling_rate_mask)
#define max_sr(_port)		fls((_port)->sampling_rate_mask)

/* Iterate over all supported sampling rates, from high to low */
#define for_each_sr(_sr, _port)						\
	for ((_sr) = max_sr(_port); (_sr) >= min_sr(_port); (_sr)--)	\
		if ((_port)->sampling_rate_mask & SCI_SR((_sr)))

103 104 105
struct sci_port {
	struct uart_port	port;

106 107
	/* Platform configuration */
	struct plat_sci_port	*cfg;
108
	unsigned int		overrun_reg;
109
	unsigned int		overrun_mask;
110
	unsigned int		error_mask;
111
	unsigned int		error_clear;
112
	unsigned int		sampling_rate_mask;
113
	resource_size_t		reg_size;
114 115 116 117

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

119 120 121
	/* Clocks */
	struct clk		*clks[SCI_NUM_CLKS];
	unsigned long		clk_rates[SCI_NUM_CLKS];
122

123
	int			irqs[SCIx_NR_IRQS];
124 125
	char			*irqstr[SCIx_NR_IRQS];

126 127
	struct dma_chan			*chan_tx;
	struct dma_chan			*chan_rx;
P
Paul Mundt 已提交
128

129 130 131 132
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	dma_cookie_t			cookie_tx;
	dma_cookie_t			cookie_rx[2];
	dma_cookie_t			active_rx;
133 134
	dma_addr_t			tx_dma_addr;
	unsigned int			tx_dma_len;
135
	struct scatterlist		sg_rx[2];
136
	void				*rx_buf[2];
137 138 139
	size_t				buf_len_rx;
	struct work_struct		work_tx;
	struct timer_list		rx_timer;
140
	unsigned int			rx_timeout;
141
#endif
142 143 144
};

#define SCI_NPORTS CONFIG_SERIAL_SH_SCI_NR_UARTS
145

146 147
static struct sci_port sci_ports[SCI_NPORTS];
static struct uart_driver sci_uart_driver;
L
Linus Torvalds 已提交
148

149 150 151 152 153 154
static inline struct sci_port *
to_sci_port(struct uart_port *uart)
{
	return container_of(uart, struct sci_port, port);
}

155 156 157 158 159 160 161
struct plat_sci_reg {
	u8 offset, size;
};

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

162
static const struct plat_sci_reg sci_regmap[SCIx_NR_REGTYPES][SCIx_NR_REGS] = {
163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183
	[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,
U
Ulrich Hecht 已提交
184
		[HSSRR]		= sci_reg_invalid,
185 186
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
187 188
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207
	},

	/*
	 * 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,
U
Ulrich Hecht 已提交
208
		[HSSRR]		= sci_reg_invalid,
209 210
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
211 212
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230
	},

	/*
	 * 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,
U
Ulrich Hecht 已提交
231
		[HSSRR]		= sci_reg_invalid,
232 233
		[SCPCR]		= { 0x30, 16 },
		[SCPDR]		= { 0x34, 16 },
234 235
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
236 237 238 239 240 241 242 243 244 245 246 247 248
	},

	/*
	 * 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 },
249 250 251
		[SCFDR]		= sci_reg_invalid,
		[SCTFDR]	= { 0x38, 16 },
		[SCRFDR]	= { 0x3c, 16 },
252 253
		[SCSPTR]	= sci_reg_invalid,
		[SCLSR]		= sci_reg_invalid,
U
Ulrich Hecht 已提交
254
		[HSSRR]		= sci_reg_invalid,
255 256
		[SCPCR]		= { 0x30, 16 },
		[SCPDR]		= { 0x34, 16 },
257 258
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
259 260
	},

261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277
	/*
	 * 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 },
U
Ulrich Hecht 已提交
278
		[HSSRR]		= sci_reg_invalid,
279 280
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
281 282
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
283 284
	},

285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300
	/*
	 * 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,
U
Ulrich Hecht 已提交
301
		[HSSRR]		= sci_reg_invalid,
302 303
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
304 305
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323
	},

	/*
	 * 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 },
U
Ulrich Hecht 已提交
324
		[HSSRR]		= sci_reg_invalid,
325 326
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
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
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
	},

	/*
	 * Common SCIF definitions for ports with a Baud Rate Generator for
	 * External Clock (BRG).
	 */
	[SCIx_SH4_SCIF_BRG_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 },
		[HSSRR]		= sci_reg_invalid,
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
		[SCDL]		= { 0x30, 16 },
		[SCCKS]		= { 0x34, 16 },
U
Ulrich Hecht 已提交
353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371
	},

	/*
	 * Common HSCIF definitions.
	 */
	[SCIx_HSCIF_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 },
		[HSSRR]		= { 0x40, 16 },
372 373
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
374 375
		[SCDL]		= { 0x30, 16 },
		[SCCKS]		= { 0x34, 16 },
376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394
	},

	/*
	 * 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 },
U
Ulrich Hecht 已提交
395
		[HSSRR]		= sci_reg_invalid,
396 397
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
398 399
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418
	},

	/*
	 * 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 },
U
Ulrich Hecht 已提交
419
		[HSSRR]		= sci_reg_invalid,
420 421
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
422 423
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
	},

	/*
	 * 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,
U
Ulrich Hecht 已提交
443
		[HSSRR]		= sci_reg_invalid,
444 445
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
446 447
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
448 449 450
	},
};

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

453 454 455 456 457 458 459 460
/*
 * 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)
{
461
	const struct plat_sci_reg *reg = sci_getreg(p, offset);
462 463 464 465 466 467 468 469 470 471 472 473 474

	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)
{
475
	const struct plat_sci_reg *reg = sci_getreg(p, offset);
476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501 502 503 504 505 506 507 508

	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");
}

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;
U
Ulrich Hecht 已提交
509 510 511
	case PORT_HSCIF:
		cfg->regtype = SCIx_HSCIF_REGTYPE;
		break;
512
	default:
513
		pr_err("Can't probe register map for given port\n");
514 515 516 517 518 519
		return -EINVAL;
	}

	return 0;
}

520 521
static void sci_port_enable(struct sci_port *sci_port)
{
522 523
	unsigned int i;

524 525 526 527 528
	if (!sci_port->port.dev)
		return;

	pm_runtime_get_sync(sci_port->port.dev);

529 530 531 532 533
	for (i = 0; i < SCI_NUM_CLKS; i++) {
		clk_prepare_enable(sci_port->clks[i]);
		sci_port->clk_rates[i] = clk_get_rate(sci_port->clks[i]);
	}
	sci_port->port.uartclk = sci_port->clk_rates[SCI_FCK];
534 535 536 537
}

static void sci_port_disable(struct sci_port *sci_port)
{
538 539
	unsigned int i;

540 541 542
	if (!sci_port->port.dev)
		return;

543 544 545 546 547 548 549 550
	/* Cancel the break timer to ensure that the timer handler will not try
	 * to access the hardware with clocks and power disabled. Reset the
	 * break flag to make the break debouncing state machine ready for the
	 * next break.
	 */
	del_timer_sync(&sci_port->break_timer);
	sci_port->break_flag = 0;

551 552
	for (i = SCI_NUM_CLKS; i-- > 0; )
		clk_disable_unprepare(sci_port->clks[i]);
553 554 555 556

	pm_runtime_put_sync(sci_port->port.dev);
}

557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638 639
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.
	 */
	return SCSCR_RIE | (to_sci_port(port)->cfg->scscr & SCSCR_REIE);
}

static void sci_start_tx(struct uart_port *port)
{
	struct sci_port *s = to_sci_port(port);
	unsigned short ctrl;

#ifdef CONFIG_SERIAL_SH_SCI_DMA
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
		u16 new, scr = serial_port_in(port, SCSCR);
		if (s->chan_tx)
			new = scr | SCSCR_TDRQE;
		else
			new = scr & ~SCSCR_TDRQE;
		if (new != scr)
			serial_port_out(port, SCSCR, new);
	}

	if (s->chan_tx && !uart_circ_empty(&s->port.state->xmit) &&
	    dma_submit_error(s->cookie_tx)) {
		s->cookie_tx = 0;
		schedule_work(&s->work_tx);
	}
#endif

	if (!s->chan_tx || port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
		/* Set TIE (Transmit Interrupt Enable) bit in SCSCR */
		ctrl = serial_port_in(port, SCSCR);
		serial_port_out(port, SCSCR, ctrl | SCSCR_TIE);
	}
}

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

	/* Clear TIE (Transmit Interrupt Enable) bit in SCSCR */
	ctrl = serial_port_in(port, SCSCR);

	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
		ctrl &= ~SCSCR_TDRQE;

	ctrl &= ~SCSCR_TIE;

	serial_port_out(port, SCSCR, ctrl);
}

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

	ctrl = serial_port_in(port, SCSCR) | port_rx_irq_mask(port);

	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
		ctrl &= ~SCSCR_RDRQE;

	serial_port_out(port, SCSCR, ctrl);
}

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

	ctrl = serial_port_in(port, SCSCR);

	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
		ctrl &= ~SCSCR_RDRQE;

	ctrl &= ~port_rx_irq_mask(port);

	serial_port_out(port, SCSCR, ctrl);
}

640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655
static void sci_clear_SCxSR(struct uart_port *port, unsigned int mask)
{
	if (port->type == PORT_SCI) {
		/* Just store the mask */
		serial_port_out(port, SCxSR, mask);
	} else if (to_sci_port(port)->overrun_mask == SCIFA_ORER) {
		/* SCIFA/SCIFB and SCIF on SH7705/SH7720/SH7721 */
		/* Only clear the status bits we want to clear */
		serial_port_out(port, SCxSR,
				serial_port_in(port, SCxSR) & mask);
	} else {
		/* Store the mask, clear parity/framing errors */
		serial_port_out(port, SCxSR, mask & ~(SCIF_FERC | SCIF_PERC));
	}
}

656 657
#if defined(CONFIG_CONSOLE_POLL) || defined(CONFIG_SERIAL_SH_SCI_CONSOLE) || \
    defined(CONFIG_SERIAL_SH_SCI_EARLYCON)
658 659

#ifdef CONFIG_CONSOLE_POLL
660
static int sci_poll_get_char(struct uart_port *port)
L
Linus Torvalds 已提交
661 662 663 664
{
	unsigned short status;
	int c;

665
	do {
666
		status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
667
		if (status & SCxSR_ERRORS(port)) {
668
			sci_clear_SCxSR(port, SCxSR_ERROR_CLEAR(port));
L
Linus Torvalds 已提交
669 670
			continue;
		}
671 672 673 674 675
		break;
	} while (1);

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

677
	c = serial_port_in(port, SCxRDR);
678

679
	/* Dummy read */
680
	serial_port_in(port, SCxSR);
681
	sci_clear_SCxSR(port, SCxSR_RDxF_CLEAR(port));
L
Linus Torvalds 已提交
682 683 684

	return c;
}
685
#endif
L
Linus Torvalds 已提交
686

687
static void sci_poll_put_char(struct uart_port *port, unsigned char c)
L
Linus Torvalds 已提交
688 689 690 691
{
	unsigned short status;

	do {
692
		status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
693 694
	} while (!(status & SCxSR_TDxE(port)));

695
	serial_port_out(port, SCxTDR, c);
696
	sci_clear_SCxSR(port, SCxSR_TDxE_CLEAR(port) & ~SCxSR_TEND(port));
L
Linus Torvalds 已提交
697
}
698 699
#endif /* CONFIG_CONSOLE_POLL || CONFIG_SERIAL_SH_SCI_CONSOLE ||
	  CONFIG_SERIAL_SH_SCI_EARLYCON */
L
Linus Torvalds 已提交
700

701
static void sci_init_pins(struct uart_port *port, unsigned int cflag)
L
Linus Torvalds 已提交
702
{
703
	struct sci_port *s = to_sci_port(port);
704
	const struct plat_sci_reg *reg = sci_regmap[s->cfg->regtype] + SCSPTR;
L
Linus Torvalds 已提交
705

706 707 708 709 710 711
	/*
	 * 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 已提交
712
	}
P
Paul Mundt 已提交
713

714 715 716 717 718 719
	/*
	 * For the generic path SCSPTR is necessary. Bail out if that's
	 * unavailable, too.
	 */
	if (!reg->size)
		return;
P
Paul Mundt 已提交
720

721 722 723 724
	if ((s->cfg->capabilities & SCIx_HAVE_RTSCTS) &&
	    ((!(cflag & CRTSCTS)))) {
		unsigned short status;

725
		status = serial_port_in(port, SCSPTR);
726 727
		status &= ~SCSPTR_CTSIO;
		status |= SCSPTR_RTSIO;
728
		serial_port_out(port, SCSPTR, status); /* Set RTS = 1 */
729
	}
730
}
731

732
static int sci_txfill(struct uart_port *port)
733
{
734
	const struct plat_sci_reg *reg;
735

736 737
	reg = sci_getreg(port, SCTFDR);
	if (reg->size)
738
		return serial_port_in(port, SCTFDR) & ((port->fifosize << 1) - 1);
739

740 741
	reg = sci_getreg(port, SCFDR);
	if (reg->size)
742
		return serial_port_in(port, SCFDR) >> 8;
743

744
	return !(serial_port_in(port, SCxSR) & SCI_TDRE);
745 746
}

747 748
static int sci_txroom(struct uart_port *port)
{
749
	return port->fifosize - sci_txfill(port);
750 751 752
}

static int sci_rxfill(struct uart_port *port)
753
{
754
	const struct plat_sci_reg *reg;
755 756 757

	reg = sci_getreg(port, SCRFDR);
	if (reg->size)
758
		return serial_port_in(port, SCRFDR) & ((port->fifosize << 1) - 1);
759 760 761

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

764
	return (serial_port_in(port, SCxSR) & SCxSR_RDxF(port)) != 0;
765 766
}

767 768 769 770 771 772 773 774 775 776
/*
 * 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;

777
	/* Cast for ARM damage */
778
	return !!__raw_readb((void __iomem *)(uintptr_t)s->cfg->port_reg);
779 780
}

L
Linus Torvalds 已提交
781 782 783 784 785 786
/* ********************************************************************** *
 *                   the interrupt related routines                       *
 * ********************************************************************** */

static void sci_transmit_chars(struct uart_port *port)
{
A
Alan Cox 已提交
787
	struct circ_buf *xmit = &port->state->xmit;
L
Linus Torvalds 已提交
788 789 790
	unsigned int stopped = uart_tx_stopped(port);
	unsigned short status;
	unsigned short ctrl;
791
	int count;
L
Linus Torvalds 已提交
792

793
	status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
794
	if (!(status & SCxSR_TDxE(port))) {
795
		ctrl = serial_port_in(port, SCSCR);
796
		if (uart_circ_empty(xmit))
797
			ctrl &= ~SCSCR_TIE;
798
		else
799
			ctrl |= SCSCR_TIE;
800
		serial_port_out(port, SCSCR, ctrl);
L
Linus Torvalds 已提交
801 802 803
		return;
	}

804
	count = sci_txroom(port);
L
Linus Torvalds 已提交
805 806 807 808 809 810 811 812 813 814 815 816 817 818

	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;
		}

819
		serial_port_out(port, SCxTDR, c);
L
Linus Torvalds 已提交
820 821 822 823

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

824
	sci_clear_SCxSR(port, SCxSR_TDxE_CLEAR(port));
L
Linus Torvalds 已提交
825 826 827 828

	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(port);
	if (uart_circ_empty(xmit)) {
829
		sci_stop_tx(port);
L
Linus Torvalds 已提交
830
	} else {
831
		ctrl = serial_port_in(port, SCSCR);
L
Linus Torvalds 已提交
832

833
		if (port->type != PORT_SCI) {
834
			serial_port_in(port, SCxSR); /* Dummy read */
835
			sci_clear_SCxSR(port, SCxSR_TDxE_CLEAR(port));
L
Linus Torvalds 已提交
836 837
		}

838
		ctrl |= SCSCR_TIE;
839
		serial_port_out(port, SCSCR, ctrl);
L
Linus Torvalds 已提交
840 841 842 843
	}
}

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

846
static void sci_receive_chars(struct uart_port *port)
L
Linus Torvalds 已提交
847
{
848
	struct sci_port *sci_port = to_sci_port(port);
849
	struct tty_port *tport = &port->state->port;
L
Linus Torvalds 已提交
850 851
	int i, count, copied = 0;
	unsigned short status;
A
Alan Cox 已提交
852
	unsigned char flag;
L
Linus Torvalds 已提交
853

854
	status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
855 856 857 858 859
	if (!(status & SCxSR_RDxF(port)))
		return;

	while (1) {
		/* Don't copy more bytes than there is room for in the buffer */
860
		count = tty_buffer_request_room(tport, sci_rxfill(port));
L
Linus Torvalds 已提交
861 862 863 864 865 866

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

		if (port->type == PORT_SCI) {
867
			char c = serial_port_in(port, SCxRDR);
868 869
			if (uart_handle_sysrq_char(port, c) ||
			    sci_port->break_flag)
L
Linus Torvalds 已提交
870
				count = 0;
871
			else
J
Jiri Slaby 已提交
872
				tty_insert_flip_char(tport, c, TTY_NORMAL);
L
Linus Torvalds 已提交
873
		} else {
874
			for (i = 0; i < count; i++) {
875
				char c = serial_port_in(port, SCxRDR);
876

877
				status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
878 879
#if defined(CONFIG_CPU_SH3)
				/* Skip "chars" during break */
880
				if (sci_port->break_flag) {
L
Linus Torvalds 已提交
881 882 883 884 885
					if ((c == 0) &&
					    (status & SCxSR_FER(port))) {
						count--; i--;
						continue;
					}
886

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

L
Linus Torvalds 已提交
891 892 893 894 895 896
					if (STEPFN(c)) {
						count--; i--;
						continue;
					}
				}
#endif /* CONFIG_CPU_SH3 */
897
				if (uart_handle_sysrq_char(port, c)) {
L
Linus Torvalds 已提交
898 899 900 901 902
					count--; i--;
					continue;
				}

				/* Store data and status */
903
				if (status & SCxSR_FER(port)) {
A
Alan Cox 已提交
904
					flag = TTY_FRAME;
905
					port->icount.frame++;
906
					dev_notice(port->dev, "frame error\n");
907
				} else if (status & SCxSR_PER(port)) {
A
Alan Cox 已提交
908
					flag = TTY_PARITY;
909
					port->icount.parity++;
910
					dev_notice(port->dev, "parity error\n");
A
Alan Cox 已提交
911 912
				} else
					flag = TTY_NORMAL;
913

J
Jiri Slaby 已提交
914
				tty_insert_flip_char(tport, c, flag);
L
Linus Torvalds 已提交
915 916 917
			}
		}

918
		serial_port_in(port, SCxSR); /* dummy read */
919
		sci_clear_SCxSR(port, SCxSR_RDxF_CLEAR(port));
L
Linus Torvalds 已提交
920 921 922 923 924 925 926

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

	if (copied) {
		/* Tell the rest of the system the news. New characters! */
J
Jiri Slaby 已提交
927
		tty_flip_buffer_push(tport);
L
Linus Torvalds 已提交
928
	} else {
929
		serial_port_in(port, SCxSR); /* dummy read */
930
		sci_clear_SCxSR(port, SCxSR_RDxF_CLEAR(port));
L
Linus Torvalds 已提交
931 932 933 934
	}
}

#define SCI_BREAK_JIFFIES (HZ/20)
935 936 937

/*
 * The sci generates interrupts during the break,
L
Linus Torvalds 已提交
938 939 940 941 942 943
 * 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.
 */
944
static inline void sci_schedule_break_timer(struct sci_port *port)
L
Linus Torvalds 已提交
945
{
946
	mod_timer(&port->break_timer, jiffies + SCI_BREAK_JIFFIES);
L
Linus Torvalds 已提交
947
}
948

L
Linus Torvalds 已提交
949 950 951
/* Ensure that two consecutive samples find the break over. */
static void sci_break_timer(unsigned long data)
{
952 953 954
	struct sci_port *port = (struct sci_port *)data;

	if (sci_rxd_in(&port->port) == 0) {
L
Linus Torvalds 已提交
955
		port->break_flag = 1;
956 957
		sci_schedule_break_timer(port);
	} else if (port->break_flag == 1) {
L
Linus Torvalds 已提交
958 959
		/* break is over. */
		port->break_flag = 2;
960 961 962
		sci_schedule_break_timer(port);
	} else
		port->break_flag = 0;
L
Linus Torvalds 已提交
963 964
}

965
static int sci_handle_errors(struct uart_port *port)
L
Linus Torvalds 已提交
966 967
{
	int copied = 0;
968
	unsigned short status = serial_port_in(port, SCxSR);
J
Jiri Slaby 已提交
969
	struct tty_port *tport = &port->state->port;
970
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
971

972
	/* Handle overruns */
973
	if (status & s->overrun_mask) {
974
		port->icount.overrun++;
975

976 977 978
		/* overrun error */
		if (tty_insert_flip_char(tport, 0, TTY_OVERRUN))
			copied++;
979

980
		dev_notice(port->dev, "overrun error\n");
L
Linus Torvalds 已提交
981 982
	}

983
	if (status & SCxSR_FER(port)) {
L
Linus Torvalds 已提交
984 985
		if (sci_rxd_in(port) == 0) {
			/* Notify of BREAK */
986
			struct sci_port *sci_port = to_sci_port(port);
987 988

			if (!sci_port->break_flag) {
989 990
				port->icount.brk++;

991 992 993
				sci_port->break_flag = 1;
				sci_schedule_break_timer(sci_port);

L
Linus Torvalds 已提交
994
				/* Do sysrq handling. */
995
				if (uart_handle_break(port))
L
Linus Torvalds 已提交
996
					return 0;
997 998 999

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

J
Jiri Slaby 已提交
1000
				if (tty_insert_flip_char(tport, 0, TTY_BREAK))
1001 1002 1003
					copied++;
			}

1004
		} else {
L
Linus Torvalds 已提交
1005
			/* frame error */
1006 1007
			port->icount.frame++;

J
Jiri Slaby 已提交
1008
			if (tty_insert_flip_char(tport, 0, TTY_FRAME))
A
Alan Cox 已提交
1009
				copied++;
1010 1011

			dev_notice(port->dev, "frame error\n");
L
Linus Torvalds 已提交
1012 1013 1014
		}
	}

1015
	if (status & SCxSR_PER(port)) {
L
Linus Torvalds 已提交
1016
		/* parity error */
1017 1018
		port->icount.parity++;

J
Jiri Slaby 已提交
1019
		if (tty_insert_flip_char(tport, 0, TTY_PARITY))
1020
			copied++;
1021

1022
		dev_notice(port->dev, "parity error\n");
L
Linus Torvalds 已提交
1023 1024
	}

A
Alan Cox 已提交
1025
	if (copied)
J
Jiri Slaby 已提交
1026
		tty_flip_buffer_push(tport);
L
Linus Torvalds 已提交
1027 1028 1029 1030

	return copied;
}

1031
static int sci_handle_fifo_overrun(struct uart_port *port)
1032
{
J
Jiri Slaby 已提交
1033
	struct tty_port *tport = &port->state->port;
1034
	struct sci_port *s = to_sci_port(port);
1035
	const struct plat_sci_reg *reg;
1036
	int copied = 0;
1037
	u16 status;
1038

1039
	reg = sci_getreg(port, s->overrun_reg);
1040
	if (!reg->size)
1041 1042
		return 0;

1043
	status = serial_port_in(port, s->overrun_reg);
1044 1045
	if (status & s->overrun_mask) {
		status &= ~s->overrun_mask;
1046
		serial_port_out(port, s->overrun_reg, status);
1047

1048 1049
		port->icount.overrun++;

J
Jiri Slaby 已提交
1050
		tty_insert_flip_char(tport, 0, TTY_OVERRUN);
J
Jiri Slaby 已提交
1051
		tty_flip_buffer_push(tport);
1052

1053
		dev_dbg(port->dev, "overrun error\n");
1054 1055 1056 1057 1058 1059
		copied++;
	}

	return copied;
}

1060
static int sci_handle_breaks(struct uart_port *port)
L
Linus Torvalds 已提交
1061 1062
{
	int copied = 0;
1063
	unsigned short status = serial_port_in(port, SCxSR);
J
Jiri Slaby 已提交
1064
	struct tty_port *tport = &port->state->port;
1065
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
1066

1067 1068 1069
	if (uart_handle_break(port))
		return 0;

1070
	if (!s->break_flag && status & SCxSR_BRK(port)) {
L
Linus Torvalds 已提交
1071 1072 1073 1074
#if defined(CONFIG_CPU_SH3)
		/* Debounce break */
		s->break_flag = 1;
#endif
1075 1076 1077

		port->icount.brk++;

L
Linus Torvalds 已提交
1078
		/* Notify of BREAK */
J
Jiri Slaby 已提交
1079
		if (tty_insert_flip_char(tport, 0, TTY_BREAK))
A
Alan Cox 已提交
1080
			copied++;
1081 1082

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

A
Alan Cox 已提交
1085
	if (copied)
J
Jiri Slaby 已提交
1086
		tty_flip_buffer_push(tport);
1087

1088 1089
	copied += sci_handle_fifo_overrun(port);

L
Linus Torvalds 已提交
1090 1091 1092
	return copied;
}

1093
#ifdef CONFIG_SERIAL_SH_SCI_DMA
1094 1095 1096 1097 1098 1099
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;
1100

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

1103
	spin_lock_irqsave(&port->lock, flags);
1104

1105 1106
	xmit->tail += s->tx_dma_len;
	xmit->tail &= UART_XMIT_SIZE - 1;
1107

1108
	port->icount.tx += s->tx_dma_len;
L
Linus Torvalds 已提交
1109

1110 1111
	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(port);
L
Linus Torvalds 已提交
1112

1113 1114 1115 1116 1117 1118 1119 1120 1121 1122
	if (!uart_circ_empty(xmit)) {
		s->cookie_tx = 0;
		schedule_work(&s->work_tx);
	} else {
		s->cookie_tx = -EINVAL;
		if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
			u16 ctrl = serial_port_in(port, SCSCR);
			serial_port_out(port, SCSCR, ctrl & ~SCSCR_TIE);
		}
	}
L
Linus Torvalds 已提交
1123

1124
	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
1125 1126
}

1127 1128
/* Locking: called with port lock held */
static int sci_dma_rx_push(struct sci_port *s, void *buf, size_t count)
L
Linus Torvalds 已提交
1129
{
1130 1131 1132
	struct uart_port *port = &s->port;
	struct tty_port *tport = &port->state->port;
	int copied;
L
Linus Torvalds 已提交
1133

1134 1135 1136 1137 1138
	copied = tty_insert_flip_string(tport, buf, count);
	if (copied < count) {
		dev_warn(port->dev, "Rx overrun: dropping %zu bytes\n",
			 count - copied);
		port->icount.buf_overrun++;
L
Linus Torvalds 已提交
1139 1140
	}

1141
	port->icount.rx += copied;
L
Linus Torvalds 已提交
1142

1143
	return copied;
L
Linus Torvalds 已提交
1144 1145
}

1146
static int sci_dma_rx_find_active(struct sci_port *s)
L
Linus Torvalds 已提交
1147
{
1148
	unsigned int i;
L
Linus Torvalds 已提交
1149

1150 1151 1152
	for (i = 0; i < ARRAY_SIZE(s->cookie_rx); i++)
		if (s->active_rx == s->cookie_rx[i])
			return i;
L
Linus Torvalds 已提交
1153

1154 1155 1156
	dev_err(s->port.dev, "%s: Rx cookie %d not found!\n", __func__,
		s->active_rx);
	return -1;
L
Linus Torvalds 已提交
1157 1158
}

1159
static void sci_rx_dma_release(struct sci_port *s, bool enable_pio)
P
Paul Mundt 已提交
1160
{
1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174
	struct dma_chan *chan = s->chan_rx;
	struct uart_port *port = &s->port;
	unsigned long flags;

	spin_lock_irqsave(&port->lock, flags);
	s->chan_rx = NULL;
	s->cookie_rx[0] = s->cookie_rx[1] = -EINVAL;
	spin_unlock_irqrestore(&port->lock, flags);
	dmaengine_terminate_all(chan);
	dma_free_coherent(chan->device->dev, s->buf_len_rx * 2, s->rx_buf[0],
			  sg_dma_address(&s->sg_rx[0]));
	dma_release_channel(chan);
	if (enable_pio)
		sci_start_rx(port);
P
Paul Mundt 已提交
1175 1176
}

1177
static void sci_dma_rx_complete(void *arg)
L
Linus Torvalds 已提交
1178
{
1179
	struct sci_port *s = arg;
1180
	struct dma_chan *chan = s->chan_rx;
1181
	struct uart_port *port = &s->port;
1182
	struct dma_async_tx_descriptor *desc;
1183 1184
	unsigned long flags;
	int active, count = 0;
L
Linus Torvalds 已提交
1185

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

1189
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
1190

1191 1192 1193
	active = sci_dma_rx_find_active(s);
	if (active >= 0)
		count = sci_dma_rx_push(s, s->rx_buf[active], s->buf_len_rx);
P
Paul Mundt 已提交
1194

1195
	mod_timer(&s->rx_timer, jiffies + s->rx_timeout);
P
Paul Mundt 已提交
1196

1197 1198
	if (count)
		tty_flip_buffer_push(&port->state->port);
1199

1200 1201 1202 1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213
	desc = dmaengine_prep_slave_sg(s->chan_rx, &s->sg_rx[active], 1,
				       DMA_DEV_TO_MEM,
				       DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
	if (!desc)
		goto fail;

	desc->callback = sci_dma_rx_complete;
	desc->callback_param = s;
	s->cookie_rx[active] = dmaengine_submit(desc);
	if (dma_submit_error(s->cookie_rx[active]))
		goto fail;

	s->active_rx = s->cookie_rx[!active];

1214 1215
	dma_async_issue_pending(chan);

1216 1217 1218 1219 1220 1221 1222 1223 1224
	dev_dbg(port->dev, "%s: cookie %d #%d, new active cookie %d\n",
		__func__, s->cookie_rx[active], active, s->active_rx);
	spin_unlock_irqrestore(&port->lock, flags);
	return;

fail:
	spin_unlock_irqrestore(&port->lock, flags);
	dev_warn(port->dev, "Failed submitting Rx DMA descriptor\n");
	sci_rx_dma_release(s, true);
L
Linus Torvalds 已提交
1225 1226
}

1227
static void sci_tx_dma_release(struct sci_port *s, bool enable_pio)
L
Linus Torvalds 已提交
1228
{
1229 1230
	struct dma_chan *chan = s->chan_tx;
	struct uart_port *port = &s->port;
1231
	unsigned long flags;
L
Linus Torvalds 已提交
1232

1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243
	spin_lock_irqsave(&port->lock, flags);
	s->chan_tx = NULL;
	s->cookie_tx = -EINVAL;
	spin_unlock_irqrestore(&port->lock, flags);
	dmaengine_terminate_all(chan);
	dma_unmap_single(chan->device->dev, s->tx_dma_addr, UART_XMIT_SIZE,
			 DMA_TO_DEVICE);
	dma_release_channel(chan);
	if (enable_pio)
		sci_start_tx(port);
}
1244

1245 1246 1247 1248
static void sci_submit_rx(struct sci_port *s)
{
	struct dma_chan *chan = s->chan_rx;
	int i;
1249

1250 1251 1252
	for (i = 0; i < 2; i++) {
		struct scatterlist *sg = &s->sg_rx[i];
		struct dma_async_tx_descriptor *desc;
L
Linus Torvalds 已提交
1253

1254 1255 1256 1257 1258
		desc = dmaengine_prep_slave_sg(chan,
			sg, 1, DMA_DEV_TO_MEM,
			DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
		if (!desc)
			goto fail;
1259

1260 1261 1262 1263 1264
		desc->callback = sci_dma_rx_complete;
		desc->callback_param = s;
		s->cookie_rx[i] = dmaengine_submit(desc);
		if (dma_submit_error(s->cookie_rx[i]))
			goto fail;
1265

1266 1267 1268
		dev_dbg(s->port.dev, "%s(): cookie %d to #%d\n", __func__,
			s->cookie_rx[i], i);
	}
1269

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

1272 1273
	dma_async_issue_pending(chan);
	return;
1274

1275 1276 1277 1278 1279 1280 1281 1282 1283
fail:
	if (i)
		dmaengine_terminate_all(chan);
	for (i = 0; i < 2; i++)
		s->cookie_rx[i] = -EINVAL;
	s->active_rx = -EINVAL;
	dev_warn(s->port.dev, "Failed to re-start Rx DMA, using PIO\n");
	sci_rx_dma_release(s, true);
}
1284

1285
static void work_fn_tx(struct work_struct *work)
L
Linus Torvalds 已提交
1286
{
1287 1288 1289 1290 1291 1292
	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;
	dma_addr_t buf;
L
Linus Torvalds 已提交
1293

1294
	/*
1295 1296 1297 1298 1299
	 * 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.
1300
	 */
1301 1302 1303 1304 1305 1306
	spin_lock_irq(&port->lock);
	buf = s->tx_dma_addr + (xmit->tail & (UART_XMIT_SIZE - 1));
	s->tx_dma_len = min_t(unsigned int,
		CIRC_CNT(xmit->head, xmit->tail, UART_XMIT_SIZE),
		CIRC_CNT_TO_END(xmit->head, xmit->tail, UART_XMIT_SIZE));
	spin_unlock_irq(&port->lock);
1307

1308 1309 1310 1311 1312 1313 1314 1315 1316
	desc = dmaengine_prep_slave_single(chan, buf, s->tx_dma_len,
					   DMA_MEM_TO_DEV,
					   DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
	if (!desc) {
		dev_warn(port->dev, "Failed preparing Tx DMA descriptor\n");
		/* switch to PIO */
		sci_tx_dma_release(s, true);
		return;
	}
1317

1318 1319
	dma_sync_single_for_device(chan->device->dev, buf, s->tx_dma_len,
				   DMA_TO_DEVICE);
L
Linus Torvalds 已提交
1320

1321 1322 1323 1324 1325 1326 1327 1328 1329 1330
	spin_lock_irq(&port->lock);
	desc->callback = sci_dma_tx_complete;
	desc->callback_param = s;
	spin_unlock_irq(&port->lock);
	s->cookie_tx = dmaengine_submit(desc);
	if (dma_submit_error(s->cookie_tx)) {
		dev_warn(port->dev, "Failed submitting Tx DMA descriptor\n");
		/* switch to PIO */
		sci_tx_dma_release(s, true);
		return;
L
Linus Torvalds 已提交
1331 1332
	}

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

1336
	dma_async_issue_pending(chan);
L
Linus Torvalds 已提交
1337 1338
}

1339
static void rx_timer_fn(unsigned long arg)
L
Linus Torvalds 已提交
1340
{
1341
	struct sci_port *s = (struct sci_port *)arg;
1342
	struct dma_chan *chan = s->chan_rx;
1343
	struct uart_port *port = &s->port;
1344 1345 1346 1347 1348 1349 1350 1351
	struct dma_tx_state state;
	enum dma_status status;
	unsigned long flags;
	unsigned int read;
	int active, count;
	u16 scr;

	spin_lock_irqsave(&port->lock, flags);
1352

1353 1354 1355 1356 1357 1358 1359 1360 1361
	dev_dbg(port->dev, "DMA Rx timed out\n");

	active = sci_dma_rx_find_active(s);
	if (active < 0) {
		spin_unlock_irqrestore(&port->lock, flags);
		return;
	}

	status = dmaengine_tx_status(s->chan_rx, s->active_rx, &state);
1362
	if (status == DMA_COMPLETE) {
1363 1364
		dev_dbg(port->dev, "Cookie %d #%d has already completed\n",
			s->active_rx, active);
1365 1366 1367 1368 1369
		spin_unlock_irqrestore(&port->lock, flags);

		/* Let packet complete handler take care of the packet */
		return;
	}
1370

1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385
	dmaengine_pause(chan);

	/*
	 * sometimes DMA transfer doesn't stop even if it is stopped and
	 * data keeps on coming until transaction is complete so check
	 * for DMA_COMPLETE again
	 * Let packet complete handler take care of the packet
	 */
	status = dmaengine_tx_status(s->chan_rx, s->active_rx, &state);
	if (status == DMA_COMPLETE) {
		spin_unlock_irqrestore(&port->lock, flags);
		dev_dbg(port->dev, "Transaction complete after DMA engine was stopped");
		return;
	}

1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397
	/* Handle incomplete DMA receive */
	dmaengine_terminate_all(s->chan_rx);
	read = sg_dma_len(&s->sg_rx[active]) - state.residue;
	dev_dbg(port->dev, "Read %u bytes with cookie %d\n", read,
		s->active_rx);

	if (read) {
		count = sci_dma_rx_push(s, s->rx_buf[active], read);
		if (count)
			tty_flip_buffer_push(&port->state->port);
	}

1398 1399
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
		sci_submit_rx(s);
1400 1401 1402 1403 1404 1405 1406 1407 1408 1409

	/* Direct new serial port interrupts back to CPU */
	scr = serial_port_in(port, SCSCR);
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
		scr &= ~SCSCR_RDRQE;
		enable_irq(s->irqs[SCIx_RXI_IRQ]);
	}
	serial_port_out(port, SCSCR, scr | SCSCR_RIE);

	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
1410 1411
}

1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454
static struct dma_chan *sci_request_dma_chan(struct uart_port *port,
					     enum dma_transfer_direction dir,
					     unsigned int id)
{
	dma_cap_mask_t mask;
	struct dma_chan *chan;
	struct dma_slave_config cfg;
	int ret;

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

	chan = dma_request_slave_channel_compat(mask, shdma_chan_filter,
					(void *)(unsigned long)id, port->dev,
					dir == DMA_MEM_TO_DEV ? "tx" : "rx");
	if (!chan) {
		dev_warn(port->dev,
			 "dma_request_slave_channel_compat failed\n");
		return NULL;
	}

	memset(&cfg, 0, sizeof(cfg));
	cfg.direction = dir;
	if (dir == DMA_MEM_TO_DEV) {
		cfg.dst_addr = port->mapbase +
			(sci_getreg(port, SCxTDR)->offset << port->regshift);
		cfg.dst_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
	} else {
		cfg.src_addr = port->mapbase +
			(sci_getreg(port, SCxRDR)->offset << port->regshift);
		cfg.src_addr_width = DMA_SLAVE_BUSWIDTH_1_BYTE;
	}

	ret = dmaengine_slave_config(chan, &cfg);
	if (ret) {
		dev_warn(port->dev, "dmaengine_slave_config failed %d\n", ret);
		dma_release_channel(chan);
		return NULL;
	}

	return chan;
}

1455
static void sci_request_dma(struct uart_port *port)
1456
{
1457 1458
	struct sci_port *s = to_sci_port(port);
	struct dma_chan *chan;
1459

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

1462 1463
	if (!port->dev->of_node &&
	    (s->cfg->dma_slave_tx <= 0 || s->cfg->dma_slave_rx <= 0))
1464
		return;
1465

1466
	s->cookie_tx = -EINVAL;
1467
	chan = sci_request_dma_chan(port, DMA_MEM_TO_DEV, s->cfg->dma_slave_tx);
1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482 1483
	dev_dbg(port->dev, "%s: TX: got channel %p\n", __func__, chan);
	if (chan) {
		s->chan_tx = chan;
		/* UART circular tx buffer is an aligned page. */
		s->tx_dma_addr = dma_map_single(chan->device->dev,
						port->state->xmit.buf,
						UART_XMIT_SIZE,
						DMA_TO_DEVICE);
		if (dma_mapping_error(chan->device->dev, s->tx_dma_addr)) {
			dev_warn(port->dev, "Failed mapping Tx DMA descriptor\n");
			dma_release_channel(chan);
			s->chan_tx = NULL;
		} else {
			dev_dbg(port->dev, "%s: mapped %lu@%p to %pad\n",
				__func__, UART_XMIT_SIZE,
				port->state->xmit.buf, &s->tx_dma_addr);
1484
		}
1485 1486

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

1489
	chan = sci_request_dma_chan(port, DMA_DEV_TO_MEM, s->cfg->dma_slave_rx);
1490 1491 1492 1493 1494
	dev_dbg(port->dev, "%s: RX: got channel %p\n", __func__, chan);
	if (chan) {
		unsigned int i;
		dma_addr_t dma;
		void *buf;
1495

1496
		s->chan_rx = chan;
1497

1498 1499 1500 1501 1502 1503 1504 1505 1506 1507
		s->buf_len_rx = 2 * max_t(size_t, 16, port->fifosize);
		buf = dma_alloc_coherent(chan->device->dev, s->buf_len_rx * 2,
					 &dma, GFP_KERNEL);
		if (!buf) {
			dev_warn(port->dev,
				 "Failed to allocate Rx dma buffer, using PIO\n");
			dma_release_channel(chan);
			s->chan_rx = NULL;
			return;
		}
1508

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

1512 1513 1514
			sg_init_table(sg, 1);
			s->rx_buf[i] = buf;
			sg_dma_address(sg) = dma;
1515
			sg_dma_len(sg) = s->buf_len_rx;
1516

1517 1518 1519 1520 1521 1522
			buf += s->buf_len_rx;
			dma += s->buf_len_rx;
		}

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

1523 1524
		if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
			sci_submit_rx(s);
1525
	}
1526 1527
}

1528
static void sci_free_dma(struct uart_port *port)
1529
{
1530
	struct sci_port *s = to_sci_port(port);
1531

1532 1533 1534 1535 1536 1537 1538 1539 1540
	if (s->chan_tx)
		sci_tx_dma_release(s, false);
	if (s->chan_rx)
		sci_rx_dma_release(s, false);
}
#else
static inline void sci_request_dma(struct uart_port *port)
{
}
1541

1542 1543 1544 1545
static inline void sci_free_dma(struct uart_port *port)
{
}
#endif
1546

1547 1548 1549 1550 1551
static irqreturn_t sci_rx_interrupt(int irq, void *ptr)
{
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	struct uart_port *port = ptr;
	struct sci_port *s = to_sci_port(port);
1552

1553 1554 1555
	if (s->chan_rx) {
		u16 scr = serial_port_in(port, SCSCR);
		u16 ssr = serial_port_in(port, SCxSR);
1556

1557 1558 1559 1560 1561 1562
		/* Disable future Rx interrupts */
		if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
			disable_irq_nosync(irq);
			scr |= SCSCR_RDRQE;
		} else {
			scr &= ~SCSCR_RIE;
1563
			sci_submit_rx(s);
1564 1565 1566 1567 1568 1569 1570 1571
		}
		serial_port_out(port, SCSCR, scr);
		/* Clear current interrupt */
		serial_port_out(port, SCxSR,
				ssr & ~(SCIF_DR | SCxSR_RDxF(port)));
		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);
1572

1573 1574 1575
		return IRQ_HANDLED;
	}
#endif
1576

1577 1578 1579 1580 1581 1582 1583
	/* 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?
	 */
	sci_receive_chars(ptr);

	return IRQ_HANDLED;
1584 1585
}

1586
static irqreturn_t sci_tx_interrupt(int irq, void *ptr)
1587
{
1588
	struct uart_port *port = ptr;
1589
	unsigned long flags;
1590

1591
	spin_lock_irqsave(&port->lock, flags);
1592
	sci_transmit_chars(port);
1593
	spin_unlock_irqrestore(&port->lock, flags);
1594 1595

	return IRQ_HANDLED;
1596 1597
}

1598
static irqreturn_t sci_er_interrupt(int irq, void *ptr)
1599
{
1600 1601
	struct uart_port *port = ptr;
	struct sci_port *s = to_sci_port(port);
1602

1603 1604 1605 1606 1607 1608 1609 1610 1611 1612 1613 1614 1615 1616 1617 1618 1619 1620 1621 1622
	/* Handle errors */
	if (port->type == PORT_SCI) {
		if (sci_handle_errors(port)) {
			/* discard character in rx buffer */
			serial_port_in(port, SCxSR);
			sci_clear_SCxSR(port, SCxSR_RDxF_CLEAR(port));
		}
	} else {
		sci_handle_fifo_overrun(port);
		if (!s->chan_rx)
			sci_receive_chars(ptr);
	}

	sci_clear_SCxSR(port, SCxSR_ERROR_CLEAR(port));

	/* Kick the transmission */
	if (!s->chan_tx)
		sci_tx_interrupt(irq, ptr);

	return IRQ_HANDLED;
1623 1624
}

1625
static irqreturn_t sci_br_interrupt(int irq, void *ptr)
1626
{
1627
	struct uart_port *port = ptr;
1628

1629 1630 1631
	/* Handle BREAKs */
	sci_handle_breaks(port);
	sci_clear_SCxSR(port, SCxSR_BREAK_CLEAR(port));
1632

1633 1634
	return IRQ_HANDLED;
}
1635

1636 1637 1638 1639 1640 1641
static irqreturn_t sci_mpxed_interrupt(int irq, void *ptr)
{
	unsigned short ssr_status, scr_status, err_enabled, orer_status = 0;
	struct uart_port *port = ptr;
	struct sci_port *s = to_sci_port(port);
	irqreturn_t ret = IRQ_NONE;
1642

1643 1644 1645 1646 1647 1648 1649
	ssr_status = serial_port_in(port, SCxSR);
	scr_status = serial_port_in(port, SCSCR);
	if (s->overrun_reg == SCxSR)
		orer_status = ssr_status;
	else {
		if (sci_getreg(port, s->overrun_reg)->size)
			orer_status = serial_port_in(port, s->overrun_reg);
1650 1651
	}

1652
	err_enabled = scr_status & port_rx_irq_mask(port);
1653

1654 1655 1656 1657
	/* Tx Interrupt */
	if ((ssr_status & SCxSR_TDxE(port)) && (scr_status & SCSCR_TIE) &&
	    !s->chan_tx)
		ret = sci_tx_interrupt(irq, ptr);
1658

1659 1660 1661 1662 1663 1664 1665
	/*
	 * Rx Interrupt: if we're using DMA, the DMA controller clears RDF /
	 * DR flags
	 */
	if (((ssr_status & SCxSR_RDxF(port)) || s->chan_rx) &&
	    (scr_status & SCSCR_RIE))
		ret = sci_rx_interrupt(irq, ptr);
1666

1667 1668 1669
	/* Error Interrupt */
	if ((ssr_status & SCxSR_ERRORS(port)) && err_enabled)
		ret = sci_er_interrupt(irq, ptr);
1670

1671 1672 1673 1674 1675 1676 1677 1678
	/* Break Interrupt */
	if ((ssr_status & SCxSR_BRK(port)) && err_enabled)
		ret = sci_br_interrupt(irq, ptr);

	/* Overrun Interrupt */
	if (orer_status & s->overrun_mask) {
		sci_handle_fifo_overrun(port);
		ret = IRQ_HANDLED;
1679 1680
	}

1681 1682
	return ret;
}
1683

1684 1685 1686 1687 1688 1689 1690 1691 1692 1693 1694
static const 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,
	},
1695

1696 1697 1698 1699
	[SCIx_RXI_IRQ] = {
		.desc = "rx full",
		.handler = sci_rx_interrupt,
	},
1700

1701 1702 1703 1704
	[SCIx_TXI_IRQ] = {
		.desc = "tx empty",
		.handler = sci_tx_interrupt,
	},
1705

1706 1707 1708 1709
	[SCIx_BRI_IRQ] = {
		.desc = "break",
		.handler = sci_br_interrupt,
	},
1710 1711

	/*
1712
	 * Special muxed handler.
1713
	 */
1714 1715 1716 1717 1718
	[SCIx_MUX_IRQ] = {
		.desc = "mux",
		.handler = sci_mpxed_interrupt,
	},
};
1719

1720 1721 1722 1723
static int sci_request_irq(struct sci_port *port)
{
	struct uart_port *up = &port->port;
	int i, j, ret = 0;
1724

1725 1726 1727
	for (i = j = 0; i < SCIx_NR_IRQS; i++, j++) {
		const struct sci_irq_desc *desc;
		int irq;
1728

1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754
		if (SCIx_IRQ_IS_MUXED(port)) {
			i = SCIx_MUX_IRQ;
			irq = up->irq;
		} else {
			irq = port->irqs[i];

			/*
			 * Certain port types won't support all of the
			 * available interrupt sources.
			 */
			if (unlikely(irq < 0))
				continue;
		}

		desc = sci_irq_desc + i;
		port->irqstr[j] = kasprintf(GFP_KERNEL, "%s:%s",
					    dev_name(up->dev), desc->desc);
		if (!port->irqstr[j])
			goto out_nomem;

		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;
		}
1755 1756
	}

1757
	return 0;
L
Linus Torvalds 已提交
1758

1759 1760 1761
out_noirq:
	while (--i >= 0)
		free_irq(port->irqs[i], port);
P
Paul Mundt 已提交
1762

1763 1764 1765
out_nomem:
	while (--j >= 0)
		kfree(port->irqstr[j]);
P
Paul Mundt 已提交
1766

1767
	return ret;
L
Linus Torvalds 已提交
1768 1769
}

1770
static void sci_free_irq(struct sci_port *port)
L
Linus Torvalds 已提交
1771
{
1772
	int i;
L
Linus Torvalds 已提交
1773

1774 1775 1776 1777 1778 1779
	/*
	 * Intentionally in reverse order so we iterate over the muxed
	 * IRQ first.
	 */
	for (i = 0; i < SCIx_NR_IRQS; i++) {
		int irq = port->irqs[i];
P
Paul Mundt 已提交
1780

1781 1782 1783 1784 1785 1786
		/*
		 * Certain port types won't support all of the available
		 * interrupt sources.
		 */
		if (unlikely(irq < 0))
			continue;
P
Paul Mundt 已提交
1787

1788 1789
		free_irq(port->irqs[i], port);
		kfree(port->irqstr[i]);
P
Paul Mundt 已提交
1790

1791 1792 1793 1794 1795
		if (SCIx_IRQ_IS_MUXED(port)) {
			/* If there's only one IRQ, we're done. */
			return;
		}
	}
L
Linus Torvalds 已提交
1796 1797
}

1798
static unsigned int sci_tx_empty(struct uart_port *port)
L
Linus Torvalds 已提交
1799
{
1800 1801
	unsigned short status = serial_port_in(port, SCxSR);
	unsigned short in_tx_fifo = sci_txfill(port);
P
Paul Mundt 已提交
1802

1803
	return (status & SCxSR_TEND(port)) && !in_tx_fifo ? TIOCSER_TEMT : 0;
L
Linus Torvalds 已提交
1804 1805
}

1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818
/*
 * Modem control is a bit of a mixed bag for SCI(F) ports. Generally
 * CTS/RTS is supported in hardware by at least one port and controlled
 * via SCSPTR (SCxPCR for SCIFA/B parts), or external pins (presently
 * handled via the ->init_pins() op, which is a bit of a one-way street,
 * lacking any ability to defer pin control -- this will later be
 * converted over to the GPIO framework).
 *
 * Other modes (such as loopback) are supported generically on certain
 * port types, but not others. For these it's sufficient to test for the
 * existence of the support register and simply ignore the port type.
 */
static void sci_set_mctrl(struct uart_port *port, unsigned int mctrl)
L
Linus Torvalds 已提交
1819
{
1820 1821
	if (mctrl & TIOCM_LOOP) {
		const struct plat_sci_reg *reg;
P
Paul Mundt 已提交
1822

1823 1824 1825 1826 1827 1828 1829 1830 1831 1832
		/*
		 * Standard loopback mode for SCFCR ports.
		 */
		reg = sci_getreg(port, SCFCR);
		if (reg->size)
			serial_port_out(port, SCFCR,
					serial_port_in(port, SCFCR) |
					SCFCR_LOOP);
	}
}
P
Paul Mundt 已提交
1833

1834 1835 1836 1837
static unsigned int sci_get_mctrl(struct uart_port *port)
{
	/*
	 * CTS/RTS is handled in hardware when supported, while nothing
1838
	 * else is wired up. Keep it simple and simply assert CTS/DSR/CAR.
1839
	 */
1840
	return TIOCM_CTS | TIOCM_DSR | TIOCM_CAR;
L
Linus Torvalds 已提交
1841 1842 1843 1844
}

static void sci_break_ctl(struct uart_port *port, int break_state)
{
1845
	struct sci_port *s = to_sci_port(port);
1846
	const struct plat_sci_reg *reg = sci_regmap[s->cfg->regtype] + SCSPTR;
1847 1848
	unsigned short scscr, scsptr;

1849 1850
	/* check wheter the port has SCSPTR */
	if (!reg->size) {
1851 1852 1853 1854
		/*
		 * Not supported by hardware. Most parts couple break and rx
		 * interrupts together, with break detection always enabled.
		 */
1855
		return;
1856
	}
1857 1858 1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870

	scsptr = serial_port_in(port, SCSPTR);
	scscr = serial_port_in(port, SCSCR);

	if (break_state == -1) {
		scsptr = (scsptr | SCSPTR_SPB2IO) & ~SCSPTR_SPB2DT;
		scscr &= ~SCSCR_TE;
	} else {
		scsptr = (scsptr | SCSPTR_SPB2DT) & ~SCSPTR_SPB2IO;
		scscr |= SCSCR_TE;
	}

	serial_port_out(port, SCSPTR, scsptr);
	serial_port_out(port, SCSCR, scscr);
L
Linus Torvalds 已提交
1871 1872 1873 1874
}

static int sci_startup(struct uart_port *port)
{
1875
	struct sci_port *s = to_sci_port(port);
1876
	unsigned long flags;
1877
	int ret;
L
Linus Torvalds 已提交
1878

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

1881 1882 1883 1884
	ret = sci_request_irq(s);
	if (unlikely(ret < 0))
		return ret;

1885
	sci_request_dma(port);
1886

1887
	spin_lock_irqsave(&port->lock, flags);
1888
	sci_start_tx(port);
1889
	sci_start_rx(port);
1890
	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
1891 1892 1893 1894 1895 1896

	return 0;
}

static void sci_shutdown(struct uart_port *port)
{
1897
	struct sci_port *s = to_sci_port(port);
1898
	unsigned long flags;
L
Linus Torvalds 已提交
1899

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

1902
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
1903
	sci_stop_rx(port);
1904
	sci_stop_tx(port);
1905
	spin_unlock_irqrestore(&port->lock, flags);
1906

1907 1908 1909 1910 1911 1912 1913 1914
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	if (s->chan_rx) {
		dev_dbg(port->dev, "%s(%d) deleting rx_timer\n", __func__,
			port->line);
		del_timer_sync(&s->rx_timer);
	}
#endif

1915
	sci_free_dma(port);
L
Linus Torvalds 已提交
1916 1917 1918
	sci_free_irq(s);
}

1919 1920
static int sci_sck_calc(struct sci_port *s, unsigned int bps,
			unsigned int *srr)
1921
{
1922 1923
	unsigned long freq = s->clk_rates[SCI_SCK];
	int err, min_err = INT_MAX;
1924
	unsigned int sr;
1925

1926 1927
	if (s->port.type != PORT_HSCIF)
		freq *= 2;
1928

1929
	for_each_sr(sr, s) {
1930 1931 1932 1933 1934 1935
		err = DIV_ROUND_CLOSEST(freq, sr) - bps;
		if (abs(err) >= abs(min_err))
			continue;

		min_err = err;
		*srr = sr - 1;
1936

1937 1938 1939
		if (!err)
			break;
	}
1940

1941 1942 1943
	dev_dbg(s->port.dev, "SCK: %u%+d bps using SR %u\n", bps, min_err,
		*srr + 1);
	return min_err;
1944 1945
}

1946 1947 1948
static int sci_brg_calc(struct sci_port *s, unsigned int bps,
			unsigned long freq, unsigned int *dlr,
			unsigned int *srr)
1949
{
1950
	int err, min_err = INT_MAX;
1951
	unsigned int sr, dl;
1952

1953 1954
	if (s->port.type != PORT_HSCIF)
		freq *= 2;
1955

1956
	for_each_sr(sr, s) {
1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970
		dl = DIV_ROUND_CLOSEST(freq, sr * bps);
		dl = clamp(dl, 1U, 65535U);

		err = DIV_ROUND_CLOSEST(freq, sr * dl) - bps;
		if (abs(err) >= abs(min_err))
			continue;

		min_err = err;
		*dlr = dl;
		*srr = sr - 1;

		if (!err)
			break;
	}
1971

1972 1973 1974 1975
	dev_dbg(s->port.dev, "BRG: %u%+d bps using DL %u SR %u\n", bps,
		min_err, *dlr, *srr + 1);
	return min_err;
}
1976

1977
/* calculate sample rate, BRR, and clock select */
1978 1979 1980
static int sci_scbrr_calc(struct sci_port *s, unsigned int bps,
			  unsigned int *brr, unsigned int *srr,
			  unsigned int *cks)
U
Ulrich Hecht 已提交
1981
{
1982
	unsigned long freq = s->clk_rates[SCI_FCK];
1983
	unsigned int sr, br, prediv, scrate, c;
1984
	int err, min_err = INT_MAX;
U
Ulrich Hecht 已提交
1985

1986 1987
	if (s->port.type != PORT_HSCIF)
		freq *= 2;
1988

1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003
	/*
	 * Find the combination of sample rate and clock select with the
	 * smallest deviation from the desired baud rate.
	 * Prefer high sample rates to maximise the receive margin.
	 *
	 * M: Receive margin (%)
	 * N: Ratio of bit rate to clock (N = sampling rate)
	 * D: Clock duty (D = 0 to 1.0)
	 * L: Frame length (L = 9 to 12)
	 * F: Absolute value of clock frequency deviation
	 *
	 *  M = |(0.5 - 1 / 2 * N) - ((L - 0.5) * F) -
	 *      (|D - 0.5| / N * (1 + F))|
	 *  NOTE: Usually, treat D for 0.5, F is 0 by this calculation.
	 */
2004
	for_each_sr(sr, s) {
U
Ulrich Hecht 已提交
2005 2006
		for (c = 0; c <= 3; c++) {
			/* integerized formulas from HSCIF documentation */
2007
			prediv = sr * (1 << (2 * c + 1));
2008 2009 2010 2011 2012

			/*
			 * We need to calculate:
			 *
			 *     br = freq / (prediv * bps) clamped to [1..256]
2013
			 *     err = freq / (br * prediv) - bps
2014
			 *
2015 2016
			 * Watch out for overflow when calculating the desired
			 * sampling clock rate!
2017
			 */
2018 2019 2020 2021 2022
			if (bps > UINT_MAX / prediv)
				break;

			scrate = prediv * bps;
			br = DIV_ROUND_CLOSEST(freq, scrate);
2023
			br = clamp(br, 1U, 256U);
2024

2025
			err = DIV_ROUND_CLOSEST(freq, br * prediv) - bps;
2026
			if (abs(err) >= abs(min_err))
2027 2028
				continue;

2029
			min_err = err;
2030
			*brr = br - 1;
2031 2032
			*srr = sr - 1;
			*cks = c;
2033 2034 2035

			if (!err)
				goto found;
U
Ulrich Hecht 已提交
2036 2037 2038
		}
	}

2039
found:
2040 2041
	dev_dbg(s->port.dev, "BRR: %u%+d bps using N %u SR %u cks %u\n", bps,
		min_err, *brr, *srr + 1, *cks);
2042
	return min_err;
U
Ulrich Hecht 已提交
2043 2044
}

2045 2046
static void sci_reset(struct uart_port *port)
{
2047
	const struct plat_sci_reg *reg;
2048 2049 2050
	unsigned int status;

	do {
2051
		status = serial_port_in(port, SCxSR);
2052 2053
	} while (!(status & SCxSR_TEND(port)));

2054
	serial_port_out(port, SCSCR, 0x00);	/* TE=0, RE=0, CKE1=0 */
2055

2056 2057
	reg = sci_getreg(port, SCFCR);
	if (reg->size)
2058
		serial_port_out(port, SCFCR, SCFCR_RFRST | SCFCR_TFRST);
2059 2060
}

A
Alan Cox 已提交
2061 2062
static void sci_set_termios(struct uart_port *port, struct ktermios *termios,
			    struct ktermios *old)
L
Linus Torvalds 已提交
2063
{
2064
	unsigned int baud, smr_val = SCSMR_ASYNC, scr_val = 0, i;
2065 2066
	unsigned int brr = 255, cks = 0, srr = 15, dl = 0, sccks = 0;
	unsigned int brr1 = 255, cks1 = 0, srr1 = 15, dl1 = 0;
2067
	struct sci_port *s = to_sci_port(port);
2068
	const struct plat_sci_reg *reg;
2069 2070 2071
	int min_err = INT_MAX, err;
	unsigned long max_freq = 0;
	int best_clk = -1;
L
Linus Torvalds 已提交
2072

2073 2074 2075 2076 2077 2078 2079 2080 2081
	if ((termios->c_cflag & CSIZE) == CS7)
		smr_val |= SCSMR_CHR;
	if (termios->c_cflag & PARENB)
		smr_val |= SCSMR_PE;
	if (termios->c_cflag & PARODD)
		smr_val |= SCSMR_PE | SCSMR_ODD;
	if (termios->c_cflag & CSTOPB)
		smr_val |= SCSMR_STOP;

2082 2083 2084 2085 2086 2087 2088 2089
	/*
	 * 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.
	 */
2090 2091 2092 2093
	if (!port->uartclk) {
		baud = uart_get_baud_rate(port, termios, old, 0, 115200);
		goto done;
	}
L
Linus Torvalds 已提交
2094

2095 2096 2097
	for (i = 0; i < SCI_NUM_CLKS; i++)
		max_freq = max(max_freq, s->clk_rates[i]);

2098
	baud = uart_get_baud_rate(port, termios, old, 0, max_freq / min_sr(s));
2099 2100 2101 2102 2103 2104 2105 2106
	if (!baud)
		goto done;

	/*
	 * There can be multiple sources for the sampling clock.  Find the one
	 * that gives us the smallest deviation from the desired baud rate.
	 */

2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119 2120 2121
	/* Optional Undivided External Clock */
	if (s->clk_rates[SCI_SCK] && port->type != PORT_SCIFA &&
	    port->type != PORT_SCIFB) {
		err = sci_sck_calc(s, baud, &srr1);
		if (abs(err) < abs(min_err)) {
			best_clk = SCI_SCK;
			scr_val = SCSCR_CKE1;
			sccks = SCCKS_CKS;
			min_err = err;
			srr = srr1;
			if (!err)
				goto done;
		}
	}

2122 2123 2124 2125 2126 2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150
	/* Optional BRG Frequency Divided External Clock */
	if (s->clk_rates[SCI_SCIF_CLK] && sci_getreg(port, SCDL)->size) {
		err = sci_brg_calc(s, baud, s->clk_rates[SCI_SCIF_CLK], &dl1,
				   &srr1);
		if (abs(err) < abs(min_err)) {
			best_clk = SCI_SCIF_CLK;
			scr_val = SCSCR_CKE1;
			sccks = 0;
			min_err = err;
			dl = dl1;
			srr = srr1;
			if (!err)
				goto done;
		}
	}

	/* Optional BRG Frequency Divided Internal Clock */
	if (s->clk_rates[SCI_BRG_INT] && sci_getreg(port, SCDL)->size) {
		err = sci_brg_calc(s, baud, s->clk_rates[SCI_BRG_INT], &dl1,
				   &srr1);
		if (abs(err) < abs(min_err)) {
			best_clk = SCI_BRG_INT;
			scr_val = SCSCR_CKE1;
			sccks = SCCKS_XIN;
			min_err = err;
			dl = dl1;
			srr = srr1;
			if (!min_err)
				goto done;
U
Ulrich Hecht 已提交
2151 2152
		}
	}
2153

2154 2155 2156 2157
	/* Divided Functional Clock using standard Bit Rate Register */
	err = sci_scbrr_calc(s, baud, &brr1, &srr1, &cks1);
	if (abs(err) < abs(min_err)) {
		best_clk = SCI_FCK;
2158
		scr_val = 0;
2159 2160 2161 2162 2163 2164 2165 2166 2167 2168
		min_err = err;
		brr = brr1;
		srr = srr1;
		cks = cks1;
	}

done:
	if (best_clk >= 0)
		dev_dbg(port->dev, "Using clk %pC for %u%+d bps\n",
			s->clks[best_clk], baud, min_err);
2169

2170
	sci_port_enable(s);
2171

2172 2173 2174 2175
	/*
	 * Program the optional External Baud Rate Generator (BRG) first.
	 * It controls the mux to select (H)SCK or frequency divided clock.
	 */
2176 2177
	if (best_clk >= 0 && sci_getreg(port, SCCKS)->size) {
		serial_port_out(port, SCDL, dl);
2178
		serial_port_out(port, SCCKS, sccks);
2179
	}
L
Linus Torvalds 已提交
2180

2181
	sci_reset(port);
L
Linus Torvalds 已提交
2182 2183 2184

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

2185
	if (best_clk >= 0) {
2186 2187 2188 2189 2190 2191 2192 2193 2194 2195 2196
		if (port->type == PORT_SCIFA || port->type == PORT_SCIFB)
			switch (srr + 1) {
			case 5:  smr_val |= SCSMR_SRC_5;  break;
			case 7:  smr_val |= SCSMR_SRC_7;  break;
			case 11: smr_val |= SCSMR_SRC_11; break;
			case 13: smr_val |= SCSMR_SRC_13; break;
			case 16: smr_val |= SCSMR_SRC_16; break;
			case 17: smr_val |= SCSMR_SRC_17; break;
			case 19: smr_val |= SCSMR_SRC_19; break;
			case 27: smr_val |= SCSMR_SRC_27; break;
			}
2197
		smr_val |= cks;
2198
		dev_dbg(port->dev,
2199 2200
			 "SCR 0x%x SMR 0x%x BRR %u CKS 0x%x DL %u SRR %u\n",
			 scr_val, smr_val, brr, sccks, dl, srr);
2201
		serial_port_out(port, SCSCR, scr_val);
2202 2203 2204
		serial_port_out(port, SCSMR, smr_val);
		serial_port_out(port, SCBRR, brr);
		if (sci_getreg(port, HSSRR)->size)
U
Ulrich Hecht 已提交
2205
			serial_port_out(port, HSSRR, srr | HSCIF_SRE);
2206 2207 2208 2209 2210 2211

		/* Wait one bit interval */
		udelay((1000000 + (baud - 1)) / baud);
	} else {
		/* Don't touch the bit rate configuration */
		scr_val = s->cfg->scscr & (SCSCR_CKE1 | SCSCR_CKE0);
2212 2213
		smr_val |= serial_port_in(port, SCSMR) &
			   (SCSMR_CKEDG | SCSMR_SRC_MASK | SCSMR_CKS);
2214 2215
		dev_dbg(port->dev, "SCR 0x%x SMR 0x%x\n", scr_val, smr_val);
		serial_port_out(port, SCSCR, scr_val);
2216
		serial_port_out(port, SCSMR, smr_val);
2217
	}
L
Linus Torvalds 已提交
2218

2219
	sci_init_pins(port, termios->c_cflag);
2220

2221 2222
	reg = sci_getreg(port, SCFCR);
	if (reg->size) {
2223
		unsigned short ctrl = serial_port_in(port, SCFCR);
2224

2225
		if (s->cfg->capabilities & SCIx_HAVE_RTSCTS) {
2226 2227 2228 2229 2230
			if (termios->c_cflag & CRTSCTS)
				ctrl |= SCFCR_MCE;
			else
				ctrl &= ~SCFCR_MCE;
		}
2231 2232 2233 2234 2235 2236 2237 2238

		/*
		 * As we've done a sci_reset() above, ensure we don't
		 * interfere with the FIFOs while toggling MCE. As the
		 * reset values could still be set, simply mask them out.
		 */
		ctrl &= ~(SCFCR_RFRST | SCFCR_TFRST);

2239
		serial_port_out(port, SCFCR, ctrl);
2240
	}
2241

2242 2243 2244
	scr_val |= s->cfg->scscr & ~(SCSCR_CKE1 | SCSCR_CKE0);
	dev_dbg(port->dev, "SCSCR 0x%x\n", scr_val);
	serial_port_out(port, SCSCR, scr_val);
2245 2246 2247 2248 2249 2250 2251 2252 2253 2254
	if ((srr + 1 == 5) &&
	    (port->type == PORT_SCIFA || port->type == PORT_SCIFB)) {
		/*
		 * In asynchronous mode, when the sampling rate is 1/5, first
		 * received data may become invalid on some SCIFA and SCIFB.
		 * To avoid this problem wait more than 1 serial data time (1
		 * bit time x serial data number) after setting SCSCR.RE = 1.
		 */
		udelay(DIV_ROUND_UP(10 * 1000000, baud));
	}
L
Linus Torvalds 已提交
2255

2256 2257
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	/*
2258
	 * Calculate delay for 2 DMA buffers (4 FIFO).
2259 2260 2261 2262 2263 2264 2265
	 * See 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 5 jiffies (20ms) for 2 DMA
	 * buffers (4 FIFO sizes), but when performing a faster transfer, the
	 * value obtained by this formula is too small. Therefore, if the value
	 * is smaller than 20ms, use 20ms as the timeout value for DMA.
2266 2267
	 */
	if (s->chan_rx) {
2268 2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285 2286 2287 2288 2289 2290 2291
		unsigned int bits;

		/* byte size and parity */
		switch (termios->c_cflag & CSIZE) {
		case CS5:
			bits = 7;
			break;
		case CS6:
			bits = 8;
			break;
		case CS7:
			bits = 9;
			break;
		default:
			bits = 10;
			break;
		}

		if (termios->c_cflag & CSTOPB)
			bits++;
		if (termios->c_cflag & PARENB)
			bits++;
		s->rx_timeout = DIV_ROUND_UP((s->buf_len_rx * 2 * bits * HZ) /
					     (baud / 10), 10);
2292
		dev_dbg(port->dev, "DMA Rx t-out %ums, tty t-out %u jiffies\n",
2293 2294 2295 2296 2297 2298
			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 已提交
2299
	if ((termios->c_cflag & CREAD) != 0)
2300
		sci_start_rx(port);
2301

2302
	sci_port_disable(s);
L
Linus Torvalds 已提交
2303 2304
}

2305 2306 2307 2308 2309 2310
static void sci_pm(struct uart_port *port, unsigned int state,
		   unsigned int oldstate)
{
	struct sci_port *sci_port = to_sci_port(port);

	switch (state) {
2311
	case UART_PM_STATE_OFF:
2312 2313 2314 2315 2316 2317 2318 2319
		sci_port_disable(sci_port);
		break;
	default:
		sci_port_enable(sci_port);
		break;
	}
}

L
Linus Torvalds 已提交
2320 2321 2322
static const char *sci_type(struct uart_port *port)
{
	switch (port->type) {
2323 2324 2325 2326 2327 2328 2329 2330
	case PORT_IRDA:
		return "irda";
	case PORT_SCI:
		return "sci";
	case PORT_SCIF:
		return "scif";
	case PORT_SCIFA:
		return "scifa";
2331 2332
	case PORT_SCIFB:
		return "scifb";
U
Ulrich Hecht 已提交
2333 2334
	case PORT_HSCIF:
		return "hscif";
L
Linus Torvalds 已提交
2335 2336
	}

P
Paul Mundt 已提交
2337
	return NULL;
L
Linus Torvalds 已提交
2338 2339
}

2340 2341
static int sci_remap_port(struct uart_port *port)
{
2342
	struct sci_port *sport = to_sci_port(port);
2343 2344 2345 2346 2347 2348 2349 2350

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

	if (port->flags & UPF_IOREMAP) {
2351
		port->membase = ioremap_nocache(port->mapbase, sport->reg_size);
2352 2353 2354 2355 2356 2357 2358 2359 2360 2361
		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.
		 */
J
Jingoo Han 已提交
2362
		port->membase = (void __iomem *)(uintptr_t)port->mapbase;
2363 2364 2365 2366 2367
	}

	return 0;
}

2368
static void sci_release_port(struct uart_port *port)
L
Linus Torvalds 已提交
2369
{
2370 2371
	struct sci_port *sport = to_sci_port(port);

2372 2373 2374 2375 2376
	if (port->flags & UPF_IOREMAP) {
		iounmap(port->membase);
		port->membase = NULL;
	}

2377
	release_mem_region(port->mapbase, sport->reg_size);
L
Linus Torvalds 已提交
2378 2379
}

2380
static int sci_request_port(struct uart_port *port)
L
Linus Torvalds 已提交
2381
{
2382
	struct resource *res;
2383
	struct sci_port *sport = to_sci_port(port);
2384
	int ret;
L
Linus Torvalds 已提交
2385

2386 2387 2388 2389
	res = request_mem_region(port->mapbase, sport->reg_size,
				 dev_name(port->dev));
	if (unlikely(res == NULL)) {
		dev_err(port->dev, "request_mem_region failed.");
2390
		return -EBUSY;
2391
	}
L
Linus Torvalds 已提交
2392

2393 2394 2395 2396
	ret = sci_remap_port(port);
	if (unlikely(ret != 0)) {
		release_resource(res);
		return ret;
2397
	}
2398 2399 2400 2401 2402 2403 2404 2405 2406 2407 2408 2409

	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 已提交
2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427 2428 2429 2430 2431
}

static int sci_verify_port(struct uart_port *port, struct serial_struct *ser)
{
	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,
	.break_ctl	= sci_break_ctl,
	.startup	= sci_startup,
	.shutdown	= sci_shutdown,
	.set_termios	= sci_set_termios,
2432
	.pm		= sci_pm,
L
Linus Torvalds 已提交
2433 2434 2435 2436 2437
	.type		= sci_type,
	.release_port	= sci_release_port,
	.request_port	= sci_request_port,
	.config_port	= sci_config_port,
	.verify_port	= sci_verify_port,
2438 2439 2440 2441
#ifdef CONFIG_CONSOLE_POLL
	.poll_get_char	= sci_poll_get_char,
	.poll_put_char	= sci_poll_put_char,
#endif
L
Linus Torvalds 已提交
2442 2443
};

2444 2445
static int sci_init_clocks(struct sci_port *sci_port, struct device *dev)
{
2446 2447
	const char *clk_names[] = {
		[SCI_FCK] = "fck",
2448
		[SCI_SCK] = "sck",
2449 2450
		[SCI_BRG_INT] = "brg_int",
		[SCI_SCIF_CLK] = "scif_clk",
2451 2452 2453
	};
	struct clk *clk;
	unsigned int i;
2454

2455 2456 2457
	if (sci_port->cfg->type == PORT_HSCIF)
		clk_names[SCI_SCK] = "hsck";

2458 2459 2460 2461
	for (i = 0; i < SCI_NUM_CLKS; i++) {
		clk = devm_clk_get(dev, clk_names[i]);
		if (PTR_ERR(clk) == -EPROBE_DEFER)
			return -EPROBE_DEFER;
2462

2463 2464 2465 2466 2467 2468 2469 2470
		if (IS_ERR(clk) && i == SCI_FCK) {
			/*
			 * "fck" used to be called "sci_ick", and we need to
			 * maintain DT backward compatibility.
			 */
			clk = devm_clk_get(dev, "sci_ick");
			if (PTR_ERR(clk) == -EPROBE_DEFER)
				return -EPROBE_DEFER;
2471

2472 2473
			if (!IS_ERR(clk))
				goto found;
2474

2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498
			/*
			 * Not all SH platforms declare a clock lookup entry
			 * for SCI devices, in which case we need to get the
			 * global "peripheral_clk" clock.
			 */
			clk = devm_clk_get(dev, "peripheral_clk");
			if (!IS_ERR(clk))
				goto found;

			dev_err(dev, "failed to get %s (%ld)\n", clk_names[i],
				PTR_ERR(clk));
			return PTR_ERR(clk);
		}

found:
		if (IS_ERR(clk))
			dev_dbg(dev, "failed to get %s (%ld)\n", clk_names[i],
				PTR_ERR(clk));
		else
			dev_dbg(dev, "clk %s is %pC rate %pCr\n", clk_names[i],
				clk, clk);
		sci_port->clks[i] = IS_ERR(clk) ? NULL : clk;
	}
	return 0;
2499 2500
}

B
Bill Pemberton 已提交
2501
static int sci_init_single(struct platform_device *dev,
2502 2503
			   struct sci_port *sci_port, unsigned int index,
			   struct plat_sci_port *p, bool early)
2504
{
2505
	struct uart_port *port = &sci_port->port;
2506 2507
	const struct resource *res;
	unsigned int i;
2508
	int ret;
2509

2510 2511
	sci_port->cfg	= p;

2512 2513 2514
	port->ops	= &sci_uart_ops;
	port->iotype	= UPIO_MEM;
	port->line	= index;
2515

2516 2517 2518
	res = platform_get_resource(dev, IORESOURCE_MEM, 0);
	if (res == NULL)
		return -ENOMEM;
2519

2520
	port->mapbase = res->start;
2521
	sci_port->reg_size = resource_size(res);
2522

2523 2524
	for (i = 0; i < ARRAY_SIZE(sci_port->irqs); ++i)
		sci_port->irqs[i] = platform_get_irq(dev, i);
2525

2526 2527 2528 2529 2530 2531 2532
	/* The SCI generates several interrupts. They can be muxed together or
	 * connected to different interrupt lines. In the muxed case only one
	 * interrupt resource is specified. In the non-muxed case three or four
	 * interrupt resources are specified, as the BRI interrupt is optional.
	 */
	if (sci_port->irqs[0] < 0)
		return -ENXIO;
2533

2534 2535 2536 2537
	if (sci_port->irqs[1] < 0) {
		sci_port->irqs[1] = sci_port->irqs[0];
		sci_port->irqs[2] = sci_port->irqs[0];
		sci_port->irqs[3] = sci_port->irqs[0];
2538 2539
	}

2540 2541 2542 2543 2544 2545
	if (p->regtype == SCIx_PROBE_REGTYPE) {
		ret = sci_probe_regmap(p);
		if (unlikely(ret))
			return ret;
	}

2546
	switch (p->type) {
2547 2548
	case PORT_SCIFB:
		port->fifosize = 256;
2549
		sci_port->overrun_reg = SCxSR;
2550
		sci_port->overrun_mask = SCIFA_ORER;
2551
		sci_port->sampling_rate_mask = SCI_SR_SCIFAB;
2552
		break;
U
Ulrich Hecht 已提交
2553 2554
	case PORT_HSCIF:
		port->fifosize = 128;
2555
		sci_port->overrun_reg = SCLSR;
2556
		sci_port->overrun_mask = SCLSR_ORER;
2557
		sci_port->sampling_rate_mask = SCI_SR_RANGE(8, 32);
U
Ulrich Hecht 已提交
2558
		break;
2559
	case PORT_SCIFA:
2560
		port->fifosize = 64;
2561
		sci_port->overrun_reg = SCxSR;
2562
		sci_port->overrun_mask = SCIFA_ORER;
2563
		sci_port->sampling_rate_mask = SCI_SR_SCIFAB;
2564 2565
		break;
	case PORT_SCIF:
2566
		port->fifosize = 16;
2567
		if (p->regtype == SCIx_SH7705_SCIF_REGTYPE) {
2568
			sci_port->overrun_reg = SCxSR;
2569
			sci_port->overrun_mask = SCIFA_ORER;
2570
			sci_port->sampling_rate_mask = SCI_SR(16);
2571
		} else {
2572
			sci_port->overrun_reg = SCLSR;
2573
			sci_port->overrun_mask = SCLSR_ORER;
2574
			sci_port->sampling_rate_mask = SCI_SR(32);
2575
		}
2576 2577
		break;
	default:
2578
		port->fifosize = 1;
2579
		sci_port->overrun_reg = SCxSR;
2580
		sci_port->overrun_mask = SCI_ORER;
2581
		sci_port->sampling_rate_mask = SCI_SR(32);
2582 2583
		break;
	}
2584

2585 2586 2587
	/* SCIFA on sh7723 and sh7724 need a custom sampling rate that doesn't
	 * match the SoC datasheet, this should be investigated. Let platform
	 * data override the sampling rate for now.
2588
	 */
2589
	if (p->sampling_rate)
2590
		sci_port->sampling_rate_mask = SCI_SR(p->sampling_rate);
2591

2592
	if (!early) {
2593 2594 2595
		ret = sci_init_clocks(sci_port, &dev->dev);
		if (ret < 0)
			return ret;
2596

2597
		port->dev = &dev->dev;
M
Magnus Damm 已提交
2598 2599

		pm_runtime_enable(&dev->dev);
2600
	}
2601

M
Magnus Damm 已提交
2602 2603 2604 2605
	sci_port->break_timer.data = (unsigned long)sci_port;
	sci_port->break_timer.function = sci_break_timer;
	init_timer(&sci_port->break_timer);

2606 2607 2608
	/*
	 * Establish some sensible defaults for the error detection.
	 */
2609 2610 2611 2612 2613 2614 2615
	if (p->type == PORT_SCI) {
		sci_port->error_mask = SCI_DEFAULT_ERROR_MASK;
		sci_port->error_clear = SCI_ERROR_CLEAR;
	} else {
		sci_port->error_mask = SCIF_DEFAULT_ERROR_MASK;
		sci_port->error_clear = SCIF_ERROR_CLEAR;
	}
2616

2617 2618 2619 2620
	/*
	 * Make the error mask inclusive of overrun detection, if
	 * supported.
	 */
2621
	if (sci_port->overrun_reg == SCxSR) {
2622
		sci_port->error_mask |= sci_port->overrun_mask;
2623 2624
		sci_port->error_clear &= ~sci_port->overrun_mask;
	}
2625

2626
	port->type		= p->type;
2627
	port->flags		= UPF_FIXED_PORT | p->flags;
2628
	port->regshift		= p->regshift;
2629

2630
	/*
2631
	 * The UART port needs an IRQ value, so we peg this to the RX IRQ
2632 2633 2634 2635 2636
	 * 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.
	 */
2637
	port->irq		= sci_port->irqs[SCIx_RXI_IRQ];
Y
Yong Zhang 已提交
2638
	port->irqflags		= 0;
2639

2640 2641 2642
	port->serial_in		= sci_serial_in;
	port->serial_out	= sci_serial_out;

2643 2644 2645
	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 已提交
2646

2647
	return 0;
2648 2649
}

2650 2651 2652 2653 2654
static void sci_cleanup_single(struct sci_port *port)
{
	pm_runtime_disable(port->port.dev);
}

2655 2656
#if defined(CONFIG_SERIAL_SH_SCI_CONSOLE) || \
    defined(CONFIG_SERIAL_SH_SCI_EARLYCON)
2657 2658 2659 2660 2661
static void serial_console_putchar(struct uart_port *port, int ch)
{
	sci_poll_put_char(port, ch);
}

L
Linus Torvalds 已提交
2662 2663 2664 2665 2666 2667 2668
/*
 *	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)
{
2669 2670
	struct sci_port *sci_port = &sci_ports[co->index];
	struct uart_port *port = &sci_port->port;
2671
	unsigned short bits, ctrl, ctrl_temp;
2672 2673 2674 2675
	unsigned long flags;
	int locked = 1;

	local_irq_save(flags);
2676
#if defined(SUPPORT_SYSRQ)
2677 2678
	if (port->sysrq)
		locked = 0;
2679 2680 2681
	else
#endif
	if (oops_in_progress)
2682 2683 2684 2685
		locked = spin_trylock(&port->lock);
	else
		spin_lock(&port->lock);

2686
	/* first save SCSCR then disable interrupts, keep clock source */
2687
	ctrl = serial_port_in(port, SCSCR);
2688 2689 2690
	ctrl_temp = (sci_port->cfg->scscr & ~(SCSCR_CKE1 | SCSCR_CKE0)) |
		    (ctrl & (SCSCR_CKE1 | SCSCR_CKE0));
	serial_port_out(port, SCSCR, ctrl_temp);
2691

2692
	uart_console_write(port, s, count, serial_console_putchar);
M
Magnus Damm 已提交
2693 2694 2695

	/* wait until fifo is empty and last bit has been transmitted */
	bits = SCxSR_TDxE(port) | SCxSR_TEND(port);
2696
	while ((serial_port_in(port, SCxSR) & bits) != bits)
M
Magnus Damm 已提交
2697
		cpu_relax();
2698 2699 2700 2701 2702 2703 2704

	/* restore the SCSCR */
	serial_port_out(port, SCSCR, ctrl);

	if (locked)
		spin_unlock(&port->lock);
	local_irq_restore(flags);
L
Linus Torvalds 已提交
2705 2706
}

B
Bill Pemberton 已提交
2707
static int serial_console_setup(struct console *co, char *options)
L
Linus Torvalds 已提交
2708
{
2709
	struct sci_port *sci_port;
L
Linus Torvalds 已提交
2710 2711 2712 2713 2714 2715 2716
	struct uart_port *port;
	int baud = 115200;
	int bits = 8;
	int parity = 'n';
	int flow = 'n';
	int ret;

2717
	/*
2718
	 * Refuse to handle any bogus ports.
L
Linus Torvalds 已提交
2719
	 */
2720
	if (co->index < 0 || co->index >= SCI_NPORTS)
2721 2722
		return -ENODEV;

2723 2724 2725
	sci_port = &sci_ports[co->index];
	port = &sci_port->port;

2726 2727 2728 2729 2730 2731
	/*
	 * Refuse to handle uninitialized ports.
	 */
	if (!port->ops)
		return -ENODEV;

2732 2733 2734
	ret = sci_remap_port(port);
	if (unlikely(ret != 0))
		return ret;
2735

L
Linus Torvalds 已提交
2736 2737 2738
	if (options)
		uart_parse_options(options, &baud, &parity, &bits, &flow);

2739
	return uart_set_options(port, co, baud, parity, bits, flow);
L
Linus Torvalds 已提交
2740 2741 2742 2743
}

static struct console serial_console = {
	.name		= "ttySC",
2744
	.device		= uart_console_device,
L
Linus Torvalds 已提交
2745 2746
	.write		= serial_console_write,
	.setup		= serial_console_setup,
P
Paul Mundt 已提交
2747
	.flags		= CON_PRINTBUFFER,
L
Linus Torvalds 已提交
2748
	.index		= -1,
2749
	.data		= &sci_uart_driver,
L
Linus Torvalds 已提交
2750 2751
};

2752 2753 2754 2755
static struct console early_serial_console = {
	.name           = "early_ttySC",
	.write          = serial_console_write,
	.flags          = CON_PRINTBUFFER,
2756
	.index		= -1,
2757
};
2758

2759 2760
static char early_serial_buf[32];

B
Bill Pemberton 已提交
2761
static int sci_probe_earlyprintk(struct platform_device *pdev)
2762
{
J
Jingoo Han 已提交
2763
	struct plat_sci_port *cfg = dev_get_platdata(&pdev->dev);
2764 2765 2766 2767 2768 2769

	if (early_serial_console.data)
		return -EEXIST;

	early_serial_console.index = pdev->id;

2770
	sci_init_single(pdev, &sci_ports[pdev->id], pdev->id, cfg, true);
2771 2772 2773 2774 2775 2776 2777 2778 2779

	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;
}
2780 2781 2782

#define SCI_CONSOLE	(&serial_console)

2783
#else
B
Bill Pemberton 已提交
2784
static inline int sci_probe_earlyprintk(struct platform_device *pdev)
2785 2786 2787
{
	return -EINVAL;
}
L
Linus Torvalds 已提交
2788

2789 2790
#define SCI_CONSOLE	NULL

2791
#endif /* CONFIG_SERIAL_SH_SCI_CONSOLE || CONFIG_SERIAL_SH_SCI_EARLYCON */
L
Linus Torvalds 已提交
2792

2793
static const char banner[] __initconst = "SuperH (H)SCI(F) driver initialized";
L
Linus Torvalds 已提交
2794 2795 2796 2797 2798 2799 2800

static struct uart_driver sci_uart_driver = {
	.owner		= THIS_MODULE,
	.driver_name	= "sci",
	.dev_name	= "ttySC",
	.major		= SCI_MAJOR,
	.minor		= SCI_MINOR_START,
2801
	.nr		= SCI_NPORTS,
L
Linus Torvalds 已提交
2802 2803 2804
	.cons		= SCI_CONSOLE,
};

2805
static int sci_remove(struct platform_device *dev)
2806
{
2807
	struct sci_port *port = platform_get_drvdata(dev);
2808

2809 2810
	uart_remove_one_port(&sci_uart_driver, &port->port);

2811
	sci_cleanup_single(port);
2812 2813 2814 2815

	return 0;
}

2816 2817 2818 2819

#define SCI_OF_DATA(type, regtype)	(void *)((type) << 16 | (regtype))
#define SCI_OF_TYPE(data)		((unsigned long)(data) >> 16)
#define SCI_OF_REGTYPE(data)		((unsigned long)(data) & 0xffff)
B
Bastian Hecht 已提交
2820 2821

static const struct of_device_id of_sci_match[] = {
2822 2823 2824 2825 2826
	/* SoC-specific types */
	{
		.compatible = "renesas,scif-r7s72100",
		.data = SCI_OF_DATA(PORT_SCIF, SCIx_SH2_SCIF_FIFODATA_REGTYPE),
	},
2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837
	/* Family-specific types */
	{
		.compatible = "renesas,rcar-gen1-scif",
		.data = SCI_OF_DATA(PORT_SCIF, SCIx_SH4_SCIF_BRG_REGTYPE),
	}, {
		.compatible = "renesas,rcar-gen2-scif",
		.data = SCI_OF_DATA(PORT_SCIF, SCIx_SH4_SCIF_BRG_REGTYPE),
	}, {
		.compatible = "renesas,rcar-gen3-scif",
		.data = SCI_OF_DATA(PORT_SCIF, SCIx_SH4_SCIF_BRG_REGTYPE),
	},
2838
	/* Generic types */
B
Bastian Hecht 已提交
2839 2840
	{
		.compatible = "renesas,scif",
2841
		.data = SCI_OF_DATA(PORT_SCIF, SCIx_SH4_SCIF_REGTYPE),
B
Bastian Hecht 已提交
2842 2843
	}, {
		.compatible = "renesas,scifa",
2844
		.data = SCI_OF_DATA(PORT_SCIFA, SCIx_SCIFA_REGTYPE),
B
Bastian Hecht 已提交
2845 2846
	}, {
		.compatible = "renesas,scifb",
2847
		.data = SCI_OF_DATA(PORT_SCIFB, SCIx_SCIFB_REGTYPE),
B
Bastian Hecht 已提交
2848 2849
	}, {
		.compatible = "renesas,hscif",
2850
		.data = SCI_OF_DATA(PORT_HSCIF, SCIx_HSCIF_REGTYPE),
Y
Yoshinori Sato 已提交
2851 2852
	}, {
		.compatible = "renesas,sci",
2853
		.data = SCI_OF_DATA(PORT_SCI, SCIx_SCI_REGTYPE),
B
Bastian Hecht 已提交
2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870
	}, {
		/* Terminator */
	},
};
MODULE_DEVICE_TABLE(of, of_sci_match);

static struct plat_sci_port *
sci_parse_dt(struct platform_device *pdev, unsigned int *dev_id)
{
	struct device_node *np = pdev->dev.of_node;
	const struct of_device_id *match;
	struct plat_sci_port *p;
	int id;

	if (!IS_ENABLED(CONFIG_OF) || !np)
		return NULL;

2871
	match = of_match_node(of_sci_match, np);
B
Bastian Hecht 已提交
2872 2873 2874 2875
	if (!match)
		return NULL;

	p = devm_kzalloc(&pdev->dev, sizeof(struct plat_sci_port), GFP_KERNEL);
2876
	if (!p)
B
Bastian Hecht 已提交
2877 2878
		return NULL;

2879
	/* Get the line number from the aliases node. */
B
Bastian Hecht 已提交
2880 2881 2882 2883 2884 2885 2886 2887 2888
	id = of_alias_get_id(np, "serial");
	if (id < 0) {
		dev_err(&pdev->dev, "failed to get alias id (%d)\n", id);
		return NULL;
	}

	*dev_id = id;

	p->flags = UPF_IOREMAP | UPF_BOOT_AUTOCONF;
2889 2890
	p->type = SCI_OF_TYPE(match->data);
	p->regtype = SCI_OF_REGTYPE(match->data);
B
Bastian Hecht 已提交
2891 2892 2893 2894 2895
	p->scscr = SCSCR_RE | SCSCR_TE;

	return p;
}

B
Bill Pemberton 已提交
2896
static int sci_probe_single(struct platform_device *dev,
2897 2898 2899 2900 2901 2902 2903 2904
				      unsigned int index,
				      struct plat_sci_port *p,
				      struct sci_port *sciport)
{
	int ret;

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

2911
	ret = sci_init_single(dev, sciport, index, p, false);
2912 2913
	if (ret)
		return ret;
2914

2915 2916 2917 2918 2919 2920 2921
	ret = uart_add_one_port(&sci_uart_driver, &sciport->port);
	if (ret) {
		sci_cleanup_single(sciport);
		return ret;
	}

	return 0;
2922 2923
}

B
Bill Pemberton 已提交
2924
static int sci_probe(struct platform_device *dev)
L
Linus Torvalds 已提交
2925
{
B
Bastian Hecht 已提交
2926 2927 2928
	struct plat_sci_port *p;
	struct sci_port *sp;
	unsigned int dev_id;
2929
	int ret;
2930

2931 2932 2933 2934 2935 2936 2937
	/*
	 * 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);
2938

B
Bastian Hecht 已提交
2939 2940 2941 2942 2943 2944 2945 2946 2947 2948 2949 2950 2951 2952 2953
	if (dev->dev.of_node) {
		p = sci_parse_dt(dev, &dev_id);
		if (p == NULL)
			return -EINVAL;
	} else {
		p = dev->dev.platform_data;
		if (p == NULL) {
			dev_err(&dev->dev, "no platform data supplied\n");
			return -EINVAL;
		}

		dev_id = dev->id;
	}

	sp = &sci_ports[dev_id];
2954
	platform_set_drvdata(dev, sp);
2955

B
Bastian Hecht 已提交
2956
	ret = sci_probe_single(dev, dev_id, p, sp);
2957
	if (ret)
2958
		return ret;
2959

L
Linus Torvalds 已提交
2960 2961 2962 2963
#ifdef CONFIG_SH_STANDARD_BIOS
	sh_bios_gdb_detach();
#endif

2964
	return 0;
L
Linus Torvalds 已提交
2965 2966
}

S
Sergei Shtylyov 已提交
2967
static __maybe_unused int sci_suspend(struct device *dev)
L
Linus Torvalds 已提交
2968
{
2969
	struct sci_port *sport = dev_get_drvdata(dev);
2970

2971 2972
	if (sport)
		uart_suspend_port(&sci_uart_driver, &sport->port);
L
Linus Torvalds 已提交
2973

2974 2975
	return 0;
}
L
Linus Torvalds 已提交
2976

S
Sergei Shtylyov 已提交
2977
static __maybe_unused int sci_resume(struct device *dev)
2978
{
2979
	struct sci_port *sport = dev_get_drvdata(dev);
2980

2981 2982
	if (sport)
		uart_resume_port(&sci_uart_driver, &sport->port);
2983 2984 2985 2986

	return 0;
}

S
Sergei Shtylyov 已提交
2987
static SIMPLE_DEV_PM_OPS(sci_dev_pm_ops, sci_suspend, sci_resume);
2988

2989 2990
static struct platform_driver sci_driver = {
	.probe		= sci_probe,
2991
	.remove		= sci_remove,
2992 2993
	.driver		= {
		.name	= "sh-sci",
2994
		.pm	= &sci_dev_pm_ops,
B
Bastian Hecht 已提交
2995
		.of_match_table = of_match_ptr(of_sci_match),
2996 2997 2998 2999 3000 3001 3002
	},
};

static int __init sci_init(void)
{
	int ret;

3003
	pr_info("%s\n", banner);
3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017

	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 已提交
3018 3019 3020
	uart_unregister_driver(&sci_uart_driver);
}

3021 3022 3023 3024
#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
early_platform_init_buffer("earlyprintk", &sci_driver,
			   early_serial_buf, ARRAY_SIZE(early_serial_buf));
#endif
3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038 3039 3040 3041 3042 3043 3044 3045 3046 3047 3048 3049 3050 3051 3052 3053 3054 3055 3056 3057 3058 3059 3060 3061 3062 3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 3080
#ifdef CONFIG_SERIAL_SH_SCI_EARLYCON
static struct __init plat_sci_port port_cfg;

static int __init early_console_setup(struct earlycon_device *device,
				      int type)
{
	if (!device->port.membase)
		return -ENODEV;

	device->port.serial_in = sci_serial_in;
	device->port.serial_out	= sci_serial_out;
	device->port.type = type;
	memcpy(&sci_ports[0].port, &device->port, sizeof(struct uart_port));
	sci_ports[0].cfg = &port_cfg;
	sci_ports[0].cfg->type = type;
	sci_probe_regmap(sci_ports[0].cfg);
	port_cfg.scscr = sci_serial_in(&sci_ports[0].port, SCSCR) |
			 SCSCR_RE | SCSCR_TE;
	sci_serial_out(&sci_ports[0].port, SCSCR, port_cfg.scscr);

	device->con->write = serial_console_write;
	return 0;
}
static int __init sci_early_console_setup(struct earlycon_device *device,
					  const char *opt)
{
	return early_console_setup(device, PORT_SCI);
}
static int __init scif_early_console_setup(struct earlycon_device *device,
					  const char *opt)
{
	return early_console_setup(device, PORT_SCIF);
}
static int __init scifa_early_console_setup(struct earlycon_device *device,
					  const char *opt)
{
	return early_console_setup(device, PORT_SCIFA);
}
static int __init scifb_early_console_setup(struct earlycon_device *device,
					  const char *opt)
{
	return early_console_setup(device, PORT_SCIFB);
}
static int __init hscif_early_console_setup(struct earlycon_device *device,
					  const char *opt)
{
	return early_console_setup(device, PORT_HSCIF);
}

OF_EARLYCON_DECLARE(sci, "renesas,sci", sci_early_console_setup);
OF_EARLYCON_DECLARE(scif, "renesas,scif", scif_early_console_setup);
OF_EARLYCON_DECLARE(scifa, "renesas,scifa", scifa_early_console_setup);
OF_EARLYCON_DECLARE(scifb, "renesas,scifb", scifb_early_console_setup);
OF_EARLYCON_DECLARE(hscif, "renesas,hscif", hscif_early_console_setup);
#endif /* CONFIG_SERIAL_SH_SCI_EARLYCON */

L
Linus Torvalds 已提交
3081 3082 3083
module_init(sci_init);
module_exit(sci_exit);

3084
MODULE_LICENSE("GPL");
3085
MODULE_ALIAS("platform:sh-sci");
3086
MODULE_AUTHOR("Paul Mundt");
U
Ulrich Hecht 已提交
3087
MODULE_DESCRIPTION("SuperH (H)SCI(F) serial driver");