sh-sci.c 77.7 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
#include <asm/sh_bios.h>
#endif

60
#include "serial_mctrl_gpio.h"
L
Linus Torvalds 已提交
61 62
#include "sh-sci.h"

63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79
/* 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))

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

88 89 90 91
/* 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)

92 93 94 95
#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)

96 97 98 99 100 101 102 103
#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)))

104 105 106
struct sci_port {
	struct uart_port	port;

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

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

121 122 123
	/* Clocks */
	struct clk		*clks[SCI_NUM_CLKS];
	unsigned long		clk_rates[SCI_NUM_CLKS];
124

125
	int			irqs[SCIx_NR_IRQS];
126 127
	char			*irqstr[SCIx_NR_IRQS];

128 129
	struct dma_chan			*chan_tx;
	struct dma_chan			*chan_rx;
P
Paul Mundt 已提交
130

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

	bool autorts;
146 147 148
};

#define SCI_NPORTS CONFIG_SERIAL_SH_SCI_NR_UARTS
149

150 151
static struct sci_port sci_ports[SCI_NPORTS];
static struct uart_driver sci_uart_driver;
L
Linus Torvalds 已提交
152

153 154 155 156 157 158
static inline struct sci_port *
to_sci_port(struct uart_port *uart)
{
	return container_of(uart, struct sci_port, port);
}

159 160 161 162 163 164 165
struct plat_sci_reg {
	u8 offset, size;
};

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

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

	/*
	 * 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 已提交
212
		[HSSRR]		= sci_reg_invalid,
213 214
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
215 216
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234
	},

	/*
	 * 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 已提交
235
		[HSSRR]		= sci_reg_invalid,
236 237
		[SCPCR]		= { 0x30, 16 },
		[SCPDR]		= { 0x34, 16 },
238 239
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
240 241 242 243 244 245 246 247 248 249 250 251 252
	},

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

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

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

	/*
	 * 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 已提交
328
		[HSSRR]		= sci_reg_invalid,
329 330
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356
		[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 已提交
357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375
	},

	/*
	 * 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 },
376 377
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
378 379
		[SCDL]		= { 0x30, 16 },
		[SCCKS]		= { 0x34, 16 },
380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398
	},

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

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

	/*
	 * 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 已提交
447
		[HSSRR]		= sci_reg_invalid,
448 449
		[SCPCR]		= sci_reg_invalid,
		[SCPDR]		= sci_reg_invalid,
450 451
		[SCDL]		= sci_reg_invalid,
		[SCCKS]		= sci_reg_invalid,
452 453 454
	},
};

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

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

	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)
{
479
	const struct plat_sci_reg *reg = sci_getreg(p, offset);
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 509 510 511 512

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

	return 0;
}

524 525
static void sci_port_enable(struct sci_port *sci_port)
{
526 527
	unsigned int i;

528 529 530 531 532
	if (!sci_port->port.dev)
		return;

	pm_runtime_get_sync(sci_port->port.dev);

533 534 535 536 537
	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];
538 539 540 541
}

static void sci_port_disable(struct sci_port *sci_port)
{
542 543
	unsigned int i;

544 545 546
	if (!sci_port->port.dev)
		return;

547 548 549 550 551 552 553 554
	/* 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;

555 556
	for (i = SCI_NUM_CLKS; i-- > 0; )
		clk_disable_unprepare(sci_port->clks[i]);
557 558 559 560

	pm_runtime_put_sync(sci_port->port.dev);
}

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 640 641 642 643
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);
}

644 645 646 647 648 649 650 651 652 653 654 655 656 657 658 659
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));
	}
}

660 661
#if defined(CONFIG_CONSOLE_POLL) || defined(CONFIG_SERIAL_SH_SCI_CONSOLE) || \
    defined(CONFIG_SERIAL_SH_SCI_EARLYCON)
662 663

#ifdef CONFIG_CONSOLE_POLL
664
static int sci_poll_get_char(struct uart_port *port)
L
Linus Torvalds 已提交
665 666 667 668
{
	unsigned short status;
	int c;

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

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

681
	c = serial_port_in(port, SCxRDR);
682

683
	/* Dummy read */
684
	serial_port_in(port, SCxSR);
685
	sci_clear_SCxSR(port, SCxSR_RDxF_CLEAR(port));
L
Linus Torvalds 已提交
686 687 688

	return c;
}
689
#endif
L
Linus Torvalds 已提交
690

691
static void sci_poll_put_char(struct uart_port *port, unsigned char c)
L
Linus Torvalds 已提交
692 693 694 695
{
	unsigned short status;

	do {
696
		status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
697 698
	} while (!(status & SCxSR_TDxE(port)));

699
	serial_port_out(port, SCxTDR, c);
700
	sci_clear_SCxSR(port, SCxSR_TDxE_CLEAR(port) & ~SCxSR_TEND(port));
L
Linus Torvalds 已提交
701
}
702 703
#endif /* CONFIG_CONSOLE_POLL || CONFIG_SERIAL_SH_SCI_CONSOLE ||
	  CONFIG_SERIAL_SH_SCI_EARLYCON */
L
Linus Torvalds 已提交
704

705
static void sci_init_pins(struct uart_port *port, unsigned int cflag)
L
Linus Torvalds 已提交
706
{
707
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
708

709 710 711 712 713 714
	/*
	 * 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 已提交
715
	}
P
Paul Mundt 已提交
716

717 718 719 720 721 722 723 724 725 726 727 728 729 730 731
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
		u16 ctrl = serial_port_in(port, SCPCR);

		/* Enable RXD and TXD pin functions */
		ctrl &= ~(SCPCR_RXDC | SCPCR_TXDC);
		if (to_sci_port(port)->cfg->capabilities & SCIx_HAVE_RTSCTS) {
			/* RTS# is output, driven 1 */
			ctrl |= SCPCR_RTSC;
			serial_port_out(port, SCPDR,
				serial_port_in(port, SCPDR) | SCPDR_RTSD);
			/* Enable CTS# pin function */
			ctrl &= ~SCPCR_CTSC;
		}
		serial_port_out(port, SCPCR, ctrl);
	} else if (sci_getreg(port, SCSPTR)->size) {
732 733 734 735 736 737 738
		u16 status = serial_port_in(port, SCSPTR);

		/* RTS# is output, driven 1 */
		status |= SCSPTR_RTSIO | SCSPTR_RTSDT;
		/* CTS# and SCK are inputs */
		status &= ~(SCSPTR_CTSIO | SCSPTR_SCKIO);
		serial_port_out(port, SCSPTR, status);
739
	}
740
}
741

742
static int sci_txfill(struct uart_port *port)
743
{
744
	const struct plat_sci_reg *reg;
745

746 747
	reg = sci_getreg(port, SCTFDR);
	if (reg->size)
748
		return serial_port_in(port, SCTFDR) & ((port->fifosize << 1) - 1);
749

750 751
	reg = sci_getreg(port, SCFDR);
	if (reg->size)
752
		return serial_port_in(port, SCFDR) >> 8;
753

754
	return !(serial_port_in(port, SCxSR) & SCI_TDRE);
755 756
}

757 758
static int sci_txroom(struct uart_port *port)
{
759
	return port->fifosize - sci_txfill(port);
760 761 762
}

static int sci_rxfill(struct uart_port *port)
763
{
764
	const struct plat_sci_reg *reg;
765 766 767

	reg = sci_getreg(port, SCRFDR);
	if (reg->size)
768
		return serial_port_in(port, SCRFDR) & ((port->fifosize << 1) - 1);
769 770 771

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

774
	return (serial_port_in(port, SCxSR) & SCxSR_RDxF(port)) != 0;
775 776
}

777 778 779 780 781 782 783 784 785 786
/*
 * 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;

787
	/* Cast for ARM damage */
788
	return !!__raw_readb((void __iomem *)(uintptr_t)s->cfg->port_reg);
789 790
}

L
Linus Torvalds 已提交
791 792 793 794 795 796
/* ********************************************************************** *
 *                   the interrupt related routines                       *
 * ********************************************************************** */

static void sci_transmit_chars(struct uart_port *port)
{
A
Alan Cox 已提交
797
	struct circ_buf *xmit = &port->state->xmit;
L
Linus Torvalds 已提交
798 799 800
	unsigned int stopped = uart_tx_stopped(port);
	unsigned short status;
	unsigned short ctrl;
801
	int count;
L
Linus Torvalds 已提交
802

803
	status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
804
	if (!(status & SCxSR_TDxE(port))) {
805
		ctrl = serial_port_in(port, SCSCR);
806
		if (uart_circ_empty(xmit))
807
			ctrl &= ~SCSCR_TIE;
808
		else
809
			ctrl |= SCSCR_TIE;
810
		serial_port_out(port, SCSCR, ctrl);
L
Linus Torvalds 已提交
811 812 813
		return;
	}

814
	count = sci_txroom(port);
L
Linus Torvalds 已提交
815 816 817 818 819 820 821 822 823 824 825 826 827 828

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

829
		serial_port_out(port, SCxTDR, c);
L
Linus Torvalds 已提交
830 831 832 833

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

834
	sci_clear_SCxSR(port, SCxSR_TDxE_CLEAR(port));
L
Linus Torvalds 已提交
835 836 837 838

	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(port);
	if (uart_circ_empty(xmit)) {
839
		sci_stop_tx(port);
L
Linus Torvalds 已提交
840
	} else {
841
		ctrl = serial_port_in(port, SCSCR);
L
Linus Torvalds 已提交
842

843
		if (port->type != PORT_SCI) {
844
			serial_port_in(port, SCxSR); /* Dummy read */
845
			sci_clear_SCxSR(port, SCxSR_TDxE_CLEAR(port));
L
Linus Torvalds 已提交
846 847
		}

848
		ctrl |= SCSCR_TIE;
849
		serial_port_out(port, SCSCR, ctrl);
L
Linus Torvalds 已提交
850 851 852 853
	}
}

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

856
static void sci_receive_chars(struct uart_port *port)
L
Linus Torvalds 已提交
857
{
858
	struct sci_port *sci_port = to_sci_port(port);
859
	struct tty_port *tport = &port->state->port;
L
Linus Torvalds 已提交
860 861
	int i, count, copied = 0;
	unsigned short status;
A
Alan Cox 已提交
862
	unsigned char flag;
L
Linus Torvalds 已提交
863

864
	status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
865 866 867 868 869
	if (!(status & SCxSR_RDxF(port)))
		return;

	while (1) {
		/* Don't copy more bytes than there is room for in the buffer */
870
		count = tty_buffer_request_room(tport, sci_rxfill(port));
L
Linus Torvalds 已提交
871 872 873 874 875 876

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

		if (port->type == PORT_SCI) {
877
			char c = serial_port_in(port, SCxRDR);
878 879
			if (uart_handle_sysrq_char(port, c) ||
			    sci_port->break_flag)
L
Linus Torvalds 已提交
880
				count = 0;
881
			else
J
Jiri Slaby 已提交
882
				tty_insert_flip_char(tport, c, TTY_NORMAL);
L
Linus Torvalds 已提交
883
		} else {
884
			for (i = 0; i < count; i++) {
885
				char c = serial_port_in(port, SCxRDR);
886

887
				status = serial_port_in(port, SCxSR);
L
Linus Torvalds 已提交
888 889
#if defined(CONFIG_CPU_SH3)
				/* Skip "chars" during break */
890
				if (sci_port->break_flag) {
L
Linus Torvalds 已提交
891 892 893 894 895
					if ((c == 0) &&
					    (status & SCxSR_FER(port))) {
						count--; i--;
						continue;
					}
896

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

L
Linus Torvalds 已提交
901 902 903 904 905 906
					if (STEPFN(c)) {
						count--; i--;
						continue;
					}
				}
#endif /* CONFIG_CPU_SH3 */
907
				if (uart_handle_sysrq_char(port, c)) {
L
Linus Torvalds 已提交
908 909 910 911 912
					count--; i--;
					continue;
				}

				/* Store data and status */
913
				if (status & SCxSR_FER(port)) {
A
Alan Cox 已提交
914
					flag = TTY_FRAME;
915
					port->icount.frame++;
916
					dev_notice(port->dev, "frame error\n");
917
				} else if (status & SCxSR_PER(port)) {
A
Alan Cox 已提交
918
					flag = TTY_PARITY;
919
					port->icount.parity++;
920
					dev_notice(port->dev, "parity error\n");
A
Alan Cox 已提交
921 922
				} else
					flag = TTY_NORMAL;
923

J
Jiri Slaby 已提交
924
				tty_insert_flip_char(tport, c, flag);
L
Linus Torvalds 已提交
925 926 927
			}
		}

928
		serial_port_in(port, SCxSR); /* dummy read */
929
		sci_clear_SCxSR(port, SCxSR_RDxF_CLEAR(port));
L
Linus Torvalds 已提交
930 931 932 933 934 935 936

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

	if (copied) {
		/* Tell the rest of the system the news. New characters! */
J
Jiri Slaby 已提交
937
		tty_flip_buffer_push(tport);
L
Linus Torvalds 已提交
938
	} else {
939
		serial_port_in(port, SCxSR); /* dummy read */
940
		sci_clear_SCxSR(port, SCxSR_RDxF_CLEAR(port));
L
Linus Torvalds 已提交
941 942 943 944
	}
}

#define SCI_BREAK_JIFFIES (HZ/20)
945 946 947

/*
 * The sci generates interrupts during the break,
L
Linus Torvalds 已提交
948 949 950 951 952 953
 * 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.
 */
954
static inline void sci_schedule_break_timer(struct sci_port *port)
L
Linus Torvalds 已提交
955
{
956
	mod_timer(&port->break_timer, jiffies + SCI_BREAK_JIFFIES);
L
Linus Torvalds 已提交
957
}
958

L
Linus Torvalds 已提交
959 960 961
/* Ensure that two consecutive samples find the break over. */
static void sci_break_timer(unsigned long data)
{
962 963 964
	struct sci_port *port = (struct sci_port *)data;

	if (sci_rxd_in(&port->port) == 0) {
L
Linus Torvalds 已提交
965
		port->break_flag = 1;
966 967
		sci_schedule_break_timer(port);
	} else if (port->break_flag == 1) {
L
Linus Torvalds 已提交
968 969
		/* break is over. */
		port->break_flag = 2;
970 971 972
		sci_schedule_break_timer(port);
	} else
		port->break_flag = 0;
L
Linus Torvalds 已提交
973 974
}

975
static int sci_handle_errors(struct uart_port *port)
L
Linus Torvalds 已提交
976 977
{
	int copied = 0;
978
	unsigned short status = serial_port_in(port, SCxSR);
J
Jiri Slaby 已提交
979
	struct tty_port *tport = &port->state->port;
980
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
981

982
	/* Handle overruns */
983
	if (status & s->overrun_mask) {
984
		port->icount.overrun++;
985

986 987 988
		/* overrun error */
		if (tty_insert_flip_char(tport, 0, TTY_OVERRUN))
			copied++;
989

990
		dev_notice(port->dev, "overrun error\n");
L
Linus Torvalds 已提交
991 992
	}

993
	if (status & SCxSR_FER(port)) {
L
Linus Torvalds 已提交
994 995
		if (sci_rxd_in(port) == 0) {
			/* Notify of BREAK */
996
			struct sci_port *sci_port = to_sci_port(port);
997 998

			if (!sci_port->break_flag) {
999 1000
				port->icount.brk++;

1001 1002 1003
				sci_port->break_flag = 1;
				sci_schedule_break_timer(sci_port);

L
Linus Torvalds 已提交
1004
				/* Do sysrq handling. */
1005
				if (uart_handle_break(port))
L
Linus Torvalds 已提交
1006
					return 0;
1007 1008 1009

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

J
Jiri Slaby 已提交
1010
				if (tty_insert_flip_char(tport, 0, TTY_BREAK))
1011 1012 1013
					copied++;
			}

1014
		} else {
L
Linus Torvalds 已提交
1015
			/* frame error */
1016 1017
			port->icount.frame++;

J
Jiri Slaby 已提交
1018
			if (tty_insert_flip_char(tport, 0, TTY_FRAME))
A
Alan Cox 已提交
1019
				copied++;
1020 1021

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

1025
	if (status & SCxSR_PER(port)) {
L
Linus Torvalds 已提交
1026
		/* parity error */
1027 1028
		port->icount.parity++;

J
Jiri Slaby 已提交
1029
		if (tty_insert_flip_char(tport, 0, TTY_PARITY))
1030
			copied++;
1031

1032
		dev_notice(port->dev, "parity error\n");
L
Linus Torvalds 已提交
1033 1034
	}

A
Alan Cox 已提交
1035
	if (copied)
J
Jiri Slaby 已提交
1036
		tty_flip_buffer_push(tport);
L
Linus Torvalds 已提交
1037 1038 1039 1040

	return copied;
}

1041
static int sci_handle_fifo_overrun(struct uart_port *port)
1042
{
J
Jiri Slaby 已提交
1043
	struct tty_port *tport = &port->state->port;
1044
	struct sci_port *s = to_sci_port(port);
1045
	const struct plat_sci_reg *reg;
1046
	int copied = 0;
1047
	u16 status;
1048

1049
	reg = sci_getreg(port, s->overrun_reg);
1050
	if (!reg->size)
1051 1052
		return 0;

1053
	status = serial_port_in(port, s->overrun_reg);
1054 1055
	if (status & s->overrun_mask) {
		status &= ~s->overrun_mask;
1056
		serial_port_out(port, s->overrun_reg, status);
1057

1058 1059
		port->icount.overrun++;

J
Jiri Slaby 已提交
1060
		tty_insert_flip_char(tport, 0, TTY_OVERRUN);
J
Jiri Slaby 已提交
1061
		tty_flip_buffer_push(tport);
1062

1063
		dev_dbg(port->dev, "overrun error\n");
1064 1065 1066 1067 1068 1069
		copied++;
	}

	return copied;
}

1070
static int sci_handle_breaks(struct uart_port *port)
L
Linus Torvalds 已提交
1071 1072
{
	int copied = 0;
1073
	unsigned short status = serial_port_in(port, SCxSR);
J
Jiri Slaby 已提交
1074
	struct tty_port *tport = &port->state->port;
1075
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
1076

1077 1078 1079
	if (uart_handle_break(port))
		return 0;

1080
	if (!s->break_flag && status & SCxSR_BRK(port)) {
L
Linus Torvalds 已提交
1081 1082 1083 1084
#if defined(CONFIG_CPU_SH3)
		/* Debounce break */
		s->break_flag = 1;
#endif
1085 1086 1087

		port->icount.brk++;

L
Linus Torvalds 已提交
1088
		/* Notify of BREAK */
J
Jiri Slaby 已提交
1089
		if (tty_insert_flip_char(tport, 0, TTY_BREAK))
A
Alan Cox 已提交
1090
			copied++;
1091 1092

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

A
Alan Cox 已提交
1095
	if (copied)
J
Jiri Slaby 已提交
1096
		tty_flip_buffer_push(tport);
1097

1098 1099
	copied += sci_handle_fifo_overrun(port);

L
Linus Torvalds 已提交
1100 1101 1102
	return copied;
}

1103
#ifdef CONFIG_SERIAL_SH_SCI_DMA
1104 1105 1106 1107 1108 1109
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;
1110

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

1113
	spin_lock_irqsave(&port->lock, flags);
1114

1115 1116
	xmit->tail += s->tx_dma_len;
	xmit->tail &= UART_XMIT_SIZE - 1;
1117

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

1120 1121
	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(port);
L
Linus Torvalds 已提交
1122

1123 1124 1125 1126 1127 1128 1129 1130 1131 1132
	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 已提交
1133

1134
	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
1135 1136
}

1137 1138
/* Locking: called with port lock held */
static int sci_dma_rx_push(struct sci_port *s, void *buf, size_t count)
L
Linus Torvalds 已提交
1139
{
1140 1141 1142
	struct uart_port *port = &s->port;
	struct tty_port *tport = &port->state->port;
	int copied;
L
Linus Torvalds 已提交
1143

1144
	copied = tty_insert_flip_string(tport, buf, count);
1145
	if (copied < count)
1146
		port->icount.buf_overrun++;
L
Linus Torvalds 已提交
1147

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

1150
	return copied;
L
Linus Torvalds 已提交
1151 1152
}

1153
static int sci_dma_rx_find_active(struct sci_port *s)
L
Linus Torvalds 已提交
1154
{
1155
	unsigned int i;
L
Linus Torvalds 已提交
1156

1157 1158 1159
	for (i = 0; i < ARRAY_SIZE(s->cookie_rx); i++)
		if (s->active_rx == s->cookie_rx[i])
			return i;
L
Linus Torvalds 已提交
1160

1161
	return -1;
L
Linus Torvalds 已提交
1162 1163
}

1164
static void sci_rx_dma_release(struct sci_port *s, bool enable_pio)
P
Paul Mundt 已提交
1165
{
1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179
	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 已提交
1180 1181
}

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

1191 1192
	dev_dbg(port->dev, "%s(%d) active cookie %d\n", __func__, port->line,
		s->active_rx);
1193

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

1196 1197 1198
	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 已提交
1199

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

1202 1203
	if (count)
		tty_flip_buffer_push(&port->state->port);
1204

1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218
	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];

1219 1220
	dma_async_issue_pending(chan);

1221
	spin_unlock_irqrestore(&port->lock, flags);
1222 1223 1224 1225 1226 1227 1228 1229
	dev_dbg(port->dev, "%s: cookie %d #%d, new active cookie %d\n",
		__func__, s->cookie_rx[active], active, s->active_rx);
	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 已提交
1230 1231
}

1232
static void sci_tx_dma_release(struct sci_port *s, bool enable_pio)
L
Linus Torvalds 已提交
1233
{
1234 1235
	struct dma_chan *chan = s->chan_tx;
	struct uart_port *port = &s->port;
1236
	unsigned long flags;
L
Linus Torvalds 已提交
1237

1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248
	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);
}
1249

1250 1251 1252 1253
static void sci_submit_rx(struct sci_port *s)
{
	struct dma_chan *chan = s->chan_rx;
	int i;
1254

1255 1256 1257
	for (i = 0; i < 2; i++) {
		struct scatterlist *sg = &s->sg_rx[i];
		struct dma_async_tx_descriptor *desc;
L
Linus Torvalds 已提交
1258

1259 1260 1261 1262 1263
		desc = dmaengine_prep_slave_sg(chan,
			sg, 1, DMA_DEV_TO_MEM,
			DMA_PREP_INTERRUPT | DMA_CTRL_ACK);
		if (!desc)
			goto fail;
1264

1265 1266 1267 1268 1269
		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;
1270

1271
	}
1272

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

1275 1276
	dma_async_issue_pending(chan);
	return;
1277

1278 1279 1280 1281 1282 1283 1284 1285
fail:
	if (i)
		dmaengine_terminate_all(chan);
	for (i = 0; i < 2; i++)
		s->cookie_rx[i] = -EINVAL;
	s->active_rx = -EINVAL;
	sci_rx_dma_release(s, true);
}
1286

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

1296
	/*
1297 1298 1299 1300 1301
	 * 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.
1302
	 */
1303 1304 1305 1306 1307 1308
	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);
1309

1310 1311 1312 1313 1314 1315 1316 1317 1318
	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;
	}
1319

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

1323 1324 1325 1326 1327 1328 1329 1330 1331 1332
	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 已提交
1333 1334
	}

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

1338
	dma_async_issue_pending(chan);
L
Linus Torvalds 已提交
1339 1340
}

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

	dev_dbg(port->dev, "DMA Rx timed out\n");

1355 1356
	spin_lock_irqsave(&port->lock, flags);

1357 1358 1359 1360 1361 1362 1363
	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);
1364
	if (status == DMA_COMPLETE) {
1365
		spin_unlock_irqrestore(&port->lock, flags);
1366 1367
		dev_dbg(port->dev, "Cookie %d #%d has already completed\n",
			s->active_rx, active);
1368 1369 1370 1371

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

1373 1374 1375 1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387
	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;
	}

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;

	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 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845
static void sci_set_rts(struct uart_port *port, bool state)
{
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
		u16 data = serial_port_in(port, SCPDR);

		/* Active low */
		if (state)
			data &= ~SCPDR_RTSD;
		else
			data |= SCPDR_RTSD;
		serial_port_out(port, SCPDR, data);

		/* RTS# is output */
		serial_port_out(port, SCPCR,
				serial_port_in(port, SCPCR) | SCPCR_RTSC);
	} else if (sci_getreg(port, SCSPTR)->size) {
		u16 ctrl = serial_port_in(port, SCSPTR);

		/* Active low */
		if (state)
			ctrl &= ~SCSPTR_RTSDT;
		else
			ctrl |= SCSPTR_RTSDT;
		serial_port_out(port, SCSPTR, ctrl);
	}
}

static bool sci_get_cts(struct uart_port *port)
{
	if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
		/* Active low */
		return !(serial_port_in(port, SCPDR) & SCPDR_CTSD);
	} else if (sci_getreg(port, SCSPTR)->size) {
		/* Active low */
		return !(serial_port_in(port, SCSPTR) & SCSPTR_CTSDT);
	}

	return true;
}

1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858
/*
 * 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 已提交
1859
{
1860 1861
	struct sci_port *s = to_sci_port(port);

1862 1863
	if (mctrl & TIOCM_LOOP) {
		const struct plat_sci_reg *reg;
P
Paul Mundt 已提交
1864

1865 1866 1867 1868 1869 1870 1871 1872 1873
		/*
		 * 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);
	}
1874 1875

	mctrl_gpio_set(s->gpios, mctrl);
1876 1877 1878 1879 1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900

	if (!(s->cfg->capabilities & SCIx_HAVE_RTSCTS))
		return;

	if (!(mctrl & TIOCM_RTS)) {
		/* Disable Auto RTS */
		serial_port_out(port, SCFCR,
				serial_port_in(port, SCFCR) & ~SCFCR_MCE);

		/* Clear RTS */
		sci_set_rts(port, 0);
	} else if (s->autorts) {
		if (port->type == PORT_SCIFA || port->type == PORT_SCIFB) {
			/* Enable RTS# pin function */
			serial_port_out(port, SCPCR,
				serial_port_in(port, SCPCR) & ~SCPCR_RTSC);
		}

		/* Enable Auto RTS */
		serial_port_out(port, SCFCR,
				serial_port_in(port, SCFCR) | SCFCR_MCE);
	} else {
		/* Set RTS */
		sci_set_rts(port, 1);
	}
1901
}
P
Paul Mundt 已提交
1902

1903 1904
static unsigned int sci_get_mctrl(struct uart_port *port)
{
1905 1906 1907 1908 1909 1910
	struct sci_port *s = to_sci_port(port);
	struct mctrl_gpios *gpios = s->gpios;
	unsigned int mctrl = 0;

	mctrl_gpio_get(gpios, &mctrl);

1911 1912
	/*
	 * CTS/RTS is handled in hardware when supported, while nothing
1913
	 * else is wired up.
1914
	 */
1915 1916 1917 1918
	if (s->autorts) {
		if (sci_get_cts(port))
			mctrl |= TIOCM_CTS;
	} else if (IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(gpios, UART_GPIO_CTS))) {
1919
		mctrl |= TIOCM_CTS;
1920
	}
1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931
	if (IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(gpios, UART_GPIO_DSR)))
		mctrl |= TIOCM_DSR;
	if (IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(gpios, UART_GPIO_DCD)))
		mctrl |= TIOCM_CAR;

	return mctrl;
}

static void sci_enable_ms(struct uart_port *port)
{
	mctrl_gpio_enable_ms(to_sci_port(port)->gpios);
L
Linus Torvalds 已提交
1932 1933 1934 1935
}

static void sci_break_ctl(struct uart_port *port, int break_state)
{
1936 1937
	unsigned short scscr, scsptr;

1938
	/* check wheter the port has SCSPTR */
1939
	if (!sci_getreg(port, SCSPTR)->size) {
1940 1941 1942 1943
		/*
		 * Not supported by hardware. Most parts couple break and rx
		 * interrupts together, with break detection always enabled.
		 */
1944
		return;
1945
	}
1946 1947 1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959

	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 已提交
1960 1961 1962 1963
}

static int sci_startup(struct uart_port *port)
{
1964
	struct sci_port *s = to_sci_port(port);
1965
	int ret;
L
Linus Torvalds 已提交
1966

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

1969 1970 1971 1972
	ret = sci_request_irq(s);
	if (unlikely(ret < 0))
		return ret;

1973
	sci_request_dma(port);
1974

L
Linus Torvalds 已提交
1975 1976 1977 1978 1979
	return 0;
}

static void sci_shutdown(struct uart_port *port)
{
1980
	struct sci_port *s = to_sci_port(port);
1981
	unsigned long flags;
1982
	u16 scr;
L
Linus Torvalds 已提交
1983

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

1986
	s->autorts = false;
1987 1988
	mctrl_gpio_disable_ms(to_sci_port(port)->gpios);

1989
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
1990
	sci_stop_rx(port);
1991
	sci_stop_tx(port);
1992 1993 1994
	/* Stop RX and TX, disable related interrupts, keep clock source */
	scr = serial_port_in(port, SCSCR);
	serial_port_out(port, SCSCR, scr & (SCSCR_CKE1 | SCSCR_CKE0));
1995
	spin_unlock_irqrestore(&port->lock, flags);
1996

1997 1998 1999 2000 2001 2002 2003 2004
#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

2005
	sci_free_dma(port);
L
Linus Torvalds 已提交
2006 2007 2008
	sci_free_irq(s);
}

2009 2010
static int sci_sck_calc(struct sci_port *s, unsigned int bps,
			unsigned int *srr)
2011
{
2012 2013
	unsigned long freq = s->clk_rates[SCI_SCK];
	int err, min_err = INT_MAX;
2014
	unsigned int sr;
2015

2016 2017
	if (s->port.type != PORT_HSCIF)
		freq *= 2;
2018

2019
	for_each_sr(sr, s) {
2020 2021 2022 2023 2024 2025
		err = DIV_ROUND_CLOSEST(freq, sr) - bps;
		if (abs(err) >= abs(min_err))
			continue;

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

2027 2028 2029
		if (!err)
			break;
	}
2030

2031 2032 2033
	dev_dbg(s->port.dev, "SCK: %u%+d bps using SR %u\n", bps, min_err,
		*srr + 1);
	return min_err;
2034 2035
}

2036 2037 2038
static int sci_brg_calc(struct sci_port *s, unsigned int bps,
			unsigned long freq, unsigned int *dlr,
			unsigned int *srr)
2039
{
2040
	int err, min_err = INT_MAX;
2041
	unsigned int sr, dl;
2042

2043 2044
	if (s->port.type != PORT_HSCIF)
		freq *= 2;
2045

2046
	for_each_sr(sr, s) {
2047 2048 2049 2050 2051 2052 2053 2054 2055 2056 2057 2058 2059 2060
		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;
	}
2061

2062 2063 2064 2065
	dev_dbg(s->port.dev, "BRG: %u%+d bps using DL %u SR %u\n", bps,
		min_err, *dlr, *srr + 1);
	return min_err;
}
2066

2067
/* calculate sample rate, BRR, and clock select */
2068 2069 2070
static int sci_scbrr_calc(struct sci_port *s, unsigned int bps,
			  unsigned int *brr, unsigned int *srr,
			  unsigned int *cks)
U
Ulrich Hecht 已提交
2071
{
2072
	unsigned long freq = s->clk_rates[SCI_FCK];
2073
	unsigned int sr, br, prediv, scrate, c;
2074
	int err, min_err = INT_MAX;
U
Ulrich Hecht 已提交
2075

2076 2077
	if (s->port.type != PORT_HSCIF)
		freq *= 2;
2078

2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093
	/*
	 * 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.
	 */
2094
	for_each_sr(sr, s) {
U
Ulrich Hecht 已提交
2095 2096
		for (c = 0; c <= 3; c++) {
			/* integerized formulas from HSCIF documentation */
2097
			prediv = sr * (1 << (2 * c + 1));
2098 2099 2100 2101 2102

			/*
			 * We need to calculate:
			 *
			 *     br = freq / (prediv * bps) clamped to [1..256]
2103
			 *     err = freq / (br * prediv) - bps
2104
			 *
2105 2106
			 * Watch out for overflow when calculating the desired
			 * sampling clock rate!
2107
			 */
2108 2109 2110 2111 2112
			if (bps > UINT_MAX / prediv)
				break;

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

2115
			err = DIV_ROUND_CLOSEST(freq, br * prediv) - bps;
2116
			if (abs(err) >= abs(min_err))
2117 2118
				continue;

2119
			min_err = err;
2120
			*brr = br - 1;
2121 2122
			*srr = sr - 1;
			*cks = c;
2123 2124 2125

			if (!err)
				goto found;
U
Ulrich Hecht 已提交
2126 2127 2128
		}
	}

2129
found:
2130 2131
	dev_dbg(s->port.dev, "BRR: %u%+d bps using N %u SR %u cks %u\n", bps,
		min_err, *brr, *srr + 1, *cks);
2132
	return min_err;
U
Ulrich Hecht 已提交
2133 2134
}

2135 2136
static void sci_reset(struct uart_port *port)
{
2137
	const struct plat_sci_reg *reg;
2138 2139 2140
	unsigned int status;

	do {
2141
		status = serial_port_in(port, SCxSR);
2142 2143
	} while (!(status & SCxSR_TEND(port)));

2144
	serial_port_out(port, SCSCR, 0x00);	/* TE=0, RE=0, CKE1=0 */
2145

2146 2147
	reg = sci_getreg(port, SCFCR);
	if (reg->size)
2148
		serial_port_out(port, SCFCR, SCFCR_RFRST | SCFCR_TFRST);
2149 2150 2151 2152

	sci_clear_SCxSR(port,
			SCxSR_RDxF_CLEAR(port) & SCxSR_ERROR_CLEAR(port) &
			SCxSR_BREAK_CLEAR(port));
2153 2154 2155 2156 2157
	if (sci_getreg(port, SCLSR)->size) {
		status = serial_port_in(port, SCLSR);
		status &= ~(SCLSR_TO | SCLSR_ORER);
		serial_port_out(port, SCLSR, status);
	}
2158 2159
}

A
Alan Cox 已提交
2160 2161
static void sci_set_termios(struct uart_port *port, struct ktermios *termios,
			    struct ktermios *old)
L
Linus Torvalds 已提交
2162
{
2163
	unsigned int baud, smr_val = SCSMR_ASYNC, scr_val = 0, i;
2164 2165
	unsigned int brr = 255, cks = 0, srr = 15, dl = 0, sccks = 0;
	unsigned int brr1 = 255, cks1 = 0, srr1 = 15, dl1 = 0;
2166
	struct sci_port *s = to_sci_port(port);
2167
	const struct plat_sci_reg *reg;
2168 2169 2170
	int min_err = INT_MAX, err;
	unsigned long max_freq = 0;
	int best_clk = -1;
L
Linus Torvalds 已提交
2171

2172 2173 2174 2175 2176 2177 2178 2179 2180
	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;

2181 2182 2183 2184 2185 2186 2187 2188
	/*
	 * 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.
	 */
2189 2190 2191 2192
	if (!port->uartclk) {
		baud = uart_get_baud_rate(port, termios, old, 0, 115200);
		goto done;
	}
L
Linus Torvalds 已提交
2193

2194 2195 2196
	for (i = 0; i < SCI_NUM_CLKS; i++)
		max_freq = max(max_freq, s->clk_rates[i]);

2197
	baud = uart_get_baud_rate(port, termios, old, 0, max_freq / min_sr(s));
2198 2199 2200 2201 2202 2203 2204 2205
	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.
	 */

2206 2207 2208 2209 2210 2211 2212 2213 2214 2215 2216 2217 2218 2219 2220
	/* 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;
		}
	}

2221 2222 2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237 2238 2239 2240 2241 2242 2243 2244 2245 2246 2247 2248 2249
	/* 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 已提交
2250 2251
		}
	}
2252

2253 2254 2255 2256
	/* 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;
2257
		scr_val = 0;
2258 2259 2260 2261 2262 2263 2264 2265 2266 2267
		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);
2268

2269
	sci_port_enable(s);
2270

2271 2272 2273 2274
	/*
	 * Program the optional External Baud Rate Generator (BRG) first.
	 * It controls the mux to select (H)SCK or frequency divided clock.
	 */
2275 2276
	if (best_clk >= 0 && sci_getreg(port, SCCKS)->size) {
		serial_port_out(port, SCDL, dl);
2277
		serial_port_out(port, SCCKS, sccks);
2278
	}
L
Linus Torvalds 已提交
2279

2280
	sci_reset(port);
L
Linus Torvalds 已提交
2281 2282 2283

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

2284
	if (best_clk >= 0) {
2285 2286 2287 2288 2289 2290 2291 2292 2293 2294 2295
		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;
			}
2296
		smr_val |= cks;
2297
		dev_dbg(port->dev,
2298 2299
			 "SCR 0x%x SMR 0x%x BRR %u CKS 0x%x DL %u SRR %u\n",
			 scr_val, smr_val, brr, sccks, dl, srr);
2300
		serial_port_out(port, SCSCR, scr_val);
2301 2302 2303
		serial_port_out(port, SCSMR, smr_val);
		serial_port_out(port, SCBRR, brr);
		if (sci_getreg(port, HSSRR)->size)
U
Ulrich Hecht 已提交
2304
			serial_port_out(port, HSSRR, srr | HSCIF_SRE);
2305 2306 2307 2308 2309 2310

		/* 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);
2311 2312
		smr_val |= serial_port_in(port, SCSMR) &
			   (SCSMR_CKEDG | SCSMR_SRC_MASK | SCSMR_CKS);
2313 2314
		dev_dbg(port->dev, "SCR 0x%x SMR 0x%x\n", scr_val, smr_val);
		serial_port_out(port, SCSCR, scr_val);
2315
		serial_port_out(port, SCSMR, smr_val);
2316
	}
L
Linus Torvalds 已提交
2317

2318
	sci_init_pins(port, termios->c_cflag);
2319

2320 2321
	port->status &= ~UPSTAT_AUTOCTS;
	s->autorts = false;
2322 2323
	reg = sci_getreg(port, SCFCR);
	if (reg->size) {
2324
		unsigned short ctrl = serial_port_in(port, SCFCR);
2325

2326 2327 2328 2329 2330 2331
		if ((port->flags & UPF_HARD_FLOW) &&
		    (termios->c_cflag & CRTSCTS)) {
			/* There is no CTS interrupt to restart the hardware */
			port->status |= UPSTAT_AUTOCTS;
			/* MCE is enabled when RTS is raised */
			s->autorts = true;
2332
		}
2333 2334 2335 2336 2337 2338 2339 2340

		/*
		 * 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);

2341
		serial_port_out(port, SCFCR, ctrl);
2342
	}
2343

2344 2345 2346
	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);
2347 2348 2349 2350 2351 2352 2353 2354 2355 2356
	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 已提交
2357

2358 2359
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	/*
2360
	 * Calculate delay for 2 DMA buffers (4 FIFO).
2361 2362 2363 2364 2365 2366 2367
	 * 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.
2368 2369
	 */
	if (s->chan_rx) {
2370 2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391 2392 2393
		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);
2394
		dev_dbg(port->dev, "DMA Rx t-out %ums, tty t-out %u jiffies\n",
2395 2396 2397 2398 2399 2400
			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 已提交
2401
	if ((termios->c_cflag & CREAD) != 0)
2402
		sci_start_rx(port);
2403

2404
	sci_port_disable(s);
2405 2406 2407

	if (UART_ENABLE_MS(port, termios->c_cflag))
		sci_enable_ms(port);
L
Linus Torvalds 已提交
2408 2409
}

2410 2411 2412 2413 2414 2415
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) {
2416
	case UART_PM_STATE_OFF:
2417 2418 2419 2420 2421 2422 2423 2424
		sci_port_disable(sci_port);
		break;
	default:
		sci_port_enable(sci_port);
		break;
	}
}

L
Linus Torvalds 已提交
2425 2426 2427
static const char *sci_type(struct uart_port *port)
{
	switch (port->type) {
2428 2429 2430 2431 2432 2433 2434 2435
	case PORT_IRDA:
		return "irda";
	case PORT_SCI:
		return "sci";
	case PORT_SCIF:
		return "scif";
	case PORT_SCIFA:
		return "scifa";
2436 2437
	case PORT_SCIFB:
		return "scifb";
U
Ulrich Hecht 已提交
2438 2439
	case PORT_HSCIF:
		return "hscif";
L
Linus Torvalds 已提交
2440 2441
	}

P
Paul Mundt 已提交
2442
	return NULL;
L
Linus Torvalds 已提交
2443 2444
}

2445 2446
static int sci_remap_port(struct uart_port *port)
{
2447
	struct sci_port *sport = to_sci_port(port);
2448 2449 2450 2451 2452 2453 2454 2455

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

	if (port->flags & UPF_IOREMAP) {
2456
		port->membase = ioremap_nocache(port->mapbase, sport->reg_size);
2457 2458 2459 2460 2461 2462 2463 2464 2465 2466
		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 已提交
2467
		port->membase = (void __iomem *)(uintptr_t)port->mapbase;
2468 2469 2470 2471 2472
	}

	return 0;
}

2473
static void sci_release_port(struct uart_port *port)
L
Linus Torvalds 已提交
2474
{
2475 2476
	struct sci_port *sport = to_sci_port(port);

2477 2478 2479 2480 2481
	if (port->flags & UPF_IOREMAP) {
		iounmap(port->membase);
		port->membase = NULL;
	}

2482
	release_mem_region(port->mapbase, sport->reg_size);
L
Linus Torvalds 已提交
2483 2484
}

2485
static int sci_request_port(struct uart_port *port)
L
Linus Torvalds 已提交
2486
{
2487
	struct resource *res;
2488
	struct sci_port *sport = to_sci_port(port);
2489
	int ret;
L
Linus Torvalds 已提交
2490

2491 2492 2493 2494
	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.");
2495
		return -EBUSY;
2496
	}
L
Linus Torvalds 已提交
2497

2498 2499 2500 2501
	ret = sci_remap_port(port);
	if (unlikely(ret != 0)) {
		release_resource(res);
		return ret;
2502
	}
2503 2504 2505 2506 2507 2508 2509 2510 2511 2512 2513 2514

	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 已提交
2515 2516 2517 2518 2519 2520 2521 2522 2523 2524 2525
}

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

2526
static const struct uart_ops sci_uart_ops = {
L
Linus Torvalds 已提交
2527 2528 2529 2530 2531 2532
	.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,
2533
	.enable_ms	= sci_enable_ms,
L
Linus Torvalds 已提交
2534 2535 2536 2537
	.break_ctl	= sci_break_ctl,
	.startup	= sci_startup,
	.shutdown	= sci_shutdown,
	.set_termios	= sci_set_termios,
2538
	.pm		= sci_pm,
L
Linus Torvalds 已提交
2539 2540 2541 2542 2543
	.type		= sci_type,
	.release_port	= sci_release_port,
	.request_port	= sci_request_port,
	.config_port	= sci_config_port,
	.verify_port	= sci_verify_port,
2544 2545 2546 2547
#ifdef CONFIG_CONSOLE_POLL
	.poll_get_char	= sci_poll_get_char,
	.poll_put_char	= sci_poll_put_char,
#endif
L
Linus Torvalds 已提交
2548 2549
};

2550 2551
static int sci_init_clocks(struct sci_port *sci_port, struct device *dev)
{
2552 2553
	const char *clk_names[] = {
		[SCI_FCK] = "fck",
2554
		[SCI_SCK] = "sck",
2555 2556
		[SCI_BRG_INT] = "brg_int",
		[SCI_SCIF_CLK] = "scif_clk",
2557 2558 2559
	};
	struct clk *clk;
	unsigned int i;
2560

2561 2562 2563
	if (sci_port->cfg->type == PORT_HSCIF)
		clk_names[SCI_SCK] = "hsck";

2564 2565 2566 2567
	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;
2568

2569 2570 2571 2572 2573 2574 2575 2576
		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;
2577

2578 2579
			if (!IS_ERR(clk))
				goto found;
2580

2581 2582 2583 2584 2585 2586 2587 2588 2589 2590 2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604
			/*
			 * 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;
2605 2606
}

B
Bill Pemberton 已提交
2607
static int sci_init_single(struct platform_device *dev,
2608 2609
			   struct sci_port *sci_port, unsigned int index,
			   struct plat_sci_port *p, bool early)
2610
{
2611
	struct uart_port *port = &sci_port->port;
2612 2613
	const struct resource *res;
	unsigned int i;
2614
	int ret;
2615

2616 2617
	sci_port->cfg	= p;

2618 2619 2620
	port->ops	= &sci_uart_ops;
	port->iotype	= UPIO_MEM;
	port->line	= index;
2621

2622 2623 2624
	res = platform_get_resource(dev, IORESOURCE_MEM, 0);
	if (res == NULL)
		return -ENOMEM;
2625

2626
	port->mapbase = res->start;
2627
	sci_port->reg_size = resource_size(res);
2628

2629 2630
	for (i = 0; i < ARRAY_SIZE(sci_port->irqs); ++i)
		sci_port->irqs[i] = platform_get_irq(dev, i);
2631

2632 2633 2634 2635 2636 2637 2638
	/* 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;
2639

2640 2641 2642 2643
	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];
2644 2645
	}

2646 2647 2648 2649 2650 2651
	if (p->regtype == SCIx_PROBE_REGTYPE) {
		ret = sci_probe_regmap(p);
		if (unlikely(ret))
			return ret;
	}

2652
	switch (p->type) {
2653 2654
	case PORT_SCIFB:
		port->fifosize = 256;
2655
		sci_port->overrun_reg = SCxSR;
2656
		sci_port->overrun_mask = SCIFA_ORER;
2657
		sci_port->sampling_rate_mask = SCI_SR_SCIFAB;
2658
		break;
U
Ulrich Hecht 已提交
2659 2660
	case PORT_HSCIF:
		port->fifosize = 128;
2661
		sci_port->overrun_reg = SCLSR;
2662
		sci_port->overrun_mask = SCLSR_ORER;
2663
		sci_port->sampling_rate_mask = SCI_SR_RANGE(8, 32);
U
Ulrich Hecht 已提交
2664
		break;
2665
	case PORT_SCIFA:
2666
		port->fifosize = 64;
2667
		sci_port->overrun_reg = SCxSR;
2668
		sci_port->overrun_mask = SCIFA_ORER;
2669
		sci_port->sampling_rate_mask = SCI_SR_SCIFAB;
2670 2671
		break;
	case PORT_SCIF:
2672
		port->fifosize = 16;
2673
		if (p->regtype == SCIx_SH7705_SCIF_REGTYPE) {
2674
			sci_port->overrun_reg = SCxSR;
2675
			sci_port->overrun_mask = SCIFA_ORER;
2676
			sci_port->sampling_rate_mask = SCI_SR(16);
2677
		} else {
2678
			sci_port->overrun_reg = SCLSR;
2679
			sci_port->overrun_mask = SCLSR_ORER;
2680
			sci_port->sampling_rate_mask = SCI_SR(32);
2681
		}
2682 2683
		break;
	default:
2684
		port->fifosize = 1;
2685
		sci_port->overrun_reg = SCxSR;
2686
		sci_port->overrun_mask = SCI_ORER;
2687
		sci_port->sampling_rate_mask = SCI_SR(32);
2688 2689
		break;
	}
2690

2691 2692 2693
	/* 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.
2694
	 */
2695
	if (p->sampling_rate)
2696
		sci_port->sampling_rate_mask = SCI_SR(p->sampling_rate);
2697

2698
	if (!early) {
2699 2700 2701
		ret = sci_init_clocks(sci_port, &dev->dev);
		if (ret < 0)
			return ret;
2702

2703
		port->dev = &dev->dev;
M
Magnus Damm 已提交
2704 2705

		pm_runtime_enable(&dev->dev);
2706
	}
2707

M
Magnus Damm 已提交
2708 2709 2710 2711
	sci_port->break_timer.data = (unsigned long)sci_port;
	sci_port->break_timer.function = sci_break_timer;
	init_timer(&sci_port->break_timer);

2712 2713 2714
	/*
	 * Establish some sensible defaults for the error detection.
	 */
2715 2716 2717 2718 2719 2720 2721
	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;
	}
2722

2723 2724 2725 2726
	/*
	 * Make the error mask inclusive of overrun detection, if
	 * supported.
	 */
2727
	if (sci_port->overrun_reg == SCxSR) {
2728
		sci_port->error_mask |= sci_port->overrun_mask;
2729 2730
		sci_port->error_clear &= ~sci_port->overrun_mask;
	}
2731

2732
	port->type		= p->type;
2733
	port->flags		= UPF_FIXED_PORT | p->flags;
2734
	port->regshift		= p->regshift;
2735

2736
	/*
2737
	 * The UART port needs an IRQ value, so we peg this to the RX IRQ
2738 2739 2740 2741 2742
	 * 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.
	 */
2743
	port->irq		= sci_port->irqs[SCIx_RXI_IRQ];
Y
Yong Zhang 已提交
2744
	port->irqflags		= 0;
2745

2746 2747 2748
	port->serial_in		= sci_serial_in;
	port->serial_out	= sci_serial_out;

2749 2750 2751
	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 已提交
2752

2753
	return 0;
2754 2755
}

2756 2757 2758 2759 2760
static void sci_cleanup_single(struct sci_port *port)
{
	pm_runtime_disable(port->port.dev);
}

2761 2762
#if defined(CONFIG_SERIAL_SH_SCI_CONSOLE) || \
    defined(CONFIG_SERIAL_SH_SCI_EARLYCON)
2763 2764 2765 2766 2767
static void serial_console_putchar(struct uart_port *port, int ch)
{
	sci_poll_put_char(port, ch);
}

L
Linus Torvalds 已提交
2768 2769 2770 2771 2772 2773 2774
/*
 *	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)
{
2775 2776
	struct sci_port *sci_port = &sci_ports[co->index];
	struct uart_port *port = &sci_port->port;
2777
	unsigned short bits, ctrl, ctrl_temp;
2778 2779 2780 2781
	unsigned long flags;
	int locked = 1;

	local_irq_save(flags);
2782
#if defined(SUPPORT_SYSRQ)
2783 2784
	if (port->sysrq)
		locked = 0;
2785 2786 2787
	else
#endif
	if (oops_in_progress)
2788 2789 2790 2791
		locked = spin_trylock(&port->lock);
	else
		spin_lock(&port->lock);

2792
	/* first save SCSCR then disable interrupts, keep clock source */
2793
	ctrl = serial_port_in(port, SCSCR);
2794 2795 2796
	ctrl_temp = (sci_port->cfg->scscr & ~(SCSCR_CKE1 | SCSCR_CKE0)) |
		    (ctrl & (SCSCR_CKE1 | SCSCR_CKE0));
	serial_port_out(port, SCSCR, ctrl_temp);
2797

2798
	uart_console_write(port, s, count, serial_console_putchar);
M
Magnus Damm 已提交
2799 2800 2801

	/* wait until fifo is empty and last bit has been transmitted */
	bits = SCxSR_TDxE(port) | SCxSR_TEND(port);
2802
	while ((serial_port_in(port, SCxSR) & bits) != bits)
M
Magnus Damm 已提交
2803
		cpu_relax();
2804 2805 2806 2807 2808 2809 2810

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

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

B
Bill Pemberton 已提交
2813
static int serial_console_setup(struct console *co, char *options)
L
Linus Torvalds 已提交
2814
{
2815
	struct sci_port *sci_port;
L
Linus Torvalds 已提交
2816 2817 2818 2819 2820 2821 2822
	struct uart_port *port;
	int baud = 115200;
	int bits = 8;
	int parity = 'n';
	int flow = 'n';
	int ret;

2823
	/*
2824
	 * Refuse to handle any bogus ports.
L
Linus Torvalds 已提交
2825
	 */
2826
	if (co->index < 0 || co->index >= SCI_NPORTS)
2827 2828
		return -ENODEV;

2829 2830 2831
	sci_port = &sci_ports[co->index];
	port = &sci_port->port;

2832 2833 2834 2835 2836 2837
	/*
	 * Refuse to handle uninitialized ports.
	 */
	if (!port->ops)
		return -ENODEV;

2838 2839 2840
	ret = sci_remap_port(port);
	if (unlikely(ret != 0))
		return ret;
2841

L
Linus Torvalds 已提交
2842 2843 2844
	if (options)
		uart_parse_options(options, &baud, &parity, &bits, &flow);

2845
	return uart_set_options(port, co, baud, parity, bits, flow);
L
Linus Torvalds 已提交
2846 2847 2848 2849
}

static struct console serial_console = {
	.name		= "ttySC",
2850
	.device		= uart_console_device,
L
Linus Torvalds 已提交
2851 2852
	.write		= serial_console_write,
	.setup		= serial_console_setup,
P
Paul Mundt 已提交
2853
	.flags		= CON_PRINTBUFFER,
L
Linus Torvalds 已提交
2854
	.index		= -1,
2855
	.data		= &sci_uart_driver,
L
Linus Torvalds 已提交
2856 2857
};

2858 2859 2860 2861
static struct console early_serial_console = {
	.name           = "early_ttySC",
	.write          = serial_console_write,
	.flags          = CON_PRINTBUFFER,
2862
	.index		= -1,
2863
};
2864

2865 2866
static char early_serial_buf[32];

B
Bill Pemberton 已提交
2867
static int sci_probe_earlyprintk(struct platform_device *pdev)
2868
{
J
Jingoo Han 已提交
2869
	struct plat_sci_port *cfg = dev_get_platdata(&pdev->dev);
2870 2871 2872 2873 2874 2875

	if (early_serial_console.data)
		return -EEXIST;

	early_serial_console.index = pdev->id;

2876
	sci_init_single(pdev, &sci_ports[pdev->id], pdev->id, cfg, true);
2877 2878 2879 2880 2881 2882 2883 2884 2885

	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;
}
2886 2887 2888

#define SCI_CONSOLE	(&serial_console)

2889
#else
B
Bill Pemberton 已提交
2890
static inline int sci_probe_earlyprintk(struct platform_device *pdev)
2891 2892 2893
{
	return -EINVAL;
}
L
Linus Torvalds 已提交
2894

2895 2896
#define SCI_CONSOLE	NULL

2897
#endif /* CONFIG_SERIAL_SH_SCI_CONSOLE || CONFIG_SERIAL_SH_SCI_EARLYCON */
L
Linus Torvalds 已提交
2898

2899
static const char banner[] __initconst = "SuperH (H)SCI(F) driver initialized";
L
Linus Torvalds 已提交
2900 2901 2902 2903 2904 2905 2906

static struct uart_driver sci_uart_driver = {
	.owner		= THIS_MODULE,
	.driver_name	= "sci",
	.dev_name	= "ttySC",
	.major		= SCI_MAJOR,
	.minor		= SCI_MINOR_START,
2907
	.nr		= SCI_NPORTS,
L
Linus Torvalds 已提交
2908 2909 2910
	.cons		= SCI_CONSOLE,
};

2911
static int sci_remove(struct platform_device *dev)
2912
{
2913
	struct sci_port *port = platform_get_drvdata(dev);
2914

2915 2916
	uart_remove_one_port(&sci_uart_driver, &port->port);

2917
	sci_cleanup_single(port);
2918 2919 2920 2921

	return 0;
}

2922 2923 2924 2925

#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 已提交
2926 2927

static const struct of_device_id of_sci_match[] = {
2928 2929 2930 2931 2932
	/* SoC-specific types */
	{
		.compatible = "renesas,scif-r7s72100",
		.data = SCI_OF_DATA(PORT_SCIF, SCIx_SH2_SCIF_FIFODATA_REGTYPE),
	},
2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943
	/* 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),
	},
2944
	/* Generic types */
B
Bastian Hecht 已提交
2945 2946
	{
		.compatible = "renesas,scif",
2947
		.data = SCI_OF_DATA(PORT_SCIF, SCIx_SH4_SCIF_REGTYPE),
B
Bastian Hecht 已提交
2948 2949
	}, {
		.compatible = "renesas,scifa",
2950
		.data = SCI_OF_DATA(PORT_SCIFA, SCIx_SCIFA_REGTYPE),
B
Bastian Hecht 已提交
2951 2952
	}, {
		.compatible = "renesas,scifb",
2953
		.data = SCI_OF_DATA(PORT_SCIFB, SCIx_SCIFB_REGTYPE),
B
Bastian Hecht 已提交
2954 2955
	}, {
		.compatible = "renesas,hscif",
2956
		.data = SCI_OF_DATA(PORT_HSCIF, SCIx_HSCIF_REGTYPE),
Y
Yoshinori Sato 已提交
2957 2958
	}, {
		.compatible = "renesas,sci",
2959
		.data = SCI_OF_DATA(PORT_SCI, SCIx_SCI_REGTYPE),
B
Bastian Hecht 已提交
2960 2961 2962 2963 2964 2965 2966 2967 2968 2969 2970 2971 2972 2973 2974 2975 2976
	}, {
		/* 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;

2977
	match = of_match_node(of_sci_match, np);
B
Bastian Hecht 已提交
2978 2979 2980 2981
	if (!match)
		return NULL;

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

2985
	/* Get the line number from the aliases node. */
B
Bastian Hecht 已提交
2986 2987 2988 2989 2990 2991 2992 2993 2994
	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;
2995 2996
	p->type = SCI_OF_TYPE(match->data);
	p->regtype = SCI_OF_REGTYPE(match->data);
B
Bastian Hecht 已提交
2997 2998
	p->scscr = SCSCR_RE | SCSCR_TE;

2999 3000 3001
	if (of_find_property(np, "uart-has-rtscts", NULL))
		p->capabilities |= SCIx_HAVE_RTSCTS;

B
Bastian Hecht 已提交
3002 3003 3004
	return p;
}

B
Bill Pemberton 已提交
3005
static int sci_probe_single(struct platform_device *dev,
3006 3007 3008 3009 3010 3011 3012 3013
				      unsigned int index,
				      struct plat_sci_port *p,
				      struct sci_port *sciport)
{
	int ret;

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

3020
	ret = sci_init_single(dev, sciport, index, p, false);
3021 3022
	if (ret)
		return ret;
3023

3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035
	sciport->gpios = mctrl_gpio_init(&sciport->port, 0);
	if (IS_ERR(sciport->gpios) && PTR_ERR(sciport->gpios) != -ENOSYS)
		return PTR_ERR(sciport->gpios);

	if (p->capabilities & SCIx_HAVE_RTSCTS) {
		if (!IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(sciport->gpios,
							UART_GPIO_CTS)) ||
		    !IS_ERR_OR_NULL(mctrl_gpio_to_gpiod(sciport->gpios,
							UART_GPIO_RTS))) {
			dev_err(&dev->dev, "Conflicting RTS/CTS config\n");
			return -EINVAL;
		}
3036
		sciport->port.flags |= UPF_HARD_FLOW;
3037 3038
	}

3039 3040 3041 3042 3043 3044 3045
	ret = uart_add_one_port(&sci_uart_driver, &sciport->port);
	if (ret) {
		sci_cleanup_single(sciport);
		return ret;
	}

	return 0;
3046 3047
}

B
Bill Pemberton 已提交
3048
static int sci_probe(struct platform_device *dev)
L
Linus Torvalds 已提交
3049
{
B
Bastian Hecht 已提交
3050 3051 3052
	struct plat_sci_port *p;
	struct sci_port *sp;
	unsigned int dev_id;
3053
	int ret;
3054

3055 3056 3057 3058 3059 3060 3061
	/*
	 * 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);
3062

B
Bastian Hecht 已提交
3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077
	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];
3078
	platform_set_drvdata(dev, sp);
3079

B
Bastian Hecht 已提交
3080
	ret = sci_probe_single(dev, dev_id, p, sp);
3081
	if (ret)
3082
		return ret;
3083

L
Linus Torvalds 已提交
3084 3085 3086 3087
#ifdef CONFIG_SH_STANDARD_BIOS
	sh_bios_gdb_detach();
#endif

3088
	return 0;
L
Linus Torvalds 已提交
3089 3090
}

S
Sergei Shtylyov 已提交
3091
static __maybe_unused int sci_suspend(struct device *dev)
L
Linus Torvalds 已提交
3092
{
3093
	struct sci_port *sport = dev_get_drvdata(dev);
3094

3095 3096
	if (sport)
		uart_suspend_port(&sci_uart_driver, &sport->port);
L
Linus Torvalds 已提交
3097

3098 3099
	return 0;
}
L
Linus Torvalds 已提交
3100

S
Sergei Shtylyov 已提交
3101
static __maybe_unused int sci_resume(struct device *dev)
3102
{
3103
	struct sci_port *sport = dev_get_drvdata(dev);
3104

3105 3106
	if (sport)
		uart_resume_port(&sci_uart_driver, &sport->port);
3107 3108 3109 3110

	return 0;
}

S
Sergei Shtylyov 已提交
3111
static SIMPLE_DEV_PM_OPS(sci_dev_pm_ops, sci_suspend, sci_resume);
3112

3113 3114
static struct platform_driver sci_driver = {
	.probe		= sci_probe,
3115
	.remove		= sci_remove,
3116 3117
	.driver		= {
		.name	= "sh-sci",
3118
		.pm	= &sci_dev_pm_ops,
B
Bastian Hecht 已提交
3119
		.of_match_table = of_match_ptr(of_sci_match),
3120 3121 3122 3123 3124 3125 3126
	},
};

static int __init sci_init(void)
{
	int ret;

3127
	pr_info("%s\n", banner);
3128 3129 3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141

	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 已提交
3142 3143 3144
	uart_unregister_driver(&sci_uart_driver);
}

3145 3146 3147 3148
#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
early_platform_init_buffer("earlyprintk", &sci_driver,
			   early_serial_buf, ARRAY_SIZE(early_serial_buf));
#endif
3149 3150 3151 3152 3153 3154 3155 3156 3157 3158 3159 3160 3161 3162 3163 3164 3165 3166 3167 3168 3169 3170 3171 3172 3173 3174 3175 3176 3177 3178 3179 3180 3181 3182 3183 3184 3185 3186 3187 3188 3189 3190 3191 3192 3193 3194 3195 3196 3197 3198 3199 3200 3201 3202 3203 3204
#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 已提交
3205 3206 3207
module_init(sci_init);
module_exit(sci_exit);

3208
MODULE_LICENSE("GPL");
3209
MODULE_ALIAS("platform:sh-sci");
3210
MODULE_AUTHOR("Paul Mundt");
U
Ulrich Hecht 已提交
3211
MODULE_DESCRIPTION("SuperH (H)SCI(F) serial driver");