sh-sci.c 45.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5
/*
 * drivers/serial/sh-sci.c
 *
 * SuperH on-chip serial module support.  (SCI with no FIFO / with FIFO)
 *
6
 *  Copyright (C) 2002 - 2008  Paul Mundt
M
Markus Brunner 已提交
7
 *  Modified to support SH7720 SCIF. Markus Brunner, Mark Jonas (Jul 2007).
L
Linus Torvalds 已提交
8 9 10 11 12 13 14 15
 *
 * 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).
16
 *   Removed SH7300 support (Jul 2007).
L
Linus Torvalds 已提交
17 18 19 20 21
 *
 * 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.
 */
22 23 24
#if defined(CONFIG_SERIAL_SH_SCI_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
#define SUPPORT_SYSRQ
#endif
L
Linus Torvalds 已提交
25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42

#undef DEBUG

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

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

58 59 60 61
#ifdef CONFIG_H8300
#include <asm/gpio.h>
#endif

L
Linus Torvalds 已提交
62 63
#include "sh-sci.h"

64 65 66 67 68 69 70
struct sci_port {
	struct uart_port	port;

	/* Port type */
	unsigned int		type;

	/* Port IRQs: ERI, RXI, TXI, BRI (optional) */
71
	unsigned int		irqs[SCIx_NR_IRQS];
72 73 74 75 76 77 78 79 80 81

	/* Port enable callback */
	void			(*enable)(struct uart_port *port);

	/* Port disable callback */
	void			(*disable)(struct uart_port *port);

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

83 84 85 86
	/* Interface clock */
	struct clk		*iclk;
	/* Data clock */
	struct clk		*dclk;
87

88
	struct list_head	node;
89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109
	struct dma_chan			*chan_tx;
	struct dma_chan			*chan_rx;
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	struct device			*dma_dev;
	enum sh_dmae_slave_chan_id	slave_tx;
	enum sh_dmae_slave_chan_id	slave_rx;
	struct dma_async_tx_descriptor	*desc_tx;
	struct dma_async_tx_descriptor	*desc_rx[2];
	dma_cookie_t			cookie_tx;
	dma_cookie_t			cookie_rx[2];
	dma_cookie_t			active_rx;
	struct scatterlist		sg_tx;
	unsigned int			sg_len_tx;
	struct scatterlist		sg_rx[2];
	size_t				buf_len_rx;
	struct sh_dmae_slave		param_tx;
	struct sh_dmae_slave		param_rx;
	struct work_struct		work_tx;
	struct work_struct		work_rx;
	struct timer_list		rx_timer;
#endif
110 111 112 113 114 115
};

struct sh_sci_priv {
	spinlock_t lock;
	struct list_head ports;
	struct notifier_block clk_nb;
116 117
};

L
Linus Torvalds 已提交
118
/* Function prototypes */
119
static void sci_stop_tx(struct uart_port *port);
L
Linus Torvalds 已提交
120

121
#define SCI_NPORTS CONFIG_SERIAL_SH_SCI_NR_UARTS
122

123 124
static struct sci_port sci_ports[SCI_NPORTS];
static struct uart_driver sci_uart_driver;
L
Linus Torvalds 已提交
125

126 127 128 129 130 131
static inline struct sci_port *
to_sci_port(struct uart_port *uart)
{
	return container_of(uart, struct sci_port, port);
}

132
#if defined(CONFIG_CONSOLE_POLL) || defined(CONFIG_SERIAL_SH_SCI_CONSOLE)
133 134

#ifdef CONFIG_CONSOLE_POLL
135 136 137
static inline void handle_error(struct uart_port *port)
{
	/* Clear error flags */
L
Linus Torvalds 已提交
138 139 140
	sci_out(port, SCxSR, SCxSR_ERROR_CLEAR(port));
}

141
static int sci_poll_get_char(struct uart_port *port)
L
Linus Torvalds 已提交
142 143 144 145
{
	unsigned short status;
	int c;

146
	do {
L
Linus Torvalds 已提交
147 148 149 150 151 152
		status = sci_in(port, SCxSR);
		if (status & SCxSR_ERRORS(port)) {
			handle_error(port);
			continue;
		}
	} while (!(status & SCxSR_RDxF(port)));
153

L
Linus Torvalds 已提交
154
	c = sci_in(port, SCxRDR);
155

156 157
	/* Dummy read */
	sci_in(port, SCxSR);
L
Linus Torvalds 已提交
158 159 160 161
	sci_out(port, SCxSR, SCxSR_RDxF_CLEAR(port));

	return c;
}
162
#endif
L
Linus Torvalds 已提交
163

164
static void sci_poll_put_char(struct uart_port *port, unsigned char c)
L
Linus Torvalds 已提交
165 166 167 168 169 170 171
{
	unsigned short status;

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

172
	sci_out(port, SCxTDR, c);
173
	sci_out(port, SCxSR, SCxSR_TDxE_CLEAR(port) & ~SCxSR_TEND(port));
L
Linus Torvalds 已提交
174
}
175
#endif /* CONFIG_CONSOLE_POLL || CONFIG_SERIAL_SH_SCI_CONSOLE */
L
Linus Torvalds 已提交
176

177
#if defined(__H8300H__) || defined(__H8300S__)
178
static void sci_init_pins(struct uart_port *port, unsigned int cflag)
L
Linus Torvalds 已提交
179 180 181 182
{
	int ch = (port->mapbase - SMR0) >> 3;

	/* set DDR regs */
183 184 185 186 187 188 189
	H8300_GPIO_DDR(h8300_sci_pins[ch].port,
		       h8300_sci_pins[ch].rx,
		       H8300_GPIO_INPUT);
	H8300_GPIO_DDR(h8300_sci_pins[ch].port,
		       h8300_sci_pins[ch].tx,
		       H8300_GPIO_OUTPUT);

L
Linus Torvalds 已提交
190 191 192
	/* tx mark output*/
	H8300_SCI_DR(ch) |= h8300_sci_pins[ch].tx;
}
193 194
#elif defined(CONFIG_CPU_SUBTYPE_SH7710) || defined(CONFIG_CPU_SUBTYPE_SH7712)
static inline void sci_init_pins(struct uart_port *port, unsigned int cflag)
195
{
196 197 198 199 200
	if (port->mapbase == 0xA4400000) {
		__raw_writew(__raw_readw(PACR) & 0xffc0, PACR);
		__raw_writew(__raw_readw(PBCR) & 0x0fff, PBCR);
	} else if (port->mapbase == 0xA4410000)
		__raw_writew(__raw_readw(PBCR) & 0xf003, PBCR);
201
}
202
#elif defined(CONFIG_CPU_SUBTYPE_SH7720) || defined(CONFIG_CPU_SUBTYPE_SH7721)
203
static inline void sci_init_pins(struct uart_port *port, unsigned int cflag)
M
Markus Brunner 已提交
204 205 206 207 208 209 210
{
	unsigned short data;

	if (cflag & CRTSCTS) {
		/* enable RTS/CTS */
		if (port->mapbase == 0xa4430000) { /* SCIF0 */
			/* Clear PTCR bit 9-2; enable all scif pins but sck */
211 212
			data = __raw_readw(PORT_PTCR);
			__raw_writew((data & 0xfc03), PORT_PTCR);
M
Markus Brunner 已提交
213 214
		} else if (port->mapbase == 0xa4438000) { /* SCIF1 */
			/* Clear PVCR bit 9-2 */
215 216
			data = __raw_readw(PORT_PVCR);
			__raw_writew((data & 0xfc03), PORT_PVCR);
M
Markus Brunner 已提交
217 218 219 220
		}
	} else {
		if (port->mapbase == 0xa4430000) { /* SCIF0 */
			/* Clear PTCR bit 5-2; enable only tx and rx  */
221 222
			data = __raw_readw(PORT_PTCR);
			__raw_writew((data & 0xffc3), PORT_PTCR);
M
Markus Brunner 已提交
223 224
		} else if (port->mapbase == 0xa4438000) { /* SCIF1 */
			/* Clear PVCR bit 5-2 */
225 226
			data = __raw_readw(PORT_PVCR);
			__raw_writew((data & 0xffc3), PORT_PVCR);
M
Markus Brunner 已提交
227 228 229
		}
	}
}
230
#elif defined(CONFIG_CPU_SH3)
231
/* For SH7705, SH7706, SH7707, SH7709, SH7709A, SH7729 */
232
static inline void sci_init_pins(struct uart_port *port, unsigned int cflag)
L
Linus Torvalds 已提交
233
{
234 235 236
	unsigned short data;

	/* We need to set SCPCR to enable RTS/CTS */
237
	data = __raw_readw(SCPCR);
238
	/* Clear out SCP7MD1,0, SCP6MD1,0, SCP4MD1,0*/
239
	__raw_writew(data & 0x0fcf, SCPCR);
L
Linus Torvalds 已提交
240

241
	if (!(cflag & CRTSCTS)) {
L
Linus Torvalds 已提交
242
		/* We need to set SCPCR to enable RTS/CTS */
243
		data = __raw_readw(SCPCR);
L
Linus Torvalds 已提交
244 245
		/* Clear out SCP7MD1,0, SCP4MD1,0,
		   Set SCP6MD1,0 = {01} (output)  */
246
		__raw_writew((data & 0x0fcf) | 0x1000, SCPCR);
L
Linus Torvalds 已提交
247

248
		data = __raw_readb(SCPDR);
L
Linus Torvalds 已提交
249
		/* Set /RTS2 (bit6) = 0 */
250
		__raw_writeb(data & 0xbf, SCPDR);
L
Linus Torvalds 已提交
251 252
	}
}
P
Paul Mundt 已提交
253
#elif defined(CONFIG_CPU_SUBTYPE_SH7722)
254
static inline void sci_init_pins(struct uart_port *port, unsigned int cflag)
P
Paul Mundt 已提交
255
{
M
Magnus Damm 已提交
256
	unsigned short data;
P
Paul Mundt 已提交
257

M
Magnus Damm 已提交
258
	if (port->mapbase == 0xffe00000) {
259
		data = __raw_readw(PSCR);
M
Magnus Damm 已提交
260
		data &= ~0x03cf;
261
		if (!(cflag & CRTSCTS))
M
Magnus Damm 已提交
262
			data |= 0x0340;
P
Paul Mundt 已提交
263

264
		__raw_writew(data, PSCR);
P
Paul Mundt 已提交
265
	}
266
}
267 268
#elif defined(CONFIG_CPU_SUBTYPE_SH7757) || \
      defined(CONFIG_CPU_SUBTYPE_SH7763) || \
269
      defined(CONFIG_CPU_SUBTYPE_SH7780) || \
270
      defined(CONFIG_CPU_SUBTYPE_SH7785) || \
271
      defined(CONFIG_CPU_SUBTYPE_SH7786) || \
272
      defined(CONFIG_CPU_SUBTYPE_SHX3)
273 274 275 276 277
static inline void sci_init_pins(struct uart_port *port, unsigned int cflag)
{
	if (!(cflag & CRTSCTS))
		__raw_writew(0x0080, SCSPTR0); /* Set RTS = 1 */
}
278
#elif defined(CONFIG_CPU_SH4) && !defined(CONFIG_CPU_SH4A)
279 280 281 282 283
static inline void sci_init_pins(struct uart_port *port, unsigned int cflag)
{
	if (!(cflag & CRTSCTS))
		__raw_writew(0x0080, SCSPTR2); /* Set RTS = 1 */
}
284
#else
285 286 287
static inline void sci_init_pins(struct uart_port *port, unsigned int cflag)
{
	/* Nothing to do */
L
Linus Torvalds 已提交
288
}
289 290
#endif

291 292
#if defined(CONFIG_CPU_SUBTYPE_SH7760) || \
    defined(CONFIG_CPU_SUBTYPE_SH7780) || \
293 294
    defined(CONFIG_CPU_SUBTYPE_SH7785) || \
    defined(CONFIG_CPU_SUBTYPE_SH7786)
295
static int scif_txfill(struct uart_port *port)
296
{
297
	return sci_in(port, SCTFDR) & 0xff;
298 299
}

300 301 302 303 304 305
static int scif_txroom(struct uart_port *port)
{
	return SCIF_TXROOM_MAX - scif_txfill(port);
}

static int scif_rxfill(struct uart_port *port)
306
{
307
	return sci_in(port, SCRFDR) & 0xff;
308
}
309
#elif defined(CONFIG_CPU_SUBTYPE_SH7763)
310
static int scif_txfill(struct uart_port *port)
311
{
312 313
	if (port->mapbase == 0xffe00000 ||
	    port->mapbase == 0xffe08000)
314
		/* SCIF0/1*/
315 316
		return sci_in(port, SCTFDR) & 0xff;
	else
317
		/* SCIF2 */
318 319 320 321 322 323 324 325 326 327 328 329
		return sci_in(port, SCFDR) >> 8;
}

static int scif_txroom(struct uart_port *port)
{
	if (port->mapbase == 0xffe00000 ||
	    port->mapbase == 0xffe08000)
		/* SCIF0/1*/
		return SCIF_TXROOM_MAX - scif_txfill(port);
	else
		/* SCIF2 */
		return SCIF2_TXROOM_MAX - scif_txfill(port);
330 331
}

332
static int scif_rxfill(struct uart_port *port)
333
{
334 335 336
	if ((port->mapbase == 0xffe00000) ||
	    (port->mapbase == 0xffe08000)) {
		/* SCIF0/1*/
337
		return sci_in(port, SCRFDR) & 0xff;
338 339
	} else {
		/* SCIF2 */
340
		return sci_in(port, SCFDR) & SCIF2_RFDC_MASK;
341
	}
342
}
343
#else
344
static int scif_txfill(struct uart_port *port)
345
{
346
	return sci_in(port, SCFDR) >> 8;
347
}
L
Linus Torvalds 已提交
348

349 350 351 352 353 354
static int scif_txroom(struct uart_port *port)
{
	return SCIF_TXROOM_MAX - scif_txfill(port);
}

static int scif_rxfill(struct uart_port *port)
355 356 357
{
	return sci_in(port, SCFDR) & SCIF_RFDC_MASK;
}
L
Linus Torvalds 已提交
358 359
#endif

360
static int sci_txfill(struct uart_port *port)
361
{
362
	return !(sci_in(port, SCxSR) & SCI_TDRE);
363 364
}

365 366 367 368 369 370
static int sci_txroom(struct uart_port *port)
{
	return !sci_txfill(port);
}

static int sci_rxfill(struct uart_port *port)
371
{
372
	return (sci_in(port, SCxSR) & SCxSR_RDxF(port)) != 0;
373 374
}

L
Linus Torvalds 已提交
375 376 377 378 379 380
/* ********************************************************************** *
 *                   the interrupt related routines                       *
 * ********************************************************************** */

static void sci_transmit_chars(struct uart_port *port)
{
A
Alan Cox 已提交
381
	struct circ_buf *xmit = &port->state->xmit;
L
Linus Torvalds 已提交
382 383 384
	unsigned int stopped = uart_tx_stopped(port);
	unsigned short status;
	unsigned short ctrl;
385
	int count;
L
Linus Torvalds 已提交
386 387 388 389

	status = sci_in(port, SCxSR);
	if (!(status & SCxSR_TDxE(port))) {
		ctrl = sci_in(port, SCSCR);
390
		if (uart_circ_empty(xmit))
L
Linus Torvalds 已提交
391
			ctrl &= ~SCI_CTRL_FLAGS_TIE;
392
		else
L
Linus Torvalds 已提交
393 394 395 396 397
			ctrl |= SCI_CTRL_FLAGS_TIE;
		sci_out(port, SCSCR, ctrl);
		return;
	}

398
	if (port->type == PORT_SCI)
399
		count = sci_txroom(port);
400 401
	else
		count = scif_txroom(port);
L
Linus Torvalds 已提交
402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423 424 425

	do {
		unsigned char c;

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

		sci_out(port, SCxTDR, c);

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

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

	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
		uart_write_wakeup(port);
	if (uart_circ_empty(xmit)) {
426
		sci_stop_tx(port);
L
Linus Torvalds 已提交
427 428 429
	} else {
		ctrl = sci_in(port, SCSCR);

430
		if (port->type != PORT_SCI) {
L
Linus Torvalds 已提交
431 432 433 434 435 436 437 438 439 440
			sci_in(port, SCxSR); /* Dummy read */
			sci_out(port, SCxSR, SCxSR_TDxE_CLEAR(port));
		}

		ctrl |= SCI_CTRL_FLAGS_TIE;
		sci_out(port, SCSCR, ctrl);
	}
}

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

443
static inline void sci_receive_chars(struct uart_port *port)
L
Linus Torvalds 已提交
444
{
445
	struct sci_port *sci_port = to_sci_port(port);
A
Alan Cox 已提交
446
	struct tty_struct *tty = port->state->port.tty;
L
Linus Torvalds 已提交
447 448
	int i, count, copied = 0;
	unsigned short status;
A
Alan Cox 已提交
449
	unsigned char flag;
L
Linus Torvalds 已提交
450 451 452 453 454 455

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

	while (1) {
456
		if (port->type == PORT_SCI)
457
			count = sci_rxfill(port);
458
		else
459
			count = scif_rxfill(port);
L
Linus Torvalds 已提交
460 461

		/* Don't copy more bytes than there is room for in the buffer */
A
Alan Cox 已提交
462
		count = tty_buffer_request_room(tty, count);
L
Linus Torvalds 已提交
463 464 465 466 467 468 469

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

		if (port->type == PORT_SCI) {
			char c = sci_in(port, SCxRDR);
470 471
			if (uart_handle_sysrq_char(port, c) ||
			    sci_port->break_flag)
L
Linus Torvalds 已提交
472
				count = 0;
473
			else
474
				tty_insert_flip_char(tty, c, TTY_NORMAL);
L
Linus Torvalds 已提交
475
		} else {
476
			for (i = 0; i < count; i++) {
L
Linus Torvalds 已提交
477 478 479 480
				char c = sci_in(port, SCxRDR);
				status = sci_in(port, SCxSR);
#if defined(CONFIG_CPU_SH3)
				/* Skip "chars" during break */
481
				if (sci_port->break_flag) {
L
Linus Torvalds 已提交
482 483 484 485 486
					if ((c == 0) &&
					    (status & SCxSR_FER(port))) {
						count--; i--;
						continue;
					}
487

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

L
Linus Torvalds 已提交
492 493 494 495 496 497
					if (STEPFN(c)) {
						count--; i--;
						continue;
					}
				}
#endif /* CONFIG_CPU_SH3 */
498
				if (uart_handle_sysrq_char(port, c)) {
L
Linus Torvalds 已提交
499 500 501 502 503
					count--; i--;
					continue;
				}

				/* Store data and status */
504
				if (status & SCxSR_FER(port)) {
A
Alan Cox 已提交
505
					flag = TTY_FRAME;
506
					dev_notice(port->dev, "frame error\n");
507
				} else if (status & SCxSR_PER(port)) {
A
Alan Cox 已提交
508
					flag = TTY_PARITY;
509
					dev_notice(port->dev, "parity error\n");
A
Alan Cox 已提交
510 511
				} else
					flag = TTY_NORMAL;
512

A
Alan Cox 已提交
513
				tty_insert_flip_char(tty, c, flag);
L
Linus Torvalds 已提交
514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539 540 541 542 543 544 545 546 547 548
			}
		}

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

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

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

#define SCI_BREAK_JIFFIES (HZ/20)
/* The sci generates interrupts during the break,
 * 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.
 */
static void sci_schedule_break_timer(struct sci_port *port)
{
	port->break_timer.expires = jiffies + SCI_BREAK_JIFFIES;
	add_timer(&port->break_timer);
}
/* Ensure that two consecutive samples find the break over. */
static void sci_break_timer(unsigned long data)
{
549 550 551
	struct sci_port *port = (struct sci_port *)data;

	if (sci_rxd_in(&port->port) == 0) {
L
Linus Torvalds 已提交
552
		port->break_flag = 1;
553 554
		sci_schedule_break_timer(port);
	} else if (port->break_flag == 1) {
L
Linus Torvalds 已提交
555 556
		/* break is over. */
		port->break_flag = 2;
557 558 559
		sci_schedule_break_timer(port);
	} else
		port->break_flag = 0;
L
Linus Torvalds 已提交
560 561 562 563 564 565
}

static inline int sci_handle_errors(struct uart_port *port)
{
	int copied = 0;
	unsigned short status = sci_in(port, SCxSR);
A
Alan Cox 已提交
566
	struct tty_struct *tty = port->state->port.tty;
L
Linus Torvalds 已提交
567

568
	if (status & SCxSR_ORER(port)) {
L
Linus Torvalds 已提交
569
		/* overrun error */
570
		if (tty_insert_flip_char(tty, 0, TTY_OVERRUN))
A
Alan Cox 已提交
571
			copied++;
572 573

		dev_notice(port->dev, "overrun error");
L
Linus Torvalds 已提交
574 575
	}

576
	if (status & SCxSR_FER(port)) {
L
Linus Torvalds 已提交
577 578
		if (sci_rxd_in(port) == 0) {
			/* Notify of BREAK */
579
			struct sci_port *sci_port = to_sci_port(port);
580 581 582 583 584

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

L
Linus Torvalds 已提交
585
				/* Do sysrq handling. */
586
				if (uart_handle_break(port))
L
Linus Torvalds 已提交
587
					return 0;
588 589 590

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

591
				if (tty_insert_flip_char(tty, 0, TTY_BREAK))
592 593 594
					copied++;
			}

595
		} else {
L
Linus Torvalds 已提交
596
			/* frame error */
597
			if (tty_insert_flip_char(tty, 0, TTY_FRAME))
A
Alan Cox 已提交
598
				copied++;
599 600

			dev_notice(port->dev, "frame error\n");
L
Linus Torvalds 已提交
601 602 603
		}
	}

604
	if (status & SCxSR_PER(port)) {
L
Linus Torvalds 已提交
605
		/* parity error */
606 607
		if (tty_insert_flip_char(tty, 0, TTY_PARITY))
			copied++;
608 609

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

A
Alan Cox 已提交
612
	if (copied)
L
Linus Torvalds 已提交
613 614 615 616 617
		tty_flip_buffer_push(tty);

	return copied;
}

618 619
static inline int sci_handle_fifo_overrun(struct uart_port *port)
{
A
Alan Cox 已提交
620
	struct tty_struct *tty = port->state->port.tty;
621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 637 638
	int copied = 0;

	if (port->type != PORT_SCIF)
		return 0;

	if ((sci_in(port, SCLSR) & SCIF_ORER) != 0) {
		sci_out(port, SCLSR, 0);

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

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

	return copied;
}

L
Linus Torvalds 已提交
639 640 641 642
static inline int sci_handle_breaks(struct uart_port *port)
{
	int copied = 0;
	unsigned short status = sci_in(port, SCxSR);
A
Alan Cox 已提交
643
	struct tty_struct *tty = port->state->port.tty;
644
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
645

646 647 648
	if (uart_handle_break(port))
		return 0;

649
	if (!s->break_flag && status & SCxSR_BRK(port)) {
L
Linus Torvalds 已提交
650 651 652 653 654
#if defined(CONFIG_CPU_SH3)
		/* Debounce break */
		s->break_flag = 1;
#endif
		/* Notify of BREAK */
655
		if (tty_insert_flip_char(tty, 0, TTY_BREAK))
A
Alan Cox 已提交
656
			copied++;
657 658

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

A
Alan Cox 已提交
661
	if (copied)
L
Linus Torvalds 已提交
662
		tty_flip_buffer_push(tty);
663

664 665
	copied += sci_handle_fifo_overrun(port);

L
Linus Torvalds 已提交
666 667 668
	return copied;
}

669
static irqreturn_t sci_rx_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
670
{
671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	struct uart_port *port = ptr;
	struct sci_port *s = to_sci_port(port);

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

		/* Disable future Rx interrupts */
		sci_out(port, SCSCR, scr & ~SCI_CTRL_FLAGS_RIE);
		/* Clear current interrupt */
		sci_out(port, SCxSR, ssr & ~(1 | SCxSR_RDxF(port)));
		/* Calculate delay for 1.5 DMA buffers */
		tout = (port->timeout - HZ / 50) * s->buf_len_rx * 3 /
			port->fifosize / 2;
687
		dev_dbg(port->dev, "Rx IRQ: setup timeout in %lu ms\n",
688 689 690 691 692 693 694 695 696
			tout * 1000 / HZ);
		if (tout < 2)
			tout = 2;
		mod_timer(&s->rx_timer, jiffies + tout);

		return IRQ_HANDLED;
	}
#endif

L
Linus Torvalds 已提交
697 698 699 700
	/* 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?
	 */
701
	sci_receive_chars(ptr);
L
Linus Torvalds 已提交
702 703 704 705

	return IRQ_HANDLED;
}

706
static irqreturn_t sci_tx_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
707 708
{
	struct uart_port *port = ptr;
709
	unsigned long flags;
L
Linus Torvalds 已提交
710

711
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
712
	sci_transmit_chars(port);
713
	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
714 715 716 717

	return IRQ_HANDLED;
}

718
static irqreturn_t sci_er_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
719 720 721 722 723 724 725 726 727 728 729
{
	struct uart_port *port = ptr;

	/* Handle errors */
	if (port->type == PORT_SCI) {
		if (sci_handle_errors(port)) {
			/* discard character in rx buffer */
			sci_in(port, SCxSR);
			sci_out(port, SCxSR, SCxSR_RDxF_CLEAR(port));
		}
	} else {
730
		sci_handle_fifo_overrun(port);
731
		sci_rx_interrupt(irq, ptr);
L
Linus Torvalds 已提交
732 733 734 735 736
	}

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

	/* Kick the transmission */
737
	sci_tx_interrupt(irq, ptr);
L
Linus Torvalds 已提交
738 739 740 741

	return IRQ_HANDLED;
}

742
static irqreturn_t sci_br_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
743 744 745 746 747 748 749 750 751 752
{
	struct uart_port *port = ptr;

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

	return IRQ_HANDLED;
}

753
static irqreturn_t sci_mpxed_interrupt(int irq, void *ptr)
L
Linus Torvalds 已提交
754
{
755
	unsigned short ssr_status, scr_status, err_enabled;
756
	struct uart_port *port = ptr;
757
	struct sci_port *s = to_sci_port(port);
758
	irqreturn_t ret = IRQ_NONE;
L
Linus Torvalds 已提交
759

760 761
	ssr_status = sci_in(port, SCxSR);
	scr_status = sci_in(port, SCSCR);
762
	err_enabled = scr_status & (SCI_CTRL_FLAGS_REIE | SCI_CTRL_FLAGS_RIE);
L
Linus Torvalds 已提交
763 764

	/* Tx Interrupt */
765 766
	if ((ssr_status & SCxSR_TDxE(port)) && (scr_status & SCI_CTRL_FLAGS_TIE) &&
	    !s->chan_tx)
767
		ret = sci_tx_interrupt(irq, ptr);
768 769 770 771 772 773
	/*
	 * 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 & SCI_CTRL_FLAGS_RIE))
774
		ret = sci_rx_interrupt(irq, ptr);
L
Linus Torvalds 已提交
775
	/* Error Interrupt */
776
	if ((ssr_status & SCxSR_ERRORS(port)) && err_enabled)
777
		ret = sci_er_interrupt(irq, ptr);
L
Linus Torvalds 已提交
778
	/* Break Interrupt */
779
	if ((ssr_status & SCxSR_BRK(port)) && err_enabled)
780
		ret = sci_br_interrupt(irq, ptr);
L
Linus Torvalds 已提交
781

782 783 784 785
	WARN_ONCE(ret == IRQ_NONE,
		  "%s: %d IRQ %d, status %x, control %x\n", __func__,
		  irq, port->line, ssr_status, scr_status);

786
	return ret;
L
Linus Torvalds 已提交
787 788 789 790 791 792
}

/*
 * Here we define a transistion notifier so that we can update all of our
 * ports' baud rate when the peripheral clock changes.
 */
793 794
static int sci_notifier(struct notifier_block *self,
			unsigned long phase, void *p)
L
Linus Torvalds 已提交
795
{
796 797 798 799
	struct sh_sci_priv *priv = container_of(self,
						struct sh_sci_priv, clk_nb);
	struct sci_port *sci_port;
	unsigned long flags;
L
Linus Torvalds 已提交
800 801

	if ((phase == CPUFREQ_POSTCHANGE) ||
802 803 804
	    (phase == CPUFREQ_RESUMECHANGE)) {
		spin_lock_irqsave(&priv->lock, flags);
		list_for_each_entry(sci_port, &priv->ports, node)
805
			sci_port->port.uartclk = clk_get_rate(sci_port->dclk);
806 807
		spin_unlock_irqrestore(&priv->lock, flags);
	}
L
Linus Torvalds 已提交
808 809 810

	return NOTIFY_OK;
}
811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831

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

	clk_enable(sci_port->dclk);
	sci_port->port.uartclk = clk_get_rate(sci_port->dclk);

	if (sci_port->iclk)
		clk_enable(sci_port->iclk);
}

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

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

	clk_disable(sci_port->dclk);
}
L
Linus Torvalds 已提交
832 833 834 835

static int sci_request_irq(struct sci_port *port)
{
	int i;
836
	irqreturn_t (*handlers[4])(int irq, void *ptr) = {
L
Linus Torvalds 已提交
837 838 839 840 841 842 843
		sci_er_interrupt, sci_rx_interrupt, sci_tx_interrupt,
		sci_br_interrupt,
	};
	const char *desc[] = { "SCI Receive Error", "SCI Receive Data Full",
			       "SCI Transmit Data Empty", "SCI Break" };

	if (port->irqs[0] == port->irqs[1]) {
844
		if (unlikely(!port->irqs[0]))
L
Linus Torvalds 已提交
845
			return -ENODEV;
846 847

		if (request_irq(port->irqs[0], sci_mpxed_interrupt,
P
Paul Mundt 已提交
848
				IRQF_DISABLED, "sci", port)) {
849
			dev_err(port->port.dev, "Can't allocate IRQ\n");
L
Linus Torvalds 已提交
850 851 852 853
			return -ENODEV;
		}
	} else {
		for (i = 0; i < ARRAY_SIZE(handlers); i++) {
854
			if (unlikely(!port->irqs[i]))
L
Linus Torvalds 已提交
855
				continue;
856

857
			if (request_irq(port->irqs[i], handlers[i],
P
Paul Mundt 已提交
858
					IRQF_DISABLED, desc[i], port)) {
859
				dev_err(port->port.dev, "Can't allocate IRQ\n");
L
Linus Torvalds 已提交
860 861 862 863 864 865 866 867 868 869 870 871
				return -ENODEV;
			}
		}
	}

	return 0;
}

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

872 873 874
	if (port->irqs[0] == port->irqs[1])
		free_irq(port->irqs[0], port);
	else {
L
Linus Torvalds 已提交
875 876 877 878 879 880 881 882 883 884 885
		for (i = 0; i < ARRAY_SIZE(port->irqs); i++) {
			if (!port->irqs[i])
				continue;

			free_irq(port->irqs[i], port);
		}
	}
}

static unsigned int sci_tx_empty(struct uart_port *port)
{
886
	unsigned short status = sci_in(port, SCxSR);
887 888 889
	unsigned short in_tx_fifo = scif_txfill(port);

	return (status & SCxSR_TEND(port)) && !in_tx_fifo ? TIOCSER_TEMT : 0;
L
Linus Torvalds 已提交
890 891 892 893 894 895 896 897 898 899 900
}

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

static unsigned int sci_get_mctrl(struct uart_port *port)
{
901
	/* This routine is used for getting signals of: DTR, DCD, DSR, RI,
L
Linus Torvalds 已提交
902 903 904 905 906
	   and CTS/RTS */

	return TIOCM_DTR | TIOCM_RTS | TIOCM_DSR;
}

907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146 1147 1148 1149 1150 1151 1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176
#ifdef CONFIG_SERIAL_SH_SCI_DMA
static void sci_dma_tx_complete(void *arg)
{
	struct sci_port *s = arg;
	struct uart_port *port = &s->port;
	struct circ_buf *xmit = &port->state->xmit;
	unsigned long flags;

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

	spin_lock_irqsave(&port->lock, flags);

	xmit->tail += s->sg_tx.length;
	xmit->tail &= UART_XMIT_SIZE - 1;

	port->icount.tx += s->sg_tx.length;

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

	spin_unlock_irqrestore(&port->lock, flags);

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

	if (uart_circ_chars_pending(xmit))
		schedule_work(&s->work_tx);
}

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

	room = tty_buffer_request_room(tty, count);

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

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

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

	port->icount.rx += room;

	return room;
}

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

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

	spin_lock_irqsave(&port->lock, flags);

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

	mod_timer(&s->rx_timer, jiffies + msecs_to_jiffies(5));

	spin_unlock_irqrestore(&port->lock, flags);

	if (count)
		tty_flip_buffer_push(tty);

	schedule_work(&s->work_rx);
}

static void sci_start_rx(struct uart_port *port);
static void sci_start_tx(struct uart_port *port);

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

	s->chan_rx = NULL;
	s->cookie_rx[0] = s->cookie_rx[1] = -EINVAL;
	dma_release_channel(chan);
	dma_free_coherent(port->dev, s->buf_len_rx * 2,
			  sg_virt(&s->sg_rx[0]), sg_dma_address(&s->sg_rx[0]));
	if (enable_pio)
		sci_start_rx(port);
}

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

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

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

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

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

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

		if (!desc || s->cookie_rx[i] < 0) {
			if (i) {
				async_tx_ack(s->desc_rx[0]);
				s->cookie_rx[0] = -EINVAL;
			}
			if (desc) {
				async_tx_ack(desc);
				s->cookie_rx[i] = -EINVAL;
			}
			dev_warn(s->port.dev,
				 "failed to re-start DMA, using PIO\n");
			sci_rx_dma_release(s, true);
			return;
		}
	}

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

	dma_async_issue_pending(chan);
}

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

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

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

		chan->device->device_terminate_all(chan);
		dev_dbg(port->dev, "Read %u bytes with cookie %d\n",
			sh_desc->partial, sh_desc->cookie);

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

		if (count)
			tty_flip_buffer_push(tty);

		sci_submit_rx(s);

		return;
	}

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

	dev_dbg(port->dev, "%s: cookie %d #%d\n", __func__,
		s->cookie_rx[new], new);

	s->active_rx = s->cookie_rx[!new];
}

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

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

	BUG_ON(!sg->length);

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

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

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

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

	dma_async_issue_pending(chan);
}
#endif

1177
static void sci_start_tx(struct uart_port *port)
L
Linus Torvalds 已提交
1178
{
1179
	unsigned short ctrl;
L
Linus Torvalds 已提交
1180

1181 1182 1183 1184 1185 1186 1187 1188 1189 1190 1191
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	struct sci_port *s = to_sci_port(port);

	if (s->chan_tx) {
		if (!uart_circ_empty(&s->port.state->xmit) && s->cookie_tx < 0)
			schedule_work(&s->work_tx);

		return;
	}
#endif

1192 1193 1194 1195
	/* Set TIE (Transmit Interrupt Enable) bit in SCSCR */
	ctrl = sci_in(port, SCSCR);
	ctrl |= SCI_CTRL_FLAGS_TIE;
	sci_out(port, SCSCR, ctrl);
L
Linus Torvalds 已提交
1196 1197
}

1198
static void sci_stop_tx(struct uart_port *port)
L
Linus Torvalds 已提交
1199 1200 1201 1202 1203 1204 1205 1206 1207
{
	unsigned short ctrl;

	/* Clear TIE (Transmit Interrupt Enable) bit in SCSCR */
	ctrl = sci_in(port, SCSCR);
	ctrl &= ~SCI_CTRL_FLAGS_TIE;
	sci_out(port, SCSCR, ctrl);
}

1208
static void sci_start_rx(struct uart_port *port)
L
Linus Torvalds 已提交
1209
{
1210
	unsigned short ctrl = SCI_CTRL_FLAGS_RIE | SCI_CTRL_FLAGS_REIE;
L
Linus Torvalds 已提交
1211 1212

	/* Set RIE (Receive Interrupt Enable) bit in SCSCR */
1213
	ctrl |= sci_in(port, SCSCR);
L
Linus Torvalds 已提交
1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236
	sci_out(port, SCSCR, ctrl);
}

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

	/* Clear RIE (Receive Interrupt Enable) bit in SCSCR */
	ctrl = sci_in(port, SCSCR);
	ctrl &= ~(SCI_CTRL_FLAGS_RIE | SCI_CTRL_FLAGS_REIE);
	sci_out(port, SCSCR, ctrl);
}

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

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

1237 1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259 1260 1261 1262 1263 1264 1265 1266 1267 1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292 1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357 1358 1359 1360 1361 1362 1363 1364 1365 1366 1367 1368 1369
#ifdef CONFIG_SERIAL_SH_SCI_DMA
static bool filter(struct dma_chan *chan, void *slave)
{
	struct sh_dmae_slave *param = slave;

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

	if (param->dma_dev == chan->device->dev) {
		chan->private = param;
		return true;
	} else {
		return false;
	}
}

static void rx_timer_fn(unsigned long arg)
{
	struct sci_port *s = (struct sci_port *)arg;
	struct uart_port *port = &s->port;

	u16 scr = sci_in(port, SCSCR);
	sci_out(port, SCSCR, scr | SCI_CTRL_FLAGS_RIE);
	dev_dbg(port->dev, "DMA Rx timed out\n");
	schedule_work(&s->work_rx);
}

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

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

	if (!s->dma_dev)
		return;

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

	param = &s->param_tx;

	/* Slave ID, e.g., SHDMA_SLAVE_SCIF0_TX */
	param->slave_id = s->slave_tx;
	param->dma_dev = s->dma_dev;

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

		s->sg_len_tx = nent;

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

	param = &s->param_rx;

	/* Slave ID, e.g., SHDMA_SLAVE_SCIF0_RX */
	param->slave_id = s->slave_rx;
	param->dma_dev = s->dma_dev;

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

		s->chan_rx = chan;

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

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

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

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

			sg_init_table(sg, 1);
			sg_set_page(sg, virt_to_page(buf[i]), s->buf_len_rx,
				    (int)buf[i] & ~PAGE_MASK);
			sg->dma_address = dma[i];
			sg->dma_length = sg->length;
		}

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

		sci_submit_rx(s);
	}
}

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

	if (!s->dma_dev)
		return;

	if (s->chan_tx)
		sci_tx_dma_release(s, false);
	if (s->chan_rx)
		sci_rx_dma_release(s, false);
}
#endif

L
Linus Torvalds 已提交
1370 1371
static int sci_startup(struct uart_port *port)
{
1372
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
1373

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

1376 1377
	if (s->enable)
		s->enable(port);
L
Linus Torvalds 已提交
1378 1379

	sci_request_irq(s);
1380 1381 1382
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	sci_request_dma(port);
#endif
1383
	sci_start_tx(port);
1384
	sci_start_rx(port);
L
Linus Torvalds 已提交
1385 1386 1387 1388 1389 1390

	return 0;
}

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

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

L
Linus Torvalds 已提交
1395
	sci_stop_rx(port);
1396
	sci_stop_tx(port);
1397 1398 1399
#ifdef CONFIG_SERIAL_SH_SCI_DMA
	sci_free_dma(port);
#endif
L
Linus Torvalds 已提交
1400 1401
	sci_free_irq(s);

1402 1403
	if (s->disable)
		s->disable(port);
L
Linus Torvalds 已提交
1404 1405
}

A
Alan Cox 已提交
1406 1407
static void sci_set_termios(struct uart_port *port, struct ktermios *termios,
			    struct ktermios *old)
L
Linus Torvalds 已提交
1408
{
1409
	unsigned int status, baud, smr_val, max_baud;
1410
	int t = -1;
L
Linus Torvalds 已提交
1411

1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423
	/*
	 * earlyprintk comes here early on with port->uartclk set to zero.
	 * the clock framework is not up and running at this point so here
	 * we assume that 115200 is the maximum baud rate. please note that
	 * the baud rate is not programmed during earlyprintk - it is assumed
	 * that the previous boot loader has enabled required clocks and
	 * setup the baud rate generator hardware for us already.
	 */
	max_baud = port->uartclk ? port->uartclk / 16 : 115200;

	baud = uart_get_baud_rate(port, termios, old, 0, max_baud);
	if (likely(baud && port->uartclk))
1424
		t = SCBRR_VALUE(baud, port->uartclk);
1425

L
Linus Torvalds 已提交
1426 1427 1428 1429 1430 1431
	do {
		status = sci_in(port, SCxSR);
	} while (!(status & SCxSR_TEND(port)));

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

1432
	if (port->type != PORT_SCI)
L
Linus Torvalds 已提交
1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448
		sci_out(port, SCFCR, SCFCR_RFRST | SCFCR_TFRST);

	smr_val = sci_in(port, SCSMR) & 3;
	if ((termios->c_cflag & CSIZE) == CS7)
		smr_val |= 0x40;
	if (termios->c_cflag & PARENB)
		smr_val |= 0x20;
	if (termios->c_cflag & PARODD)
		smr_val |= 0x30;
	if (termios->c_cflag & CSTOPB)
		smr_val |= 0x08;

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

	sci_out(port, SCSMR, smr_val);

1449 1450 1451
	dev_dbg(port->dev, "%s: SMR %x, t %x, SCSCR %x\n", __func__, smr_val, t,
		SCSCR_INIT(port));

L
Linus Torvalds 已提交
1452
	if (t > 0) {
1453
		if (t >= 256) {
L
Linus Torvalds 已提交
1454 1455
			sci_out(port, SCSMR, (sci_in(port, SCSMR) & ~3) | 1);
			t >>= 2;
1456
		} else
L
Linus Torvalds 已提交
1457
			sci_out(port, SCSMR, sci_in(port, SCSMR) & ~3);
1458

L
Linus Torvalds 已提交
1459 1460 1461 1462
		sci_out(port, SCBRR, t);
		udelay((1000000+(baud-1)) / baud); /* Wait one bit interval */
	}

1463 1464
	sci_init_pins(port, termios->c_cflag);
	sci_out(port, SCFCR, (termios->c_cflag & CRTSCTS) ? SCFCR_MCE : 0);
1465

L
Linus Torvalds 已提交
1466 1467 1468
	sci_out(port, SCSCR, SCSCR_INIT(port));

	if ((termios->c_cflag & CREAD) != 0)
1469
		sci_start_rx(port);
L
Linus Torvalds 已提交
1470 1471 1472 1473 1474
}

static const char *sci_type(struct uart_port *port)
{
	switch (port->type) {
1475 1476 1477 1478 1479 1480 1481 1482
	case PORT_IRDA:
		return "irda";
	case PORT_SCI:
		return "sci";
	case PORT_SCIF:
		return "scif";
	case PORT_SCIFA:
		return "scifa";
L
Linus Torvalds 已提交
1483 1484
	}

P
Paul Mundt 已提交
1485
	return NULL;
L
Linus Torvalds 已提交
1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500
}

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

static int sci_request_port(struct uart_port *port)
{
	/* Nothing here yet .. */
	return 0;
}

static void sci_config_port(struct uart_port *port, int flags)
{
1501
	struct sci_port *s = to_sci_port(port);
L
Linus Torvalds 已提交
1502 1503 1504

	port->type = s->type;

1505 1506 1507 1508
	if (port->membase)
		return;

	if (port->flags & UPF_IOREMAP) {
1509
		port->membase = ioremap_nocache(port->mapbase, 0x40);
1510 1511 1512 1513 1514 1515 1516 1517 1518 1519

		if (IS_ERR(port->membase))
			dev_err(port->dev, "can't remap port#%d\n", port->line);
	} else {
		/*
		 * For the simple (and majority of) cases where we don't
		 * need to do any remapping, just cast the cookie
		 * directly.
		 */
		port->membase = (void __iomem *)port->mapbase;
1520
	}
L
Linus Torvalds 已提交
1521 1522 1523 1524
}

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

Y
Yinghai Lu 已提交
1527
	if (ser->irq != s->irqs[SCIx_TXI_IRQ] || ser->irq > nr_irqs)
L
Linus Torvalds 已提交
1528 1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552
		return -EINVAL;
	if (ser->baud_base < 2400)
		/* No paper tape reader for Mitch.. */
		return -EINVAL;

	return 0;
}

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

1559 1560
static void __devinit sci_init_single(struct platform_device *dev,
				      struct sci_port *sci_port,
1561 1562
				      unsigned int index,
				      struct plat_sci_port *p)
1563
{
1564 1565 1566 1567 1568
	struct uart_port *port = &sci_port->port;

	port->ops	= &sci_uart_ops;
	port->iotype	= UPIO_MEM;
	port->line	= index;
1569 1570 1571

	switch (p->type) {
	case PORT_SCIFA:
1572
		port->fifosize = 64;
1573 1574
		break;
	case PORT_SCIF:
1575
		port->fifosize = 16;
1576 1577
		break;
	default:
1578
		port->fifosize = 1;
1579 1580
		break;
	}
1581 1582 1583 1584 1585 1586

	if (dev) {
		sci_port->iclk = p->clk ? clk_get(&dev->dev, p->clk) : NULL;
		sci_port->dclk = clk_get(&dev->dev, "peripheral_clk");
		sci_port->enable = sci_clk_enable;
		sci_port->disable = sci_clk_disable;
1587
		port->dev = &dev->dev;
1588
	}
1589

M
Magnus Damm 已提交
1590 1591 1592 1593
	sci_port->break_timer.data = (unsigned long)sci_port;
	sci_port->break_timer.function = sci_break_timer;
	init_timer(&sci_port->break_timer);

1594 1595
	port->mapbase	= p->mapbase;
	port->membase	= p->membase;
M
Magnus Damm 已提交
1596

1597 1598 1599 1600 1601 1602 1603 1604 1605 1606 1607 1608
	port->irq	= p->irqs[SCIx_TXI_IRQ];
	port->flags	= p->flags;
	sci_port->type	= port->type = p->type;

#ifdef CONFIG_SERIAL_SH_SCI_DMA
	sci_port->dma_dev	= p->dma_dev;
	sci_port->slave_tx	= p->dma_slave_tx;
	sci_port->slave_rx	= p->dma_slave_rx;

	dev_dbg(port->dev, "%s: DMA device %p, tx %d, rx %d\n", __func__,
		p->dma_dev, p->dma_slave_tx, p->dma_slave_rx);
#endif
M
Magnus Damm 已提交
1609 1610

	memcpy(&sci_port->irqs, &p->irqs, sizeof(p->irqs));
1611 1612
}

L
Linus Torvalds 已提交
1613
#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
1614 1615 1616 1617 1618 1619 1620 1621 1622 1623 1624 1625
static struct tty_driver *serial_console_device(struct console *co, int *index)
{
	struct uart_driver *p = &sci_uart_driver;
	*index = co->index;
	return p->tty_driver;
}

static void serial_console_putchar(struct uart_port *port, int ch)
{
	sci_poll_put_char(port, ch);
}

L
Linus Torvalds 已提交
1626 1627 1628 1629 1630 1631 1632
/*
 *	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)
{
1633
	struct uart_port *port = co->data;
1634
	struct sci_port *sci_port = to_sci_port(port);
M
Magnus Damm 已提交
1635
	unsigned short bits;
1636

1637 1638 1639 1640
	if (sci_port->enable)
		sci_port->enable(port);

	uart_console_write(port, s, count, serial_console_putchar);
M
Magnus Damm 已提交
1641 1642 1643 1644 1645

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

1647
	if (sci_port->disable)
1648
		sci_port->disable(port);
L
Linus Torvalds 已提交
1649 1650
}

1651
static int __devinit serial_console_setup(struct console *co, char *options)
L
Linus Torvalds 已提交
1652
{
1653
	struct sci_port *sci_port;
L
Linus Torvalds 已提交
1654 1655 1656 1657 1658 1659 1660
	struct uart_port *port;
	int baud = 115200;
	int bits = 8;
	int parity = 'n';
	int flow = 'n';
	int ret;

1661 1662 1663 1664 1665 1666 1667 1668
	/*
	 * Check whether an invalid uart number has been specified, and
	 * if so, search for the first available port that does have
	 * console support.
	 */
	if (co->index >= SCI_NPORTS)
		co->index = 0;

1669 1670 1671 1672 1673 1674 1675 1676
	if (co->data) {
		port = co->data;
		sci_port = to_sci_port(port);
	} else {
		sci_port = &sci_ports[co->index];
		port = &sci_port->port;
		co->data = port;
	}
L
Linus Torvalds 已提交
1677 1678

	/*
1679 1680 1681 1682
	 * Also need to check port->type, we don't actually have any
	 * UPIO_PORT ports, but uart_report_port() handily misreports
	 * it anyways if we don't have a port available by the time this is
	 * called.
L
Linus Torvalds 已提交
1683
	 */
1684 1685 1686
	if (!port->type)
		return -ENODEV;

1687
	sci_config_port(port, 0);
1688

1689 1690
	if (sci_port->enable)
		sci_port->enable(port);
1691

L
Linus Torvalds 已提交
1692 1693 1694 1695 1696 1697 1698 1699 1700
	if (options)
		uart_parse_options(options, &baud, &parity, &bits, &flow);

	ret = uart_set_options(port, co, baud, parity, bits, flow);
#if defined(__H8300H__) || defined(__H8300S__)
	/* disable rx interrupt */
	if (ret == 0)
		sci_stop_rx(port);
#endif
1701
	/* TODO: disable clock */
L
Linus Torvalds 已提交
1702 1703 1704 1705 1706
	return ret;
}

static struct console serial_console = {
	.name		= "ttySC",
1707
	.device		= serial_console_device,
L
Linus Torvalds 已提交
1708 1709
	.write		= serial_console_write,
	.setup		= serial_console_setup,
P
Paul Mundt 已提交
1710
	.flags		= CON_PRINTBUFFER,
L
Linus Torvalds 已提交
1711 1712 1713 1714 1715 1716 1717 1718 1719
	.index		= -1,
};

static int __init sci_console_init(void)
{
	register_console(&serial_console);
	return 0;
}
console_initcall(sci_console_init);
1720 1721 1722 1723 1724 1725 1726 1727 1728

static struct sci_port early_serial_port;
static struct console early_serial_console = {
	.name           = "early_ttySC",
	.write          = serial_console_write,
	.flags          = CON_PRINTBUFFER,
};
static char early_serial_buf[32];

L
Linus Torvalds 已提交
1729 1730
#endif /* CONFIG_SERIAL_SH_SCI_CONSOLE */

1731
#if defined(CONFIG_SERIAL_SH_SCI_CONSOLE)
1732
#define SCI_CONSOLE	(&serial_console)
L
Linus Torvalds 已提交
1733
#else
1734
#define SCI_CONSOLE	0
L
Linus Torvalds 已提交
1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745
#endif

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

static struct uart_driver sci_uart_driver = {
	.owner		= THIS_MODULE,
	.driver_name	= "sci",
	.dev_name	= "ttySC",
	.major		= SCI_MAJOR,
	.minor		= SCI_MINOR_START,
1746
	.nr		= SCI_NPORTS,
L
Linus Torvalds 已提交
1747 1748 1749
	.cons		= SCI_CONSOLE,
};

1750

1751
static int sci_remove(struct platform_device *dev)
1752 1753 1754 1755 1756 1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767
{
	struct sh_sci_priv *priv = platform_get_drvdata(dev);
	struct sci_port *p;
	unsigned long flags;

	cpufreq_unregister_notifier(&priv->clk_nb, CPUFREQ_TRANSITION_NOTIFIER);

	spin_lock_irqsave(&priv->lock, flags);
	list_for_each_entry(p, &priv->ports, node)
		uart_remove_one_port(&sci_uart_driver, &p->port);
	spin_unlock_irqrestore(&priv->lock, flags);

	kfree(priv);
	return 0;
}

1768 1769 1770 1771 1772 1773 1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784 1785 1786
static int __devinit sci_probe_single(struct platform_device *dev,
				      unsigned int index,
				      struct plat_sci_port *p,
				      struct sci_port *sciport)
{
	struct sh_sci_priv *priv = platform_get_drvdata(dev);
	unsigned long flags;
	int ret;

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

1787
	sci_init_single(dev, sciport, index, p);
1788 1789

	ret = uart_add_one_port(&sci_uart_driver, &sciport->port);
1790
	if (ret)
1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801
		return ret;

	INIT_LIST_HEAD(&sciport->node);

	spin_lock_irqsave(&priv->lock, flags);
	list_add(&sciport->node, &priv->ports);
	spin_unlock_irqrestore(&priv->lock, flags);

	return 0;
}

1802 1803 1804 1805 1806 1807 1808
/*
 * Register a set of serial devices attached to a platform device.  The
 * list is terminated with a zero flags entry, which means we expect
 * all entries to have at least UPF_BOOT_AUTOCONF set. Platforms that need
 * remapping (such as sh64) should also set UPF_IOREMAP.
 */
static int __devinit sci_probe(struct platform_device *dev)
L
Linus Torvalds 已提交
1809
{
1810
	struct plat_sci_port *p = dev->dev.platform_data;
1811
	struct sh_sci_priv *priv;
1812
	int i, ret = -EINVAL;
1813

1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828
#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
	if (is_early_platform_device(dev)) {
		if (dev->id == -1)
			return -ENOTSUPP;
		early_serial_console.index = dev->id;
		early_serial_console.data = &early_serial_port.port;
		sci_init_single(NULL, &early_serial_port, dev->id, p);
		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;
	}
#endif

1829 1830 1831 1832 1833 1834 1835 1836 1837 1838
	priv = kzalloc(sizeof(*priv), GFP_KERNEL);
	if (!priv)
		return -ENOMEM;

	INIT_LIST_HEAD(&priv->ports);
	spin_lock_init(&priv->lock);
	platform_set_drvdata(dev, priv);

	priv->clk_nb.notifier_call = sci_notifier;
	cpufreq_register_notifier(&priv->clk_nb, CPUFREQ_TRANSITION_NOTIFIER);
L
Linus Torvalds 已提交
1839

1840 1841 1842
	if (dev->id != -1) {
		ret = sci_probe_single(dev, dev->id, p, &sci_ports[dev->id]);
		if (ret)
1843
			goto err_unreg;
1844 1845 1846 1847 1848
	} else {
		for (i = 0; p && p->flags != 0; p++, i++) {
			ret = sci_probe_single(dev, i, p, &sci_ports[i]);
			if (ret)
				goto err_unreg;
1849 1850
		}
	}
L
Linus Torvalds 已提交
1851 1852 1853 1854 1855

#ifdef CONFIG_SH_STANDARD_BIOS
	sh_bios_gdb_detach();
#endif

1856
	return 0;
1857 1858

err_unreg:
1859
	sci_remove(dev);
1860
	return ret;
L
Linus Torvalds 已提交
1861 1862
}

1863
static int sci_suspend(struct device *dev)
L
Linus Torvalds 已提交
1864
{
1865
	struct sh_sci_priv *priv = dev_get_drvdata(dev);
1866 1867
	struct sci_port *p;
	unsigned long flags;
1868

1869 1870 1871 1872
	spin_lock_irqsave(&priv->lock, flags);
	list_for_each_entry(p, &priv->ports, node)
		uart_suspend_port(&sci_uart_driver, &p->port);
	spin_unlock_irqrestore(&priv->lock, flags);
L
Linus Torvalds 已提交
1873

1874 1875
	return 0;
}
L
Linus Torvalds 已提交
1876

1877
static int sci_resume(struct device *dev)
1878
{
1879
	struct sh_sci_priv *priv = dev_get_drvdata(dev);
1880 1881
	struct sci_port *p;
	unsigned long flags;
1882

1883 1884 1885 1886
	spin_lock_irqsave(&priv->lock, flags);
	list_for_each_entry(p, &priv->ports, node)
		uart_resume_port(&sci_uart_driver, &p->port);
	spin_unlock_irqrestore(&priv->lock, flags);
1887 1888 1889 1890

	return 0;
}

1891
static const struct dev_pm_ops sci_dev_pm_ops = {
1892 1893 1894 1895
	.suspend	= sci_suspend,
	.resume		= sci_resume,
};

1896 1897
static struct platform_driver sci_driver = {
	.probe		= sci_probe,
1898
	.remove		= sci_remove,
1899 1900 1901
	.driver		= {
		.name	= "sh-sci",
		.owner	= THIS_MODULE,
1902
		.pm	= &sci_dev_pm_ops,
1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917 1918 1919 1920 1921 1922 1923 1924
	},
};

static int __init sci_init(void)
{
	int ret;

	printk(banner);

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

	return ret;
}

static void __exit sci_exit(void)
{
	platform_driver_unregister(&sci_driver);
L
Linus Torvalds 已提交
1925 1926 1927
	uart_unregister_driver(&sci_uart_driver);
}

1928 1929 1930 1931
#ifdef CONFIG_SERIAL_SH_SCI_CONSOLE
early_platform_init_buffer("earlyprintk", &sci_driver,
			   early_serial_buf, ARRAY_SIZE(early_serial_buf));
#endif
L
Linus Torvalds 已提交
1932 1933 1934
module_init(sci_init);
module_exit(sci_exit);

1935
MODULE_LICENSE("GPL");
1936
MODULE_ALIAS("platform:sh-sci");