8250_core.c 95.4 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29
/*
 *  Driver for 8250/16550-type serial ports
 *
 *  Based on drivers/char/serial.c, by Linus Torvalds, Theodore Ts'o.
 *
 *  Copyright (C) 2001 Russell King.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * A note about mapbase / membase
 *
 *  mapbase is the physical address of the IO port.
 *  membase is an 'ioremapped' cookie.
 */

#if defined(CONFIG_SERIAL_8250_CONSOLE) && defined(CONFIG_MAGIC_SYSRQ)
#define SUPPORT_SYSRQ
#endif

#include <linux/module.h>
#include <linux/moduleparam.h>
#include <linux/ioport.h>
#include <linux/init.h>
#include <linux/console.h>
#include <linux/sysrq.h>
#include <linux/delay.h>
30
#include <linux/platform_device.h>
L
Linus Torvalds 已提交
31
#include <linux/tty.h>
32
#include <linux/ratelimit.h>
L
Linus Torvalds 已提交
33 34 35 36
#include <linux/tty_flip.h>
#include <linux/serial_core.h>
#include <linux/serial.h>
#include <linux/serial_8250.h>
37
#include <linux/nmi.h>
38
#include <linux/mutex.h>
39
#include <linux/slab.h>
40
#include <linux/uaccess.h>
41
#include <linux/pm_runtime.h>
42 43 44
#ifdef CONFIG_SPARC
#include <linux/sunserialcore.h>
#endif
L
Linus Torvalds 已提交
45 46 47 48 49 50 51 52

#include <asm/io.h>
#include <asm/irq.h>

#include "8250.h"

/*
 * Configuration:
53
 *   share_irqs - whether we pass IRQF_SHARED to request_irq().  This option
L
Linus Torvalds 已提交
54 55
 *                is unsafe when used on edge-triggered interrupts.
 */
A
Adrian Bunk 已提交
56
static unsigned int share_irqs = SERIAL8250_SHARE_IRQS;
L
Linus Torvalds 已提交
57

58 59
static unsigned int nr_uarts = CONFIG_SERIAL_8250_RUNTIME_UARTS;

60 61 62 63 64 65 66
static struct uart_driver serial8250_reg;

static int serial_index(struct uart_port *port)
{
	return (serial8250_reg.minor - 64) + port->line;
}

67 68
static unsigned int skip_txen_test; /* force skip of txen test at init time */

L
Linus Torvalds 已提交
69 70 71 72 73 74 75 76 77 78 79 80 81 82 83
/*
 * Debugging.
 */
#if 0
#define DEBUG_AUTOCONF(fmt...)	printk(fmt)
#else
#define DEBUG_AUTOCONF(fmt...)	do { } while (0)
#endif

#if 0
#define DEBUG_INTR(fmt...)	printk(fmt)
#else
#define DEBUG_INTR(fmt...)	do { } while (0)
#endif

J
Jiri Slaby 已提交
84
#define PASS_LIMIT	512
L
Linus Torvalds 已提交
85

86 87 88
#define BOTH_EMPTY 	(UART_LSR_TEMT | UART_LSR_THRE)


L
Linus Torvalds 已提交
89 90 91 92 93 94 95 96 97 98 99 100 101
#ifdef CONFIG_SERIAL_8250_DETECT_IRQ
#define CONFIG_SERIAL_DETECT_IRQ 1
#endif
#ifdef CONFIG_SERIAL_8250_MANY_PORTS
#define CONFIG_SERIAL_MANY_PORTS 1
#endif

/*
 * HUB6 is always on.  This will be removed once the header
 * files have been cleaned.
 */
#define CONFIG_HUB6 1

102
#include <asm/serial.h>
L
Linus Torvalds 已提交
103 104 105 106 107 108 109 110 111
/*
 * SERIAL_PORT_DFNS tells us about built-in ports that have no
 * standard enumeration mechanism.   Platforms that can find all
 * serial ports via mechanisms like ACPI or PCI need not supply it.
 */
#ifndef SERIAL_PORT_DFNS
#define SERIAL_PORT_DFNS
#endif

112
static const struct old_serial_port old_serial_port[] = {
L
Linus Torvalds 已提交
113 114 115
	SERIAL_PORT_DFNS /* defined in asm/serial.h */
};

116
#define UART_NR	CONFIG_SERIAL_8250_NR_UARTS
L
Linus Torvalds 已提交
117 118 119 120 121 122 123 124 125

#ifdef CONFIG_SERIAL_8250_RSA

#define PORT_RSA_MAX 4
static unsigned long probe_rsa[PORT_RSA_MAX];
static unsigned int probe_rsa_count;
#endif /* CONFIG_SERIAL_8250_RSA  */

struct irq_info {
A
Alan Cox 已提交
126 127 128
	struct			hlist_node node;
	int			irq;
	spinlock_t		lock;	/* Protects list not the hash */
L
Linus Torvalds 已提交
129 130 131
	struct list_head	*head;
};

A
Alan Cox 已提交
132 133 134
#define NR_IRQ_HASH		32	/* Can be adjusted later */
static struct hlist_head irq_lists[NR_IRQ_HASH];
static DEFINE_MUTEX(hash_mutex);	/* Used to walk the hash */
L
Linus Torvalds 已提交
135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164

/*
 * Here we define the default xmit fifo size used for each type of UART.
 */
static const struct serial8250_config uart_config[] = {
	[PORT_UNKNOWN] = {
		.name		= "unknown",
		.fifo_size	= 1,
		.tx_loadsz	= 1,
	},
	[PORT_8250] = {
		.name		= "8250",
		.fifo_size	= 1,
		.tx_loadsz	= 1,
	},
	[PORT_16450] = {
		.name		= "16450",
		.fifo_size	= 1,
		.tx_loadsz	= 1,
	},
	[PORT_16550] = {
		.name		= "16550",
		.fifo_size	= 1,
		.tx_loadsz	= 1,
	},
	[PORT_16550A] = {
		.name		= "16550A",
		.fifo_size	= 16,
		.tx_loadsz	= 16,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
165
		.rxtrig_bytes	= {1, 4, 8, 14},
L
Linus Torvalds 已提交
166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184
		.flags		= UART_CAP_FIFO,
	},
	[PORT_CIRRUS] = {
		.name		= "Cirrus",
		.fifo_size	= 1,
		.tx_loadsz	= 1,
	},
	[PORT_16650] = {
		.name		= "ST16650",
		.fifo_size	= 1,
		.tx_loadsz	= 1,
		.flags		= UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
	},
	[PORT_16650V2] = {
		.name		= "ST16650V2",
		.fifo_size	= 32,
		.tx_loadsz	= 16,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
				  UART_FCR_T_TRIG_00,
185
		.rxtrig_bytes	= {8, 16, 24, 28},
L
Linus Torvalds 已提交
186 187 188 189 190 191 192 193
		.flags		= UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
	},
	[PORT_16750] = {
		.name		= "TI16750",
		.fifo_size	= 64,
		.tx_loadsz	= 64,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10 |
				  UART_FCR7_64BYTE,
194
		.rxtrig_bytes	= {1, 16, 32, 56},
L
Linus Torvalds 已提交
195 196 197 198 199 200 201 202 203 204 205 206
		.flags		= UART_CAP_FIFO | UART_CAP_SLEEP | UART_CAP_AFE,
	},
	[PORT_STARTECH] = {
		.name		= "Startech",
		.fifo_size	= 1,
		.tx_loadsz	= 1,
	},
	[PORT_16C950] = {
		.name		= "16C950/954",
		.fifo_size	= 128,
		.tx_loadsz	= 128,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
207 208
		/* UART_CAP_EFR breaks billionon CF bluetooth card. */
		.flags		= UART_CAP_FIFO | UART_CAP_SLEEP,
L
Linus Torvalds 已提交
209 210 211 212 213 214 215
	},
	[PORT_16654] = {
		.name		= "ST16654",
		.fifo_size	= 64,
		.tx_loadsz	= 32,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
				  UART_FCR_T_TRIG_10,
216
		.rxtrig_bytes	= {8, 16, 56, 60},
L
Linus Torvalds 已提交
217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
		.flags		= UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
	},
	[PORT_16850] = {
		.name		= "XR16850",
		.fifo_size	= 128,
		.tx_loadsz	= 128,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
		.flags		= UART_CAP_FIFO | UART_CAP_EFR | UART_CAP_SLEEP,
	},
	[PORT_RSA] = {
		.name		= "RSA",
		.fifo_size	= 2048,
		.tx_loadsz	= 2048,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_11,
		.flags		= UART_CAP_FIFO,
	},
	[PORT_NS16550A] = {
		.name		= "NS16550A",
		.fifo_size	= 16,
		.tx_loadsz	= 16,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
		.flags		= UART_CAP_FIFO | UART_NATSEMI,
	},
	[PORT_XSCALE] = {
		.name		= "XScale",
		.fifo_size	= 32,
		.tx_loadsz	= 32,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
245
		.flags		= UART_CAP_FIFO | UART_CAP_UUE | UART_CAP_RTOIE,
L
Linus Torvalds 已提交
246
	},
247 248 249 250 251
	[PORT_OCTEON] = {
		.name		= "OCTEON",
		.fifo_size	= 64,
		.tx_loadsz	= 64,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
T
Thomas Koeller 已提交
252 253
		.flags		= UART_CAP_FIFO,
	},
254 255 256 257 258 259 260
	[PORT_AR7] = {
		.name		= "AR7",
		.fifo_size	= 16,
		.tx_loadsz	= 16,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_00,
		.flags		= UART_CAP_FIFO | UART_CAP_AFE,
	},
261 262 263 264 265 266 267
	[PORT_U6_16550A] = {
		.name		= "U6_16550A",
		.fifo_size	= 64,
		.tx_loadsz	= 64,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
		.flags		= UART_CAP_FIFO | UART_CAP_AFE,
	},
268 269 270 271 272 273
	[PORT_TEGRA] = {
		.name		= "Tegra",
		.fifo_size	= 32,
		.tx_loadsz	= 8,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_01 |
				  UART_FCR_T_TRIG_01,
274
		.rxtrig_bytes	= {1, 4, 8, 14},
275 276
		.flags		= UART_CAP_FIFO | UART_CAP_RTOIE,
	},
277 278 279 280 281
	[PORT_XR17D15X] = {
		.name		= "XR17D15X",
		.fifo_size	= 64,
		.tx_loadsz	= 64,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
282 283
		.flags		= UART_CAP_FIFO | UART_CAP_AFE | UART_CAP_EFR |
				  UART_CAP_SLEEP,
284
	},
285 286 287 288 289 290 291 292 293
	[PORT_XR17V35X] = {
		.name		= "XR17V35X",
		.fifo_size	= 256,
		.tx_loadsz	= 256,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_11 |
				  UART_FCR_T_TRIG_11,
		.flags		= UART_CAP_FIFO | UART_CAP_AFE | UART_CAP_EFR |
				  UART_CAP_SLEEP,
	},
294 295 296 297 298 299 300 301
	[PORT_LPC3220] = {
		.name		= "LPC3220",
		.fifo_size	= 64,
		.tx_loadsz	= 32,
		.fcr		= UART_FCR_DMA_SELECT | UART_FCR_ENABLE_FIFO |
				  UART_FCR_R_TRIG_00 | UART_FCR_T_TRIG_00,
		.flags		= UART_CAP_FIFO,
	},
302 303 304 305 306 307
	[PORT_BRCM_TRUMANAGE] = {
		.name		= "TruManage",
		.fifo_size	= 1,
		.tx_loadsz	= 1024,
		.flags		= UART_CAP_HFIFO,
	},
S
Sean Young 已提交
308 309
	[PORT_8250_CIR] = {
		.name		= "CIR port"
310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331
	},
	[PORT_ALTR_16550_F32] = {
		.name		= "Altera 16550 FIFO32",
		.fifo_size	= 32,
		.tx_loadsz	= 32,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
		.flags		= UART_CAP_FIFO | UART_CAP_AFE,
	},
	[PORT_ALTR_16550_F64] = {
		.name		= "Altera 16550 FIFO64",
		.fifo_size	= 64,
		.tx_loadsz	= 64,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
		.flags		= UART_CAP_FIFO | UART_CAP_AFE,
	},
	[PORT_ALTR_16550_F128] = {
		.name		= "Altera 16550 FIFO128",
		.fifo_size	= 128,
		.tx_loadsz	= 128,
		.fcr		= UART_FCR_ENABLE_FIFO | UART_FCR_R_TRIG_10,
		.flags		= UART_CAP_FIFO | UART_CAP_AFE,
	},
L
Linus Torvalds 已提交
332 333
};

334
/* Uart divisor latch read */
335
static int default_serial_dl_read(struct uart_8250_port *up)
336 337 338 339 340
{
	return serial_in(up, UART_DLL) | serial_in(up, UART_DLM) << 8;
}

/* Uart divisor latch write */
341
static void default_serial_dl_write(struct uart_8250_port *up, int value)
342 343 344 345 346
{
	serial_out(up, UART_DLL, value & 0xff);
	serial_out(up, UART_DLM, value >> 8 & 0xff);
}

347
#if defined(CONFIG_MIPS_ALCHEMY) || defined(CONFIG_SERIAL_8250_RT288X)
348

349
/* Au1x00/RT288x UART hardware has a weird register layout */
350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367
static const u8 au_io_in_map[] = {
	[UART_RX]  = 0,
	[UART_IER] = 2,
	[UART_IIR] = 3,
	[UART_LCR] = 5,
	[UART_MCR] = 6,
	[UART_LSR] = 7,
	[UART_MSR] = 8,
};

static const u8 au_io_out_map[] = {
	[UART_TX]  = 1,
	[UART_IER] = 2,
	[UART_FCR] = 4,
	[UART_LCR] = 5,
	[UART_MCR] = 6,
};

368
static unsigned int au_serial_in(struct uart_port *p, int offset)
369
{
370 371
	offset = au_io_in_map[offset] << p->regshift;
	return __raw_readl(p->membase + offset);
372 373
}

374
static void au_serial_out(struct uart_port *p, int offset, int value)
375
{
376 377 378 379 380 381 382 383 384 385 386 387 388
	offset = au_io_out_map[offset] << p->regshift;
	__raw_writel(value, p->membase + offset);
}

/* Au1x00 haven't got a standard divisor latch */
static int au_serial_dl_read(struct uart_8250_port *up)
{
	return __raw_readl(up->port.membase + 0x28);
}

static void au_serial_dl_write(struct uart_8250_port *up, int value)
{
	__raw_writel(value, up->port.membase + 0x28);
389 390
}

391 392
#endif

393
static unsigned int hub6_serial_in(struct uart_port *p, int offset)
L
Linus Torvalds 已提交
394
{
395
	offset = offset << p->regshift;
396 397 398
	outb(p->hub6 - 1 + offset, p->iobase);
	return inb(p->iobase + 1);
}
L
Linus Torvalds 已提交
399

400 401
static void hub6_serial_out(struct uart_port *p, int offset, int value)
{
402
	offset = offset << p->regshift;
403 404 405
	outb(p->hub6 - 1 + offset, p->iobase);
	outb(value, p->iobase + 1);
}
L
Linus Torvalds 已提交
406

407 408
static unsigned int mem_serial_in(struct uart_port *p, int offset)
{
409
	offset = offset << p->regshift;
410 411
	return readb(p->membase + offset);
}
L
Linus Torvalds 已提交
412

413 414
static void mem_serial_out(struct uart_port *p, int offset, int value)
{
415
	offset = offset << p->regshift;
416 417 418 419 420
	writeb(value, p->membase + offset);
}

static void mem32_serial_out(struct uart_port *p, int offset, int value)
{
421
	offset = offset << p->regshift;
422 423 424 425 426
	writel(value, p->membase + offset);
}

static unsigned int mem32_serial_in(struct uart_port *p, int offset)
{
427
	offset = offset << p->regshift;
428 429
	return readl(p->membase + offset);
}
L
Linus Torvalds 已提交
430

431 432
static unsigned int io_serial_in(struct uart_port *p, int offset)
{
433
	offset = offset << p->regshift;
434 435 436 437 438
	return inb(p->iobase + offset);
}

static void io_serial_out(struct uart_port *p, int offset, int value)
{
439
	offset = offset << p->regshift;
440 441 442
	outb(value, p->iobase + offset);
}

443
static int serial8250_default_handle_irq(struct uart_port *port);
444
static int exar_handle_irq(struct uart_port *port);
445

446 447
static void set_io_from_upio(struct uart_port *p)
{
448
	struct uart_8250_port *up = up_to_u8250p(p);
449

450 451
	up->dl_read = default_serial_dl_read;
	up->dl_write = default_serial_dl_write;
452

453
	switch (p->iotype) {
L
Linus Torvalds 已提交
454
	case UPIO_HUB6:
455 456
		p->serial_in = hub6_serial_in;
		p->serial_out = hub6_serial_out;
L
Linus Torvalds 已提交
457 458 459
		break;

	case UPIO_MEM:
460 461
		p->serial_in = mem_serial_in;
		p->serial_out = mem_serial_out;
L
Linus Torvalds 已提交
462 463 464
		break;

	case UPIO_MEM32:
465 466
		p->serial_in = mem32_serial_in;
		p->serial_out = mem32_serial_out;
L
Linus Torvalds 已提交
467 468
		break;

469
#if defined(CONFIG_MIPS_ALCHEMY) || defined(CONFIG_SERIAL_8250_RT288X)
470
	case UPIO_AU:
471 472
		p->serial_in = au_serial_in;
		p->serial_out = au_serial_out;
473 474
		up->dl_read = au_serial_dl_read;
		up->dl_write = au_serial_dl_write;
475
		break;
476
#endif
477

L
Linus Torvalds 已提交
478
	default:
479 480 481
		p->serial_in = io_serial_in;
		p->serial_out = io_serial_out;
		break;
L
Linus Torvalds 已提交
482
	}
A
Alan Cox 已提交
483 484
	/* Remember loaded iotype */
	up->cur_iotype = p->iotype;
485
	p->handle_irq = serial8250_default_handle_irq;
L
Linus Torvalds 已提交
486 487
}

A
Alex Williamson 已提交
488
static void
489
serial_port_out_sync(struct uart_port *p, int offset, int value)
A
Alex Williamson 已提交
490
{
491
	switch (p->iotype) {
A
Alex Williamson 已提交
492 493 494
	case UPIO_MEM:
	case UPIO_MEM32:
	case UPIO_AU:
495 496
		p->serial_out(p, offset, value);
		p->serial_in(p, UART_LCR);	/* safe, no side-effects */
A
Alex Williamson 已提交
497 498
		break;
	default:
499
		p->serial_out(p, offset, value);
A
Alex Williamson 已提交
500 501 502
	}
}

L
Linus Torvalds 已提交
503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526
/*
 * For the 16C950
 */
static void serial_icr_write(struct uart_8250_port *up, int offset, int value)
{
	serial_out(up, UART_SCR, offset);
	serial_out(up, UART_ICR, value);
}

static unsigned int serial_icr_read(struct uart_8250_port *up, int offset)
{
	unsigned int value;

	serial_icr_write(up, UART_ACR, up->acr | UART_ACR_ICRRD);
	serial_out(up, UART_SCR, offset);
	value = serial_in(up, UART_ICR);
	serial_icr_write(up, UART_ACR, up->acr);

	return value;
}

/*
 * FIFO support.
 */
527
static void serial8250_clear_fifos(struct uart_8250_port *p)
L
Linus Torvalds 已提交
528 529
{
	if (p->capabilities & UART_CAP_FIFO) {
530 531
		serial_out(p, UART_FCR, UART_FCR_ENABLE_FIFO);
		serial_out(p, UART_FCR, UART_FCR_ENABLE_FIFO |
L
Linus Torvalds 已提交
532
			       UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
533
		serial_out(p, UART_FCR, 0);
L
Linus Torvalds 已提交
534 535 536
	}
}

537 538 539
void serial8250_clear_and_reinit_fifos(struct uart_8250_port *p)
{
	serial8250_clear_fifos(p);
540
	serial_out(p, UART_FCR, p->fcr);
541 542 543
}
EXPORT_SYMBOL_GPL(serial8250_clear_and_reinit_fifos);

544
void serial8250_rpm_get(struct uart_8250_port *p)
545 546 547 548 549
{
	if (!(p->capabilities & UART_CAP_RPM))
		return;
	pm_runtime_get_sync(p->port.dev);
}
550
EXPORT_SYMBOL_GPL(serial8250_rpm_get);
551

552
void serial8250_rpm_put(struct uart_8250_port *p)
553 554 555 556 557 558
{
	if (!(p->capabilities & UART_CAP_RPM))
		return;
	pm_runtime_mark_last_busy(p->port.dev);
	pm_runtime_put_autosuspend(p->port.dev);
}
559
EXPORT_SYMBOL_GPL(serial8250_rpm_put);
560 561

/*
562
 * These two wrappers ensure that enable_runtime_pm_tx() can be called more than
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
 * once and disable_runtime_pm_tx() will still disable RPM because the fifo is
 * empty and the HW can idle again.
 */
static void serial8250_rpm_get_tx(struct uart_8250_port *p)
{
	unsigned char rpm_active;

	if (!(p->capabilities & UART_CAP_RPM))
		return;

	rpm_active = xchg(&p->rpm_tx_active, 1);
	if (rpm_active)
		return;
	pm_runtime_get_sync(p->port.dev);
}

static void serial8250_rpm_put_tx(struct uart_8250_port *p)
{
	unsigned char rpm_active;

	if (!(p->capabilities & UART_CAP_RPM))
		return;

	rpm_active = xchg(&p->rpm_tx_active, 0);
	if (!rpm_active)
		return;
	pm_runtime_mark_last_busy(p->port.dev);
	pm_runtime_put_autosuspend(p->port.dev);
}

L
Linus Torvalds 已提交
593 594 595 596 597
/*
 * IER sleep support.  UARTs which have EFRs need the "extended
 * capability" bit enabled.  Note that on XR16C850s, we need to
 * reset LCR to write to IER.
 */
598
static void serial8250_set_sleep(struct uart_8250_port *p, int sleep)
L
Linus Torvalds 已提交
599
{
600
	unsigned char lcr = 0, efr = 0;
601 602 603 604 605 606 607
	/*
	 * Exar UARTs have a SLEEP register that enables or disables
	 * each UART to enter sleep mode separately.  On the XR17V35x the
	 * register is accessible to each UART at the UART_EXAR_SLEEP
	 * offset but the UART channel may only write to the corresponding
	 * bit.
	 */
608
	serial8250_rpm_get(p);
609 610
	if ((p->port.type == PORT_XR17V35X) ||
	   (p->port.type == PORT_XR17D15X)) {
611
		serial_out(p, UART_EXAR_SLEEP, sleep ? 0xff : 0);
612
		goto out;
613 614
	}

L
Linus Torvalds 已提交
615 616
	if (p->capabilities & UART_CAP_SLEEP) {
		if (p->capabilities & UART_CAP_EFR) {
617 618
			lcr = serial_in(p, UART_LCR);
			efr = serial_in(p, UART_EFR);
619 620 621
			serial_out(p, UART_LCR, UART_LCR_CONF_MODE_B);
			serial_out(p, UART_EFR, UART_EFR_ECB);
			serial_out(p, UART_LCR, 0);
L
Linus Torvalds 已提交
622
		}
623
		serial_out(p, UART_IER, sleep ? UART_IERX_SLEEP : 0);
L
Linus Torvalds 已提交
624
		if (p->capabilities & UART_CAP_EFR) {
625
			serial_out(p, UART_LCR, UART_LCR_CONF_MODE_B);
626 627
			serial_out(p, UART_EFR, efr);
			serial_out(p, UART_LCR, lcr);
L
Linus Torvalds 已提交
628 629
		}
	}
630 631
out:
	serial8250_rpm_put(p);
L
Linus Torvalds 已提交
632 633 634 635 636 637 638 639 640 641 642 643
}

#ifdef CONFIG_SERIAL_8250_RSA
/*
 * Attempts to turn on the RSA FIFO.  Returns zero on failure.
 * We set the port uart clock rate if we succeed.
 */
static int __enable_rsa(struct uart_8250_port *up)
{
	unsigned char mode;
	int result;

644
	mode = serial_in(up, UART_RSA_MSR);
L
Linus Torvalds 已提交
645 646 647
	result = mode & UART_RSA_MSR_FIFO;

	if (!result) {
648 649
		serial_out(up, UART_RSA_MSR, mode | UART_RSA_MSR_FIFO);
		mode = serial_in(up, UART_RSA_MSR);
L
Linus Torvalds 已提交
650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667
		result = mode & UART_RSA_MSR_FIFO;
	}

	if (result)
		up->port.uartclk = SERIAL_RSA_BAUD_BASE * 16;

	return result;
}

static void enable_rsa(struct uart_8250_port *up)
{
	if (up->port.type == PORT_RSA) {
		if (up->port.uartclk != SERIAL_RSA_BAUD_BASE * 16) {
			spin_lock_irq(&up->port.lock);
			__enable_rsa(up);
			spin_unlock_irq(&up->port.lock);
		}
		if (up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16)
668
			serial_out(up, UART_RSA_FRR, 0);
L
Linus Torvalds 已提交
669 670 671 672 673 674 675 676 677 678 679 680 681 682 683 684 685 686
	}
}

/*
 * Attempts to turn off the RSA FIFO.  Returns zero on failure.
 * It is unknown why interrupts were disabled in here.  However,
 * the caller is expected to preserve this behaviour by grabbing
 * the spinlock before calling this function.
 */
static void disable_rsa(struct uart_8250_port *up)
{
	unsigned char mode;
	int result;

	if (up->port.type == PORT_RSA &&
	    up->port.uartclk == SERIAL_RSA_BAUD_BASE * 16) {
		spin_lock_irq(&up->port.lock);

687
		mode = serial_in(up, UART_RSA_MSR);
L
Linus Torvalds 已提交
688 689 690
		result = !(mode & UART_RSA_MSR_FIFO);

		if (!result) {
691 692
			serial_out(up, UART_RSA_MSR, mode & ~UART_RSA_MSR_FIFO);
			mode = serial_in(up, UART_RSA_MSR);
L
Linus Torvalds 已提交
693 694 695 696 697 698 699 700 701 702 703 704 705 706 707 708
			result = !(mode & UART_RSA_MSR_FIFO);
		}

		if (result)
			up->port.uartclk = SERIAL_RSA_BAUD_BASE_LO * 16;
		spin_unlock_irq(&up->port.lock);
	}
}
#endif /* CONFIG_SERIAL_8250_RSA */

/*
 * This is a quickie test to see how big the FIFO is.
 * It doesn't work at all the time, more's the pity.
 */
static int size_fifo(struct uart_8250_port *up)
{
709 710
	unsigned char old_fcr, old_mcr, old_lcr;
	unsigned short old_dl;
L
Linus Torvalds 已提交
711 712
	int count;

713 714 715 716 717
	old_lcr = serial_in(up, UART_LCR);
	serial_out(up, UART_LCR, 0);
	old_fcr = serial_in(up, UART_FCR);
	old_mcr = serial_in(up, UART_MCR);
	serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO |
L
Linus Torvalds 已提交
718
		    UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT);
719 720
	serial_out(up, UART_MCR, UART_MCR_LOOP);
	serial_out(up, UART_LCR, UART_LCR_CONF_MODE_A);
721 722
	old_dl = serial_dl_read(up);
	serial_dl_write(up, 0x0001);
723
	serial_out(up, UART_LCR, 0x03);
L
Linus Torvalds 已提交
724
	for (count = 0; count < 256; count++)
725
		serial_out(up, UART_TX, count);
L
Linus Torvalds 已提交
726
	mdelay(20);/* FIXME - schedule_timeout */
727
	for (count = 0; (serial_in(up, UART_LSR) & UART_LSR_DR) &&
L
Linus Torvalds 已提交
728
	     (count < 256); count++)
729 730 731 732
		serial_in(up, UART_RX);
	serial_out(up, UART_FCR, old_fcr);
	serial_out(up, UART_MCR, old_mcr);
	serial_out(up, UART_LCR, UART_LCR_CONF_MODE_A);
733
	serial_dl_write(up, old_dl);
734
	serial_out(up, UART_LCR, old_lcr);
L
Linus Torvalds 已提交
735 736 737 738 739 740 741 742 743 744 745 746 747 748

	return count;
}

/*
 * Read UART ID using the divisor method - set DLL and DLM to zero
 * and the revision will be in DLL and device type in DLM.  We
 * preserve the device state across this.
 */
static unsigned int autoconfig_read_divisor_id(struct uart_8250_port *p)
{
	unsigned char old_dll, old_dlm, old_lcr;
	unsigned int id;

749 750
	old_lcr = serial_in(p, UART_LCR);
	serial_out(p, UART_LCR, UART_LCR_CONF_MODE_A);
L
Linus Torvalds 已提交
751

752 753
	old_dll = serial_in(p, UART_DLL);
	old_dlm = serial_in(p, UART_DLM);
L
Linus Torvalds 已提交
754

755 756
	serial_out(p, UART_DLL, 0);
	serial_out(p, UART_DLM, 0);
L
Linus Torvalds 已提交
757

758
	id = serial_in(p, UART_DLL) | serial_in(p, UART_DLM) << 8;
L
Linus Torvalds 已提交
759

760 761 762
	serial_out(p, UART_DLL, old_dll);
	serial_out(p, UART_DLM, old_dlm);
	serial_out(p, UART_LCR, old_lcr);
L
Linus Torvalds 已提交
763 764 765 766 767 768 769 770 771 772 773

	return id;
}

/*
 * This is a helper routine to autodetect StarTech/Exar/Oxsemi UART's.
 * When this function is called we know it is at least a StarTech
 * 16650 V2, but it might be one of several StarTech UARTs, or one of
 * its clones.  (We treat the broken original StarTech 16650 V1 as a
 * 16550, and why not?  Startech doesn't seem to even acknowledge its
 * existence.)
T
Thomas Koeller 已提交
774
 *
L
Linus Torvalds 已提交
775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803
 * What evil have men's minds wrought...
 */
static void autoconfig_has_efr(struct uart_8250_port *up)
{
	unsigned int id1, id2, id3, rev;

	/*
	 * Everything with an EFR has SLEEP
	 */
	up->capabilities |= UART_CAP_EFR | UART_CAP_SLEEP;

	/*
	 * First we check to see if it's an Oxford Semiconductor UART.
	 *
	 * If we have to do this here because some non-National
	 * Semiconductor clone chips lock up if you try writing to the
	 * LSR register (which serial_icr_read does)
	 */

	/*
	 * Check for Oxford Semiconductor 16C950.
	 *
	 * EFR [4] must be set else this test fails.
	 *
	 * This shouldn't be necessary, but Mike Hudson (Exoray@isys.ca)
	 * claims that it's needed for 952 dual UART's (which are not
	 * recommended for new designs).
	 */
	up->acr = 0;
804
	serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
L
Linus Torvalds 已提交
805 806 807 808 809 810 811 812 813 814 815 816
	serial_out(up, UART_EFR, UART_EFR_ECB);
	serial_out(up, UART_LCR, 0x00);
	id1 = serial_icr_read(up, UART_ID1);
	id2 = serial_icr_read(up, UART_ID2);
	id3 = serial_icr_read(up, UART_ID3);
	rev = serial_icr_read(up, UART_REV);

	DEBUG_AUTOCONF("950id=%02x:%02x:%02x:%02x ", id1, id2, id3, rev);

	if (id1 == 0x16 && id2 == 0xC9 &&
	    (id3 == 0x50 || id3 == 0x52 || id3 == 0x54)) {
		up->port.type = PORT_16C950;
817 818 819 820 821 822 823 824

		/*
		 * Enable work around for the Oxford Semiconductor 952 rev B
		 * chip which causes it to seriously miscalculate baud rates
		 * when DLL is 0.
		 */
		if (id3 == 0x52 && rev == 0x01)
			up->bugs |= UART_BUG_QUOT;
L
Linus Torvalds 已提交
825 826
		return;
	}
T
Thomas Koeller 已提交
827

L
Linus Torvalds 已提交
828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 849 850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871
	/*
	 * We check for a XR16C850 by setting DLL and DLM to 0, and then
	 * reading back DLL and DLM.  The chip type depends on the DLM
	 * value read back:
	 *  0x10 - XR16C850 and the DLL contains the chip revision.
	 *  0x12 - XR16C2850.
	 *  0x14 - XR16C854.
	 */
	id1 = autoconfig_read_divisor_id(up);
	DEBUG_AUTOCONF("850id=%04x ", id1);

	id2 = id1 >> 8;
	if (id2 == 0x10 || id2 == 0x12 || id2 == 0x14) {
		up->port.type = PORT_16850;
		return;
	}

	/*
	 * It wasn't an XR16C850.
	 *
	 * We distinguish between the '654 and the '650 by counting
	 * how many bytes are in the FIFO.  I'm using this for now,
	 * since that's the technique that was sent to me in the
	 * serial driver update, but I'm not convinced this works.
	 * I've had problems doing this in the past.  -TYT
	 */
	if (size_fifo(up) == 64)
		up->port.type = PORT_16654;
	else
		up->port.type = PORT_16650V2;
}

/*
 * We detected a chip without a FIFO.  Only two fall into
 * this category - the original 8250 and the 16450.  The
 * 16450 has a scratch register (accessible with LCR=0)
 */
static void autoconfig_8250(struct uart_8250_port *up)
{
	unsigned char scratch, status1, status2;

	up->port.type = PORT_8250;

	scratch = serial_in(up, UART_SCR);
872
	serial_out(up, UART_SCR, 0xa5);
L
Linus Torvalds 已提交
873
	status1 = serial_in(up, UART_SCR);
874
	serial_out(up, UART_SCR, 0x5a);
L
Linus Torvalds 已提交
875
	status2 = serial_in(up, UART_SCR);
876
	serial_out(up, UART_SCR, scratch);
L
Linus Torvalds 已提交
877 878 879 880 881 882 883 884 885 886

	if (status1 == 0xa5 && status2 == 0x5a)
		up->port.type = PORT_16450;
}

static int broken_efr(struct uart_8250_port *up)
{
	/*
	 * Exar ST16C2550 "A2" devices incorrectly detect as
	 * having an EFR, and report an ID of 0x0201.  See
887
	 * http://linux.derkeiler.com/Mailing-Lists/Kernel/2004-11/4812.html 
L
Linus Torvalds 已提交
888 889 890 891 892 893 894
	 */
	if (autoconfig_read_divisor_id(up) == 0x0201 && size_fifo(up) == 16)
		return 1;

	return 0;
}

895 896 897 898 899 900 901 902 903 904 905 906
static inline int ns16550a_goto_highspeed(struct uart_8250_port *up)
{
	unsigned char status;

	status = serial_in(up, 0x04); /* EXCR2 */
#define PRESL(x) ((x) & 0x30)
	if (PRESL(status) == 0x10) {
		/* already in high speed mode */
		return 0;
	} else {
		status &= ~0xB0; /* Disable LOCK, mask out PRESL[01] */
		status |= 0x10;  /* 1.625 divisor for baud_base --> 921600 */
907
		serial_out(up, 0x04, status);
908 909 910 911
	}
	return 1;
}

L
Linus Torvalds 已提交
912 913 914 915 916 917 918 919 920 921 922 923 924 925
/*
 * We know that the chip has FIFOs.  Does it have an EFR?  The
 * EFR is located in the same register position as the IIR and
 * we know the top two bits of the IIR are currently set.  The
 * EFR should contain zero.  Try to read the EFR.
 */
static void autoconfig_16550a(struct uart_8250_port *up)
{
	unsigned char status1, status2;
	unsigned int iersave;

	up->port.type = PORT_16550A;
	up->capabilities |= UART_CAP_FIFO;

926 927 928 929 930 931 932 933
	/*
	 * XR17V35x UARTs have an extra divisor register, DLD
	 * that gets enabled with when DLAB is set which will
	 * cause the device to incorrectly match and assign
	 * port type to PORT_16650.  The EFR for this UART is
	 * found at offset 0x09. Instead check the Deice ID (DVID)
	 * register for a 2, 4 or 8 port UART.
	 */
934 935 936
	if (up->port.flags & UPF_EXAR_EFR) {
		status1 = serial_in(up, UART_EXAR_DVID);
		if (status1 == 0x82 || status1 == 0x84 || status1 == 0x88) {
937 938 939 940 941 942 943 944 945 946
			DEBUG_AUTOCONF("Exar XR17V35x ");
			up->port.type = PORT_XR17V35X;
			up->capabilities |= UART_CAP_AFE | UART_CAP_EFR |
						UART_CAP_SLEEP;

			return;
		}

	}

L
Linus Torvalds 已提交
947 948 949 950
	/*
	 * Check for presence of the EFR when DLAB is set.
	 * Only ST16C650V1 UARTs pass this test.
	 */
951
	serial_out(up, UART_LCR, UART_LCR_CONF_MODE_A);
L
Linus Torvalds 已提交
952
	if (serial_in(up, UART_EFR) == 0) {
953
		serial_out(up, UART_EFR, 0xA8);
L
Linus Torvalds 已提交
954 955 956 957 958 959 960
		if (serial_in(up, UART_EFR) != 0) {
			DEBUG_AUTOCONF("EFRv1 ");
			up->port.type = PORT_16650;
			up->capabilities |= UART_CAP_EFR | UART_CAP_SLEEP;
		} else {
			DEBUG_AUTOCONF("Motorola 8xxx DUART ");
		}
961
		serial_out(up, UART_EFR, 0);
L
Linus Torvalds 已提交
962 963 964 965 966 967 968
		return;
	}

	/*
	 * Maybe it requires 0xbf to be written to the LCR.
	 * (other ST16C650V2 UARTs, TI16C752A, etc)
	 */
969
	serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
L
Linus Torvalds 已提交
970 971 972 973 974 975 976 977 978 979 980 981 982
	if (serial_in(up, UART_EFR) == 0 && !broken_efr(up)) {
		DEBUG_AUTOCONF("EFRv2 ");
		autoconfig_has_efr(up);
		return;
	}

	/*
	 * Check for a National Semiconductor SuperIO chip.
	 * Attempt to switch to bank 2, read the value of the LOOP bit
	 * from EXCR1. Switch back to bank 0, change it in MCR. Then
	 * switch back to bank 2, read it from EXCR1 again and check
	 * it's changed. If so, set baud_base in EXCR2 to 921600. -- dwmw2
	 */
983
	serial_out(up, UART_LCR, 0);
L
Linus Torvalds 已提交
984
	status1 = serial_in(up, UART_MCR);
985
	serial_out(up, UART_LCR, 0xE0);
L
Linus Torvalds 已提交
986 987 988
	status2 = serial_in(up, 0x02); /* EXCR1 */

	if (!((status2 ^ status1) & UART_MCR_LOOP)) {
989 990 991
		serial_out(up, UART_LCR, 0);
		serial_out(up, UART_MCR, status1 ^ UART_MCR_LOOP);
		serial_out(up, UART_LCR, 0xE0);
L
Linus Torvalds 已提交
992
		status2 = serial_in(up, 0x02); /* EXCR1 */
993 994
		serial_out(up, UART_LCR, 0);
		serial_out(up, UART_MCR, status1);
L
Linus Torvalds 已提交
995 996

		if ((status2 ^ status1) & UART_MCR_LOOP) {
997 998
			unsigned short quot;

999
			serial_out(up, UART_LCR, 0xE0);
1000

1001
			quot = serial_dl_read(up);
1002 1003
			quot <<= 3;

1004 1005
			if (ns16550a_goto_highspeed(up))
				serial_dl_write(up, quot);
1006

1007
			serial_out(up, UART_LCR, 0);
L
Linus Torvalds 已提交
1008

1009
			up->port.uartclk = 921600*16;
L
Linus Torvalds 已提交
1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021
			up->port.type = PORT_NS16550A;
			up->capabilities |= UART_NATSEMI;
			return;
		}
	}

	/*
	 * No EFR.  Try to detect a TI16750, which only sets bit 5 of
	 * the IIR when 64 byte FIFO mode is enabled when DLAB is set.
	 * Try setting it with and without DLAB set.  Cheap clones
	 * set bit 5 without DLAB set.
	 */
1022 1023
	serial_out(up, UART_LCR, 0);
	serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR7_64BYTE);
L
Linus Torvalds 已提交
1024
	status1 = serial_in(up, UART_IIR) >> 5;
1025 1026 1027
	serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO);
	serial_out(up, UART_LCR, UART_LCR_CONF_MODE_A);
	serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO | UART_FCR7_64BYTE);
L
Linus Torvalds 已提交
1028
	status2 = serial_in(up, UART_IIR) >> 5;
1029 1030
	serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO);
	serial_out(up, UART_LCR, 0);
L
Linus Torvalds 已提交
1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048

	DEBUG_AUTOCONF("iir1=%d iir2=%d ", status1, status2);

	if (status1 == 6 && status2 == 7) {
		up->port.type = PORT_16750;
		up->capabilities |= UART_CAP_AFE | UART_CAP_SLEEP;
		return;
	}

	/*
	 * Try writing and reading the UART_IER_UUE bit (b6).
	 * If it works, this is probably one of the Xscale platform's
	 * internal UARTs.
	 * We're going to explicitly set the UUE bit to 0 before
	 * trying to write and read a 1 just to make sure it's not
	 * already a 1 and maybe locked there before we even start start.
	 */
	iersave = serial_in(up, UART_IER);
1049
	serial_out(up, UART_IER, iersave & ~UART_IER_UUE);
L
Linus Torvalds 已提交
1050 1051 1052 1053 1054
	if (!(serial_in(up, UART_IER) & UART_IER_UUE)) {
		/*
		 * OK it's in a known zero state, try writing and reading
		 * without disturbing the current state of the other bits.
		 */
1055
		serial_out(up, UART_IER, iersave | UART_IER_UUE);
L
Linus Torvalds 已提交
1056 1057 1058 1059 1060 1061 1062
		if (serial_in(up, UART_IER) & UART_IER_UUE) {
			/*
			 * It's an Xscale.
			 * We'll leave the UART_IER_UUE bit set to 1 (enabled).
			 */
			DEBUG_AUTOCONF("Xscale ");
			up->port.type = PORT_XSCALE;
1063
			up->capabilities |= UART_CAP_UUE | UART_CAP_RTOIE;
L
Linus Torvalds 已提交
1064 1065 1066 1067 1068 1069 1070 1071 1072
			return;
		}
	} else {
		/*
		 * If we got here we couldn't force the IER_UUE bit to 0.
		 * Log it and continue.
		 */
		DEBUG_AUTOCONF("Couldn't force IER_UUE to 0 ");
	}
1073
	serial_out(up, UART_IER, iersave);
1074

1075 1076 1077 1078
	/*
	 * Exar uarts have EFR in a weird location
	 */
	if (up->port.flags & UPF_EXAR_EFR) {
1079
		DEBUG_AUTOCONF("Exar XR17D15x ");
1080
		up->port.type = PORT_XR17D15X;
1081 1082 1083 1084
		up->capabilities |= UART_CAP_AFE | UART_CAP_EFR |
				    UART_CAP_SLEEP;

		return;
1085 1086
	}

1087 1088 1089 1090 1091 1092 1093 1094
	/*
	 * We distinguish between 16550A and U6 16550A by counting
	 * how many bytes are in the FIFO.
	 */
	if (up->port.type == PORT_16550A && size_fifo(up) == 64) {
		up->port.type = PORT_U6_16550A;
		up->capabilities |= UART_CAP_AFE;
	}
L
Linus Torvalds 已提交
1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107
}

/*
 * This routine is called by rs_init() to initialize a specific serial
 * port.  It determines what type of UART chip this serial port is
 * using: 8250, 16450, 16550, 16550A.  The important question is
 * whether or not this UART is a 16550A or not, since this will
 * determine whether or not we can use its FIFO features or not.
 */
static void autoconfig(struct uart_8250_port *up, unsigned int probeflags)
{
	unsigned char status1, scratch, scratch2, scratch3;
	unsigned char save_lcr, save_mcr;
1108
	struct uart_port *port = &up->port;
L
Linus Torvalds 已提交
1109
	unsigned long flags;
1110
	unsigned int old_capabilities;
L
Linus Torvalds 已提交
1111

1112
	if (!port->iobase && !port->mapbase && !port->membase)
L
Linus Torvalds 已提交
1113 1114
		return;

1115
	DEBUG_AUTOCONF("ttyS%d: autoconf (0x%04lx, 0x%p): ",
1116
		       serial_index(port), port->iobase, port->membase);
L
Linus Torvalds 已提交
1117 1118 1119 1120 1121

	/*
	 * We really do need global IRQs disabled here - we're going to
	 * be frobbing the chips IRQ enable register to see if it exists.
	 */
1122
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
1123 1124

	up->capabilities = 0;
1125
	up->bugs = 0;
L
Linus Torvalds 已提交
1126

1127
	if (!(port->flags & UPF_BUGGY_UART)) {
L
Linus Torvalds 已提交
1128 1129 1130
		/*
		 * Do a simple existence test first; if we fail this,
		 * there's no point trying anything else.
T
Thomas Koeller 已提交
1131
		 *
L
Linus Torvalds 已提交
1132 1133 1134 1135 1136 1137 1138 1139 1140
		 * 0x80 is used as a nonsense port to prevent against
		 * false positives due to ISA bus float.  The
		 * assumption is that 0x80 is a non-existent port;
		 * which should be safe since include/asm/io.h also
		 * makes this assumption.
		 *
		 * Note: this is safe as long as MCR bit 4 is clear
		 * and the device is in "PC" mode.
		 */
1141 1142
		scratch = serial_in(up, UART_IER);
		serial_out(up, UART_IER, 0);
L
Linus Torvalds 已提交
1143 1144 1145
#ifdef __i386__
		outb(0xff, 0x080);
#endif
1146 1147 1148 1149
		/*
		 * Mask out IER[7:4] bits for test as some UARTs (e.g. TL
		 * 16C754B) allow only to modify them if an EFR bit is set.
		 */
1150 1151
		scratch2 = serial_in(up, UART_IER) & 0x0f;
		serial_out(up, UART_IER, 0x0F);
L
Linus Torvalds 已提交
1152 1153 1154
#ifdef __i386__
		outb(0, 0x080);
#endif
1155 1156
		scratch3 = serial_in(up, UART_IER) & 0x0f;
		serial_out(up, UART_IER, scratch);
L
Linus Torvalds 已提交
1157 1158 1159 1160
		if (scratch2 != 0 || scratch3 != 0x0F) {
			/*
			 * We failed; there's nothing here
			 */
1161
			spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
1162 1163 1164 1165 1166 1167 1168 1169 1170
			DEBUG_AUTOCONF("IER test failed (%02x, %02x) ",
				       scratch2, scratch3);
			goto out;
		}
	}

	save_mcr = serial_in(up, UART_MCR);
	save_lcr = serial_in(up, UART_LCR);

T
Thomas Koeller 已提交
1171
	/*
L
Linus Torvalds 已提交
1172 1173 1174 1175 1176 1177 1178 1179
	 * Check to see if a UART is really there.  Certain broken
	 * internal modems based on the Rockwell chipset fail this
	 * test, because they apparently don't implement the loopback
	 * test mode.  So this test is skipped on the COM 1 through
	 * COM 4 ports.  This *should* be safe, since no board
	 * manufacturer would be stupid enough to design a board
	 * that conflicts with COM 1-4 --- we hope!
	 */
1180
	if (!(port->flags & UPF_SKIP_TEST)) {
1181 1182 1183
		serial_out(up, UART_MCR, UART_MCR_LOOP | 0x0A);
		status1 = serial_in(up, UART_MSR) & 0xF0;
		serial_out(up, UART_MCR, save_mcr);
L
Linus Torvalds 已提交
1184
		if (status1 != 0x90) {
1185
			spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
1186 1187 1188 1189 1190 1191 1192 1193 1194
			DEBUG_AUTOCONF("LOOP test failed (%02x) ",
				       status1);
			goto out;
		}
	}

	/*
	 * We're pretty sure there's a port here.  Lets find out what
	 * type of port it is.  The IIR top two bits allows us to find
R
Russell King 已提交
1195
	 * out if it's 8250 or 16450, 16550, 16550A or later.  This
L
Linus Torvalds 已提交
1196 1197 1198 1199 1200
	 * determines what we test for next.
	 *
	 * We also initialise the EFR (if any) to zero for later.  The
	 * EFR occupies the same register location as the FCR and IIR.
	 */
1201 1202 1203
	serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
	serial_out(up, UART_EFR, 0);
	serial_out(up, UART_LCR, 0);
L
Linus Torvalds 已提交
1204

1205
	serial_out(up, UART_FCR, UART_FCR_ENABLE_FIFO);
L
Linus Torvalds 已提交
1206 1207 1208 1209 1210 1211 1212
	scratch = serial_in(up, UART_IIR) >> 6;

	switch (scratch) {
	case 0:
		autoconfig_8250(up);
		break;
	case 1:
1213
		port->type = PORT_UNKNOWN;
L
Linus Torvalds 已提交
1214 1215
		break;
	case 2:
1216
		port->type = PORT_16550;
L
Linus Torvalds 已提交
1217 1218 1219 1220 1221 1222 1223 1224 1225 1226
		break;
	case 3:
		autoconfig_16550a(up);
		break;
	}

#ifdef CONFIG_SERIAL_8250_RSA
	/*
	 * Only probe for RSA ports if we got the region.
	 */
1227
	if (port->type == PORT_16550A && probeflags & PROBE_RSA) {
L
Linus Torvalds 已提交
1228 1229 1230
		int i;

		for (i = 0 ; i < probe_rsa_count; ++i) {
1231 1232
			if (probe_rsa[i] == port->iobase && __enable_rsa(up)) {
				port->type = PORT_RSA;
L
Linus Torvalds 已提交
1233 1234 1235 1236 1237
				break;
			}
		}
	}
#endif
1238

1239
	serial_out(up, UART_LCR, save_lcr);
L
Linus Torvalds 已提交
1240

1241
	port->fifosize = uart_config[up->port.type].fifo_size;
1242
	old_capabilities = up->capabilities; 
1243 1244
	up->capabilities = uart_config[port->type].flags;
	up->tx_loadsz = uart_config[port->type].tx_loadsz;
L
Linus Torvalds 已提交
1245

1246
	if (port->type == PORT_UNKNOWN)
1247
		goto out_lock;
L
Linus Torvalds 已提交
1248 1249 1250 1251 1252

	/*
	 * Reset the UART.
	 */
#ifdef CONFIG_SERIAL_8250_RSA
1253
	if (port->type == PORT_RSA)
1254
		serial_out(up, UART_RSA_FRR, 0);
L
Linus Torvalds 已提交
1255
#endif
1256
	serial_out(up, UART_MCR, save_mcr);
L
Linus Torvalds 已提交
1257
	serial8250_clear_fifos(up);
A
Alex Williamson 已提交
1258
	serial_in(up, UART_RX);
1259
	if (up->capabilities & UART_CAP_UUE)
1260
		serial_out(up, UART_IER, UART_IER_UUE);
1261
	else
1262
		serial_out(up, UART_IER, 0);
L
Linus Torvalds 已提交
1263

1264
out_lock:
1265
	spin_unlock_irqrestore(&port->lock, flags);
1266 1267 1268 1269 1270 1271 1272 1273
	if (up->capabilities != old_capabilities) {
		printk(KERN_WARNING
		       "ttyS%d: detected caps %08x should be %08x\n",
		       serial_index(port), old_capabilities,
		       up->capabilities);
	}
out:
	DEBUG_AUTOCONF("iir=%d ", scratch);
1274
	DEBUG_AUTOCONF("type=%s\n", uart_config[port->type].name);
L
Linus Torvalds 已提交
1275 1276 1277 1278
}

static void autoconfig_irq(struct uart_8250_port *up)
{
1279
	struct uart_port *port = &up->port;
L
Linus Torvalds 已提交
1280 1281 1282 1283 1284 1285
	unsigned char save_mcr, save_ier;
	unsigned char save_ICP = 0;
	unsigned int ICP = 0;
	unsigned long irqs;
	int irq;

1286 1287
	if (port->flags & UPF_FOURPORT) {
		ICP = (port->iobase & 0xfe0) | 0x1f;
L
Linus Torvalds 已提交
1288 1289
		save_ICP = inb_p(ICP);
		outb_p(0x80, ICP);
1290
		inb_p(ICP);
L
Linus Torvalds 已提交
1291 1292 1293 1294
	}

	/* forget possible initially masked and pending IRQ */
	probe_irq_off(probe_irq_on());
1295 1296 1297
	save_mcr = serial_in(up, UART_MCR);
	save_ier = serial_in(up, UART_IER);
	serial_out(up, UART_MCR, UART_MCR_OUT1 | UART_MCR_OUT2);
T
Thomas Koeller 已提交
1298

L
Linus Torvalds 已提交
1299
	irqs = probe_irq_on();
1300
	serial_out(up, UART_MCR, 0);
A
Alan Cox 已提交
1301
	udelay(10);
1302
	if (port->flags & UPF_FOURPORT) {
1303
		serial_out(up, UART_MCR,
L
Linus Torvalds 已提交
1304 1305
			    UART_MCR_DTR | UART_MCR_RTS);
	} else {
1306
		serial_out(up, UART_MCR,
L
Linus Torvalds 已提交
1307 1308
			    UART_MCR_DTR | UART_MCR_RTS | UART_MCR_OUT2);
	}
1309
	serial_out(up, UART_IER, 0x0f);	/* enable all intrs */
1310 1311 1312 1313
	serial_in(up, UART_LSR);
	serial_in(up, UART_RX);
	serial_in(up, UART_IIR);
	serial_in(up, UART_MSR);
1314
	serial_out(up, UART_TX, 0xFF);
A
Alan Cox 已提交
1315
	udelay(20);
L
Linus Torvalds 已提交
1316 1317
	irq = probe_irq_off(irqs);

1318 1319
	serial_out(up, UART_MCR, save_mcr);
	serial_out(up, UART_IER, save_ier);
L
Linus Torvalds 已提交
1320

1321
	if (port->flags & UPF_FOURPORT)
L
Linus Torvalds 已提交
1322 1323
		outb_p(save_ICP, ICP);

1324
	port->irq = (irq > 0) ? irq : 0;
L
Linus Torvalds 已提交
1325 1326
}

1327 1328 1329 1330 1331
static inline void __stop_tx(struct uart_8250_port *p)
{
	if (p->ier & UART_IER_THRI) {
		p->ier &= ~UART_IER_THRI;
		serial_out(p, UART_IER, p->ier);
1332
		serial8250_rpm_put_tx(p);
1333 1334 1335
	}
}

1336
static void serial8250_stop_tx(struct uart_port *port)
L
Linus Torvalds 已提交
1337
{
1338
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
1339

1340
	serial8250_rpm_get(up);
1341
	__stop_tx(up);
L
Linus Torvalds 已提交
1342 1343

	/*
1344
	 * We really want to stop the transmitter from sending.
L
Linus Torvalds 已提交
1345
	 */
1346
	if (port->type == PORT_16C950) {
L
Linus Torvalds 已提交
1347 1348 1349
		up->acr |= UART_ACR_TXDIS;
		serial_icr_write(up, UART_ACR, up->acr);
	}
1350
	serial8250_rpm_put(up);
L
Linus Torvalds 已提交
1351 1352
}

1353
static void serial8250_start_tx(struct uart_port *port)
L
Linus Torvalds 已提交
1354
{
1355
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
1356

1357
	serial8250_rpm_get_tx(up);
1358
	if (up->dma && !up->dma->tx_dma(up)) {
1359 1360
		return;
	} else if (!(up->ier & UART_IER_THRI)) {
L
Linus Torvalds 已提交
1361
		up->ier |= UART_IER_THRI;
1362
		serial_port_out(port, UART_IER, up->ier);
1363

1364
		if (up->bugs & UART_BUG_TXEN) {
1365
			unsigned char lsr;
1366
			lsr = serial_in(up, UART_LSR);
1367
			up->lsr_saved_flags |= lsr & LSR_SAVE_FLAGS;
1368
			if (lsr & UART_LSR_TEMT)
1369
				serial8250_tx_chars(up);
1370
		}
L
Linus Torvalds 已提交
1371
	}
1372

L
Linus Torvalds 已提交
1373
	/*
1374
	 * Re-enable the transmitter if we disabled it.
L
Linus Torvalds 已提交
1375
	 */
1376
	if (port->type == PORT_16C950 && up->acr & UART_ACR_TXDIS) {
L
Linus Torvalds 已提交
1377 1378 1379 1380 1381
		up->acr &= ~UART_ACR_TXDIS;
		serial_icr_write(up, UART_ACR, up->acr);
	}
}

1382 1383 1384 1385 1386 1387 1388 1389 1390 1391
static void serial8250_throttle(struct uart_port *port)
{
	port->throttle(port);
}

static void serial8250_unthrottle(struct uart_port *port)
{
	port->unthrottle(port);
}

L
Linus Torvalds 已提交
1392 1393
static void serial8250_stop_rx(struct uart_port *port)
{
1394
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
1395

1396 1397
	serial8250_rpm_get(up);

1398
	up->ier &= ~(UART_IER_RLSI | UART_IER_RDI);
L
Linus Torvalds 已提交
1399
	up->port.read_status_mask &= ~UART_LSR_DR;
1400
	serial_port_out(port, UART_IER, up->ier);
1401 1402

	serial8250_rpm_put(up);
L
Linus Torvalds 已提交
1403 1404 1405 1406
}

static void serial8250_enable_ms(struct uart_port *port)
{
1407
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
1408

1409 1410 1411 1412
	/* no MSR capabilities */
	if (up->bugs & UART_BUG_NOMSR)
		return;

L
Linus Torvalds 已提交
1413
	up->ier |= UART_IER_MSI;
1414 1415

	serial8250_rpm_get(up);
1416
	serial_port_out(port, UART_IER, up->ier);
1417
	serial8250_rpm_put(up);
L
Linus Torvalds 已提交
1418 1419
}

1420
/*
1421
 * serial8250_rx_chars: processes according to the passed in LSR
1422 1423 1424
 * value, and returns the remaining LSR bits not handled
 * by this Rx routine.
 */
1425 1426
unsigned char
serial8250_rx_chars(struct uart_8250_port *up, unsigned char lsr)
L
Linus Torvalds 已提交
1427
{
1428
	struct uart_port *port = &up->port;
1429
	unsigned char ch;
L
Linus Torvalds 已提交
1430 1431 1432 1433
	int max_count = 256;
	char flag;

	do {
1434
		if (likely(lsr & UART_LSR_DR))
1435
			ch = serial_in(up, UART_RX);
1436 1437 1438 1439 1440 1441 1442 1443 1444 1445
		else
			/*
			 * Intel 82571 has a Serial Over Lan device that will
			 * set UART_LSR_BI without setting UART_LSR_DR when
			 * it receives a break. To avoid reading from the
			 * receive buffer without UART_LSR_DR bit set, we
			 * just force the read character to be 0
			 */
			ch = 0;

L
Linus Torvalds 已提交
1446
		flag = TTY_NORMAL;
1447
		port->icount.rx++;
L
Linus Torvalds 已提交
1448

1449 1450
		lsr |= up->lsr_saved_flags;
		up->lsr_saved_flags = 0;
L
Linus Torvalds 已提交
1451

1452
		if (unlikely(lsr & UART_LSR_BRK_ERROR_BITS)) {
L
Linus Torvalds 已提交
1453 1454
			if (lsr & UART_LSR_BI) {
				lsr &= ~(UART_LSR_FE | UART_LSR_PE);
1455
				port->icount.brk++;
L
Linus Torvalds 已提交
1456 1457 1458 1459 1460 1461
				/*
				 * We do the SysRQ and SAK checking
				 * here because otherwise the break
				 * may get masked by ignore_status_mask
				 * or read_status_mask.
				 */
1462
				if (uart_handle_break(port))
L
Linus Torvalds 已提交
1463 1464
					goto ignore_char;
			} else if (lsr & UART_LSR_PE)
1465
				port->icount.parity++;
L
Linus Torvalds 已提交
1466
			else if (lsr & UART_LSR_FE)
1467
				port->icount.frame++;
L
Linus Torvalds 已提交
1468
			if (lsr & UART_LSR_OE)
1469
				port->icount.overrun++;
L
Linus Torvalds 已提交
1470 1471

			/*
1472
			 * Mask off conditions which should be ignored.
L
Linus Torvalds 已提交
1473
			 */
1474
			lsr &= port->read_status_mask;
L
Linus Torvalds 已提交
1475 1476 1477 1478 1479 1480 1481 1482 1483

			if (lsr & UART_LSR_BI) {
				DEBUG_INTR("handling break....");
				flag = TTY_BREAK;
			} else if (lsr & UART_LSR_PE)
				flag = TTY_PARITY;
			else if (lsr & UART_LSR_FE)
				flag = TTY_FRAME;
		}
1484
		if (uart_handle_sysrq_char(port, ch))
L
Linus Torvalds 已提交
1485
			goto ignore_char;
1486

1487
		uart_insert_char(port, lsr, UART_LSR_OE, ch, flag);
1488

A
Alan Cox 已提交
1489
ignore_char:
1490
		lsr = serial_in(up, UART_LSR);
1491
	} while ((lsr & (UART_LSR_DR | UART_LSR_BI)) && (max_count-- > 0));
1492
	spin_unlock(&port->lock);
J
Jiri Slaby 已提交
1493
	tty_flip_buffer_push(&port->state->port);
1494
	spin_lock(&port->lock);
1495
	return lsr;
L
Linus Torvalds 已提交
1496
}
1497
EXPORT_SYMBOL_GPL(serial8250_rx_chars);
L
Linus Torvalds 已提交
1498

1499
void serial8250_tx_chars(struct uart_8250_port *up)
L
Linus Torvalds 已提交
1500
{
1501 1502
	struct uart_port *port = &up->port;
	struct circ_buf *xmit = &port->state->xmit;
L
Linus Torvalds 已提交
1503 1504
	int count;

1505 1506 1507 1508
	if (port->x_char) {
		serial_out(up, UART_TX, port->x_char);
		port->icount.tx++;
		port->x_char = 0;
L
Linus Torvalds 已提交
1509 1510
		return;
	}
1511 1512
	if (uart_tx_stopped(port)) {
		serial8250_stop_tx(port);
1513 1514 1515
		return;
	}
	if (uart_circ_empty(xmit)) {
1516
		__stop_tx(up);
L
Linus Torvalds 已提交
1517 1518 1519 1520 1521 1522 1523
		return;
	}

	count = up->tx_loadsz;
	do {
		serial_out(up, UART_TX, xmit->buf[xmit->tail]);
		xmit->tail = (xmit->tail + 1) & (UART_XMIT_SIZE - 1);
1524
		port->icount.tx++;
L
Linus Torvalds 已提交
1525 1526
		if (uart_circ_empty(xmit))
			break;
1527 1528 1529 1530 1531
		if (up->capabilities & UART_CAP_HFIFO) {
			if ((serial_port_in(port, UART_LSR) & BOTH_EMPTY) !=
			    BOTH_EMPTY)
				break;
		}
L
Linus Torvalds 已提交
1532 1533 1534
	} while (--count > 0);

	if (uart_circ_chars_pending(xmit) < WAKEUP_CHARS)
1535
		uart_write_wakeup(port);
L
Linus Torvalds 已提交
1536 1537 1538

	DEBUG_INTR("THRE...");

1539
	/*
1540
	 * With RPM enabled, we have to wait until the FIFO is empty before the
1541 1542 1543 1544
	 * HW can go idle. So we get here once again with empty FIFO and disable
	 * the interrupt and RPM in __stop_tx()
	 */
	if (uart_circ_empty(xmit) && !(up->capabilities & UART_CAP_RPM))
1545
		__stop_tx(up);
L
Linus Torvalds 已提交
1546
}
1547
EXPORT_SYMBOL_GPL(serial8250_tx_chars);
L
Linus Torvalds 已提交
1548

1549
/* Caller holds uart port lock */
1550
unsigned int serial8250_modem_status(struct uart_8250_port *up)
L
Linus Torvalds 已提交
1551
{
1552
	struct uart_port *port = &up->port;
1553 1554
	unsigned int status = serial_in(up, UART_MSR);

1555 1556
	status |= up->msr_saved_flags;
	up->msr_saved_flags = 0;
1557
	if (status & UART_MSR_ANY_DELTA && up->ier & UART_IER_MSI &&
1558
	    port->state != NULL) {
1559
		if (status & UART_MSR_TERI)
1560
			port->icount.rng++;
1561
		if (status & UART_MSR_DDSR)
1562
			port->icount.dsr++;
1563
		if (status & UART_MSR_DDCD)
1564
			uart_handle_dcd_change(port, status & UART_MSR_DCD);
1565
		if (status & UART_MSR_DCTS)
1566
			uart_handle_cts_change(port, status & UART_MSR_CTS);
1567

1568
		wake_up_interruptible(&port->state->port.delta_msr_wait);
1569
	}
L
Linus Torvalds 已提交
1570

1571
	return status;
L
Linus Torvalds 已提交
1572
}
1573
EXPORT_SYMBOL_GPL(serial8250_modem_status);
L
Linus Torvalds 已提交
1574 1575 1576 1577

/*
 * This handles the interrupt from one port.
 */
1578
int serial8250_handle_irq(struct uart_port *port, unsigned int iir)
L
Linus Torvalds 已提交
1579
{
1580
	unsigned char status;
1581
	unsigned long flags;
1582
	struct uart_8250_port *up = up_to_u8250p(port);
1583
	int dma_err = 0;
1584 1585 1586

	if (iir & UART_IIR_NO_INT)
		return 0;
1587

1588
	spin_lock_irqsave(&port->lock, flags);
1589

1590
	status = serial_port_in(port, UART_LSR);
L
Linus Torvalds 已提交
1591 1592 1593

	DEBUG_INTR("status = %x...", status);

1594 1595
	if (status & (UART_LSR_DR | UART_LSR_BI)) {
		if (up->dma)
1596
			dma_err = up->dma->rx_dma(up, iir);
1597 1598 1599 1600

		if (!up->dma || dma_err)
			status = serial8250_rx_chars(up, status);
	}
1601
	serial8250_modem_status(up);
1602 1603
	if ((!up->dma || (up->dma && up->dma->tx_err)) &&
	    (status & UART_LSR_THRE))
1604
		serial8250_tx_chars(up);
1605

1606
	spin_unlock_irqrestore(&port->lock, flags);
1607
	return 1;
1608
}
1609
EXPORT_SYMBOL_GPL(serial8250_handle_irq);
1610 1611 1612

static int serial8250_default_handle_irq(struct uart_port *port)
{
1613 1614 1615 1616 1617
	struct uart_8250_port *up = up_to_u8250p(port);
	unsigned int iir;
	int ret;

	serial8250_rpm_get(up);
1618

1619 1620 1621 1622 1623
	iir = serial_port_in(port, UART_IIR);
	ret = serial8250_handle_irq(port, iir);

	serial8250_rpm_put(up);
	return ret;
1624 1625
}

1626 1627 1628 1629 1630 1631 1632 1633 1634 1635 1636 1637 1638 1639
/*
 * These Exar UARTs have an extra interrupt indicator that could
 * fire for a few unimplemented interrupts.  One of which is a
 * wakeup event when coming out of sleep.  Put this here just
 * to be on the safe side that these interrupts don't go unhandled.
 */
static int exar_handle_irq(struct uart_port *port)
{
	unsigned char int0, int1, int2, int3;
	unsigned int iir = serial_port_in(port, UART_IIR);
	int ret;

	ret = serial8250_handle_irq(port, iir);

1640 1641
	if ((port->type == PORT_XR17V35X) ||
	   (port->type == PORT_XR17D15X)) {
1642 1643 1644 1645 1646 1647 1648 1649 1650
		int0 = serial_port_in(port, 0x80);
		int1 = serial_port_in(port, 0x81);
		int2 = serial_port_in(port, 0x82);
		int3 = serial_port_in(port, 0x83);
	}

	return ret;
}

L
Linus Torvalds 已提交
1651 1652 1653 1654 1655 1656 1657 1658 1659 1660 1661 1662 1663 1664
/*
 * This is the serial driver's interrupt routine.
 *
 * Arjan thinks the old way was overly complex, so it got simplified.
 * Alan disagrees, saying that need the complexity to handle the weird
 * nature of ISA shared interrupts.  (This is a special exception.)
 *
 * In order to handle ISA shared interrupts properly, we need to check
 * that all ports have been serviced, and therefore the ISA interrupt
 * line has been de-asserted.
 *
 * This means we need to loop through all ports. checking that they
 * don't have an interrupt pending.
 */
1665
static irqreturn_t serial8250_interrupt(int irq, void *dev_id)
L
Linus Torvalds 已提交
1666 1667 1668 1669 1670 1671 1672 1673 1674 1675 1676 1677
{
	struct irq_info *i = dev_id;
	struct list_head *l, *end = NULL;
	int pass_counter = 0, handled = 0;

	DEBUG_INTR("serial8250_interrupt(%d)...", irq);

	spin_lock(&i->lock);

	l = i->head;
	do {
		struct uart_8250_port *up;
1678
		struct uart_port *port;
L
Linus Torvalds 已提交
1679 1680

		up = list_entry(l, struct uart_8250_port, list);
1681
		port = &up->port;
L
Linus Torvalds 已提交
1682

1683
		if (port->handle_irq(port)) {
L
Linus Torvalds 已提交
1684 1685 1686 1687 1688 1689 1690 1691 1692
			handled = 1;
			end = NULL;
		} else if (end == NULL)
			end = l;

		l = l->next;

		if (l == i->head && pass_counter++ > PASS_LIMIT) {
			/* If we hit this, we're dead. */
1693 1694
			printk_ratelimited(KERN_ERR
				"serial8250: too much work for irq%d\n", irq);
L
Linus Torvalds 已提交
1695 1696 1697 1698 1699 1700 1701 1702 1703 1704 1705 1706 1707 1708 1709 1710 1711 1712 1713 1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724 1725
			break;
		}
	} while (l != end);

	spin_unlock(&i->lock);

	DEBUG_INTR("end.\n");

	return IRQ_RETVAL(handled);
}

/*
 * To support ISA shared interrupts, we need to have one interrupt
 * handler that ensures that the IRQ line has been deasserted
 * before returning.  Failing to do this will result in the IRQ
 * line being stuck active, and, since ISA irqs are edge triggered,
 * no more IRQs will be seen.
 */
static void serial_do_unlink(struct irq_info *i, struct uart_8250_port *up)
{
	spin_lock_irq(&i->lock);

	if (!list_empty(i->head)) {
		if (i->head == &up->list)
			i->head = i->head->next;
		list_del(&up->list);
	} else {
		BUG_ON(i->head != &up->list);
		i->head = NULL;
	}
	spin_unlock_irq(&i->lock);
A
Alan Cox 已提交
1726 1727 1728 1729 1730
	/* List empty so throw away the hash node */
	if (i->head == NULL) {
		hlist_del(&i->node);
		kfree(i);
	}
L
Linus Torvalds 已提交
1731 1732 1733 1734
}

static int serial_link_irq_chain(struct uart_8250_port *up)
{
A
Alan Cox 已提交
1735 1736 1737
	struct hlist_head *h;
	struct hlist_node *n;
	struct irq_info *i;
1738
	int ret, irq_flags = up->port.flags & UPF_SHARE_IRQ ? IRQF_SHARED : 0;
L
Linus Torvalds 已提交
1739

A
Alan Cox 已提交
1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752 1753 1754 1755 1756 1757 1758 1759 1760 1761
	mutex_lock(&hash_mutex);

	h = &irq_lists[up->port.irq % NR_IRQ_HASH];

	hlist_for_each(n, h) {
		i = hlist_entry(n, struct irq_info, node);
		if (i->irq == up->port.irq)
			break;
	}

	if (n == NULL) {
		i = kzalloc(sizeof(struct irq_info), GFP_KERNEL);
		if (i == NULL) {
			mutex_unlock(&hash_mutex);
			return -ENOMEM;
		}
		spin_lock_init(&i->lock);
		i->irq = up->port.irq;
		hlist_add_head(&i->node, h);
	}
	mutex_unlock(&hash_mutex);

L
Linus Torvalds 已提交
1762 1763 1764 1765 1766 1767 1768 1769 1770 1771 1772
	spin_lock_irq(&i->lock);

	if (i->head) {
		list_add(&up->list, i->head);
		spin_unlock_irq(&i->lock);

		ret = 0;
	} else {
		INIT_LIST_HEAD(&up->list);
		i->head = &up->list;
		spin_unlock_irq(&i->lock);
1773
		irq_flags |= up->port.irqflags;
L
Linus Torvalds 已提交
1774 1775 1776 1777 1778 1779 1780 1781 1782 1783 1784
		ret = request_irq(up->port.irq, serial8250_interrupt,
				  irq_flags, "serial", i);
		if (ret < 0)
			serial_do_unlink(i, up);
	}

	return ret;
}

static void serial_unlink_irq_chain(struct uart_8250_port *up)
{
1785 1786 1787 1788
	/*
	 * yes, some broken gcc emit "warning: 'i' may be used uninitialized"
	 * but no, we are not going to take a patch that assigns NULL below.
	 */
A
Alan Cox 已提交
1789 1790 1791
	struct irq_info *i;
	struct hlist_node *n;
	struct hlist_head *h;
L
Linus Torvalds 已提交
1792

A
Alan Cox 已提交
1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803
	mutex_lock(&hash_mutex);

	h = &irq_lists[up->port.irq % NR_IRQ_HASH];

	hlist_for_each(n, h) {
		i = hlist_entry(n, struct irq_info, node);
		if (i->irq == up->port.irq)
			break;
	}

	BUG_ON(n == NULL);
L
Linus Torvalds 已提交
1804 1805 1806 1807 1808 1809
	BUG_ON(i->head == NULL);

	if (list_empty(i->head))
		free_irq(up->port.irq, i);

	serial_do_unlink(i, up);
A
Alan Cox 已提交
1810
	mutex_unlock(&hash_mutex);
L
Linus Torvalds 已提交
1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822
}

/*
 * This function is used to handle ports that do not have an
 * interrupt.  This doesn't work very well for 16450's, but gives
 * barely passable results for a 16550A.  (Although at the expense
 * of much CPU overhead).
 */
static void serial8250_timeout(unsigned long data)
{
	struct uart_8250_port *up = (struct uart_8250_port *)data;

1823
	up->port.handle_irq(&up->port);
1824
	mod_timer(&up->timer, jiffies + uart_poll_timeout(&up->port));
A
Alex Williamson 已提交
1825 1826 1827 1828 1829
}

static void serial8250_backup_timeout(unsigned long data)
{
	struct uart_8250_port *up = (struct uart_8250_port *)data;
1830 1831
	unsigned int iir, ier = 0, lsr;
	unsigned long flags;
A
Alex Williamson 已提交
1832

1833 1834
	spin_lock_irqsave(&up->port.lock, flags);

A
Alex Williamson 已提交
1835 1836 1837 1838
	/*
	 * Must disable interrupts or else we risk racing with the interrupt
	 * based handler.
	 */
A
Alan Cox 已提交
1839
	if (up->port.irq) {
A
Alex Williamson 已提交
1840 1841 1842
		ier = serial_in(up, UART_IER);
		serial_out(up, UART_IER, 0);
	}
L
Linus Torvalds 已提交
1843

A
Alex Williamson 已提交
1844 1845 1846 1847 1848 1849 1850 1851
	iir = serial_in(up, UART_IIR);

	/*
	 * This should be a safe test for anyone who doesn't trust the
	 * IIR bits on their UART, but it's specifically designed for
	 * the "Diva" UART used on the management processor on many HP
	 * ia64 and parisc boxes.
	 */
1852 1853
	lsr = serial_in(up, UART_LSR);
	up->lsr_saved_flags |= lsr & LSR_SAVE_FLAGS;
A
Alex Williamson 已提交
1854
	if ((iir & UART_IIR_NO_INT) && (up->ier & UART_IER_THRI) &&
A
Alan Cox 已提交
1855
	    (!uart_circ_empty(&up->port.state->xmit) || up->port.x_char) &&
1856
	    (lsr & UART_LSR_THRE)) {
A
Alex Williamson 已提交
1857 1858 1859 1860 1861
		iir &= ~(UART_IIR_ID | UART_IIR_NO_INT);
		iir |= UART_IIR_THRI;
	}

	if (!(iir & UART_IIR_NO_INT))
1862
		serial8250_tx_chars(up);
A
Alex Williamson 已提交
1863

A
Alan Cox 已提交
1864
	if (up->port.irq)
A
Alex Williamson 已提交
1865 1866
		serial_out(up, UART_IER, ier);

1867 1868
	spin_unlock_irqrestore(&up->port.lock, flags);

A
Alex Williamson 已提交
1869
	/* Standard timer interval plus 0.2s to keep the port running */
A
Alan Cox 已提交
1870
	mod_timer(&up->timer,
1871
		jiffies + uart_poll_timeout(&up->port) + HZ / 5);
L
Linus Torvalds 已提交
1872 1873 1874 1875
}

static unsigned int serial8250_tx_empty(struct uart_port *port)
{
1876
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
1877
	unsigned long flags;
1878
	unsigned int lsr;
L
Linus Torvalds 已提交
1879

1880 1881
	serial8250_rpm_get(up);

1882
	spin_lock_irqsave(&port->lock, flags);
1883
	lsr = serial_port_in(port, UART_LSR);
1884
	up->lsr_saved_flags |= lsr & LSR_SAVE_FLAGS;
1885
	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
1886

1887 1888
	serial8250_rpm_put(up);

1889
	return (lsr & BOTH_EMPTY) == BOTH_EMPTY ? TIOCSER_TEMT : 0;
L
Linus Torvalds 已提交
1890 1891 1892 1893
}

static unsigned int serial8250_get_mctrl(struct uart_port *port)
{
1894
	struct uart_8250_port *up = up_to_u8250p(port);
1895
	unsigned int status;
L
Linus Torvalds 已提交
1896 1897
	unsigned int ret;

1898
	serial8250_rpm_get(up);
1899
	status = serial8250_modem_status(up);
1900
	serial8250_rpm_put(up);
L
Linus Torvalds 已提交
1901 1902 1903 1904 1905 1906 1907 1908 1909 1910 1911 1912 1913 1914 1915

	ret = 0;
	if (status & UART_MSR_DCD)
		ret |= TIOCM_CAR;
	if (status & UART_MSR_RI)
		ret |= TIOCM_RNG;
	if (status & UART_MSR_DSR)
		ret |= TIOCM_DSR;
	if (status & UART_MSR_CTS)
		ret |= TIOCM_CTS;
	return ret;
}

static void serial8250_set_mctrl(struct uart_port *port, unsigned int mctrl)
{
1916
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
1917 1918 1919 1920 1921 1922 1923 1924 1925 1926 1927 1928 1929 1930 1931
	unsigned char mcr = 0;

	if (mctrl & TIOCM_RTS)
		mcr |= UART_MCR_RTS;
	if (mctrl & TIOCM_DTR)
		mcr |= UART_MCR_DTR;
	if (mctrl & TIOCM_OUT1)
		mcr |= UART_MCR_OUT1;
	if (mctrl & TIOCM_OUT2)
		mcr |= UART_MCR_OUT2;
	if (mctrl & TIOCM_LOOP)
		mcr |= UART_MCR_LOOP;

	mcr = (mcr & up->mcr_mask) | up->mcr_force | up->mcr;

1932
	serial_port_out(port, UART_MCR, mcr);
L
Linus Torvalds 已提交
1933 1934 1935 1936
}

static void serial8250_break_ctl(struct uart_port *port, int break_state)
{
1937
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
1938 1939
	unsigned long flags;

1940
	serial8250_rpm_get(up);
1941
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
1942 1943 1944 1945
	if (break_state == -1)
		up->lcr |= UART_LCR_SBC;
	else
		up->lcr &= ~UART_LCR_SBC;
1946
	serial_port_out(port, UART_LCR, up->lcr);
1947
	spin_unlock_irqrestore(&port->lock, flags);
1948
	serial8250_rpm_put(up);
L
Linus Torvalds 已提交
1949 1950
}

A
Alex Williamson 已提交
1951 1952 1953
/*
 *	Wait for transmitter & holding register to empty
 */
1954
static void wait_for_xmitr(struct uart_8250_port *up, int bits)
A
Alex Williamson 已提交
1955 1956 1957 1958
{
	unsigned int status, tmout = 10000;

	/* Wait up to 10ms for the character(s) to be sent. */
1959
	for (;;) {
A
Alex Williamson 已提交
1960 1961
		status = serial_in(up, UART_LSR);

1962
		up->lsr_saved_flags |= status & LSR_SAVE_FLAGS;
A
Alex Williamson 已提交
1963

1964 1965
		if ((status & bits) == bits)
			break;
A
Alex Williamson 已提交
1966 1967 1968
		if (--tmout == 0)
			break;
		udelay(1);
1969
	}
A
Alex Williamson 已提交
1970 1971 1972

	/* Wait up to 1s for flow control if necessary */
	if (up->port.flags & UPF_CONS_FLOW) {
1973 1974 1975 1976 1977 1978
		unsigned int tmout;
		for (tmout = 1000000; tmout; tmout--) {
			unsigned int msr = serial_in(up, UART_MSR);
			up->msr_saved_flags |= msr & MSR_SAVE_FLAGS;
			if (msr & UART_MSR_CTS)
				break;
A
Alex Williamson 已提交
1979 1980 1981 1982 1983 1984
			udelay(1);
			touch_nmi_watchdog();
		}
	}
}

J
Jason Wessel 已提交
1985 1986 1987 1988 1989 1990 1991 1992
#ifdef CONFIG_CONSOLE_POLL
/*
 * Console polling routines for writing and reading from the uart while
 * in an interrupt or debug context.
 */

static int serial8250_get_poll_char(struct uart_port *port)
{
1993 1994 1995
	struct uart_8250_port *up = up_to_u8250p(port);
	unsigned char lsr;
	int status;
J
Jason Wessel 已提交
1996

1997
	serial8250_rpm_get(up);
J
Jason Wessel 已提交
1998

1999
	lsr = serial_port_in(port, UART_LSR);
J
Jason Wessel 已提交
2000

2001 2002 2003 2004
	if (!(lsr & UART_LSR_DR)) {
		status = NO_POLL_CHAR;
		goto out;
	}
J
Jason Wessel 已提交
2005

2006 2007 2008 2009
	status = serial_port_in(port, UART_RX);
out:
	serial8250_rpm_put(up);
	return status;
J
Jason Wessel 已提交
2010 2011 2012 2013 2014 2015 2016
}


static void serial8250_put_poll_char(struct uart_port *port,
			 unsigned char c)
{
	unsigned int ier;
2017
	struct uart_8250_port *up = up_to_u8250p(port);
J
Jason Wessel 已提交
2018

2019
	serial8250_rpm_get(up);
J
Jason Wessel 已提交
2020 2021 2022
	/*
	 *	First save the IER then disable the interrupts
	 */
2023
	ier = serial_port_in(port, UART_IER);
J
Jason Wessel 已提交
2024
	if (up->capabilities & UART_CAP_UUE)
2025
		serial_port_out(port, UART_IER, UART_IER_UUE);
J
Jason Wessel 已提交
2026
	else
2027
		serial_port_out(port, UART_IER, 0);
J
Jason Wessel 已提交
2028 2029 2030 2031 2032

	wait_for_xmitr(up, BOTH_EMPTY);
	/*
	 *	Send the character out.
	 */
2033
	serial_port_out(port, UART_TX, c);
J
Jason Wessel 已提交
2034 2035 2036 2037 2038 2039

	/*
	 *	Finally, wait for transmitter to become empty
	 *	and restore the IER
	 */
	wait_for_xmitr(up, BOTH_EMPTY);
2040
	serial_port_out(port, UART_IER, ier);
2041
	serial8250_rpm_put(up);
J
Jason Wessel 已提交
2042 2043 2044 2045
}

#endif /* CONFIG_CONSOLE_POLL */

2046
int serial8250_do_startup(struct uart_port *port)
L
Linus Torvalds 已提交
2047
{
2048
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
2049
	unsigned long flags;
2050
	unsigned char lsr, iir;
L
Linus Torvalds 已提交
2051 2052
	int retval;

S
Sean Young 已提交
2053 2054 2055
	if (port->type == PORT_8250_CIR)
		return -ENODEV;

2056 2057 2058 2059 2060 2061
	if (!port->fifosize)
		port->fifosize = uart_config[port->type].fifo_size;
	if (!up->tx_loadsz)
		up->tx_loadsz = uart_config[port->type].tx_loadsz;
	if (!up->capabilities)
		up->capabilities = uart_config[port->type].flags;
L
Linus Torvalds 已提交
2062 2063
	up->mcr = 0;

2064
	if (port->iotype != up->cur_iotype)
A
Alan Cox 已提交
2065 2066
		set_io_from_upio(port);

2067
	serial8250_rpm_get(up);
2068
	if (port->type == PORT_16C950) {
L
Linus Torvalds 已提交
2069 2070
		/* Wake up and initialize UART */
		up->acr = 0;
2071 2072 2073 2074
		serial_port_out(port, UART_LCR, UART_LCR_CONF_MODE_B);
		serial_port_out(port, UART_EFR, UART_EFR_ECB);
		serial_port_out(port, UART_IER, 0);
		serial_port_out(port, UART_LCR, 0);
L
Linus Torvalds 已提交
2075
		serial_icr_write(up, UART_CSR, 0); /* Reset the UART */
2076 2077 2078
		serial_port_out(port, UART_LCR, UART_LCR_CONF_MODE_B);
		serial_port_out(port, UART_EFR, UART_EFR_ECB);
		serial_port_out(port, UART_LCR, 0);
L
Linus Torvalds 已提交
2079 2080 2081 2082 2083 2084 2085 2086 2087 2088 2089
	}

#ifdef CONFIG_SERIAL_8250_RSA
	/*
	 * If this is an RSA port, see if we can kick it up to the
	 * higher speed clock.
	 */
	enable_rsa(up);
#endif
	/*
	 * Clear the FIFO buffers and disable them.
A
Alexey Dobriyan 已提交
2090
	 * (they will be reenabled in set_termios())
L
Linus Torvalds 已提交
2091 2092 2093 2094 2095 2096
	 */
	serial8250_clear_fifos(up);

	/*
	 * Clear the interrupt registers.
	 */
2097 2098
	if (serial_port_in(port, UART_LSR) & UART_LSR_DR)
		serial_port_in(port, UART_RX);
2099 2100
	serial_port_in(port, UART_IIR);
	serial_port_in(port, UART_MSR);
L
Linus Torvalds 已提交
2101 2102 2103 2104 2105 2106

	/*
	 * At this point, there's no way the LSR could still be 0xff;
	 * if it is, then bail out, because there's likely no UART
	 * here.
	 */
2107
	if (!(port->flags & UPF_BUGGY_UART) &&
2108
	    (serial_port_in(port, UART_LSR) == 0xff)) {
2109
		printk_ratelimited(KERN_INFO "ttyS%d: LSR safety check engaged!\n",
2110
				   serial_index(port));
2111 2112
		retval = -ENODEV;
		goto out;
L
Linus Torvalds 已提交
2113 2114 2115 2116 2117
	}

	/*
	 * For a XR16C850, we need to set the trigger levels
	 */
2118
	if (port->type == PORT_16850) {
L
Linus Torvalds 已提交
2119 2120
		unsigned char fctr;

2121
		serial_out(up, UART_LCR, UART_LCR_CONF_MODE_B);
L
Linus Torvalds 已提交
2122

2123
		fctr = serial_in(up, UART_FCTR) & ~(UART_FCTR_RX|UART_FCTR_TX);
2124 2125 2126 2127 2128 2129
		serial_port_out(port, UART_FCTR,
				fctr | UART_FCTR_TRGD | UART_FCTR_RX);
		serial_port_out(port, UART_TRG, UART_TRG_96);
		serial_port_out(port, UART_FCTR,
				fctr | UART_FCTR_TRGD | UART_FCTR_TX);
		serial_port_out(port, UART_TRG, UART_TRG_96);
L
Linus Torvalds 已提交
2130

2131
		serial_port_out(port, UART_LCR, 0);
L
Linus Torvalds 已提交
2132 2133
	}

2134
	if (port->irq) {
2135
		unsigned char iir1;
A
Alex Williamson 已提交
2136 2137 2138 2139 2140 2141 2142 2143
		/*
		 * Test for UARTs that do not reassert THRE when the
		 * transmitter is idle and the interrupt has already
		 * been cleared.  Real 16550s should always reassert
		 * this interrupt whenever the transmitter is idle and
		 * the interrupt is enabled.  Delays are necessary to
		 * allow register changes to become visible.
		 */
2144
		spin_lock_irqsave(&port->lock, flags);
2145
		if (up->port.irqflags & IRQF_SHARED)
2146
			disable_irq_nosync(port->irq);
A
Alex Williamson 已提交
2147 2148

		wait_for_xmitr(up, UART_LSR_THRE);
2149
		serial_port_out_sync(port, UART_IER, UART_IER_THRI);
A
Alex Williamson 已提交
2150
		udelay(1); /* allow THRE to set */
2151 2152
		iir1 = serial_port_in(port, UART_IIR);
		serial_port_out(port, UART_IER, 0);
2153
		serial_port_out_sync(port, UART_IER, UART_IER_THRI);
A
Alex Williamson 已提交
2154
		udelay(1); /* allow a working UART time to re-assert THRE */
2155 2156
		iir = serial_port_in(port, UART_IIR);
		serial_port_out(port, UART_IER, 0);
A
Alex Williamson 已提交
2157

2158 2159 2160
		if (port->irqflags & IRQF_SHARED)
			enable_irq(port->irq);
		spin_unlock_irqrestore(&port->lock, flags);
A
Alex Williamson 已提交
2161 2162

		/*
2163 2164 2165
		 * If the interrupt is not reasserted, or we otherwise
		 * don't trust the iir, setup a timer to kick the UART
		 * on a regular basis.
A
Alex Williamson 已提交
2166
		 */
2167 2168
		if ((!(iir1 & UART_IIR_NO_INT) && (iir & UART_IIR_NO_INT)) ||
		    up->port.flags & UPF_BUG_THRE) {
2169
			up->bugs |= UART_BUG_THRE;
2170 2171
			pr_debug("ttyS%d - using backup timer\n",
				 serial_index(port));
A
Alex Williamson 已提交
2172 2173 2174
		}
	}

2175 2176 2177 2178 2179 2180 2181 2182
	/*
	 * The above check will only give an accurate result the first time
	 * the port is opened so this value needs to be preserved.
	 */
	if (up->bugs & UART_BUG_THRE) {
		up->timer.function = serial8250_backup_timeout;
		up->timer.data = (unsigned long)up;
		mod_timer(&up->timer, jiffies +
2183
			uart_poll_timeout(port) + HZ / 5);
2184 2185
	}

L
Linus Torvalds 已提交
2186 2187 2188 2189 2190
	/*
	 * If the "interrupt" for this port doesn't correspond with any
	 * hardware interrupt, we use a timer-based system.  The original
	 * driver used to do this with IRQ0.
	 */
2191
	if (!port->irq) {
L
Linus Torvalds 已提交
2192
		up->timer.data = (unsigned long)up;
2193
		mod_timer(&up->timer, jiffies + uart_poll_timeout(port));
L
Linus Torvalds 已提交
2194 2195 2196
	} else {
		retval = serial_link_irq_chain(up);
		if (retval)
2197
			goto out;
L
Linus Torvalds 已提交
2198 2199 2200 2201 2202
	}

	/*
	 * Now, initialize the UART
	 */
2203
	serial_port_out(port, UART_LCR, UART_LCR_WLEN8);
L
Linus Torvalds 已提交
2204

2205
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
2206
	if (up->port.flags & UPF_FOURPORT) {
A
Alan Cox 已提交
2207
		if (!up->port.irq)
L
Linus Torvalds 已提交
2208 2209 2210 2211 2212
			up->port.mctrl |= TIOCM_OUT1;
	} else
		/*
		 * Most PC uarts need OUT2 raised to enable interrupts.
		 */
2213
		if (port->irq)
L
Linus Torvalds 已提交
2214 2215
			up->port.mctrl |= TIOCM_OUT2;

2216
	serial8250_set_mctrl(port, port->mctrl);
2217

2218 2219 2220 2221 2222 2223 2224 2225 2226 2227 2228
	/* Serial over Lan (SoL) hack:
	   Intel 8257x Gigabit ethernet chips have a
	   16550 emulation, to be used for Serial Over Lan.
	   Those chips take a longer time than a normal
	   serial device to signalize that a transmission
	   data was queued. Due to that, the above test generally
	   fails. One solution would be to delay the reading of
	   iir. However, this is not reliable, since the timeout
	   is variable. So, let's just don't test if we receive
	   TX irq. This way, we'll never enable UART_BUG_TXEN.
	 */
2229
	if (skip_txen_test || up->port.flags & UPF_NO_TXEN_TEST)
2230 2231
		goto dont_test_tx_en;

2232 2233 2234 2235
	/*
	 * Do a quick test to see if we receive an
	 * interrupt when we enable the TX irq.
	 */
2236 2237 2238 2239
	serial_port_out(port, UART_IER, UART_IER_THRI);
	lsr = serial_port_in(port, UART_LSR);
	iir = serial_port_in(port, UART_IIR);
	serial_port_out(port, UART_IER, 0);
2240 2241

	if (lsr & UART_LSR_TEMT && iir & UART_IIR_NO_INT) {
2242 2243
		if (!(up->bugs & UART_BUG_TXEN)) {
			up->bugs |= UART_BUG_TXEN;
2244
			pr_debug("ttyS%d - enabling bad tx status workarounds\n",
2245
				 serial_index(port));
2246 2247
		}
	} else {
2248
		up->bugs &= ~UART_BUG_TXEN;
2249 2250
	}

2251
dont_test_tx_en:
2252
	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
2253

2254 2255 2256 2257 2258
	/*
	 * Clear the interrupt registers again for luck, and clear the
	 * saved flags to avoid getting false values from polling
	 * routines or the previous session.
	 */
2259 2260
	if (serial_port_in(port, UART_LSR) & UART_LSR_DR)
		serial_port_in(port, UART_RX);
2261 2262
	serial_port_in(port, UART_IIR);
	serial_port_in(port, UART_MSR);
2263 2264 2265
	up->lsr_saved_flags = 0;
	up->msr_saved_flags = 0;

2266 2267 2268 2269 2270 2271 2272 2273 2274 2275 2276 2277
	/*
	 * Request DMA channels for both RX and TX.
	 */
	if (up->dma) {
		retval = serial8250_request_dma(up);
		if (retval) {
			pr_warn_ratelimited("ttyS%d - failed to request DMA\n",
					    serial_index(port));
			up->dma = NULL;
		}
	}

L
Linus Torvalds 已提交
2278 2279 2280 2281 2282 2283
	/*
	 * Finally, enable interrupts.  Note: Modem status interrupts
	 * are set via set_termios(), which will be occurring imminently
	 * anyway, so we don't enable them here.
	 */
	up->ier = UART_IER_RLSI | UART_IER_RDI;
2284
	serial_port_out(port, UART_IER, up->ier);
L
Linus Torvalds 已提交
2285

2286
	if (port->flags & UPF_FOURPORT) {
L
Linus Torvalds 已提交
2287 2288 2289 2290
		unsigned int icp;
		/*
		 * Enable interrupts on the AST Fourport board
		 */
2291
		icp = (port->iobase & 0xfe0) | 0x01f;
L
Linus Torvalds 已提交
2292
		outb_p(0x80, icp);
2293
		inb_p(icp);
L
Linus Torvalds 已提交
2294
	}
2295 2296 2297 2298
	retval = 0;
out:
	serial8250_rpm_put(up);
	return retval;
L
Linus Torvalds 已提交
2299
}
2300
EXPORT_SYMBOL_GPL(serial8250_do_startup);
L
Linus Torvalds 已提交
2301

2302 2303 2304 2305 2306
static int serial8250_startup(struct uart_port *port)
{
	if (port->startup)
		return port->startup(port);
	return serial8250_do_startup(port);
L
Linus Torvalds 已提交
2307 2308
}

2309
void serial8250_do_shutdown(struct uart_port *port)
L
Linus Torvalds 已提交
2310
{
2311
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
2312 2313
	unsigned long flags;

2314
	serial8250_rpm_get(up);
L
Linus Torvalds 已提交
2315 2316 2317 2318
	/*
	 * Disable interrupts from this port
	 */
	up->ier = 0;
2319
	serial_port_out(port, UART_IER, 0);
L
Linus Torvalds 已提交
2320

2321 2322 2323
	if (up->dma)
		serial8250_release_dma(up);

2324 2325
	spin_lock_irqsave(&port->lock, flags);
	if (port->flags & UPF_FOURPORT) {
L
Linus Torvalds 已提交
2326
		/* reset interrupts on the AST Fourport board */
2327 2328
		inb((port->iobase & 0xfe0) | 0x1f);
		port->mctrl |= TIOCM_OUT1;
L
Linus Torvalds 已提交
2329
	} else
2330
		port->mctrl &= ~TIOCM_OUT2;
L
Linus Torvalds 已提交
2331

2332 2333
	serial8250_set_mctrl(port, port->mctrl);
	spin_unlock_irqrestore(&port->lock, flags);
L
Linus Torvalds 已提交
2334 2335 2336 2337

	/*
	 * Disable break condition and FIFOs
	 */
2338 2339
	serial_port_out(port, UART_LCR,
			serial_port_in(port, UART_LCR) & ~UART_LCR_SBC);
L
Linus Torvalds 已提交
2340 2341 2342 2343 2344 2345 2346 2347 2348 2349 2350 2351 2352
	serial8250_clear_fifos(up);

#ifdef CONFIG_SERIAL_8250_RSA
	/*
	 * Reset the RSA board back to 115kbps compat mode.
	 */
	disable_rsa(up);
#endif

	/*
	 * Read data port to reset things, and then unlink from
	 * the IRQ chain.
	 */
2353 2354
	if (serial_port_in(port, UART_LSR) & UART_LSR_DR)
		serial_port_in(port, UART_RX);
2355
	serial8250_rpm_put(up);
L
Linus Torvalds 已提交
2356

A
Alex Williamson 已提交
2357 2358
	del_timer_sync(&up->timer);
	up->timer.function = serial8250_timeout;
2359
	if (port->irq)
L
Linus Torvalds 已提交
2360 2361
		serial_unlink_irq_chain(up);
}
2362 2363 2364 2365 2366 2367 2368 2369 2370
EXPORT_SYMBOL_GPL(serial8250_do_shutdown);

static void serial8250_shutdown(struct uart_port *port)
{
	if (port->shutdown)
		port->shutdown(port);
	else
		serial8250_do_shutdown(port);
}
L
Linus Torvalds 已提交
2371 2372 2373 2374 2375 2376 2377 2378 2379 2380 2381 2382 2383 2384 2385 2386 2387 2388 2389 2390 2391

static unsigned int serial8250_get_divisor(struct uart_port *port, unsigned int baud)
{
	unsigned int quot;

	/*
	 * Handle magic divisors for baud rates above baud_base on
	 * SMSC SuperIO chips.
	 */
	if ((port->flags & UPF_MAGIC_MULTIPLIER) &&
	    baud == (port->uartclk/4))
		quot = 0x8001;
	else if ((port->flags & UPF_MAGIC_MULTIPLIER) &&
		 baud == (port->uartclk/8))
		quot = 0x8002;
	else
		quot = uart_get_divisor(port, baud);

	return quot;
}

2392 2393 2394
void
serial8250_do_set_termios(struct uart_port *port, struct ktermios *termios,
		          struct ktermios *old)
L
Linus Torvalds 已提交
2395
{
2396
	struct uart_8250_port *up = up_to_u8250p(port);
2397
	unsigned char cval;
L
Linus Torvalds 已提交
2398 2399 2400 2401 2402
	unsigned long flags;
	unsigned int baud, quot;

	switch (termios->c_cflag & CSIZE) {
	case CS5:
2403
		cval = UART_LCR_WLEN5;
L
Linus Torvalds 已提交
2404 2405
		break;
	case CS6:
2406
		cval = UART_LCR_WLEN6;
L
Linus Torvalds 已提交
2407 2408
		break;
	case CS7:
2409
		cval = UART_LCR_WLEN7;
L
Linus Torvalds 已提交
2410 2411 2412
		break;
	default:
	case CS8:
2413
		cval = UART_LCR_WLEN8;
L
Linus Torvalds 已提交
2414 2415 2416 2417
		break;
	}

	if (termios->c_cflag & CSTOPB)
2418
		cval |= UART_LCR_STOP;
2419
	if (termios->c_cflag & PARENB) {
L
Linus Torvalds 已提交
2420
		cval |= UART_LCR_PARITY;
2421
		if (up->bugs & UART_BUG_PARITY)
2422
			up->fifo_bug = true;
2423
	}
L
Linus Torvalds 已提交
2424 2425 2426 2427 2428 2429 2430 2431 2432 2433
	if (!(termios->c_cflag & PARODD))
		cval |= UART_LCR_EPAR;
#ifdef CMSPAR
	if (termios->c_cflag & CMSPAR)
		cval |= UART_LCR_SPAR;
#endif

	/*
	 * Ask the core to calculate the divisor for us.
	 */
2434 2435 2436
	baud = uart_get_baud_rate(port, termios, old,
				  port->uartclk / 16 / 0xffff,
				  port->uartclk / 16);
L
Linus Torvalds 已提交
2437 2438 2439
	quot = serial8250_get_divisor(port, baud);

	/*
2440
	 * Oxford Semi 952 rev B workaround
L
Linus Torvalds 已提交
2441
	 */
2442
	if (up->bugs & UART_BUG_QUOT && (quot & 0xff) == 0)
A
Alan Cox 已提交
2443
		quot++;
L
Linus Torvalds 已提交
2444

2445
	if (up->capabilities & UART_CAP_FIFO && port->fifosize > 1) {
2446 2447 2448 2449
		/* NOTE: If fifo_bug is not set, a user can set RX_trigger. */
		if ((baud < 2400 && !up->dma) || up->fifo_bug) {
			up->fcr &= ~UART_FCR_TRIGGER_MASK;
			up->fcr |= UART_FCR_TRIGGER_1;
2450
		}
L
Linus Torvalds 已提交
2451 2452 2453 2454 2455 2456 2457 2458
	}

	/*
	 * MCR-based auto flow control.  When AFE is enabled, RTS will be
	 * deasserted when the receive FIFO contains more characters than
	 * the trigger, or the MCR RTS bit is cleared.  In the case where
	 * the remote UART is not using CTS auto flow control, we must
	 * have sufficient FIFO entries for the latency of the remote
2459
	 * UART to respond.  IOW, at least 32 bytes of FIFO.
L
Linus Torvalds 已提交
2460
	 */
2461
	if (up->capabilities & UART_CAP_AFE && port->fifosize >= 32) {
L
Linus Torvalds 已提交
2462 2463 2464 2465 2466 2467 2468 2469 2470
		up->mcr &= ~UART_MCR_AFE;
		if (termios->c_cflag & CRTSCTS)
			up->mcr |= UART_MCR_AFE;
	}

	/*
	 * Ok, we're now changing the port state.  Do it with
	 * interrupts disabled.
	 */
2471
	serial8250_rpm_get(up);
2472
	spin_lock_irqsave(&port->lock, flags);
L
Linus Torvalds 已提交
2473 2474 2475 2476 2477 2478

	/*
	 * Update the per-port timeout.
	 */
	uart_update_timeout(port, termios->c_cflag, baud);

2479
	port->read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR;
L
Linus Torvalds 已提交
2480
	if (termios->c_iflag & INPCK)
2481
		port->read_status_mask |= UART_LSR_FE | UART_LSR_PE;
P
Peter Hurley 已提交
2482
	if (termios->c_iflag & (IGNBRK | BRKINT | PARMRK))
2483
		port->read_status_mask |= UART_LSR_BI;
L
Linus Torvalds 已提交
2484 2485 2486 2487

	/*
	 * Characteres to ignore
	 */
2488
	port->ignore_status_mask = 0;
L
Linus Torvalds 已提交
2489
	if (termios->c_iflag & IGNPAR)
2490
		port->ignore_status_mask |= UART_LSR_PE | UART_LSR_FE;
L
Linus Torvalds 已提交
2491
	if (termios->c_iflag & IGNBRK) {
2492
		port->ignore_status_mask |= UART_LSR_BI;
L
Linus Torvalds 已提交
2493 2494 2495 2496 2497
		/*
		 * If we're ignoring parity and break indicators,
		 * ignore overruns too (for real raw support).
		 */
		if (termios->c_iflag & IGNPAR)
2498
			port->ignore_status_mask |= UART_LSR_OE;
L
Linus Torvalds 已提交
2499 2500 2501 2502 2503 2504
	}

	/*
	 * ignore all characters if CREAD is not set
	 */
	if ((termios->c_cflag & CREAD) == 0)
2505
		port->ignore_status_mask |= UART_LSR_DR;
L
Linus Torvalds 已提交
2506 2507 2508 2509

	/*
	 * CTS flow control flag and modem status interrupts
	 */
2510
	up->ier &= ~UART_IER_MSI;
2511 2512
	if (!(up->bugs & UART_BUG_NOMSR) &&
			UART_ENABLE_MS(&up->port, termios->c_cflag))
L
Linus Torvalds 已提交
2513 2514
		up->ier |= UART_IER_MSI;
	if (up->capabilities & UART_CAP_UUE)
2515 2516 2517
		up->ier |= UART_IER_UUE;
	if (up->capabilities & UART_CAP_RTOIE)
		up->ier |= UART_IER_RTOIE;
L
Linus Torvalds 已提交
2518

2519
	serial_port_out(port, UART_IER, up->ier);
L
Linus Torvalds 已提交
2520 2521 2522 2523 2524 2525 2526 2527 2528 2529 2530

	if (up->capabilities & UART_CAP_EFR) {
		unsigned char efr = 0;
		/*
		 * TI16C752/Startech hardware flow control.  FIXME:
		 * - TI16C752 requires control thresholds to be set.
		 * - UART_MCR_RTS is ineffective if auto-RTS mode is enabled.
		 */
		if (termios->c_cflag & CRTSCTS)
			efr |= UART_EFR_CTS;

2531
		serial_port_out(port, UART_LCR, UART_LCR_CONF_MODE_B);
2532
		if (port->flags & UPF_EXAR_EFR)
2533
			serial_port_out(port, UART_XR_EFR, efr);
2534
		else
2535
			serial_port_out(port, UART_EFR, efr);
L
Linus Torvalds 已提交
2536 2537
	}

2538
	/* Workaround to enable 115200 baud on OMAP1510 internal ports */
2539
	if (is_omap1510_8250(up)) {
2540 2541
		if (baud == 115200) {
			quot = 1;
2542
			serial_port_out(port, UART_OMAP_OSC_12M_SEL, 1);
2543
		} else
2544
			serial_port_out(port, UART_OMAP_OSC_12M_SEL, 0);
2545 2546
	}

2547 2548 2549 2550 2551 2552 2553 2554
	/*
	 * For NatSemi, switch to bank 2 not bank 1, to avoid resetting EXCR2,
	 * otherwise just set DLAB
	 */
	if (up->capabilities & UART_NATSEMI)
		serial_port_out(port, UART_LCR, 0xe0);
	else
		serial_port_out(port, UART_LCR, cval | UART_LCR_DLAB);
L
Linus Torvalds 已提交
2555

2556
	serial_dl_write(up, quot);
L
Linus Torvalds 已提交
2557

2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575
	/*
	 * XR17V35x UARTs have an extra fractional divisor register (DLD)
	 *
	 * We need to recalculate all of the registers, because DLM and DLL
	 * are already rounded to a whole integer.
	 *
	 * When recalculating we use a 32x clock instead of a 16x clock to
	 * allow 1-bit for rounding in the fractional part.
	 */
	if (up->port.type == PORT_XR17V35X) {
		unsigned int baud_x32 = (port->uartclk * 2) / baud;
		u16 quot = baud_x32 / 32;
		u8 quot_frac = DIV_ROUND_CLOSEST(baud_x32 % 32, 2);

		serial_dl_write(up, quot);
		serial_port_out(port, 0x2, quot_frac & 0xf);
	}

L
Linus Torvalds 已提交
2576 2577 2578 2579
	/*
	 * LCR DLAB must be set to enable 64-byte FIFO mode. If the FCR
	 * is written without DLAB set, this mode will be disabled.
	 */
2580
	if (port->type == PORT_16750)
2581
		serial_port_out(port, UART_FCR, up->fcr);
L
Linus Torvalds 已提交
2582

2583
	serial_port_out(port, UART_LCR, cval);		/* reset DLAB */
L
Linus Torvalds 已提交
2584
	up->lcr = cval;					/* Save LCR */
2585
	if (port->type != PORT_16750) {
2586
		/* emulated UARTs (Lucent Venus 167x) need two steps */
2587
		if (up->fcr & UART_FCR_ENABLE_FIFO)
2588
			serial_port_out(port, UART_FCR, UART_FCR_ENABLE_FIFO);
2589
		serial_port_out(port, UART_FCR, up->fcr);	/* set fcr */
L
Linus Torvalds 已提交
2590
	}
2591 2592
	serial8250_set_mctrl(port, port->mctrl);
	spin_unlock_irqrestore(&port->lock, flags);
2593 2594
	serial8250_rpm_put(up);

A
Alan Cox 已提交
2595 2596 2597
	/* Don't rewrite B0 */
	if (tty_termios_baud_rate(termios))
		tty_termios_encode_baud_rate(termios, baud, baud);
L
Linus Torvalds 已提交
2598
}
2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609
EXPORT_SYMBOL(serial8250_do_set_termios);

static void
serial8250_set_termios(struct uart_port *port, struct ktermios *termios,
		       struct ktermios *old)
{
	if (port->set_termios)
		port->set_termios(port, termios, old);
	else
		serial8250_do_set_termios(port, termios, old);
}
L
Linus Torvalds 已提交
2610

2611
static void
A
Arnd Bergmann 已提交
2612
serial8250_set_ldisc(struct uart_port *port, int new)
2613
{
A
Arnd Bergmann 已提交
2614
	if (new == N_PPS) {
2615 2616 2617 2618 2619 2620
		port->flags |= UPF_HARDPPS_CD;
		serial8250_enable_ms(port);
	} else
		port->flags &= ~UPF_HARDPPS_CD;
}

2621 2622 2623

void serial8250_do_pm(struct uart_port *port, unsigned int state,
		      unsigned int oldstate)
L
Linus Torvalds 已提交
2624
{
2625
	struct uart_8250_port *p = up_to_u8250p(port);
L
Linus Torvalds 已提交
2626 2627

	serial8250_set_sleep(p, state != 0);
2628 2629
}
EXPORT_SYMBOL(serial8250_do_pm);
L
Linus Torvalds 已提交
2630

2631 2632 2633 2634 2635 2636 2637 2638
static void
serial8250_pm(struct uart_port *port, unsigned int state,
	      unsigned int oldstate)
{
	if (port->pm)
		port->pm(port, state, oldstate);
	else
		serial8250_do_pm(port, state, oldstate);
L
Linus Torvalds 已提交
2639 2640
}

2641 2642
static unsigned int serial8250_port_size(struct uart_8250_port *pt)
{
2643 2644 2645
	if (pt->port.iotype == UPIO_AU) {
		if (pt->port.type == PORT_RT2880)
			return 0x100;
2646
		return 0x1000;
2647
	}
2648
	if (is_omap1_8250(pt))
2649
		return 0x16 << pt->port.regshift;
2650

2651 2652 2653
	return 8 << pt->port.regshift;
}

L
Linus Torvalds 已提交
2654 2655 2656 2657 2658
/*
 * Resource handling.
 */
static int serial8250_request_std_resource(struct uart_8250_port *up)
{
2659
	unsigned int size = serial8250_port_size(up);
2660
	struct uart_port *port = &up->port;
L
Linus Torvalds 已提交
2661 2662
	int ret = 0;

2663
	switch (port->iotype) {
2664
	case UPIO_AU:
2665 2666
	case UPIO_TSI:
	case UPIO_MEM32:
L
Linus Torvalds 已提交
2667
	case UPIO_MEM:
2668
		if (!port->mapbase)
L
Linus Torvalds 已提交
2669 2670
			break;

2671
		if (!request_mem_region(port->mapbase, size, "serial")) {
L
Linus Torvalds 已提交
2672 2673 2674 2675
			ret = -EBUSY;
			break;
		}

2676 2677 2678 2679
		if (port->flags & UPF_IOREMAP) {
			port->membase = ioremap_nocache(port->mapbase, size);
			if (!port->membase) {
				release_mem_region(port->mapbase, size);
L
Linus Torvalds 已提交
2680 2681 2682 2683 2684 2685 2686
				ret = -ENOMEM;
			}
		}
		break;

	case UPIO_HUB6:
	case UPIO_PORT:
2687
		if (!request_region(port->iobase, size, "serial"))
L
Linus Torvalds 已提交
2688 2689 2690 2691 2692 2693 2694 2695
			ret = -EBUSY;
		break;
	}
	return ret;
}

static void serial8250_release_std_resource(struct uart_8250_port *up)
{
2696
	unsigned int size = serial8250_port_size(up);
2697
	struct uart_port *port = &up->port;
L
Linus Torvalds 已提交
2698

2699
	switch (port->iotype) {
2700
	case UPIO_AU:
2701 2702
	case UPIO_TSI:
	case UPIO_MEM32:
L
Linus Torvalds 已提交
2703
	case UPIO_MEM:
2704
		if (!port->mapbase)
L
Linus Torvalds 已提交
2705 2706
			break;

2707 2708 2709
		if (port->flags & UPF_IOREMAP) {
			iounmap(port->membase);
			port->membase = NULL;
L
Linus Torvalds 已提交
2710 2711
		}

2712
		release_mem_region(port->mapbase, size);
L
Linus Torvalds 已提交
2713 2714 2715 2716
		break;

	case UPIO_HUB6:
	case UPIO_PORT:
2717
		release_region(port->iobase, size);
L
Linus Torvalds 已提交
2718 2719 2720 2721 2722 2723 2724 2725
		break;
	}
}

static int serial8250_request_rsa_resource(struct uart_8250_port *up)
{
	unsigned long start = UART_RSA_BASE << up->port.regshift;
	unsigned int size = 8 << up->port.regshift;
2726
	struct uart_port *port = &up->port;
2727
	int ret = -EINVAL;
L
Linus Torvalds 已提交
2728

2729
	switch (port->iotype) {
L
Linus Torvalds 已提交
2730 2731
	case UPIO_HUB6:
	case UPIO_PORT:
2732
		start += port->iobase;
2733 2734 2735
		if (request_region(start, size, "serial-rsa"))
			ret = 0;
		else
L
Linus Torvalds 已提交
2736 2737 2738 2739 2740 2741 2742 2743 2744 2745 2746
			ret = -EBUSY;
		break;
	}

	return ret;
}

static void serial8250_release_rsa_resource(struct uart_8250_port *up)
{
	unsigned long offset = UART_RSA_BASE << up->port.regshift;
	unsigned int size = 8 << up->port.regshift;
2747
	struct uart_port *port = &up->port;
L
Linus Torvalds 已提交
2748

2749
	switch (port->iotype) {
L
Linus Torvalds 已提交
2750 2751
	case UPIO_HUB6:
	case UPIO_PORT:
2752
		release_region(port->iobase + offset, size);
L
Linus Torvalds 已提交
2753 2754 2755 2756 2757 2758
		break;
	}
}

static void serial8250_release_port(struct uart_port *port)
{
2759
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
2760 2761

	serial8250_release_std_resource(up);
2762
	if (port->type == PORT_RSA)
L
Linus Torvalds 已提交
2763 2764 2765 2766 2767
		serial8250_release_rsa_resource(up);
}

static int serial8250_request_port(struct uart_port *port)
{
2768
	struct uart_8250_port *up = up_to_u8250p(port);
S
Sean Young 已提交
2769 2770 2771 2772
	int ret;

	if (port->type == PORT_8250_CIR)
		return -ENODEV;
L
Linus Torvalds 已提交
2773 2774

	ret = serial8250_request_std_resource(up);
2775
	if (ret == 0 && port->type == PORT_RSA) {
L
Linus Torvalds 已提交
2776 2777 2778 2779 2780 2781 2782 2783
		ret = serial8250_request_rsa_resource(up);
		if (ret < 0)
			serial8250_release_std_resource(up);
	}

	return ret;
}

2784 2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800 2801 2802 2803 2804 2805 2806 2807 2808 2809 2810 2811 2812 2813 2814 2815 2816 2817 2818 2819 2820 2821 2822 2823 2824 2825 2826 2827 2828 2829 2830 2831 2832 2833 2834 2835 2836 2837 2838 2839 2840 2841 2842 2843 2844 2845 2846 2847 2848 2849 2850 2851 2852 2853 2854 2855 2856 2857 2858 2859 2860 2861 2862 2863 2864 2865 2866 2867 2868 2869 2870 2871 2872 2873 2874 2875 2876 2877 2878 2879 2880 2881 2882 2883 2884 2885 2886 2887 2888 2889 2890 2891 2892 2893 2894 2895 2896 2897 2898 2899 2900 2901 2902 2903 2904 2905 2906 2907 2908 2909 2910 2911 2912 2913 2914 2915 2916 2917 2918 2919 2920 2921 2922 2923
static int fcr_get_rxtrig_bytes(struct uart_8250_port *up)
{
	const struct serial8250_config *conf_type = &uart_config[up->port.type];
	unsigned char bytes;

	bytes = conf_type->rxtrig_bytes[UART_FCR_R_TRIG_BITS(up->fcr)];

	return bytes ? bytes : -EOPNOTSUPP;
}

static int bytes_to_fcr_rxtrig(struct uart_8250_port *up, unsigned char bytes)
{
	const struct serial8250_config *conf_type = &uart_config[up->port.type];
	int i;

	if (!conf_type->rxtrig_bytes[UART_FCR_R_TRIG_BITS(UART_FCR_R_TRIG_00)])
		return -EOPNOTSUPP;

	for (i = 1; i < UART_FCR_R_TRIG_MAX_STATE; i++) {
		if (bytes < conf_type->rxtrig_bytes[i])
			/* Use the nearest lower value */
			return (--i) << UART_FCR_R_TRIG_SHIFT;
	}

	return UART_FCR_R_TRIG_11;
}

static int do_get_rxtrig(struct tty_port *port)
{
	struct uart_state *state = container_of(port, struct uart_state, port);
	struct uart_port *uport = state->uart_port;
	struct uart_8250_port *up =
		container_of(uport, struct uart_8250_port, port);

	if (!(up->capabilities & UART_CAP_FIFO) || uport->fifosize <= 1)
		return -EINVAL;

	return fcr_get_rxtrig_bytes(up);
}

static int do_serial8250_get_rxtrig(struct tty_port *port)
{
	int rxtrig_bytes;

	mutex_lock(&port->mutex);
	rxtrig_bytes = do_get_rxtrig(port);
	mutex_unlock(&port->mutex);

	return rxtrig_bytes;
}

static ssize_t serial8250_get_attr_rx_trig_bytes(struct device *dev,
	struct device_attribute *attr, char *buf)
{
	struct tty_port *port = dev_get_drvdata(dev);
	int rxtrig_bytes;

	rxtrig_bytes = do_serial8250_get_rxtrig(port);
	if (rxtrig_bytes < 0)
		return rxtrig_bytes;

	return snprintf(buf, PAGE_SIZE, "%d\n", rxtrig_bytes);
}

static int do_set_rxtrig(struct tty_port *port, unsigned char bytes)
{
	struct uart_state *state = container_of(port, struct uart_state, port);
	struct uart_port *uport = state->uart_port;
	struct uart_8250_port *up =
		container_of(uport, struct uart_8250_port, port);
	int rxtrig;

	if (!(up->capabilities & UART_CAP_FIFO) || uport->fifosize <= 1 ||
	    up->fifo_bug)
		return -EINVAL;

	rxtrig = bytes_to_fcr_rxtrig(up, bytes);
	if (rxtrig < 0)
		return rxtrig;

	serial8250_clear_fifos(up);
	up->fcr &= ~UART_FCR_TRIGGER_MASK;
	up->fcr |= (unsigned char)rxtrig;
	serial_out(up, UART_FCR, up->fcr);
	return 0;
}

static int do_serial8250_set_rxtrig(struct tty_port *port, unsigned char bytes)
{
	int ret;

	mutex_lock(&port->mutex);
	ret = do_set_rxtrig(port, bytes);
	mutex_unlock(&port->mutex);

	return ret;
}

static ssize_t serial8250_set_attr_rx_trig_bytes(struct device *dev,
	struct device_attribute *attr, const char *buf, size_t count)
{
	struct tty_port *port = dev_get_drvdata(dev);
	unsigned char bytes;
	int ret;

	if (!count)
		return -EINVAL;

	ret = kstrtou8(buf, 10, &bytes);
	if (ret < 0)
		return ret;

	ret = do_serial8250_set_rxtrig(port, bytes);
	if (ret < 0)
		return ret;

	return count;
}

static DEVICE_ATTR(rx_trig_bytes, S_IRUSR | S_IWUSR | S_IRGRP,
		   serial8250_get_attr_rx_trig_bytes,
		   serial8250_set_attr_rx_trig_bytes);

static struct attribute *serial8250_dev_attrs[] = {
	&dev_attr_rx_trig_bytes.attr,
	NULL,
	};

static struct attribute_group serial8250_dev_attr_group = {
	.attrs = serial8250_dev_attrs,
	};

static void register_dev_spec_attr_grp(struct uart_8250_port *up)
{
	const struct serial8250_config *conf_type = &uart_config[up->port.type];

	if (conf_type->rxtrig_bytes[0])
		up->port.attr_group = &serial8250_dev_attr_group;
}

L
Linus Torvalds 已提交
2924 2925
static void serial8250_config_port(struct uart_port *port, int flags)
{
2926
	struct uart_8250_port *up = up_to_u8250p(port);
L
Linus Torvalds 已提交
2927 2928 2929
	int probeflags = PROBE_ANY;
	int ret;

S
Sean Young 已提交
2930 2931 2932
	if (port->type == PORT_8250_CIR)
		return;

L
Linus Torvalds 已提交
2933 2934 2935 2936 2937 2938 2939 2940 2941 2942 2943 2944
	/*
	 * Find the region that we can probe for.  This in turn
	 * tells us whether we can probe for the type of port.
	 */
	ret = serial8250_request_std_resource(up);
	if (ret < 0)
		return;

	ret = serial8250_request_rsa_resource(up);
	if (ret < 0)
		probeflags &= ~PROBE_RSA;

2945
	if (port->iotype != up->cur_iotype)
A
Alan Cox 已提交
2946 2947
		set_io_from_upio(port);

L
Linus Torvalds 已提交
2948 2949
	if (flags & UART_CONFIG_TYPE)
		autoconfig(up, probeflags);
2950 2951

	/* if access method is AU, it is a 16550 with a quirk */
2952
	if (port->type == PORT_16550A && port->iotype == UPIO_AU)
2953 2954
		up->bugs |= UART_BUG_NOMSR;

2955 2956 2957 2958
	/* HW bugs may trigger IRQ while IIR == NO_INT */
	if (port->type == PORT_TEGRA)
		up->bugs |= UART_BUG_NOMSR;

2959
	if (port->type != PORT_UNKNOWN && flags & UART_CONFIG_IRQ)
L
Linus Torvalds 已提交
2960 2961
		autoconfig_irq(up);

2962
	if (port->type != PORT_RSA && probeflags & PROBE_RSA)
L
Linus Torvalds 已提交
2963
		serial8250_release_rsa_resource(up);
2964
	if (port->type == PORT_UNKNOWN)
L
Linus Torvalds 已提交
2965
		serial8250_release_std_resource(up);
2966 2967

	/* Fixme: probably not the best place for this */
2968 2969
	if ((port->type == PORT_XR17V35X) ||
	   (port->type == PORT_XR17D15X))
2970
		port->handle_irq = exar_handle_irq;
2971 2972 2973

	register_dev_spec_attr_grp(up);
	up->fcr = uart_config[up->port.type].fcr;
L
Linus Torvalds 已提交
2974 2975 2976 2977 2978
}

static int
serial8250_verify_port(struct uart_port *port, struct serial_struct *ser)
{
Y
Yinghai Lu 已提交
2979
	if (ser->irq >= nr_irqs || ser->irq < 0 ||
L
Linus Torvalds 已提交
2980 2981 2982 2983 2984 2985 2986
	    ser->baud_base < 9600 || ser->type < PORT_UNKNOWN ||
	    ser->type >= ARRAY_SIZE(uart_config) || ser->type == PORT_CIRRUS ||
	    ser->type == PORT_STARTECH)
		return -EINVAL;
	return 0;
}

2987 2988 2989 2990 2991 2992 2993 2994 2995 2996 2997 2998 2999 3000 3001 3002 3003 3004 3005 3006 3007 3008 3009 3010 3011 3012 3013 3014 3015 3016 3017 3018 3019 3020 3021 3022
static int serial8250_ioctl(struct uart_port *port, unsigned int cmd,
			   unsigned long arg)
{
	struct uart_8250_port *up =
		container_of(port, struct uart_8250_port, port);
	int ret;
	struct serial_rs485 rs485_config;

	if (!up->rs485_config)
		return -ENOIOCTLCMD;

	switch (cmd) {
	case TIOCSRS485:
		if (copy_from_user(&rs485_config, (void __user *)arg,
				   sizeof(rs485_config)))
			return -EFAULT;

		ret = up->rs485_config(up, &rs485_config);
		if (ret)
			return ret;

		memcpy(&up->rs485, &rs485_config, sizeof(rs485_config));

		return 0;
	case TIOCGRS485:
		if (copy_to_user((void __user *)arg, &up->rs485,
				 sizeof(up->rs485)))
			return -EFAULT;
		return 0;
	default:
		break;
	}

	return -ENOIOCTLCMD;
}

L
Linus Torvalds 已提交
3023 3024 3025 3026 3027 3028 3029 3030 3031 3032 3033 3034 3035 3036 3037 3038
static const char *
serial8250_type(struct uart_port *port)
{
	int type = port->type;

	if (type >= ARRAY_SIZE(uart_config))
		type = 0;
	return uart_config[type].name;
}

static struct uart_ops serial8250_pops = {
	.tx_empty	= serial8250_tx_empty,
	.set_mctrl	= serial8250_set_mctrl,
	.get_mctrl	= serial8250_get_mctrl,
	.stop_tx	= serial8250_stop_tx,
	.start_tx	= serial8250_start_tx,
3039 3040
	.throttle	= serial8250_throttle,
	.unthrottle	= serial8250_unthrottle,
L
Linus Torvalds 已提交
3041 3042 3043 3044 3045 3046
	.stop_rx	= serial8250_stop_rx,
	.enable_ms	= serial8250_enable_ms,
	.break_ctl	= serial8250_break_ctl,
	.startup	= serial8250_startup,
	.shutdown	= serial8250_shutdown,
	.set_termios	= serial8250_set_termios,
3047
	.set_ldisc	= serial8250_set_ldisc,
L
Linus Torvalds 已提交
3048 3049 3050 3051 3052 3053
	.pm		= serial8250_pm,
	.type		= serial8250_type,
	.release_port	= serial8250_release_port,
	.request_port	= serial8250_request_port,
	.config_port	= serial8250_config_port,
	.verify_port	= serial8250_verify_port,
3054
	.ioctl		= serial8250_ioctl,
J
Jason Wessel 已提交
3055 3056 3057 3058
#ifdef CONFIG_CONSOLE_POLL
	.poll_get_char = serial8250_get_poll_char,
	.poll_put_char = serial8250_put_poll_char,
#endif
L
Linus Torvalds 已提交
3059 3060 3061 3062
};

static struct uart_8250_port serial8250_ports[UART_NR];

3063 3064 3065 3066 3067 3068 3069 3070 3071 3072 3073 3074 3075 3076 3077 3078 3079 3080
/**
 * serial8250_get_port - retrieve struct uart_8250_port
 * @line: serial line number
 *
 * This function retrieves struct uart_8250_port for the specific line.
 * This struct *must* *not* be used to perform a 8250 or serial core operation
 * which is not accessible otherwise. Its only purpose is to make the struct
 * accessible to the runtime-pm callbacks for context suspend/restore.
 * The lock assumption made here is none because runtime-pm suspend/resume
 * callbacks should not be invoked if there is any operation performed on the
 * port.
 */
struct uart_8250_port *serial8250_get_port(int line)
{
	return &serial8250_ports[line];
}
EXPORT_SYMBOL_GPL(serial8250_get_port);

3081 3082 3083 3084 3085 3086 3087 3088 3089 3090
static void (*serial8250_isa_config)(int port, struct uart_port *up,
	unsigned short *capabilities);

void serial8250_set_isa_configurator(
	void (*v)(int port, struct uart_port *up, unsigned short *capabilities))
{
	serial8250_isa_config = v;
}
EXPORT_SYMBOL(serial8250_set_isa_configurator);

L
Linus Torvalds 已提交
3091 3092 3093 3094
static void __init serial8250_isa_init_ports(void)
{
	struct uart_8250_port *up;
	static int first = 1;
3095
	int i, irqflag = 0;
L
Linus Torvalds 已提交
3096 3097 3098 3099 3100

	if (!first)
		return;
	first = 0;

3101 3102 3103
	if (nr_uarts > UART_NR)
		nr_uarts = UART_NR;

3104
	for (i = 0; i < nr_uarts; i++) {
L
Linus Torvalds 已提交
3105
		struct uart_8250_port *up = &serial8250_ports[i];
3106
		struct uart_port *port = &up->port;
L
Linus Torvalds 已提交
3107

3108 3109
		port->line = i;
		spin_lock_init(&port->lock);
L
Linus Torvalds 已提交
3110 3111 3112

		init_timer(&up->timer);
		up->timer.function = serial8250_timeout;
3113
		up->cur_iotype = 0xFF;
L
Linus Torvalds 已提交
3114 3115 3116 3117 3118 3119 3120

		/*
		 * ALPHA_KLUDGE_MCR needs to be killed.
		 */
		up->mcr_mask = ~ALPHA_KLUDGE_MCR;
		up->mcr_force = ALPHA_KLUDGE_MCR;

3121
		port->ops = &serial8250_pops;
L
Linus Torvalds 已提交
3122 3123
	}

3124 3125 3126
	if (share_irqs)
		irqflag = IRQF_SHARED;

3127
	for (i = 0, up = serial8250_ports;
3128
	     i < ARRAY_SIZE(old_serial_port) && i < nr_uarts;
L
Linus Torvalds 已提交
3129
	     i++, up++) {
3130 3131 3132 3133 3134 3135 3136 3137 3138 3139 3140 3141 3142
		struct uart_port *port = &up->port;

		port->iobase   = old_serial_port[i].port;
		port->irq      = irq_canonicalize(old_serial_port[i].irq);
		port->irqflags = old_serial_port[i].irqflags;
		port->uartclk  = old_serial_port[i].baud_base * 16;
		port->flags    = old_serial_port[i].flags;
		port->hub6     = old_serial_port[i].hub6;
		port->membase  = old_serial_port[i].iomem_base;
		port->iotype   = old_serial_port[i].io_type;
		port->regshift = old_serial_port[i].iomem_reg_shift;
		set_io_from_upio(port);
		port->irqflags |= irqflag;
3143 3144 3145
		if (serial8250_isa_config != NULL)
			serial8250_isa_config(i, &up->port, &up->capabilities);

L
Linus Torvalds 已提交
3146 3147 3148
	}
}

3149 3150 3151 3152
static void
serial8250_init_fixed_type_port(struct uart_8250_port *up, unsigned int type)
{
	up->port.type = type;
3153 3154 3155 3156 3157 3158
	if (!up->port.fifosize)
		up->port.fifosize = uart_config[type].fifo_size;
	if (!up->tx_loadsz)
		up->tx_loadsz = uart_config[type].tx_loadsz;
	if (!up->capabilities)
		up->capabilities = uart_config[type].flags;
3159 3160
}

L
Linus Torvalds 已提交
3161 3162 3163 3164 3165
static void __init
serial8250_register_ports(struct uart_driver *drv, struct device *dev)
{
	int i;

A
Alan Cox 已提交
3166 3167 3168
	for (i = 0; i < nr_uarts; i++) {
		struct uart_8250_port *up = &serial8250_ports[i];

3169 3170
		if (up->port.dev)
			continue;
L
Linus Torvalds 已提交
3171 3172

		up->port.dev = dev;
3173 3174 3175 3176

		if (up->port.flags & UPF_FIXED_TYPE)
			serial8250_init_fixed_type_port(up, up->port.type);

L
Linus Torvalds 已提交
3177 3178 3179 3180 3181 3182
		uart_add_one_port(drv, &up->port);
	}
}

#ifdef CONFIG_SERIAL_8250_CONSOLE

3183 3184
static void serial8250_console_putchar(struct uart_port *port, int ch)
{
3185
	struct uart_8250_port *up = up_to_u8250p(port);
3186 3187

	wait_for_xmitr(up, UART_LSR_THRE);
3188
	serial_port_out(port, UART_TX, ch);
3189 3190
}

L
Linus Torvalds 已提交
3191 3192 3193 3194 3195 3196 3197 3198 3199 3200
/*
 *	Print a string to the serial port trying not to disturb
 *	any possible real use of the port...
 *
 *	The console_lock must be held when we get here.
 */
static void
serial8250_console_write(struct console *co, const char *s, unsigned int count)
{
	struct uart_8250_port *up = &serial8250_ports[co->index];
3201
	struct uart_port *port = &up->port;
3202
	unsigned long flags;
L
Linus Torvalds 已提交
3203
	unsigned int ier;
3204
	int locked = 1;
L
Linus Torvalds 已提交
3205

3206 3207
	touch_nmi_watchdog();

3208 3209
	serial8250_rpm_get(up);

3210 3211 3212 3213
	if (port->sysrq || oops_in_progress)
		locked = spin_trylock_irqsave(&port->lock, flags);
	else
		spin_lock_irqsave(&port->lock, flags);
3214

L
Linus Torvalds 已提交
3215
	/*
R
Ralf Baechle 已提交
3216
	 *	First save the IER then disable the interrupts
L
Linus Torvalds 已提交
3217
	 */
3218
	ier = serial_port_in(port, UART_IER);
L
Linus Torvalds 已提交
3219 3220

	if (up->capabilities & UART_CAP_UUE)
3221
		serial_port_out(port, UART_IER, UART_IER_UUE);
L
Linus Torvalds 已提交
3222
	else
3223
		serial_port_out(port, UART_IER, 0);
L
Linus Torvalds 已提交
3224

3225
	uart_console_write(port, s, count, serial8250_console_putchar);
L
Linus Torvalds 已提交
3226 3227 3228 3229 3230

	/*
	 *	Finally, wait for transmitter to become empty
	 *	and restore the IER
	 */
A
Alan Cox 已提交
3231
	wait_for_xmitr(up, BOTH_EMPTY);
3232
	serial_port_out(port, UART_IER, ier);
3233

3234 3235 3236 3237 3238 3239 3240 3241
	/*
	 *	The receive handling will happen properly because the
	 *	receive ready bit will still be set; it is not cleared
	 *	on read.  However, modem control will not, we must
	 *	call it if we have saved something in the saved flags
	 *	while processing with interrupts off.
	 */
	if (up->msr_saved_flags)
3242
		serial8250_modem_status(up);
3243

3244
	if (locked)
3245
		spin_unlock_irqrestore(&port->lock, flags);
3246
	serial8250_rpm_put(up);
L
Linus Torvalds 已提交
3247 3248
}

3249
static int serial8250_console_setup(struct console *co, char *options)
L
Linus Torvalds 已提交
3250 3251 3252 3253 3254 3255 3256 3257 3258 3259 3260 3261
{
	struct uart_port *port;
	int baud = 9600;
	int bits = 8;
	int parity = 'n';
	int flow = 'n';

	/*
	 * Check whether an invalid uart number has been specified, and
	 * if so, search for the first available port that does have
	 * console support.
	 */
3262
	if (co->index >= nr_uarts)
L
Linus Torvalds 已提交
3263 3264 3265 3266 3267 3268 3269 3270 3271 3272 3273
		co->index = 0;
	port = &serial8250_ports[co->index].port;
	if (!port->iobase && !port->membase)
		return -ENODEV;

	if (options)
		uart_parse_options(options, &baud, &parity, &bits, &flow);

	return uart_set_options(port, co, baud, parity, bits, flow);
}

3274
static int serial8250_console_early_setup(void)
3275 3276 3277 3278
{
	return serial8250_find_port_for_earlycon();
}

L
Linus Torvalds 已提交
3279 3280 3281 3282 3283
static struct console serial8250_console = {
	.name		= "ttyS",
	.write		= serial8250_console_write,
	.device		= uart_console_device,
	.setup		= serial8250_console_setup,
3284
	.early_setup	= serial8250_console_early_setup,
3285
	.flags		= CON_PRINTBUFFER | CON_ANYTIME,
L
Linus Torvalds 已提交
3286 3287 3288 3289 3290 3291 3292 3293 3294 3295 3296 3297
	.index		= -1,
	.data		= &serial8250_reg,
};

static int __init serial8250_console_init(void)
{
	serial8250_isa_init_ports();
	register_console(&serial8250_console);
	return 0;
}
console_initcall(serial8250_console_init);

3298
int serial8250_find_port(struct uart_port *p)
L
Linus Torvalds 已提交
3299 3300 3301 3302
{
	int line;
	struct uart_port *port;

3303
	for (line = 0; line < nr_uarts; line++) {
L
Linus Torvalds 已提交
3304
		port = &serial8250_ports[line].port;
3305
		if (uart_match_port(p, port))
L
Linus Torvalds 已提交
3306 3307 3308 3309 3310 3311 3312 3313 3314 3315 3316 3317 3318 3319 3320 3321 3322 3323 3324
			return line;
	}
	return -ENODEV;
}

#define SERIAL8250_CONSOLE	&serial8250_console
#else
#define SERIAL8250_CONSOLE	NULL
#endif

static struct uart_driver serial8250_reg = {
	.owner			= THIS_MODULE,
	.driver_name		= "serial",
	.dev_name		= "ttyS",
	.major			= TTY_MAJOR,
	.minor			= 64,
	.cons			= SERIAL8250_CONSOLE,
};

3325 3326 3327 3328 3329 3330
/*
 * early_serial_setup - early registration for 8250 ports
 *
 * Setup an 8250 port structure prior to console initialisation.  Use
 * after console initialisation will cause undefined behaviour.
 */
L
Linus Torvalds 已提交
3331 3332
int __init early_serial_setup(struct uart_port *port)
{
D
David Daney 已提交
3333 3334
	struct uart_port *p;

L
Linus Torvalds 已提交
3335 3336 3337 3338
	if (port->line >= ARRAY_SIZE(serial8250_ports))
		return -ENODEV;

	serial8250_isa_init_ports();
D
David Daney 已提交
3339 3340 3341 3342
	p = &serial8250_ports[port->line].port;
	p->iobase       = port->iobase;
	p->membase      = port->membase;
	p->irq          = port->irq;
3343
	p->irqflags     = port->irqflags;
D
David Daney 已提交
3344 3345 3346 3347 3348 3349 3350
	p->uartclk      = port->uartclk;
	p->fifosize     = port->fifosize;
	p->regshift     = port->regshift;
	p->iotype       = port->iotype;
	p->flags        = port->flags;
	p->mapbase      = port->mapbase;
	p->private_data = port->private_data;
3351 3352
	p->type		= port->type;
	p->line		= port->line;
3353 3354 3355 3356 3357 3358

	set_io_from_upio(p);
	if (port->serial_in)
		p->serial_in = port->serial_in;
	if (port->serial_out)
		p->serial_out = port->serial_out;
3359 3360 3361 3362
	if (port->handle_irq)
		p->handle_irq = port->handle_irq;
	else
		p->handle_irq = serial8250_default_handle_irq;
3363

L
Linus Torvalds 已提交
3364 3365 3366 3367 3368 3369 3370 3371 3372 3373 3374 3375 3376 3377 3378 3379 3380 3381 3382 3383 3384 3385
	return 0;
}

/**
 *	serial8250_suspend_port - suspend one serial port
 *	@line:  serial line number
 *
 *	Suspend one serial port.
 */
void serial8250_suspend_port(int line)
{
	uart_suspend_port(&serial8250_reg, &serial8250_ports[line].port);
}

/**
 *	serial8250_resume_port - resume one serial port
 *	@line:  serial line number
 *
 *	Resume one serial port.
 */
void serial8250_resume_port(int line)
{
3386
	struct uart_8250_port *up = &serial8250_ports[line];
3387
	struct uart_port *port = &up->port;
3388 3389 3390

	if (up->capabilities & UART_NATSEMI) {
		/* Ensure it's still in high speed mode */
3391
		serial_port_out(port, UART_LCR, 0xE0);
3392

3393
		ns16550a_goto_highspeed(up);
3394

3395
		serial_port_out(port, UART_LCR, 0);
3396
		port->uartclk = 921600*16;
3397
	}
3398
	uart_resume_port(&serial8250_reg, port);
L
Linus Torvalds 已提交
3399 3400 3401 3402 3403 3404 3405
}

/*
 * 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.
 */
B
Bill Pemberton 已提交
3406
static int serial8250_probe(struct platform_device *dev)
L
Linus Torvalds 已提交
3407
{
J
Jingoo Han 已提交
3408
	struct plat_serial8250_port *p = dev_get_platdata(&dev->dev);
3409
	struct uart_8250_port uart;
3410
	int ret, i, irqflag = 0;
L
Linus Torvalds 已提交
3411

3412
	memset(&uart, 0, sizeof(uart));
L
Linus Torvalds 已提交
3413

3414 3415 3416
	if (share_irqs)
		irqflag = IRQF_SHARED;

3417
	for (i = 0; p && p->flags != 0; p++, i++) {
3418 3419 3420 3421 3422 3423 3424 3425 3426 3427 3428 3429 3430 3431 3432 3433 3434 3435 3436 3437 3438
		uart.port.iobase	= p->iobase;
		uart.port.membase	= p->membase;
		uart.port.irq		= p->irq;
		uart.port.irqflags	= p->irqflags;
		uart.port.uartclk	= p->uartclk;
		uart.port.regshift	= p->regshift;
		uart.port.iotype	= p->iotype;
		uart.port.flags		= p->flags;
		uart.port.mapbase	= p->mapbase;
		uart.port.hub6		= p->hub6;
		uart.port.private_data	= p->private_data;
		uart.port.type		= p->type;
		uart.port.serial_in	= p->serial_in;
		uart.port.serial_out	= p->serial_out;
		uart.port.handle_irq	= p->handle_irq;
		uart.port.handle_break	= p->handle_break;
		uart.port.set_termios	= p->set_termios;
		uart.port.pm		= p->pm;
		uart.port.dev		= &dev->dev;
		uart.port.irqflags	|= irqflag;
		ret = serial8250_register_8250_port(&uart);
3439
		if (ret < 0) {
3440
			dev_err(&dev->dev, "unable to register port at index %d "
3441 3442 3443
				"(IO%lx MEM%llx IRQ%d): %d\n", i,
				p->iobase, (unsigned long long)p->mapbase,
				p->irq, ret);
3444
		}
L
Linus Torvalds 已提交
3445 3446 3447 3448 3449 3450 3451
	}
	return 0;
}

/*
 * Remove serial ports registered against a platform device.
 */
B
Bill Pemberton 已提交
3452
static int serial8250_remove(struct platform_device *dev)
L
Linus Torvalds 已提交
3453 3454 3455
{
	int i;

3456
	for (i = 0; i < nr_uarts; i++) {
L
Linus Torvalds 已提交
3457 3458
		struct uart_8250_port *up = &serial8250_ports[i];

3459
		if (up->port.dev == &dev->dev)
L
Linus Torvalds 已提交
3460 3461 3462 3463 3464
			serial8250_unregister_port(i);
	}
	return 0;
}

3465
static int serial8250_suspend(struct platform_device *dev, pm_message_t state)
L
Linus Torvalds 已提交
3466 3467 3468 3469 3470 3471
{
	int i;

	for (i = 0; i < UART_NR; i++) {
		struct uart_8250_port *up = &serial8250_ports[i];

3472
		if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
L
Linus Torvalds 已提交
3473 3474 3475 3476 3477 3478
			uart_suspend_port(&serial8250_reg, &up->port);
	}

	return 0;
}

3479
static int serial8250_resume(struct platform_device *dev)
L
Linus Torvalds 已提交
3480 3481 3482 3483 3484 3485
{
	int i;

	for (i = 0; i < UART_NR; i++) {
		struct uart_8250_port *up = &serial8250_ports[i];

3486
		if (up->port.type != PORT_UNKNOWN && up->port.dev == &dev->dev)
3487
			serial8250_resume_port(i);
L
Linus Torvalds 已提交
3488 3489 3490 3491 3492
	}

	return 0;
}

3493
static struct platform_driver serial8250_isa_driver = {
L
Linus Torvalds 已提交
3494
	.probe		= serial8250_probe,
3495
	.remove		= serial8250_remove,
L
Linus Torvalds 已提交
3496 3497
	.suspend	= serial8250_suspend,
	.resume		= serial8250_resume,
3498 3499
	.driver		= {
		.name	= "serial8250",
3500
		.owner	= THIS_MODULE,
3501
	},
L
Linus Torvalds 已提交
3502 3503 3504 3505 3506 3507 3508 3509 3510
};

/*
 * This "device" covers _all_ ISA 8250-compatible serial devices listed
 * in the table in include/asm/serial.h
 */
static struct platform_device *serial8250_isa_devs;

/*
3511
 * serial8250_register_8250_port and serial8250_unregister_port allows for
L
Linus Torvalds 已提交
3512 3513 3514
 * 16x50 serial ports to be configured at run-time, to support PCMCIA
 * modems and PCI multiport cards.
 */
3515
static DEFINE_MUTEX(serial_mutex);
L
Linus Torvalds 已提交
3516 3517 3518 3519 3520 3521 3522 3523

static struct uart_8250_port *serial8250_find_match_or_unused(struct uart_port *port)
{
	int i;

	/*
	 * First, find a port entry which matches.
	 */
3524
	for (i = 0; i < nr_uarts; i++)
L
Linus Torvalds 已提交
3525 3526 3527
		if (uart_match_port(&serial8250_ports[i].port, port))
			return &serial8250_ports[i];

3528 3529 3530 3531 3532
	/* try line number first if still available */
	i = port->line;
	if (i < nr_uarts && serial8250_ports[i].port.type == PORT_UNKNOWN &&
			serial8250_ports[i].port.iobase == 0)
		return &serial8250_ports[i];
L
Linus Torvalds 已提交
3533 3534 3535 3536 3537
	/*
	 * We didn't find a matching entry, so look for the first
	 * free entry.  We look for one which hasn't been previously
	 * used (indicated by zero iobase).
	 */
3538
	for (i = 0; i < nr_uarts; i++)
L
Linus Torvalds 已提交
3539 3540 3541 3542 3543 3544 3545 3546
		if (serial8250_ports[i].port.type == PORT_UNKNOWN &&
		    serial8250_ports[i].port.iobase == 0)
			return &serial8250_ports[i];

	/*
	 * That also failed.  Last resort is to find any entry which
	 * doesn't have a real port associated with it.
	 */
3547
	for (i = 0; i < nr_uarts; i++)
L
Linus Torvalds 已提交
3548 3549 3550 3551 3552 3553 3554
		if (serial8250_ports[i].port.type == PORT_UNKNOWN)
			return &serial8250_ports[i];

	return NULL;
}

/**
3555
 *	serial8250_register_8250_port - register a serial port
3556
 *	@up: serial port template
L
Linus Torvalds 已提交
3557 3558 3559 3560 3561 3562 3563 3564 3565 3566
 *
 *	Configure the serial port specified by the request. If the
 *	port exists and is in use, it is hung up and unregistered
 *	first.
 *
 *	The port is then probed and if necessary the IRQ is autodetected
 *	If this fails an error is returned.
 *
 *	On success the port is ready to use and the line number is returned.
 */
3567
int serial8250_register_8250_port(struct uart_8250_port *up)
L
Linus Torvalds 已提交
3568 3569 3570 3571
{
	struct uart_8250_port *uart;
	int ret = -ENOSPC;

3572
	if (up->port.uartclk == 0)
L
Linus Torvalds 已提交
3573 3574
		return -EINVAL;

3575
	mutex_lock(&serial_mutex);
L
Linus Torvalds 已提交
3576

3577
	uart = serial8250_find_match_or_unused(&up->port);
S
Sean Young 已提交
3578
	if (uart && uart->port.type != PORT_8250_CIR) {
3579 3580
		if (uart->port.dev)
			uart_remove_one_port(&serial8250_reg, &uart->port);
L
Linus Torvalds 已提交
3581

3582 3583 3584 3585 3586 3587 3588 3589 3590
		uart->port.iobase       = up->port.iobase;
		uart->port.membase      = up->port.membase;
		uart->port.irq          = up->port.irq;
		uart->port.irqflags     = up->port.irqflags;
		uart->port.uartclk      = up->port.uartclk;
		uart->port.fifosize     = up->port.fifosize;
		uart->port.regshift     = up->port.regshift;
		uart->port.iotype       = up->port.iotype;
		uart->port.flags        = up->port.flags | UPF_BOOT_AUTOCONF;
A
Alan Cox 已提交
3591
		uart->bugs		= up->bugs;
3592 3593
		uart->port.mapbase      = up->port.mapbase;
		uart->port.private_data = up->port.private_data;
3594 3595 3596
		uart->port.fifosize	= up->port.fifosize;
		uart->tx_loadsz		= up->tx_loadsz;
		uart->capabilities	= up->capabilities;
3597 3598
		uart->rs485_config	= up->rs485_config;
		uart->rs485		= up->rs485;
3599 3600
		uart->port.throttle	= up->port.throttle;
		uart->port.unthrottle	= up->port.unthrottle;
3601

3602 3603 3604 3605
		/* Take tx_loadsz from fifosize if it wasn't set separately */
		if (uart->port.fifosize && !uart->tx_loadsz)
			uart->tx_loadsz = uart->port.fifosize;

3606 3607 3608 3609 3610
		if (up->port.dev)
			uart->port.dev = up->port.dev;

		if (up->port.flags & UPF_FIXED_TYPE)
			serial8250_init_fixed_type_port(uart, up->port.type);
3611

3612 3613
		set_io_from_upio(&uart->port);
		/* Possibly override default I/O functions.  */
3614 3615 3616 3617 3618 3619
		if (up->port.serial_in)
			uart->port.serial_in = up->port.serial_in;
		if (up->port.serial_out)
			uart->port.serial_out = up->port.serial_out;
		if (up->port.handle_irq)
			uart->port.handle_irq = up->port.handle_irq;
3620
		/*  Possibly override set_termios call */
3621 3622
		if (up->port.set_termios)
			uart->port.set_termios = up->port.set_termios;
3623 3624 3625 3626
		if (up->port.startup)
			uart->port.startup = up->port.startup;
		if (up->port.shutdown)
			uart->port.shutdown = up->port.shutdown;
3627 3628 3629 3630 3631 3632 3633 3634
		if (up->port.pm)
			uart->port.pm = up->port.pm;
		if (up->port.handle_break)
			uart->port.handle_break = up->port.handle_break;
		if (up->dl_read)
			uart->dl_read = up->dl_read;
		if (up->dl_write)
			uart->dl_write = up->dl_write;
3635
		if (up->dma) {
3636
			uart->dma = up->dma;
3637 3638 3639 3640 3641
			if (!uart->dma->tx_dma)
				uart->dma->tx_dma = serial8250_tx_dma;
			if (!uart->dma->rx_dma)
				uart->dma->rx_dma = serial8250_rx_dma;
		}
L
Linus Torvalds 已提交
3642

3643 3644 3645 3646
		if (serial8250_isa_config != NULL)
			serial8250_isa_config(0, &uart->port,
					&uart->capabilities);

L
Linus Torvalds 已提交
3647 3648 3649 3650
		ret = uart_add_one_port(&serial8250_reg, &uart->port);
		if (ret == 0)
			ret = uart->port.line;
	}
3651
	mutex_unlock(&serial_mutex);
L
Linus Torvalds 已提交
3652 3653 3654

	return ret;
}
3655 3656
EXPORT_SYMBOL(serial8250_register_8250_port);

L
Linus Torvalds 已提交
3657 3658 3659 3660 3661 3662 3663 3664 3665 3666 3667
/**
 *	serial8250_unregister_port - remove a 16x50 serial port at runtime
 *	@line: serial line number
 *
 *	Remove one serial port.  This may not be called from interrupt
 *	context.  We hand the port back to the our control.
 */
void serial8250_unregister_port(int line)
{
	struct uart_8250_port *uart = &serial8250_ports[line];

3668
	mutex_lock(&serial_mutex);
L
Linus Torvalds 已提交
3669 3670 3671 3672 3673
	uart_remove_one_port(&serial8250_reg, &uart->port);
	if (serial8250_isa_devs) {
		uart->port.flags &= ~UPF_BOOT_AUTOCONF;
		uart->port.type = PORT_UNKNOWN;
		uart->port.dev = &serial8250_isa_devs->dev;
3674
		uart->capabilities = uart_config[uart->port.type].flags;
L
Linus Torvalds 已提交
3675 3676 3677 3678
		uart_add_one_port(&serial8250_reg, &uart->port);
	} else {
		uart->port.dev = NULL;
	}
3679
	mutex_unlock(&serial_mutex);
L
Linus Torvalds 已提交
3680 3681 3682 3683 3684
}
EXPORT_SYMBOL(serial8250_unregister_port);

static int __init serial8250_init(void)
{
A
Alan Cox 已提交
3685
	int ret;
L
Linus Torvalds 已提交
3686

3687
	serial8250_isa_init_ports();
3688

3689
	printk(KERN_INFO "Serial: 8250/16550 driver, "
3690
		"%d ports, IRQ sharing %sabled\n", nr_uarts,
L
Linus Torvalds 已提交
3691 3692
		share_irqs ? "en" : "dis");

3693 3694 3695 3696
#ifdef CONFIG_SPARC
	ret = sunserial_register_minors(&serial8250_reg, UART_NR);
#else
	serial8250_reg.nr = UART_NR;
L
Linus Torvalds 已提交
3697
	ret = uart_register_driver(&serial8250_reg);
3698
#endif
L
Linus Torvalds 已提交
3699 3700 3701
	if (ret)
		goto out;

3702 3703 3704 3705
	ret = serial8250_pnp_init();
	if (ret)
		goto unreg_uart_drv;

3706 3707 3708 3709
	serial8250_isa_devs = platform_device_alloc("serial8250",
						    PLAT8250_DEV_LEGACY);
	if (!serial8250_isa_devs) {
		ret = -ENOMEM;
3710
		goto unreg_pnp;
L
Linus Torvalds 已提交
3711 3712
	}

3713 3714 3715 3716
	ret = platform_device_add(serial8250_isa_devs);
	if (ret)
		goto put_dev;

L
Linus Torvalds 已提交
3717 3718
	serial8250_register_ports(&serial8250_reg, &serial8250_isa_devs->dev);

3719 3720 3721
	ret = platform_driver_register(&serial8250_isa_driver);
	if (ret == 0)
		goto out;
L
Linus Torvalds 已提交
3722

3723
	platform_device_del(serial8250_isa_devs);
A
Alan Cox 已提交
3724
put_dev:
3725
	platform_device_put(serial8250_isa_devs);
3726 3727
unreg_pnp:
	serial8250_pnp_exit();
A
Alan Cox 已提交
3728
unreg_uart_drv:
3729 3730 3731
#ifdef CONFIG_SPARC
	sunserial_unregister_minors(&serial8250_reg, UART_NR);
#else
L
Linus Torvalds 已提交
3732
	uart_unregister_driver(&serial8250_reg);
3733
#endif
A
Alan Cox 已提交
3734
out:
L
Linus Torvalds 已提交
3735 3736 3737 3738 3739 3740 3741 3742 3743 3744 3745 3746 3747 3748
	return ret;
}

static void __exit serial8250_exit(void)
{
	struct platform_device *isa_dev = serial8250_isa_devs;

	/*
	 * This tells serial8250_unregister_port() not to re-register
	 * the ports (thereby making serial8250_isa_driver permanently
	 * in use.)
	 */
	serial8250_isa_devs = NULL;

3749
	platform_driver_unregister(&serial8250_isa_driver);
L
Linus Torvalds 已提交
3750 3751
	platform_device_unregister(isa_dev);

3752 3753
	serial8250_pnp_exit();

3754 3755 3756
#ifdef CONFIG_SPARC
	sunserial_unregister_minors(&serial8250_reg, UART_NR);
#else
L
Linus Torvalds 已提交
3757
	uart_unregister_driver(&serial8250_reg);
3758
#endif
L
Linus Torvalds 已提交
3759 3760 3761 3762 3763 3764 3765 3766 3767
}

module_init(serial8250_init);
module_exit(serial8250_exit);

EXPORT_SYMBOL(serial8250_suspend_port);
EXPORT_SYMBOL(serial8250_resume_port);

MODULE_LICENSE("GPL");
3768
MODULE_DESCRIPTION("Generic 8250/16x50 serial driver");
L
Linus Torvalds 已提交
3769 3770 3771 3772 3773

module_param(share_irqs, uint, 0644);
MODULE_PARM_DESC(share_irqs, "Share IRQs with other non-8250/16x50 devices"
	" (unsafe)");

3774 3775 3776
module_param(nr_uarts, uint, 0644);
MODULE_PARM_DESC(nr_uarts, "Maximum number of UARTs supported. (1-" __MODULE_STRING(CONFIG_SERIAL_8250_NR_UARTS) ")");

3777 3778 3779
module_param(skip_txen_test, uint, 0644);
MODULE_PARM_DESC(skip_txen_test, "Skip checking for the TXEN bug at init time");

L
Linus Torvalds 已提交
3780 3781 3782 3783 3784
#ifdef CONFIG_SERIAL_8250_RSA
module_param_array(probe_rsa, ulong, &probe_rsa_count, 0444);
MODULE_PARM_DESC(probe_rsa, "Probe I/O ports for RSA");
#endif
MODULE_ALIAS_CHARDEV_MAJOR(TTY_MAJOR);
3785

3786
#ifdef CONFIG_SERIAL_8250_DEPRECATED_OPTIONS
3787 3788 3789 3790 3791 3792 3793 3794 3795 3796 3797 3798 3799 3800
#ifndef MODULE
/* This module was renamed to 8250_core in 3.7.  Keep the old "8250" name
 * working as well for the module options so we don't break people.  We
 * need to keep the names identical and the convenient macros will happily
 * refuse to let us do that by failing the build with redefinition errors
 * of global variables.  So we stick them inside a dummy function to avoid
 * those conflicts.  The options still get parsed, and the redefined
 * MODULE_PARAM_PREFIX lets us keep the "8250." syntax alive.
 *
 * This is hacky.  I'm sorry.
 */
static void __used s8250_options(void)
{
#undef MODULE_PARAM_PREFIX
3801
#define MODULE_PARAM_PREFIX "8250_core."
3802 3803 3804 3805 3806 3807 3808

	module_param_cb(share_irqs, &param_ops_uint, &share_irqs, 0644);
	module_param_cb(nr_uarts, &param_ops_uint, &nr_uarts, 0644);
	module_param_cb(skip_txen_test, &param_ops_uint, &skip_txen_test, 0644);
#ifdef CONFIG_SERIAL_8250_RSA
	__module_param_call(MODULE_PARAM_PREFIX, probe_rsa,
		&param_array_ops, .arr = &__param_arr_probe_rsa,
3809
		0444, -1, 0);
3810 3811 3812
#endif
}
#else
3813
MODULE_ALIAS("8250_core");
3814 3815
#endif
#endif