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
		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);
1746 1747
		if (!port->irqstr[j]) {
			ret = -ENOMEM;
1748
			goto out_nomem;
1749
		}
1750 1751 1752 1753 1754 1755 1756

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

1759
	return 0;
L
Linus Torvalds 已提交
1760

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

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

1769
	return ret;
L
Linus Torvalds 已提交
1770 1771
}

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

1776 1777 1778 1779 1780 1781
	/*
	 * 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 已提交
1782

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

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

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

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

1805
	return (status & SCxSR_TEND(port)) && !in_tx_fifo ? TIOCSER_TEMT : 0;
L
Linus Torvalds 已提交
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 1846 1847
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;
}

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

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

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

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

	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);
	}
1903
}
P
Paul Mundt 已提交
1904

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

	mctrl_gpio_get(gpios, &mctrl);

1913 1914
	/*
	 * CTS/RTS is handled in hardware when supported, while nothing
1915
	 * else is wired up.
1916
	 */
1917 1918 1919 1920
	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))) {
1921
		mctrl |= TIOCM_CTS;
1922
	}
1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933
	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 已提交
1934 1935 1936 1937
}

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

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

	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 已提交
1962 1963 1964 1965
}

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

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

1971 1972 1973 1974
	ret = sci_request_irq(s);
	if (unlikely(ret < 0))
		return ret;

1975
	sci_request_dma(port);
1976

L
Linus Torvalds 已提交
1977 1978 1979 1980 1981
	return 0;
}

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

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

1988
	s->autorts = false;
1989 1990
	mctrl_gpio_disable_ms(to_sci_port(port)->gpios);

1991
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
1992
	sci_stop_rx(port);
1993
	sci_stop_tx(port);
1994 1995 1996
	/* 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));
1997
	spin_unlock_irqrestore(&port->lock, flags);
1998

1999 2000 2001 2002 2003 2004 2005 2006
#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

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

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

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

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

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

2029 2030 2031
		if (!err)
			break;
	}
2032

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

2146
	serial_port_out(port, SCSCR, 0x00);	/* TE=0, RE=0, CKE1=0 */
2147

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

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

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

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

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

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

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

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

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 2250 2251
	/* 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 已提交
2252 2253
		}
	}
2254

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

2271
	sci_port_enable(s);
2272

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

2282
	sci_reset(port);
L
Linus Torvalds 已提交
2283 2284 2285

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

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

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

2320
	sci_init_pins(port, termios->c_cflag);
2321

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

2328 2329 2330 2331 2332 2333
		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;
2334
		}
2335 2336 2337 2338 2339 2340 2341 2342

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

2343
		serial_port_out(port, SCFCR, ctrl);
2344
	}
2345

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

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

2406
	sci_port_disable(s);
2407 2408 2409

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

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

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

P
Paul Mundt 已提交
2444
	return NULL;
L
Linus Torvalds 已提交
2445 2446
}

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

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

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

	return 0;
}

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

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

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

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

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

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

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

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

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

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

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

2566 2567 2568 2569
	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;
2570

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

2580 2581
			if (!IS_ERR(clk))
				goto found;
2582

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

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

2618 2619
	sci_port->cfg	= p;

2620 2621 2622
	port->ops	= &sci_uart_ops;
	port->iotype	= UPIO_MEM;
	port->line	= index;
2623

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

2628
	port->mapbase = res->start;
2629
	sci_port->reg_size = resource_size(res);
2630

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

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

2642 2643 2644 2645
	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];
2646 2647
	}

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

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

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

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

2705
		port->dev = &dev->dev;
M
Magnus Damm 已提交
2706 2707

		pm_runtime_enable(&dev->dev);
2708
	}
2709

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

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

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

2734
	port->type		= p->type;
2735
	port->flags		= UPF_FIXED_PORT | p->flags;
2736
	port->regshift		= p->regshift;
2737

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

2748 2749 2750
	port->serial_in		= sci_serial_in;
	port->serial_out	= sci_serial_out;

2751 2752 2753
	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 已提交
2754

2755
	return 0;
2756 2757
}

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

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

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

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

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

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

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

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

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

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

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

2831 2832 2833
	sci_port = &sci_ports[co->index];
	port = &sci_port->port;

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

2840 2841 2842
	ret = sci_remap_port(port);
	if (unlikely(ret != 0))
		return ret;
2843

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

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

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

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

2867 2868
static char early_serial_buf[32];

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

	if (early_serial_console.data)
		return -EEXIST;

	early_serial_console.index = pdev->id;

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

	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;
}
2888 2889 2890

#define SCI_CONSOLE	(&serial_console)

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

2897 2898
#define SCI_CONSOLE	NULL

2899
#endif /* CONFIG_SERIAL_SH_SCI_CONSOLE || CONFIG_SERIAL_SH_SCI_EARLYCON */
L
Linus Torvalds 已提交
2900

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

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

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

2917 2918
	uart_remove_one_port(&sci_uart_driver, &port->port);

2919
	sci_cleanup_single(port);
2920 2921 2922 2923

	return 0;
}

2924 2925 2926 2927

#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 已提交
2928 2929

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

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

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

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

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

B
Bastian Hecht 已提交
3004 3005 3006
	return p;
}

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

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

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

3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037
	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;
		}
3038
		sciport->port.flags |= UPF_HARD_FLOW;
3039 3040
	}

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

	return 0;
3048 3049
}

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

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

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

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

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

3090
	return 0;
L
Linus Torvalds 已提交
3091 3092
}

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

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

3100 3101
	return 0;
}
L
Linus Torvalds 已提交
3102

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

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

	return 0;
}

S
Sergei Shtylyov 已提交
3113
static SIMPLE_DEV_PM_OPS(sci_dev_pm_ops, sci_suspend, sci_resume);
3114

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

static int __init sci_init(void)
{
	int ret;

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

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

3147 3148 3149 3150
#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
early_platform_init_buffer("earlyprintk", &sci_driver,
			   early_serial_buf, ARRAY_SIZE(early_serial_buf));
#endif
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 3205 3206
#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 已提交
3207 3208 3209
module_init(sci_init);
module_exit(sci_exit);

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