mxser.c 70.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3
/*
 *          mxser.c  -- MOXA Smartio/Industio family multiport serial driver.
 *
4 5
 *      Copyright (C) 1999-2006  Moxa Technologies (support@moxa.com).
 *	Copyright (C) 2006-2008  Jiri Slaby <jirislaby@gmail.com>
L
Linus Torvalds 已提交
6
 *
J
Jiri Slaby 已提交
7 8 9
 *      This code is loosely based on the 1.8 moxa driver which is based on
 *	Linux serial driver, written by Linus Torvalds, Theodore T'so and
 *	others.
L
Linus Torvalds 已提交
10 11 12 13
 *
 *      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
14
 *      (at your option) any later version.
L
Linus Torvalds 已提交
15 16
 *
 *	Fed through a cleanup, indent and remove of non 2.6 code by Alan Cox
17 18
 *	<alan@lxorguk.ukuu.org.uk>. The original 1.8 code is available on
 *	www.moxa.com.
L
Linus Torvalds 已提交
19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39
 *	- Fixed x86_64 cleanness
 */

#include <linux/module.h>
#include <linux/errno.h>
#include <linux/signal.h>
#include <linux/sched.h>
#include <linux/timer.h>
#include <linux/interrupt.h>
#include <linux/tty.h>
#include <linux/tty_flip.h>
#include <linux/serial.h>
#include <linux/serial_reg.h>
#include <linux/major.h>
#include <linux/string.h>
#include <linux/fcntl.h>
#include <linux/ptrace.h>
#include <linux/ioport.h>
#include <linux/mm.h>
#include <linux/delay.h>
#include <linux/pci.h>
J
Jiri Slaby 已提交
40
#include <linux/bitops.h>
41
#include <linux/slab.h>
42
#include <linux/ratelimit.h>
L
Linus Torvalds 已提交
43 44 45 46 47 48 49

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

#include "mxser.h"

50
#define	MXSER_VERSION	"2.0.5"		/* 1.14 */
L
Linus Torvalds 已提交
51 52 53 54
#define	MXSERMAJOR	 174

#define MXSER_BOARDS		4	/* Max. boards */
#define MXSER_PORTS_PER_BOARD	8	/* Max. ports per board */
J
Jiri Slaby 已提交
55 56
#define MXSER_PORTS		(MXSER_BOARDS * MXSER_PORTS_PER_BOARD)
#define MXSER_ISR_PASS_LIMIT	100
L
Linus Torvalds 已提交
57

J
Jiri Slaby 已提交
58 59 60 61 62
/*CheckIsMoxaMust return value*/
#define MOXA_OTHER_UART		0x00
#define MOXA_MUST_MU150_HWID	0x01
#define MOXA_MUST_MU860_HWID	0x02

L
Linus Torvalds 已提交
63 64 65 66 67
#define WAKEUP_CHARS		256

#define UART_MCR_AFE		0x20
#define UART_LSR_SPECIAL	0x1E

J
Jiri Slaby 已提交
68
#define PCI_DEVICE_ID_POS104UL	0x1044
J
Jiri Slaby 已提交
69
#define PCI_DEVICE_ID_CB108	0x1080
J
Jiri Slaby 已提交
70
#define PCI_DEVICE_ID_CP102UF	0x1023
71
#define PCI_DEVICE_ID_CP112UL	0x1120
J
Jiri Slaby 已提交
72
#define PCI_DEVICE_ID_CB114	0x1142
73
#define PCI_DEVICE_ID_CP114UL	0x1143
J
Jiri Slaby 已提交
74 75
#define PCI_DEVICE_ID_CB134I	0x1341
#define PCI_DEVICE_ID_CP138U	0x1380
L
Linus Torvalds 已提交
76 77 78 79 80 81 82 83 84


#define C168_ASIC_ID    1
#define C104_ASIC_ID    2
#define C102_ASIC_ID	0xB
#define CI132_ASIC_ID	4
#define CI134_ASIC_ID	3
#define CI104J_ASIC_ID  5

J
Jiri Slaby 已提交
85 86
#define MXSER_HIGHBAUD	1
#define MXSER_HAS2	2
L
Linus Torvalds 已提交
87

88
/* This is only for PCI */
J
Jiri Slaby 已提交
89
static const struct {
L
Linus Torvalds 已提交
90 91 92 93 94 95 96 97
	int type;
	int tx_fifo;
	int rx_fifo;
	int xmit_fifo_size;
	int rx_high_water;
	int rx_trigger;
	int rx_low_water;
	long max_baud;
J
Jiri Slaby 已提交
98
} Gpci_uart_info[] = {
L
Linus Torvalds 已提交
99 100 101 102
	{MOXA_OTHER_UART, 16, 16, 16, 14, 14, 1, 921600L},
	{MOXA_MUST_MU150_HWID, 64, 64, 64, 48, 48, 16, 230400L},
	{MOXA_MUST_MU860_HWID, 128, 128, 128, 96, 96, 32, 921600L}
};
J
Jiri Slaby 已提交
103
#define UART_INFO_NUM	ARRAY_SIZE(Gpci_uart_info)
L
Linus Torvalds 已提交
104

J
Jiri Slaby 已提交
105 106 107 108 109
struct mxser_cardinfo {
	char *name;
	unsigned int nports;
	unsigned int flags;
};
L
Linus Torvalds 已提交
110

J
Jiri Slaby 已提交
111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139
static const struct mxser_cardinfo mxser_cards[] = {
/* 0*/	{ "C168 series",	8, },
	{ "C104 series",	4, },
	{ "CI-104J series",	4, },
	{ "C168H/PCI series",	8, },
	{ "C104H/PCI series",	4, },
/* 5*/	{ "C102 series",	4, MXSER_HAS2 },	/* C102-ISA */
	{ "CI-132 series",	4, MXSER_HAS2 },
	{ "CI-134 series",	4, },
	{ "CP-132 series",	2, },
	{ "CP-114 series",	4, },
/*10*/	{ "CT-114 series",	4, },
	{ "CP-102 series",	2, MXSER_HIGHBAUD },
	{ "CP-104U series",	4, },
	{ "CP-168U series",	8, },
	{ "CP-132U series",	2, },
/*15*/	{ "CP-134U series",	4, },
	{ "CP-104JU series",	4, },
	{ "Moxa UC7000 Serial",	8, },		/* RC7000 */
	{ "CP-118U series",	8, },
	{ "CP-102UL series",	2, },
/*20*/	{ "CP-102U series",	2, },
	{ "CP-118EL series",	8, },
	{ "CP-168EL series",	8, },
	{ "CP-104EL series",	4, },
	{ "CB-108 series",	8, },
/*25*/	{ "CB-114 series",	4, },
	{ "CB-134I series",	4, },
	{ "CP-138U series",	8, },
140
	{ "POS-104UL series",	4, },
J
Jiri Slaby 已提交
141
	{ "CP-114UL series",	4, },
142 143
/*30*/	{ "CP-102UF series",	2, },
	{ "CP-112UL series",	2, },
J
Jiri Slaby 已提交
144
};
L
Linus Torvalds 已提交
145

J
Jiri Slaby 已提交
146 147
/* driver_data correspond to the lines in the structure above
   see also ISA probe function before you change something */
L
Linus Torvalds 已提交
148
static struct pci_device_id mxser_pcibrds[] = {
J
Jiri Slaby 已提交
149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_C168),	.driver_data = 3 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_C104),	.driver_data = 4 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP132),	.driver_data = 8 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP114),	.driver_data = 9 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CT114),	.driver_data = 10 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP102),	.driver_data = 11 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP104U),	.driver_data = 12 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP168U),	.driver_data = 13 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP132U),	.driver_data = 14 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP134U),	.driver_data = 15 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP104JU),.driver_data = 16 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_RC7000),	.driver_data = 17 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP118U),	.driver_data = 18 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP102UL),.driver_data = 19 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP102U),	.driver_data = 20 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP118EL),.driver_data = 21 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP168EL),.driver_data = 22 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP104EL),.driver_data = 23 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CB108),	.driver_data = 24 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CB114),	.driver_data = 25 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CB134I),	.driver_data = 26 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP138U),	.driver_data = 27 },
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_POS104UL),	.driver_data = 28 },
172
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP114UL),	.driver_data = 29 },
J
Jiri Slaby 已提交
173
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP102UF),	.driver_data = 30 },
174
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP112UL),	.driver_data = 31 },
J
Jiri Slaby 已提交
175
	{ }
L
Linus Torvalds 已提交
176 177 178
};
MODULE_DEVICE_TABLE(pci, mxser_pcibrds);

179
static unsigned long ioaddr[MXSER_BOARDS];
L
Linus Torvalds 已提交
180 181 182 183 184 185
static int ttymajor = MXSERMAJOR;

/* Variables for insmod */

MODULE_AUTHOR("Casper Yang");
MODULE_DESCRIPTION("MOXA Smartio/Industio Family Multiport Board Device Driver");
186 187
module_param_array(ioaddr, ulong, NULL, 0);
MODULE_PARM_DESC(ioaddr, "ISA io addresses to look for a moxa board");
R
Rusty Russell 已提交
188
module_param(ttymajor, int, 0);
L
Linus Torvalds 已提交
189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220
MODULE_LICENSE("GPL");

struct mxser_log {
	int tick;
	unsigned long rxcnt[MXSER_PORTS];
	unsigned long txcnt[MXSER_PORTS];
};

struct mxser_mon {
	unsigned long rxcnt;
	unsigned long txcnt;
	unsigned long up_rxcnt;
	unsigned long up_txcnt;
	int modem_status;
	unsigned char hold_reason;
};

struct mxser_mon_ext {
	unsigned long rx_cnt[32];
	unsigned long tx_cnt[32];
	unsigned long up_rxcnt[32];
	unsigned long up_txcnt[32];
	int modem_status[32];

	long baudrate[32];
	int databits[32];
	int stopbits[32];
	int parity[32];
	int flowctrl[32];
	int fifo[32];
	int iftype[32];
};
221

J
Jiri Slaby 已提交
222 223 224
struct mxser_board;

struct mxser_port {
A
Alan Cox 已提交
225
	struct tty_port port;
J
Jiri Slaby 已提交
226 227 228 229 230
	struct mxser_board *board;

	unsigned long ioaddr;
	unsigned long opmode_ioaddr;
	int max_baud;
L
Linus Torvalds 已提交
231 232 233 234 235 236

	int rx_high_water;
	int rx_trigger;		/* Rx fifo trigger level */
	int rx_low_water;
	int baud_base;		/* max. speed */
	int type;		/* UART type */
J
Jiri Slaby 已提交
237

L
Linus Torvalds 已提交
238 239 240
	int x_char;		/* xon/xoff character */
	int IER;		/* Interrupt Enable Register */
	int MCR;		/* Modem control register */
J
Jiri Slaby 已提交
241 242 243 244 245 246 247 248 249 250 251 252 253

	unsigned char stop_rx;
	unsigned char ldisc_stop_rx;

	int custom_divisor;
	unsigned char err_shadow;

	struct async_icount icount; /* kernel counters for 4 input interrupts */
	int timeout;

	int read_status_mask;
	int ignore_status_mask;
	int xmit_fifo_size;
L
Linus Torvalds 已提交
254 255 256
	int xmit_head;
	int xmit_tail;
	int xmit_cnt;
J
Jiri Slaby 已提交
257

A
Alan Cox 已提交
258
	struct ktermios normal_termios;
J
Jiri Slaby 已提交
259

L
Linus Torvalds 已提交
260
	struct mxser_mon mon_data;
J
Jiri Slaby 已提交
261

L
Linus Torvalds 已提交
262
	spinlock_t slock;
J
Jiri Slaby 已提交
263 264 265 266 267 268 269 270 271 272 273 274 275
};

struct mxser_board {
	unsigned int idx;
	int irq;
	const struct mxser_cardinfo *info;
	unsigned long vector;
	unsigned long vector_mask;

	int chip_flag;
	int uart_type;

	struct mxser_port ports[MXSER_PORTS_PER_BOARD];
L
Linus Torvalds 已提交
276 277 278 279 280 281 282 283 284 285
};

struct mxser_mstatus {
	tcflag_t cflag;
	int cts;
	int dsr;
	int ri;
	int dcd;
};

J
Jiri Slaby 已提交
286
static struct mxser_board mxser_boards[MXSER_BOARDS];
L
Linus Torvalds 已提交
287 288 289 290
static struct tty_driver *mxvar_sdriver;
static struct mxser_log mxvar_log;
static int mxser_set_baud_method[MXSER_PORTS + 1];

291 292 293 294 295 296 297 298 299 300 301 302 303 304 305
static void mxser_enable_must_enchance_mode(unsigned long baseio)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr |= MOXA_MUST_EFR_EFRB_ENABLE;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

306
#ifdef	CONFIG_PCI
307 308 309 310 311 312 313 314 315 316 317 318 319 320
static void mxser_disable_must_enchance_mode(unsigned long baseio)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_EFRB_ENABLE;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}
321
#endif
322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392

static void mxser_set_must_xon1_value(unsigned long baseio, u8 value)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_BANK_MASK;
	efr |= MOXA_MUST_EFR_BANK0;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(value, baseio + MOXA_MUST_XON1_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

static void mxser_set_must_xoff1_value(unsigned long baseio, u8 value)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_BANK_MASK;
	efr |= MOXA_MUST_EFR_BANK0;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(value, baseio + MOXA_MUST_XOFF1_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

static void mxser_set_must_fifo_value(struct mxser_port *info)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(info->ioaddr + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, info->ioaddr + UART_LCR);

	efr = inb(info->ioaddr + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_BANK_MASK;
	efr |= MOXA_MUST_EFR_BANK1;

	outb(efr, info->ioaddr + MOXA_MUST_EFR_REGISTER);
	outb((u8)info->rx_high_water, info->ioaddr + MOXA_MUST_RBRTH_REGISTER);
	outb((u8)info->rx_trigger, info->ioaddr + MOXA_MUST_RBRTI_REGISTER);
	outb((u8)info->rx_low_water, info->ioaddr + MOXA_MUST_RBRTL_REGISTER);
	outb(oldlcr, info->ioaddr + UART_LCR);
}

static void mxser_set_must_enum_value(unsigned long baseio, u8 value)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_BANK_MASK;
	efr |= MOXA_MUST_EFR_BANK2;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(value, baseio + MOXA_MUST_ENUM_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

393
#ifdef CONFIG_PCI
394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409
static void mxser_get_must_hardware_id(unsigned long baseio, u8 *pId)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_BANK_MASK;
	efr |= MOXA_MUST_EFR_BANK2;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	*pId = inb(baseio + MOXA_MUST_HWID_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}
410
#endif
411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 480 481 482 483 484 485 486 487 488

static void SET_MOXA_MUST_NO_SOFTWARE_FLOW_CONTROL(unsigned long baseio)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_SF_MASK;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

static void mxser_enable_must_tx_software_flow_control(unsigned long baseio)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_SF_TX_MASK;
	efr |= MOXA_MUST_EFR_SF_TX1;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

static void mxser_disable_must_tx_software_flow_control(unsigned long baseio)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_SF_TX_MASK;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

static void mxser_enable_must_rx_software_flow_control(unsigned long baseio)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_SF_RX_MASK;
	efr |= MOXA_MUST_EFR_SF_RX1;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

static void mxser_disable_must_rx_software_flow_control(unsigned long baseio)
{
	u8 oldlcr;
	u8 efr;

	oldlcr = inb(baseio + UART_LCR);
	outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);

	efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
	efr &= ~MOXA_MUST_EFR_SF_RX_MASK;

	outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
	outb(oldlcr, baseio + UART_LCR);
}

489
#ifdef CONFIG_PCI
B
Bill Pemberton 已提交
490
static int CheckIsMoxaMust(unsigned long io)
L
Linus Torvalds 已提交
491 492 493 494 495
{
	u8 oldmcr, hwid;
	int i;

	outb(0, io + UART_LCR);
496
	mxser_disable_must_enchance_mode(io);
L
Linus Torvalds 已提交
497 498
	oldmcr = inb(io + UART_MCR);
	outb(0, io + UART_MCR);
499
	mxser_set_must_xon1_value(io, 0x11);
L
Linus Torvalds 已提交
500 501
	if ((hwid = inb(io + UART_MCR)) != 0) {
		outb(oldmcr, io + UART_MCR);
502
		return MOXA_OTHER_UART;
L
Linus Torvalds 已提交
503 504
	}

505
	mxser_get_must_hardware_id(io, &hwid);
J
Jiri Slaby 已提交
506 507
	for (i = 1; i < UART_INFO_NUM; i++) { /* 0 = OTHER_UART */
		if (hwid == Gpci_uart_info[i].type)
508
			return (int)hwid;
L
Linus Torvalds 已提交
509 510 511
	}
	return MOXA_OTHER_UART;
}
512
#endif
L
Linus Torvalds 已提交
513

J
Jiri Slaby 已提交
514
static void process_txrx_fifo(struct mxser_port *info)
L
Linus Torvalds 已提交
515 516 517 518 519 520 521 522
{
	int i;

	if ((info->type == PORT_16450) || (info->type == PORT_8250)) {
		info->rx_trigger = 1;
		info->rx_high_water = 1;
		info->rx_low_water = 1;
		info->xmit_fifo_size = 1;
J
Jiri Slaby 已提交
523 524 525
	} else
		for (i = 0; i < UART_INFO_NUM; i++)
			if (info->board->chip_flag == Gpci_uart_info[i].type) {
L
Linus Torvalds 已提交
526 527 528 529 530 531 532 533
				info->rx_trigger = Gpci_uart_info[i].rx_trigger;
				info->rx_low_water = Gpci_uart_info[i].rx_low_water;
				info->rx_high_water = Gpci_uart_info[i].rx_high_water;
				info->xmit_fifo_size = Gpci_uart_info[i].xmit_fifo_size;
				break;
			}
}

J
Jiri Slaby 已提交
534
static unsigned char mxser_get_msr(int baseaddr, int mode, int port)
L
Linus Torvalds 已提交
535
{
J
Jiri Slaby 已提交
536
	static unsigned char mxser_msr[MXSER_PORTS + 1];
J
Jiri Slaby 已提交
537
	unsigned char status = 0;
L
Linus Torvalds 已提交
538

J
Jiri Slaby 已提交
539
	status = inb(baseaddr + UART_MSR);
L
Linus Torvalds 已提交
540

J
Jiri Slaby 已提交
541 542 543 544 545
	mxser_msr[port] &= 0x0F;
	mxser_msr[port] |= status;
	status = mxser_msr[port];
	if (mode)
		mxser_msr[port] = 0;
L
Linus Torvalds 已提交
546

J
Jiri Slaby 已提交
547 548
	return status;
}
L
Linus Torvalds 已提交
549

550 551 552 553 554 555
static int mxser_carrier_raised(struct tty_port *port)
{
	struct mxser_port *mp = container_of(port, struct mxser_port, port);
	return (inb(mp->ioaddr + UART_MSR) & UART_MSR_DCD)?1:0;
}

556
static void mxser_dtr_rts(struct tty_port *port, int on)
A
Alan Cox 已提交
557 558 559 560 561
{
	struct mxser_port *mp = container_of(port, struct mxser_port, port);
	unsigned long flags;

	spin_lock_irqsave(&mp->slock, flags);
562 563 564 565 566 567
	if (on)
		outb(inb(mp->ioaddr + UART_MCR) |
			UART_MCR_DTR | UART_MCR_RTS, mp->ioaddr + UART_MCR);
	else
		outb(inb(mp->ioaddr + UART_MCR)&~(UART_MCR_DTR | UART_MCR_RTS),
			mp->ioaddr + UART_MCR);
A
Alan Cox 已提交
568 569 570
	spin_unlock_irqrestore(&mp->slock, flags);
}

A
Alan Cox 已提交
571
static int mxser_set_baud(struct tty_struct *tty, long newspd)
L
Linus Torvalds 已提交
572
{
A
Alan Cox 已提交
573
	struct mxser_port *info = tty->driver_data;
J
Jiri Slaby 已提交
574 575
	int quot = 0, baud;
	unsigned char cval;
L
Linus Torvalds 已提交
576

A
Alan Cox 已提交
577
	if (!info->ioaddr)
J
Jiri Slaby 已提交
578
		return -1;
L
Linus Torvalds 已提交
579

J
Jiri Slaby 已提交
580 581
	if (newspd > info->max_baud)
		return -1;
L
Linus Torvalds 已提交
582

J
Jiri Slaby 已提交
583 584
	if (newspd == 134) {
		quot = 2 * info->baud_base / 269;
A
Alan Cox 已提交
585
		tty_encode_baud_rate(tty, 134, 134);
J
Jiri Slaby 已提交
586 587 588 589 590
	} else if (newspd) {
		quot = info->baud_base / newspd;
		if (quot == 0)
			quot = 1;
		baud = info->baud_base/quot;
A
Alan Cox 已提交
591
		tty_encode_baud_rate(tty, baud, baud);
J
Jiri Slaby 已提交
592 593 594
	} else {
		quot = 0;
	}
L
Linus Torvalds 已提交
595

J
Jiri Slaby 已提交
596 597
	info->timeout = ((info->xmit_fifo_size * HZ * 10 * quot) / info->baud_base);
	info->timeout += HZ / 50;	/* Add .02 seconds of slop */
L
Linus Torvalds 已提交
598

J
Jiri Slaby 已提交
599 600 601 602 603 604 605 606
	if (quot) {
		info->MCR |= UART_MCR_DTR;
		outb(info->MCR, info->ioaddr + UART_MCR);
	} else {
		info->MCR &= ~UART_MCR_DTR;
		outb(info->MCR, info->ioaddr + UART_MCR);
		return 0;
	}
L
Linus Torvalds 已提交
607

J
Jiri Slaby 已提交
608
	cval = inb(info->ioaddr + UART_LCR);
L
Linus Torvalds 已提交
609

J
Jiri Slaby 已提交
610
	outb(cval | UART_LCR_DLAB, info->ioaddr + UART_LCR);	/* set DLAB */
L
Linus Torvalds 已提交
611

J
Jiri Slaby 已提交
612 613 614
	outb(quot & 0xff, info->ioaddr + UART_DLL);	/* LS of divisor */
	outb(quot >> 8, info->ioaddr + UART_DLM);	/* MS of divisor */
	outb(cval, info->ioaddr + UART_LCR);	/* reset DLAB */
L
Linus Torvalds 已提交
615

J
Jiri Slaby 已提交
616
#ifdef BOTHER
A
Alan Cox 已提交
617
	if (C_BAUD(tty) == BOTHER) {
J
Jiri Slaby 已提交
618 619 620 621 622 623 624 625
		quot = info->baud_base % newspd;
		quot *= 8;
		if (quot % newspd > newspd / 2) {
			quot /= newspd;
			quot++;
		} else
			quot /= newspd;

626
		mxser_set_must_enum_value(info->ioaddr, quot);
J
Jiri Slaby 已提交
627 628
	} else
#endif
629
		mxser_set_must_enum_value(info->ioaddr, 0);
L
Linus Torvalds 已提交
630

631
	return 0;
L
Linus Torvalds 已提交
632 633
}

J
Jiri Slaby 已提交
634 635 636 637
/*
 * This routine is called to set the UART divisor registers to match
 * the specified baud rate for a serial port.
 */
A
Alan Cox 已提交
638 639
static int mxser_change_speed(struct tty_struct *tty,
					struct ktermios *old_termios)
L
Linus Torvalds 已提交
640
{
A
Alan Cox 已提交
641
	struct mxser_port *info = tty->driver_data;
J
Jiri Slaby 已提交
642 643 644
	unsigned cflag, cval, fcr;
	int ret = 0;
	unsigned char status;
L
Linus Torvalds 已提交
645

646
	cflag = tty->termios.c_cflag;
A
Alan Cox 已提交
647
	if (!info->ioaddr)
J
Jiri Slaby 已提交
648
		return ret;
L
Linus Torvalds 已提交
649

A
Alan Cox 已提交
650 651
	if (mxser_set_baud_method[tty->index] == 0)
		mxser_set_baud(tty, tty_get_baud_rate(tty));
L
Linus Torvalds 已提交
652

J
Jiri Slaby 已提交
653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676 677 678
	/* byte size and parity */
	switch (cflag & CSIZE) {
	case CS5:
		cval = 0x00;
		break;
	case CS6:
		cval = 0x01;
		break;
	case CS7:
		cval = 0x02;
		break;
	case CS8:
		cval = 0x03;
		break;
	default:
		cval = 0x00;
		break;		/* too keep GCC shut... */
	}
	if (cflag & CSTOPB)
		cval |= 0x04;
	if (cflag & PARENB)
		cval |= UART_LCR_PARITY;
	if (!(cflag & PARODD))
		cval |= UART_LCR_EPAR;
	if (cflag & CMSPAR)
		cval |= UART_LCR_SPAR;
L
Linus Torvalds 已提交
679

J
Jiri Slaby 已提交
680 681 682 683
	if ((info->type == PORT_8250) || (info->type == PORT_16450)) {
		if (info->board->chip_flag) {
			fcr = UART_FCR_ENABLE_FIFO;
			fcr |= MOXA_MUST_FCR_GDA_MODE_ENABLE;
684
			mxser_set_must_fifo_value(info);
J
Jiri Slaby 已提交
685 686 687 688 689 690
		} else
			fcr = 0;
	} else {
		fcr = UART_FCR_ENABLE_FIFO;
		if (info->board->chip_flag) {
			fcr |= MOXA_MUST_FCR_GDA_MODE_ENABLE;
691
			mxser_set_must_fifo_value(info);
J
Jiri Slaby 已提交
692 693 694 695 696 697 698 699 700 701 702 703 704 705 706
		} else {
			switch (info->rx_trigger) {
			case 1:
				fcr |= UART_FCR_TRIGGER_1;
				break;
			case 4:
				fcr |= UART_FCR_TRIGGER_4;
				break;
			case 8:
				fcr |= UART_FCR_TRIGGER_8;
				break;
			default:
				fcr |= UART_FCR_TRIGGER_14;
				break;
			}
L
Linus Torvalds 已提交
707 708 709
		}
	}

J
Jiri Slaby 已提交
710 711 712 713
	/* CTS flow control flag and modem status interrupts */
	info->IER &= ~UART_IER_MSI;
	info->MCR &= ~UART_MCR_AFE;
	if (cflag & CRTSCTS) {
A
Alan Cox 已提交
714
		info->port.flags |= ASYNC_CTS_FLOW;
J
Jiri Slaby 已提交
715 716 717 718 719
		info->IER |= UART_IER_MSI;
		if ((info->type == PORT_16550A) || (info->board->chip_flag)) {
			info->MCR |= UART_MCR_AFE;
		} else {
			status = inb(info->ioaddr + UART_MSR);
A
Alan Cox 已提交
720
			if (tty->hw_stopped) {
J
Jiri Slaby 已提交
721
				if (status & UART_MSR_CTS) {
A
Alan Cox 已提交
722
					tty->hw_stopped = 0;
J
Jiri Slaby 已提交
723 724 725 726 727 728 729 730 731
					if (info->type != PORT_16550A &&
							!info->board->chip_flag) {
						outb(info->IER & ~UART_IER_THRI,
							info->ioaddr +
							UART_IER);
						info->IER |= UART_IER_THRI;
						outb(info->IER, info->ioaddr +
								UART_IER);
					}
A
Alan Cox 已提交
732
					tty_wakeup(tty);
J
Jiri Slaby 已提交
733 734 735
				}
			} else {
				if (!(status & UART_MSR_CTS)) {
A
Alan Cox 已提交
736
					tty->hw_stopped = 1;
J
Jiri Slaby 已提交
737 738 739 740 741 742 743 744
					if ((info->type != PORT_16550A) &&
							(!info->board->chip_flag)) {
						info->IER &= ~UART_IER_THRI;
						outb(info->IER, info->ioaddr +
								UART_IER);
					}
				}
			}
L
Linus Torvalds 已提交
745
		}
J
Jiri Slaby 已提交
746
	} else {
A
Alan Cox 已提交
747
		info->port.flags &= ~ASYNC_CTS_FLOW;
J
Jiri Slaby 已提交
748 749 750
	}
	outb(info->MCR, info->ioaddr + UART_MCR);
	if (cflag & CLOCAL) {
A
Alan Cox 已提交
751
		info->port.flags &= ~ASYNC_CHECK_CD;
J
Jiri Slaby 已提交
752
	} else {
A
Alan Cox 已提交
753
		info->port.flags |= ASYNC_CHECK_CD;
J
Jiri Slaby 已提交
754 755 756 757 758 759 760 761
		info->IER |= UART_IER_MSI;
	}
	outb(info->IER, info->ioaddr + UART_IER);

	/*
	 * Set up parity check flag
	 */
	info->read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR;
A
Alan Cox 已提交
762
	if (I_INPCK(tty))
J
Jiri Slaby 已提交
763
		info->read_status_mask |= UART_LSR_FE | UART_LSR_PE;
A
Alan Cox 已提交
764
	if (I_BRKINT(tty) || I_PARMRK(tty))
J
Jiri Slaby 已提交
765
		info->read_status_mask |= UART_LSR_BI;
L
Linus Torvalds 已提交
766

J
Jiri Slaby 已提交
767
	info->ignore_status_mask = 0;
L
Linus Torvalds 已提交
768

A
Alan Cox 已提交
769
	if (I_IGNBRK(tty)) {
J
Jiri Slaby 已提交
770 771
		info->ignore_status_mask |= UART_LSR_BI;
		info->read_status_mask |= UART_LSR_BI;
772
		/*
J
Jiri Slaby 已提交
773 774
		 * If we're ignore parity and break indicators, ignore
		 * overruns too.  (For real raw support).
775
		 */
A
Alan Cox 已提交
776
		if (I_IGNPAR(tty)) {
J
Jiri Slaby 已提交
777 778 779 780 781 782 783 784 785
			info->ignore_status_mask |=
						UART_LSR_OE |
						UART_LSR_PE |
						UART_LSR_FE;
			info->read_status_mask |=
						UART_LSR_OE |
						UART_LSR_PE |
						UART_LSR_FE;
		}
L
Linus Torvalds 已提交
786
	}
J
Jiri Slaby 已提交
787
	if (info->board->chip_flag) {
A
Alan Cox 已提交
788 789 790
		mxser_set_must_xon1_value(info->ioaddr, START_CHAR(tty));
		mxser_set_must_xoff1_value(info->ioaddr, STOP_CHAR(tty));
		if (I_IXON(tty)) {
791 792
			mxser_enable_must_rx_software_flow_control(
					info->ioaddr);
J
Jiri Slaby 已提交
793
		} else {
794 795
			mxser_disable_must_rx_software_flow_control(
					info->ioaddr);
L
Linus Torvalds 已提交
796
		}
A
Alan Cox 已提交
797
		if (I_IXOFF(tty)) {
798 799
			mxser_enable_must_tx_software_flow_control(
					info->ioaddr);
J
Jiri Slaby 已提交
800
		} else {
801 802
			mxser_disable_must_tx_software_flow_control(
					info->ioaddr);
L
Linus Torvalds 已提交
803 804 805 806
		}
	}


J
Jiri Slaby 已提交
807 808
	outb(fcr, info->ioaddr + UART_FCR);	/* set fcr */
	outb(cval, info->ioaddr + UART_LCR);
L
Linus Torvalds 已提交
809

J
Jiri Slaby 已提交
810
	return ret;
L
Linus Torvalds 已提交
811 812
}

A
Alan Cox 已提交
813 814
static void mxser_check_modem_status(struct tty_struct *tty,
				struct mxser_port *port, int status)
L
Linus Torvalds 已提交
815
{
J
Jiri Slaby 已提交
816 817 818 819 820 821 822 823 824 825
	/* update input line counters */
	if (status & UART_MSR_TERI)
		port->icount.rng++;
	if (status & UART_MSR_DDSR)
		port->icount.dsr++;
	if (status & UART_MSR_DDCD)
		port->icount.dcd++;
	if (status & UART_MSR_DCTS)
		port->icount.cts++;
	port->mon_data.modem_status = status;
826
	wake_up_interruptible(&port->port.delta_msr_wait);
L
Linus Torvalds 已提交
827

A
Alan Cox 已提交
828
	if ((port->port.flags & ASYNC_CHECK_CD) && (status & UART_MSR_DDCD)) {
J
Jiri Slaby 已提交
829
		if (status & UART_MSR_DCD)
A
Alan Cox 已提交
830
			wake_up_interruptible(&port->port.open_wait);
J
Jiri Slaby 已提交
831
	}
L
Linus Torvalds 已提交
832

H
Huang Shijie 已提交
833
	if (tty_port_cts_enabled(&port->port)) {
A
Alan Cox 已提交
834
		if (tty->hw_stopped) {
J
Jiri Slaby 已提交
835
			if (status & UART_MSR_CTS) {
A
Alan Cox 已提交
836
				tty->hw_stopped = 0;
J
Jiri Slaby 已提交
837 838 839 840 841 842 843 844 845

				if ((port->type != PORT_16550A) &&
						(!port->board->chip_flag)) {
					outb(port->IER & ~UART_IER_THRI,
						port->ioaddr + UART_IER);
					port->IER |= UART_IER_THRI;
					outb(port->IER, port->ioaddr +
							UART_IER);
				}
A
Alan Cox 已提交
846
				tty_wakeup(tty);
J
Jiri Slaby 已提交
847 848 849
			}
		} else {
			if (!(status & UART_MSR_CTS)) {
A
Alan Cox 已提交
850
				tty->hw_stopped = 1;
J
Jiri Slaby 已提交
851 852 853 854 855 856 857 858
				if (port->type != PORT_16550A &&
						!port->board->chip_flag) {
					port->IER &= ~UART_IER_THRI;
					outb(port->IER, port->ioaddr +
							UART_IER);
				}
			}
		}
L
Linus Torvalds 已提交
859 860 861
	}
}

862
static int mxser_activate(struct tty_port *port, struct tty_struct *tty)
L
Linus Torvalds 已提交
863
{
864
	struct mxser_port *info = container_of(port, struct mxser_port, port);
J
Jiri Slaby 已提交
865 866
	unsigned long page;
	unsigned long flags;
L
Linus Torvalds 已提交
867

J
Jiri Slaby 已提交
868 869 870
	page = __get_free_page(GFP_KERNEL);
	if (!page)
		return -ENOMEM;
L
Linus Torvalds 已提交
871

J
Jiri Slaby 已提交
872
	spin_lock_irqsave(&info->slock, flags);
L
Linus Torvalds 已提交
873

J
Jiri Slaby 已提交
874
	if (!info->ioaddr || !info->type) {
A
Alan Cox 已提交
875
		set_bit(TTY_IO_ERROR, &tty->flags);
J
Jiri Slaby 已提交
876 877
		free_page(page);
		spin_unlock_irqrestore(&info->slock, flags);
L
Linus Torvalds 已提交
878
		return 0;
J
Jiri Slaby 已提交
879
	}
880
	info->port.xmit_buf = (unsigned char *) page;
L
Linus Torvalds 已提交
881 882

	/*
J
Jiri Slaby 已提交
883 884
	 * Clear the FIFO buffers and disable them
	 * (they will be reenabled in mxser_change_speed())
L
Linus Torvalds 已提交
885
	 */
J
Jiri Slaby 已提交
886 887 888 889 890 891 892
	if (info->board->chip_flag)
		outb((UART_FCR_CLEAR_RCVR |
			UART_FCR_CLEAR_XMIT |
			MOXA_MUST_FCR_GDA_MODE_ENABLE), info->ioaddr + UART_FCR);
	else
		outb((UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT),
			info->ioaddr + UART_FCR);
L
Linus Torvalds 已提交
893

J
Jiri Slaby 已提交
894 895 896 897 898 899 900 901
	/*
	 * 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.
	 */
	if (inb(info->ioaddr + UART_LSR) == 0xff) {
		spin_unlock_irqrestore(&info->slock, flags);
		if (capable(CAP_SYS_ADMIN)) {
902
			set_bit(TTY_IO_ERROR, &tty->flags);
J
Jiri Slaby 已提交
903 904 905 906
			return 0;
		} else
			return -ENODEV;
	}
L
Linus Torvalds 已提交
907

J
Jiri Slaby 已提交
908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938 939
	/*
	 * Clear the interrupt registers.
	 */
	(void) inb(info->ioaddr + UART_LSR);
	(void) inb(info->ioaddr + UART_RX);
	(void) inb(info->ioaddr + UART_IIR);
	(void) inb(info->ioaddr + UART_MSR);

	/*
	 * Now, initialize the UART
	 */
	outb(UART_LCR_WLEN8, info->ioaddr + UART_LCR);	/* reset DLAB */
	info->MCR = UART_MCR_DTR | UART_MCR_RTS;
	outb(info->MCR, info->ioaddr + UART_MCR);

	/*
	 * Finally, enable interrupts
	 */
	info->IER = UART_IER_MSI | UART_IER_RLSI | UART_IER_RDI;

	if (info->board->chip_flag)
		info->IER |= MOXA_MUST_IER_EGDAI;
	outb(info->IER, info->ioaddr + UART_IER);	/* enable interrupts */

	/*
	 * And clear the interrupt registers again for luck.
	 */
	(void) inb(info->ioaddr + UART_LSR);
	(void) inb(info->ioaddr + UART_RX);
	(void) inb(info->ioaddr + UART_IIR);
	(void) inb(info->ioaddr + UART_MSR);

A
Alan Cox 已提交
940
	clear_bit(TTY_IO_ERROR, &tty->flags);
J
Jiri Slaby 已提交
941 942 943 944 945
	info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;

	/*
	 * and set the speed of the serial port
	 */
A
Alan Cox 已提交
946
	mxser_change_speed(tty, NULL);
J
Jiri Slaby 已提交
947 948 949 950 951 952
	spin_unlock_irqrestore(&info->slock, flags);

	return 0;
}

/*
953
 * This routine will shutdown a serial port
J
Jiri Slaby 已提交
954
 */
955
static void mxser_shutdown_port(struct tty_port *port)
J
Jiri Slaby 已提交
956
{
957
	struct mxser_port *info = container_of(port, struct mxser_port, port);
J
Jiri Slaby 已提交
958 959 960 961 962 963 964 965
	unsigned long flags;

	spin_lock_irqsave(&info->slock, flags);

	/*
	 * clear delta_msr_wait queue to avoid mem leaks: we may free the irq
	 * here so the queue might never be waken up
	 */
966
	wake_up_interruptible(&info->port.delta_msr_wait);
J
Jiri Slaby 已提交
967 968

	/*
969
	 * Free the xmit buffer, if necessary
J
Jiri Slaby 已提交
970
	 */
A
Alan Cox 已提交
971 972 973
	if (info->port.xmit_buf) {
		free_page((unsigned long) info->port.xmit_buf);
		info->port.xmit_buf = NULL;
L
Linus Torvalds 已提交
974 975
	}

J
Jiri Slaby 已提交
976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006
	info->IER = 0;
	outb(0x00, info->ioaddr + UART_IER);

	/* clear Rx/Tx FIFO's */
	if (info->board->chip_flag)
		outb(UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT |
				MOXA_MUST_FCR_GDA_MODE_ENABLE,
				info->ioaddr + UART_FCR);
	else
		outb(UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT,
			info->ioaddr + UART_FCR);

	/* read data port to reset things */
	(void) inb(info->ioaddr + UART_RX);


	if (info->board->chip_flag)
		SET_MOXA_MUST_NO_SOFTWARE_FLOW_CONTROL(info->ioaddr);

	spin_unlock_irqrestore(&info->slock, flags);
}

/*
 * This routine is called whenever a serial port is opened.  It
 * enables interrupts for a serial port, linking in its async structure into
 * the IRQ chain.   It also performs the serial-specific
 * initialization for the tty structure.
 */
static int mxser_open(struct tty_struct *tty, struct file *filp)
{
	struct mxser_port *info;
1007
	int line;
J
Jiri Slaby 已提交
1008 1009 1010 1011 1012 1013 1014 1015

	line = tty->index;
	if (line == MXSER_PORTS)
		return 0;
	info = &mxser_boards[line / MXSER_PORTS_PER_BOARD].ports[line % MXSER_PORTS_PER_BOARD];
	if (!info->ioaddr)
		return -ENODEV;

1016
	tty->driver_data = info;
1017
	return tty_port_open(&info->port, tty, filp);
L
Linus Torvalds 已提交
1018 1019
}

1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040
static void mxser_flush_buffer(struct tty_struct *tty)
{
	struct mxser_port *info = tty->driver_data;
	char fcr;
	unsigned long flags;


	spin_lock_irqsave(&info->slock, flags);
	info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;

	fcr = inb(info->ioaddr + UART_FCR);
	outb((fcr | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT),
		info->ioaddr + UART_FCR);
	outb(fcr, info->ioaddr + UART_FCR);

	spin_unlock_irqrestore(&info->slock, flags);

	tty_wakeup(tty);
}


1041
static void mxser_close_port(struct tty_port *port)
L
Linus Torvalds 已提交
1042
{
1043
	struct mxser_port *info = container_of(port, struct mxser_port, port);
L
Linus Torvalds 已提交
1044 1045 1046 1047 1048 1049 1050 1051
	unsigned long timeout;
	/*
	 * At this point we stop accepting input.  To do this, we
	 * disable the receive line status interrupts, and tell the
	 * interrupt driver to stop checking the data ready bit in the
	 * line status register.
	 */
	info->IER &= ~UART_IER_RLSI;
J
Jiri Slaby 已提交
1052
	if (info->board->chip_flag)
L
Linus Torvalds 已提交
1053
		info->IER &= ~MOXA_MUST_RECV_ISR;
J
Jiri Slaby 已提交
1054

1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065
	outb(info->IER, info->ioaddr + UART_IER);
	/*
	 * Before we drop DTR, make sure the UART transmitter
	 * has completely drained; this is especially
	 * important if there is a transmit FIFO!
	 */
	timeout = jiffies + HZ;
	while (!(inb(info->ioaddr + UART_LSR) & UART_LSR_TEMT)) {
		schedule_timeout_interruptible(5);
		if (time_after(jiffies, timeout))
			break;
L
Linus Torvalds 已提交
1066
	}
1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079
}

/*
 * This routine is called when the serial port gets closed.  First, we
 * wait for the last remaining data to be sent.  Then, we unlink its
 * async structure from the interrupt chain if necessary, and we free
 * that IRQ if nothing is left in the chain.
 */
static void mxser_close(struct tty_struct *tty, struct file *filp)
{
	struct mxser_port *info = tty->driver_data;
	struct tty_port *port = &info->port;

1080
	if (tty->index == MXSER_PORTS || info == NULL)
1081 1082 1083
		return;
	if (tty_port_close_start(port, tty, filp) == 0)
		return;
1084 1085
	mutex_lock(&port->mutex);
	mxser_close_port(port);
1086
	mxser_flush_buffer(tty);
1087 1088 1089 1090
	if (test_bit(ASYNCB_INITIALIZED, &port->flags)) {
		if (C_HUPCL(tty))
			tty_port_lower_dtr_rts(port);
	}
1091 1092 1093
	mxser_shutdown_port(port);
	clear_bit(ASYNCB_INITIALIZED, &port->flags);
	mutex_unlock(&port->mutex);
1094 1095 1096 1097
	/* Right now the tty_port set is done outside of the close_end helper
	   as we don't yet have everyone using refcounts */	
	tty_port_close_end(port, tty);
	tty_port_tty_set(port, NULL);
L
Linus Torvalds 已提交
1098 1099 1100 1101 1102
}

static int mxser_write(struct tty_struct *tty, const unsigned char *buf, int count)
{
	int c, total = 0;
J
Jiri Slaby 已提交
1103
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1104 1105
	unsigned long flags;

A
Alan Cox 已提交
1106
	if (!info->port.xmit_buf)
1107
		return 0;
L
Linus Torvalds 已提交
1108 1109

	while (1) {
1110 1111
		c = min_t(int, count, min(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
					  SERIAL_XMIT_SIZE - info->xmit_head));
L
Linus Torvalds 已提交
1112 1113 1114
		if (c <= 0)
			break;

A
Alan Cox 已提交
1115
		memcpy(info->port.xmit_buf + info->xmit_head, buf, c);
L
Linus Torvalds 已提交
1116
		spin_lock_irqsave(&info->slock, flags);
1117 1118
		info->xmit_head = (info->xmit_head + c) &
				  (SERIAL_XMIT_SIZE - 1);
L
Linus Torvalds 已提交
1119 1120 1121 1122 1123 1124 1125 1126
		info->xmit_cnt += c;
		spin_unlock_irqrestore(&info->slock, flags);

		buf += c;
		count -= c;
		total += c;
	}

J
Jiri Slaby 已提交
1127
	if (info->xmit_cnt && !tty->stopped) {
1128 1129
		if (!tty->hw_stopped ||
				(info->type == PORT_16550A) ||
J
Jiri Slaby 已提交
1130
				(info->board->chip_flag)) {
L
Linus Torvalds 已提交
1131
			spin_lock_irqsave(&info->slock, flags);
J
Jiri Slaby 已提交
1132 1133
			outb(info->IER & ~UART_IER_THRI, info->ioaddr +
					UART_IER);
L
Linus Torvalds 已提交
1134
			info->IER |= UART_IER_THRI;
J
Jiri Slaby 已提交
1135
			outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1136 1137 1138 1139 1140 1141
			spin_unlock_irqrestore(&info->slock, flags);
		}
	}
	return total;
}

A
Alan Cox 已提交
1142
static int mxser_put_char(struct tty_struct *tty, unsigned char ch)
L
Linus Torvalds 已提交
1143
{
J
Jiri Slaby 已提交
1144
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1145 1146
	unsigned long flags;

A
Alan Cox 已提交
1147
	if (!info->port.xmit_buf)
A
Alan Cox 已提交
1148
		return 0;
L
Linus Torvalds 已提交
1149 1150

	if (info->xmit_cnt >= SERIAL_XMIT_SIZE - 1)
A
Alan Cox 已提交
1151
		return 0;
L
Linus Torvalds 已提交
1152 1153

	spin_lock_irqsave(&info->slock, flags);
A
Alan Cox 已提交
1154
	info->port.xmit_buf[info->xmit_head++] = ch;
L
Linus Torvalds 已提交
1155 1156 1157
	info->xmit_head &= SERIAL_XMIT_SIZE - 1;
	info->xmit_cnt++;
	spin_unlock_irqrestore(&info->slock, flags);
J
Jiri Slaby 已提交
1158
	if (!tty->stopped) {
1159 1160
		if (!tty->hw_stopped ||
				(info->type == PORT_16550A) ||
J
Jiri Slaby 已提交
1161
				info->board->chip_flag) {
L
Linus Torvalds 已提交
1162
			spin_lock_irqsave(&info->slock, flags);
J
Jiri Slaby 已提交
1163
			outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1164
			info->IER |= UART_IER_THRI;
J
Jiri Slaby 已提交
1165
			outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1166 1167 1168
			spin_unlock_irqrestore(&info->slock, flags);
		}
	}
A
Alan Cox 已提交
1169
	return 1;
L
Linus Torvalds 已提交
1170 1171 1172 1173 1174
}


static void mxser_flush_chars(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1175
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1176 1177
	unsigned long flags;

J
Jiri Slaby 已提交
1178 1179 1180
	if (info->xmit_cnt <= 0 || tty->stopped || !info->port.xmit_buf ||
			(tty->hw_stopped && info->type != PORT_16550A &&
			 !info->board->chip_flag))
L
Linus Torvalds 已提交
1181 1182 1183 1184
		return;

	spin_lock_irqsave(&info->slock, flags);

J
Jiri Slaby 已提交
1185
	outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1186
	info->IER |= UART_IER_THRI;
J
Jiri Slaby 已提交
1187
	outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1188 1189 1190 1191 1192 1193

	spin_unlock_irqrestore(&info->slock, flags);
}

static int mxser_write_room(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1194
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1195 1196 1197
	int ret;

	ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
J
Jiri Slaby 已提交
1198
	return ret < 0 ? 0 : ret;
L
Linus Torvalds 已提交
1199 1200 1201 1202
}

static int mxser_chars_in_buffer(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1203
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1204 1205 1206
	return info->xmit_cnt;
}

J
Jiri Slaby 已提交
1207 1208 1209 1210 1211
/*
 * ------------------------------------------------------------
 * friends of mxser_ioctl()
 * ------------------------------------------------------------
 */
A
Alan Cox 已提交
1212
static int mxser_get_serial_info(struct tty_struct *tty,
J
Jiri Slaby 已提交
1213 1214
		struct serial_struct __user *retinfo)
{
A
Alan Cox 已提交
1215
	struct mxser_port *info = tty->driver_data;
J
Jiri Slaby 已提交
1216 1217
	struct serial_struct tmp = {
		.type = info->type,
A
Alan Cox 已提交
1218
		.line = tty->index,
J
Jiri Slaby 已提交
1219 1220
		.port = info->ioaddr,
		.irq = info->board->irq,
A
Alan Cox 已提交
1221
		.flags = info->port.flags,
J
Jiri Slaby 已提交
1222
		.baud_base = info->baud_base,
A
Alan Cox 已提交
1223 1224
		.close_delay = info->port.close_delay,
		.closing_wait = info->port.closing_wait,
J
Jiri Slaby 已提交
1225 1226 1227 1228 1229 1230 1231 1232
		.custom_divisor = info->custom_divisor,
		.hub6 = 0
	};
	if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
		return -EFAULT;
	return 0;
}

A
Alan Cox 已提交
1233
static int mxser_set_serial_info(struct tty_struct *tty,
J
Jiri Slaby 已提交
1234
		struct serial_struct __user *new_info)
L
Linus Torvalds 已提交
1235
{
A
Alan Cox 已提交
1236
	struct mxser_port *info = tty->driver_data;
1237
	struct tty_port *port = &info->port;
J
Jiri Slaby 已提交
1238
	struct serial_struct new_serial;
1239
	speed_t baud;
J
Jiri Slaby 已提交
1240 1241 1242
	unsigned long sl_flags;
	unsigned int flags;
	int retval = 0;
L
Linus Torvalds 已提交
1243

J
Jiri Slaby 已提交
1244
	if (!new_info || !info->ioaddr)
1245
		return -ENODEV;
J
Jiri Slaby 已提交
1246 1247
	if (copy_from_user(&new_serial, new_info, sizeof(new_serial)))
		return -EFAULT;
L
Linus Torvalds 已提交
1248

1249 1250 1251
	if (new_serial.irq != info->board->irq ||
			new_serial.port != info->ioaddr)
		return -EINVAL;
L
Linus Torvalds 已提交
1252

1253
	flags = port->flags & ASYNC_SPD_MASK;
L
Linus Torvalds 已提交
1254

J
Jiri Slaby 已提交
1255 1256
	if (!capable(CAP_SYS_ADMIN)) {
		if ((new_serial.baud_base != info->baud_base) ||
A
Alan Cox 已提交
1257
				(new_serial.close_delay != info->port.close_delay) ||
A
Alan Cox 已提交
1258
				((new_serial.flags & ~ASYNC_USR_MASK) != (info->port.flags & ~ASYNC_USR_MASK)))
J
Jiri Slaby 已提交
1259
			return -EPERM;
A
Alan Cox 已提交
1260
		info->port.flags = ((info->port.flags & ~ASYNC_USR_MASK) |
J
Jiri Slaby 已提交
1261 1262
				(new_serial.flags & ASYNC_USR_MASK));
	} else {
L
Linus Torvalds 已提交
1263
		/*
J
Jiri Slaby 已提交
1264 1265
		 * OK, past this point, all the error checking has been done.
		 * At this point, we start making changes.....
L
Linus Torvalds 已提交
1266
		 */
1267
		port->flags = ((port->flags & ~ASYNC_FLAGS) |
J
Jiri Slaby 已提交
1268
				(new_serial.flags & ASYNC_FLAGS));
1269 1270
		port->close_delay = new_serial.close_delay * HZ / 100;
		port->closing_wait = new_serial.closing_wait * HZ / 100;
J
Jiri Slaby 已提交
1271
		port->low_latency = (port->flags & ASYNC_LOW_LATENCY) ? 1 : 0;
1272
		if ((port->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST &&
1273 1274 1275
				(new_serial.baud_base != info->baud_base ||
				new_serial.custom_divisor !=
				info->custom_divisor)) {
1276 1277
			if (new_serial.custom_divisor == 0)
				return -EINVAL;
1278
			baud = new_serial.baud_base / new_serial.custom_divisor;
A
Alan Cox 已提交
1279
			tty_encode_baud_rate(tty, baud, baud);
1280
		}
J
Jiri Slaby 已提交
1281
	}
J
Jiri Slaby 已提交
1282

J
Jiri Slaby 已提交
1283
	info->type = new_serial.type;
L
Linus Torvalds 已提交
1284

J
Jiri Slaby 已提交
1285 1286
	process_txrx_fifo(info);

1287 1288
	if (test_bit(ASYNCB_INITIALIZED, &port->flags)) {
		if (flags != (port->flags & ASYNC_SPD_MASK)) {
J
Jiri Slaby 已提交
1289
			spin_lock_irqsave(&info->slock, sl_flags);
A
Alan Cox 已提交
1290
			mxser_change_speed(tty, NULL);
J
Jiri Slaby 已提交
1291
			spin_unlock_irqrestore(&info->slock, sl_flags);
L
Linus Torvalds 已提交
1292
		}
1293
	} else {
1294
		retval = mxser_activate(port, tty);
1295
		if (retval == 0)
1296
			set_bit(ASYNCB_INITIALIZED, &port->flags);
1297
	}
J
Jiri Slaby 已提交
1298 1299
	return retval;
}
L
Linus Torvalds 已提交
1300

J
Jiri Slaby 已提交
1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316
/*
 * mxser_get_lsr_info - get line status register info
 *
 * Purpose: Let user call ioctl() to get info when the UART physically
 *	    is emptied.  On bus types like RS485, the transmitter must
 *	    release the bus after transmitting. This must be done when
 *	    the transmit shift register is empty, not be done when the
 *	    transmit holding register is empty.  This functionality
 *	    allows an RS485 driver to be written in user space.
 */
static int mxser_get_lsr_info(struct mxser_port *info,
		unsigned int __user *value)
{
	unsigned char status;
	unsigned int result;
	unsigned long flags;
L
Linus Torvalds 已提交
1317

J
Jiri Slaby 已提交
1318 1319 1320 1321 1322 1323
	spin_lock_irqsave(&info->slock, flags);
	status = inb(info->ioaddr + UART_LSR);
	spin_unlock_irqrestore(&info->slock, flags);
	result = ((status & UART_LSR_TEMT) ? TIOCSER_TEMT : 0);
	return put_user(result, value);
}
L
Linus Torvalds 已提交
1324

1325
static int mxser_tiocmget(struct tty_struct *tty)
J
Jiri Slaby 已提交
1326 1327 1328 1329
{
	struct mxser_port *info = tty->driver_data;
	unsigned char control, status;
	unsigned long flags;
L
Linus Torvalds 已提交
1330

1331

J
Jiri Slaby 已提交
1332 1333 1334 1335
	if (tty->index == MXSER_PORTS)
		return -ENOIOCTLCMD;
	if (test_bit(TTY_IO_ERROR, &tty->flags))
		return -EIO;
L
Linus Torvalds 已提交
1336

J
Jiri Slaby 已提交
1337
	control = info->MCR;
L
Linus Torvalds 已提交
1338

J
Jiri Slaby 已提交
1339 1340 1341
	spin_lock_irqsave(&info->slock, flags);
	status = inb(info->ioaddr + UART_MSR);
	if (status & UART_MSR_ANY_DELTA)
A
Alan Cox 已提交
1342
		mxser_check_modem_status(tty, info, status);
J
Jiri Slaby 已提交
1343 1344 1345 1346 1347 1348 1349 1350
	spin_unlock_irqrestore(&info->slock, flags);
	return ((control & UART_MCR_RTS) ? TIOCM_RTS : 0) |
		    ((control & UART_MCR_DTR) ? TIOCM_DTR : 0) |
		    ((status & UART_MSR_DCD) ? TIOCM_CAR : 0) |
		    ((status & UART_MSR_RI) ? TIOCM_RNG : 0) |
		    ((status & UART_MSR_DSR) ? TIOCM_DSR : 0) |
		    ((status & UART_MSR_CTS) ? TIOCM_CTS : 0);
}
L
Linus Torvalds 已提交
1351

1352
static int mxser_tiocmset(struct tty_struct *tty,
J
Jiri Slaby 已提交
1353 1354 1355 1356
		unsigned int set, unsigned int clear)
{
	struct mxser_port *info = tty->driver_data;
	unsigned long flags;
L
Linus Torvalds 已提交
1357 1358


J
Jiri Slaby 已提交
1359 1360 1361 1362
	if (tty->index == MXSER_PORTS)
		return -ENOIOCTLCMD;
	if (test_bit(TTY_IO_ERROR, &tty->flags))
		return -EIO;
L
Linus Torvalds 已提交
1363

J
Jiri Slaby 已提交
1364
	spin_lock_irqsave(&info->slock, flags);
L
Linus Torvalds 已提交
1365

J
Jiri Slaby 已提交
1366 1367 1368 1369
	if (set & TIOCM_RTS)
		info->MCR |= UART_MCR_RTS;
	if (set & TIOCM_DTR)
		info->MCR |= UART_MCR_DTR;
L
Linus Torvalds 已提交
1370

J
Jiri Slaby 已提交
1371 1372 1373 1374
	if (clear & TIOCM_RTS)
		info->MCR &= ~UART_MCR_RTS;
	if (clear & TIOCM_DTR)
		info->MCR &= ~UART_MCR_DTR;
1375

J
Jiri Slaby 已提交
1376 1377 1378 1379
	outb(info->MCR, info->ioaddr + UART_MCR);
	spin_unlock_irqrestore(&info->slock, flags);
	return 0;
}
L
Linus Torvalds 已提交
1380

J
Jiri Slaby 已提交
1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409
static int __init mxser_program_mode(int port)
{
	int id, i, j, n;

	outb(0, port);
	outb(0, port);
	outb(0, port);
	(void)inb(port);
	(void)inb(port);
	outb(0, port);
	(void)inb(port);

	id = inb(port + 1) & 0x1F;
	if ((id != C168_ASIC_ID) &&
			(id != C104_ASIC_ID) &&
			(id != C102_ASIC_ID) &&
			(id != CI132_ASIC_ID) &&
			(id != CI134_ASIC_ID) &&
			(id != CI104J_ASIC_ID))
		return -1;
	for (i = 0, j = 0; i < 4; i++) {
		n = inb(port + 2);
		if (n == 'M') {
			j = 1;
		} else if ((j == 1) && (n == 1)) {
			j = 2;
			break;
		} else
			j = 0;
L
Linus Torvalds 已提交
1410
	}
J
Jiri Slaby 已提交
1411 1412 1413
	if (j != 2)
		id = -2;
	return id;
L
Linus Torvalds 已提交
1414 1415
}

J
Jiri Slaby 已提交
1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477 1478 1479 1480 1481 1482
static void __init mxser_normal_mode(int port)
{
	int i, n;

	outb(0xA5, port + 1);
	outb(0x80, port + 3);
	outb(12, port + 0);	/* 9600 bps */
	outb(0, port + 1);
	outb(0x03, port + 3);	/* 8 data bits */
	outb(0x13, port + 4);	/* loop back mode */
	for (i = 0; i < 16; i++) {
		n = inb(port + 5);
		if ((n & 0x61) == 0x60)
			break;
		if ((n & 1) == 1)
			(void)inb(port);
	}
	outb(0x00, port + 4);
}

#define CHIP_SK 	0x01	/* Serial Data Clock  in Eprom */
#define CHIP_DO 	0x02	/* Serial Data Output in Eprom */
#define CHIP_CS 	0x04	/* Serial Chip Select in Eprom */
#define CHIP_DI 	0x08	/* Serial Data Input  in Eprom */
#define EN_CCMD 	0x000	/* Chip's command register     */
#define EN0_RSARLO	0x008	/* Remote start address reg 0  */
#define EN0_RSARHI	0x009	/* Remote start address reg 1  */
#define EN0_RCNTLO	0x00A	/* Remote byte count reg WR    */
#define EN0_RCNTHI	0x00B	/* Remote byte count reg WR    */
#define EN0_DCFG	0x00E	/* Data configuration reg WR   */
#define EN0_PORT	0x010	/* Rcv missed frame error counter RD */
#define ENC_PAGE0	0x000	/* Select page 0 of chip registers   */
#define ENC_PAGE3	0x0C0	/* Select page 3 of chip registers   */
static int __init mxser_read_register(int port, unsigned short *regs)
{
	int i, k, value, id;
	unsigned int j;

	id = mxser_program_mode(port);
	if (id < 0)
		return id;
	for (i = 0; i < 14; i++) {
		k = (i & 0x3F) | 0x180;
		for (j = 0x100; j > 0; j >>= 1) {
			outb(CHIP_CS, port);
			if (k & j) {
				outb(CHIP_CS | CHIP_DO, port);
				outb(CHIP_CS | CHIP_DO | CHIP_SK, port);	/* A? bit of read */
			} else {
				outb(CHIP_CS, port);
				outb(CHIP_CS | CHIP_SK, port);	/* A? bit of read */
			}
		}
		(void)inb(port);
		value = 0;
		for (k = 0, j = 0x8000; k < 16; k++, j >>= 1) {
			outb(CHIP_CS, port);
			outb(CHIP_CS | CHIP_SK, port);
			if (inb(port) & CHIP_DI)
				value |= j;
		}
		regs[i] = value;
		outb(0, port);
	}
	mxser_normal_mode(port);
	return id;
}
L
Linus Torvalds 已提交
1483 1484 1485

static int mxser_ioctl_special(unsigned int cmd, void __user *argp)
{
1486 1487
	struct mxser_port *ip;
	struct tty_port *port;
A
Alan Cox 已提交
1488
	struct tty_struct *tty;
J
Jiri Slaby 已提交
1489 1490
	int result, status;
	unsigned int i, j;
A
Alan Cox 已提交
1491
	int ret = 0;
L
Linus Torvalds 已提交
1492 1493 1494

	switch (cmd) {
	case MOXA_GET_MAJOR:
1495
		printk_ratelimited(KERN_WARNING "mxser: '%s' uses deprecated ioctl "
1496 1497
					"%x (GET_MAJOR), fix your userspace\n",
					current->comm, cmd);
J
Jiri Slaby 已提交
1498
		return put_user(ttymajor, (int __user *)argp);
L
Linus Torvalds 已提交
1499 1500 1501

	case MOXA_CHKPORTENABLE:
		result = 0;
J
Jiri Slaby 已提交
1502 1503 1504 1505
		for (i = 0; i < MXSER_BOARDS; i++)
			for (j = 0; j < MXSER_PORTS_PER_BOARD; j++)
				if (mxser_boards[i].ports[j].ioaddr)
					result |= (1 << i);
1506
		return put_user(result, (unsigned long __user *)argp);
L
Linus Torvalds 已提交
1507
	case MOXA_GETDATACOUNT:
1508 1509
		/* The receive side is locked by port->slock but it isn't
		   clear that an exact snapshot is worth copying here */
L
Linus Torvalds 已提交
1510
		if (copy_to_user(argp, &mxvar_log, sizeof(mxvar_log)))
A
Alan Cox 已提交
1511 1512
			ret = -EFAULT;
		return ret;
J
Jiri Slaby 已提交
1513 1514
	case MOXA_GETMSTATUS: {
		struct mxser_mstatus ms, __user *msu = argp;
J
Jiri Slaby 已提交
1515 1516
		for (i = 0; i < MXSER_BOARDS; i++)
			for (j = 0; j < MXSER_PORTS_PER_BOARD; j++) {
1517 1518
				ip = &mxser_boards[i].ports[j];
				port = &ip->port;
J
Jiri Slaby 已提交
1519
				memset(&ms, 0, sizeof(ms));
J
Jiri Slaby 已提交
1520

1521 1522
				mutex_lock(&port->mutex);
				if (!ip->ioaddr)
J
Jiri Slaby 已提交
1523
					goto copy;
A
Alan Cox 已提交
1524
				
1525
				tty = tty_port_tty_get(port);
L
Linus Torvalds 已提交
1526

1527
				if (!tty)
1528
					ms.cflag = ip->normal_termios.c_cflag;
J
Jiri Slaby 已提交
1529
				else
1530
					ms.cflag = tty->termios.c_cflag;
A
Alan Cox 已提交
1531
				tty_kref_put(tty);
1532 1533 1534
				spin_lock_irq(&ip->slock);
				status = inb(ip->ioaddr + UART_MSR);
				spin_unlock_irq(&ip->slock);
J
Jiri Slaby 已提交
1535 1536 1537 1538 1539 1540 1541
				if (status & UART_MSR_DCD)
					ms.dcd = 1;
				if (status & UART_MSR_DSR)
					ms.dsr = 1;
				if (status & UART_MSR_CTS)
					ms.cts = 1;
			copy:
1542 1543
				mutex_unlock(&port->mutex);
				if (copy_to_user(msu, &ms, sizeof(ms)))
J
Jiri Slaby 已提交
1544 1545
					return -EFAULT;
				msu++;
J
Jiri Slaby 已提交
1546
			}
L
Linus Torvalds 已提交
1547
		return 0;
J
Jiri Slaby 已提交
1548
	}
1549
	case MOXA_ASPP_MON_EXT: {
J
Jiri Slaby 已提交
1550 1551 1552 1553 1554 1555 1556
		struct mxser_mon_ext *me; /* it's 2k, stack unfriendly */
		unsigned int cflag, iflag, p;
		u8 opmode;

		me = kzalloc(sizeof(*me), GFP_KERNEL);
		if (!me)
			return -ENOMEM;
J
Jiri Slaby 已提交
1557

J
Jiri Slaby 已提交
1558 1559 1560 1561 1562 1563
		for (i = 0, p = 0; i < MXSER_BOARDS; i++) {
			for (j = 0; j < MXSER_PORTS_PER_BOARD; j++, p++) {
				if (p >= ARRAY_SIZE(me->rx_cnt)) {
					i = MXSER_BOARDS;
					break;
				}
1564 1565 1566 1567 1568 1569
				ip = &mxser_boards[i].ports[j];
				port = &ip->port;

				mutex_lock(&port->mutex);
				if (!ip->ioaddr) {
					mutex_unlock(&port->mutex);
L
Linus Torvalds 已提交
1570
					continue;
1571
				}
L
Linus Torvalds 已提交
1572

1573 1574
				spin_lock_irq(&ip->slock);
				status = mxser_get_msr(ip->ioaddr, 0, p);
J
Jiri Slaby 已提交
1575

L
Linus Torvalds 已提交
1576
				if (status & UART_MSR_TERI)
1577
					ip->icount.rng++;
L
Linus Torvalds 已提交
1578
				if (status & UART_MSR_DDSR)
1579
					ip->icount.dsr++;
L
Linus Torvalds 已提交
1580
				if (status & UART_MSR_DDCD)
1581
					ip->icount.dcd++;
L
Linus Torvalds 已提交
1582
				if (status & UART_MSR_DCTS)
1583
					ip->icount.cts++;
J
Jiri Slaby 已提交
1584

1585 1586 1587 1588 1589
				ip->mon_data.modem_status = status;
				me->rx_cnt[p] = ip->mon_data.rxcnt;
				me->tx_cnt[p] = ip->mon_data.txcnt;
				me->up_rxcnt[p] = ip->mon_data.up_rxcnt;
				me->up_txcnt[p] = ip->mon_data.up_txcnt;
J
Jiri Slaby 已提交
1590
				me->modem_status[p] =
1591 1592 1593 1594
					ip->mon_data.modem_status;
				spin_unlock_irq(&ip->slock);

				tty = tty_port_tty_get(&ip->port);
J
Jiri Slaby 已提交
1595

1596
				if (!tty) {
1597 1598 1599
					cflag = ip->normal_termios.c_cflag;
					iflag = ip->normal_termios.c_iflag;
					me->baudrate[p] = tty_termios_baud_rate(&ip->normal_termios);
L
Linus Torvalds 已提交
1600
				} else {
1601 1602
					cflag = tty->termios.c_cflag;
					iflag = tty->termios.c_iflag;
A
Alan Cox 已提交
1603
					me->baudrate[p] = tty_get_baud_rate(tty);
L
Linus Torvalds 已提交
1604
				}
A
Alan Cox 已提交
1605
				tty_kref_put(tty);
L
Linus Torvalds 已提交
1606

J
Jiri Slaby 已提交
1607 1608 1609 1610
				me->databits[p] = cflag & CSIZE;
				me->stopbits[p] = cflag & CSTOPB;
				me->parity[p] = cflag & (PARENB | PARODD |
						CMSPAR);
L
Linus Torvalds 已提交
1611 1612

				if (cflag & CRTSCTS)
J
Jiri Slaby 已提交
1613
					me->flowctrl[p] |= 0x03;
L
Linus Torvalds 已提交
1614 1615

				if (iflag & (IXON | IXOFF))
J
Jiri Slaby 已提交
1616
					me->flowctrl[p] |= 0x0C;
L
Linus Torvalds 已提交
1617

1618
				if (ip->type == PORT_16550A)
J
Jiri Slaby 已提交
1619
					me->fifo[p] = 1;
L
Linus Torvalds 已提交
1620

1621 1622 1623 1624 1625 1626
				if (ip->board->chip_flag == MOXA_MUST_MU860_HWID) {
					opmode = inb(ip->opmode_ioaddr)>>((p % 4) * 2);
					opmode &= OP_MODE_MASK;
				} else {
					opmode = RS232_MODE;
				}
J
Jiri Slaby 已提交
1627
				me->iftype[p] = opmode;
1628
				mutex_unlock(&port->mutex);
L
Linus Torvalds 已提交
1629
			}
A
Alan Cox 已提交
1630
		}
J
Jiri Slaby 已提交
1631 1632 1633 1634
		if (copy_to_user(argp, me, sizeof(*me)))
			ret = -EFAULT;
		kfree(me);
		return ret;
A
Alan Cox 已提交
1635 1636
	}
	default:
L
Linus Torvalds 已提交
1637 1638 1639 1640 1641
		return -ENOIOCTLCMD;
	}
	return 0;
}

J
Jiri Slaby 已提交
1642 1643
static int mxser_cflags_changed(struct mxser_port *info, unsigned long arg,
		struct async_icount *cprev)
L
Linus Torvalds 已提交
1644
{
J
Jiri Slaby 已提交
1645 1646 1647
	struct async_icount cnow;
	unsigned long flags;
	int ret;
L
Linus Torvalds 已提交
1648

J
Jiri Slaby 已提交
1649 1650 1651
	spin_lock_irqsave(&info->slock, flags);
	cnow = info->icount;	/* atomic copy */
	spin_unlock_irqrestore(&info->slock, flags);
L
Linus Torvalds 已提交
1652

J
Jiri Slaby 已提交
1653 1654 1655 1656
	ret =	((arg & TIOCM_RNG) && (cnow.rng != cprev->rng)) ||
		((arg & TIOCM_DSR) && (cnow.dsr != cprev->dsr)) ||
		((arg & TIOCM_CD)  && (cnow.dcd != cprev->dcd)) ||
		((arg & TIOCM_CTS) && (cnow.cts != cprev->cts));
L
Linus Torvalds 已提交
1657

J
Jiri Slaby 已提交
1658 1659 1660 1661 1662
	*cprev = cnow;

	return ret;
}

1663
static int mxser_ioctl(struct tty_struct *tty,
J
Jiri Slaby 已提交
1664
		unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
1665
{
J
Jiri Slaby 已提交
1666
	struct mxser_port *info = tty->driver_data;
1667
	struct tty_port *port = &info->port;
J
Jiri Slaby 已提交
1668 1669 1670 1671
	struct async_icount cnow;
	unsigned long flags;
	void __user *argp = (void __user *)arg;
	int retval;
L
Linus Torvalds 已提交
1672

J
Jiri Slaby 已提交
1673 1674
	if (tty->index == MXSER_PORTS)
		return mxser_ioctl_special(cmd, argp);
L
Linus Torvalds 已提交
1675

J
Jiri Slaby 已提交
1676
	if (cmd == MOXA_SET_OP_MODE || cmd == MOXA_GET_OP_MODE) {
1677 1678 1679
		if (info->board->chip_flag != MOXA_MUST_MU860_HWID)
			return -EFAULT;

J
Jiri Slaby 已提交
1680 1681 1682 1683 1684
		int p;
		unsigned long opmode;
		static unsigned char ModeMask[] = { 0xfc, 0xf3, 0xcf, 0x3f };
		int shiftbit;
		unsigned char val, mask;
L
Linus Torvalds 已提交
1685

J
Jiri Slaby 已提交
1686 1687 1688 1689 1690 1691 1692 1693 1694 1695 1696
		p = tty->index % 4;
		if (cmd == MOXA_SET_OP_MODE) {
			if (get_user(opmode, (int __user *) argp))
				return -EFAULT;
			if (opmode != RS232_MODE &&
					opmode != RS485_2WIRE_MODE &&
					opmode != RS422_MODE &&
					opmode != RS485_4WIRE_MODE)
				return -EFAULT;
			mask = ModeMask[p];
			shiftbit = p * 2;
1697
			spin_lock_irq(&info->slock);
J
Jiri Slaby 已提交
1698 1699 1700 1701
			val = inb(info->opmode_ioaddr);
			val &= mask;
			val |= (opmode << shiftbit);
			outb(val, info->opmode_ioaddr);
1702
			spin_unlock_irq(&info->slock);
J
Jiri Slaby 已提交
1703 1704
		} else {
			shiftbit = p * 2;
1705
			spin_lock_irq(&info->slock);
J
Jiri Slaby 已提交
1706
			opmode = inb(info->opmode_ioaddr) >> shiftbit;
1707
			spin_unlock_irq(&info->slock);
J
Jiri Slaby 已提交
1708 1709 1710 1711 1712 1713 1714
			opmode &= OP_MODE_MASK;
			if (put_user(opmode, (int __user *)argp))
				return -EFAULT;
		}
		return 0;
	}

1715
	if (cmd != TIOCGSERIAL && cmd != TIOCMIWAIT &&
J
Jiri Slaby 已提交
1716 1717 1718 1719 1720
			test_bit(TTY_IO_ERROR, &tty->flags))
		return -EIO;

	switch (cmd) {
	case TIOCGSERIAL:
1721
		mutex_lock(&port->mutex);
A
Alan Cox 已提交
1722
		retval = mxser_get_serial_info(tty, argp);
1723
		mutex_unlock(&port->mutex);
A
Alan Cox 已提交
1724
		return retval;
J
Jiri Slaby 已提交
1725
	case TIOCSSERIAL:
1726
		mutex_lock(&port->mutex);
A
Alan Cox 已提交
1727
		retval = mxser_set_serial_info(tty, argp);
1728
		mutex_unlock(&port->mutex);
A
Alan Cox 已提交
1729
		return retval;
J
Jiri Slaby 已提交
1730
	case TIOCSERGETLSR:	/* Get line status register */
A
Alan Cox 已提交
1731
		return  mxser_get_lsr_info(info, argp);
J
Jiri Slaby 已提交
1732 1733 1734 1735 1736 1737 1738 1739 1740 1741 1742
		/*
		 * Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
		 * - mask passed in arg for lines of interest
		 *   (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
		 * Caller should use TIOCGICOUNT to see which one it was
		 */
	case TIOCMIWAIT:
		spin_lock_irqsave(&info->slock, flags);
		cnow = info->icount;	/* note the counters on entry */
		spin_unlock_irqrestore(&info->slock, flags);

1743
		return wait_event_interruptible(info->port.delta_msr_wait,
J
Jiri Slaby 已提交
1744 1745 1746 1747
				mxser_cflags_changed(info, arg, &cnow));
	case MOXA_HighSpeedOn:
		return put_user(info->baud_base != 115200 ? 1 : 0, (int __user *)argp);
	case MOXA_SDS_RSTICOUNTER:
1748
		spin_lock_irq(&info->slock);
J
Jiri Slaby 已提交
1749 1750
		info->mon_data.rxcnt = 0;
		info->mon_data.txcnt = 0;
1751
		spin_unlock_irq(&info->slock);
J
Jiri Slaby 已提交
1752 1753 1754 1755 1756 1757
		return 0;

	case MOXA_ASPP_OQUEUE:{
		int len, lsr;

		len = mxser_chars_in_buffer(tty);
1758
		spin_lock_irq(&info->slock);
1759
		lsr = inb(info->ioaddr + UART_LSR) & UART_LSR_THRE;
1760
		spin_unlock_irq(&info->slock);
J
Jiri Slaby 已提交
1761 1762 1763 1764 1765 1766 1767
		len += (lsr ? 0 : 1);

		return put_user(len, (int __user *)argp);
	}
	case MOXA_ASPP_MON: {
		int mcr, status;

1768
		spin_lock_irq(&info->slock);
J
Jiri Slaby 已提交
1769
		status = mxser_get_msr(info->ioaddr, 1, tty->index);
A
Alan Cox 已提交
1770
		mxser_check_modem_status(tty, info, status);
J
Jiri Slaby 已提交
1771 1772

		mcr = inb(info->ioaddr + UART_MCR);
1773
		spin_unlock_irq(&info->slock);
1774

J
Jiri Slaby 已提交
1775 1776 1777 1778 1779 1780 1781 1782 1783 1784
		if (mcr & MOXA_MUST_MCR_XON_FLAG)
			info->mon_data.hold_reason &= ~NPPI_NOTIFY_XOFFHOLD;
		else
			info->mon_data.hold_reason |= NPPI_NOTIFY_XOFFHOLD;

		if (mcr & MOXA_MUST_MCR_TX_XON)
			info->mon_data.hold_reason &= ~NPPI_NOTIFY_XOFFXENT;
		else
			info->mon_data.hold_reason |= NPPI_NOTIFY_XOFFXENT;

A
Alan Cox 已提交
1785
		if (tty->hw_stopped)
J
Jiri Slaby 已提交
1786 1787 1788
			info->mon_data.hold_reason |= NPPI_NOTIFY_CTSHOLD;
		else
			info->mon_data.hold_reason &= ~NPPI_NOTIFY_CTSHOLD;
1789

J
Jiri Slaby 已提交
1790 1791 1792 1793 1794 1795 1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816
		if (copy_to_user(argp, &info->mon_data,
				sizeof(struct mxser_mon)))
			return -EFAULT;

		return 0;
	}
	case MOXA_ASPP_LSTATUS: {
		if (put_user(info->err_shadow, (unsigned char __user *)argp))
			return -EFAULT;

		info->err_shadow = 0;
		return 0;
	}
	case MOXA_SET_BAUD_METHOD: {
		int method;

		if (get_user(method, (int __user *)argp))
			return -EFAULT;
		mxser_set_baud_method[tty->index] = method;
		return put_user(method, (int __user *)argp);
	}
	default:
		return -ENOIOCTLCMD;
	}
	return 0;
}

1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836 1837 1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849
	/*
	 * Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
	 * Return: write counters to the user passed counter struct
	 * NB: both 1->0 and 0->1 transitions are counted except for
	 *     RI where only 0->1 is counted.
	 */

static int mxser_get_icount(struct tty_struct *tty,
		struct serial_icounter_struct *icount)

{
	struct mxser_port *info = tty->driver_data;
	struct async_icount cnow;
	unsigned long flags;

	spin_lock_irqsave(&info->slock, flags);
	cnow = info->icount;
	spin_unlock_irqrestore(&info->slock, flags);

	icount->frame = cnow.frame;
	icount->brk = cnow.brk;
	icount->overrun = cnow.overrun;
	icount->buf_overrun = cnow.buf_overrun;
	icount->parity = cnow.parity;
	icount->rx = cnow.rx;
	icount->tx = cnow.tx;
	icount->cts = cnow.cts;
	icount->dsr = cnow.dsr;
	icount->rng = cnow.rng;
	icount->dcd = cnow.dcd;
	return 0;
}

J
Jiri Slaby 已提交
1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861 1862 1863
static void mxser_stoprx(struct tty_struct *tty)
{
	struct mxser_port *info = tty->driver_data;

	info->ldisc_stop_rx = 1;
	if (I_IXOFF(tty)) {
		if (info->board->chip_flag) {
			info->IER &= ~MOXA_MUST_RECV_ISR;
			outb(info->IER, info->ioaddr + UART_IER);
		} else {
			info->x_char = STOP_CHAR(tty);
			outb(0, info->ioaddr + UART_IER);
			info->IER |= UART_IER_THRI;
			outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1864 1865 1866
		}
	}

1867
	if (tty->termios.c_cflag & CRTSCTS) {
J
Jiri Slaby 已提交
1868 1869
		info->MCR &= ~UART_MCR_RTS;
		outb(info->MCR, info->ioaddr + UART_MCR);
L
Linus Torvalds 已提交
1870 1871 1872 1873 1874 1875 1876 1877 1878 1879 1880 1881 1882 1883
	}
}

/*
 * This routine is called by the upper-layer tty layer to signal that
 * incoming characters should be throttled.
 */
static void mxser_throttle(struct tty_struct *tty)
{
	mxser_stoprx(tty);
}

static void mxser_unthrottle(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1884
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1885

J
Jiri Slaby 已提交
1886 1887 1888 1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900
	/* startrx */
	info->ldisc_stop_rx = 0;
	if (I_IXOFF(tty)) {
		if (info->x_char)
			info->x_char = 0;
		else {
			if (info->board->chip_flag) {
				info->IER |= MOXA_MUST_RECV_ISR;
				outb(info->IER, info->ioaddr + UART_IER);
			} else {
				info->x_char = START_CHAR(tty);
				outb(0, info->ioaddr + UART_IER);
				info->IER |= UART_IER_THRI;
				outb(info->IER, info->ioaddr + UART_IER);
			}
L
Linus Torvalds 已提交
1901
		}
J
Jiri Slaby 已提交
1902
	}
L
Linus Torvalds 已提交
1903

1904
	if (tty->termios.c_cflag & CRTSCTS) {
J
Jiri Slaby 已提交
1905 1906
		info->MCR |= UART_MCR_RTS;
		outb(info->MCR, info->ioaddr + UART_MCR);
L
Linus Torvalds 已提交
1907 1908 1909 1910 1911 1912 1913 1914 1915 1916 1917
	}
}

/*
 * mxser_stop() and mxser_start()
 *
 * This routines are called before setting or resetting tty->stopped.
 * They enable or disable transmitter interrupts, as necessary.
 */
static void mxser_stop(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1918
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1919 1920 1921 1922 1923
	unsigned long flags;

	spin_lock_irqsave(&info->slock, flags);
	if (info->IER & UART_IER_THRI) {
		info->IER &= ~UART_IER_THRI;
J
Jiri Slaby 已提交
1924
		outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1925 1926 1927 1928 1929 1930
	}
	spin_unlock_irqrestore(&info->slock, flags);
}

static void mxser_start(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1931
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1932 1933 1934
	unsigned long flags;

	spin_lock_irqsave(&info->slock, flags);
A
Alan Cox 已提交
1935
	if (info->xmit_cnt && info->port.xmit_buf) {
J
Jiri Slaby 已提交
1936
		outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1937
		info->IER |= UART_IER_THRI;
J
Jiri Slaby 已提交
1938
		outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1939 1940 1941 1942
	}
	spin_unlock_irqrestore(&info->slock, flags);
}

J
Jiri Slaby 已提交
1943 1944 1945 1946 1947 1948
static void mxser_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
{
	struct mxser_port *info = tty->driver_data;
	unsigned long flags;

	spin_lock_irqsave(&info->slock, flags);
A
Alan Cox 已提交
1949
	mxser_change_speed(tty, old_termios);
J
Jiri Slaby 已提交
1950 1951 1952
	spin_unlock_irqrestore(&info->slock, flags);

	if ((old_termios->c_cflag & CRTSCTS) &&
1953
			!(tty->termios.c_cflag & CRTSCTS)) {
J
Jiri Slaby 已提交
1954 1955 1956 1957 1958 1959
		tty->hw_stopped = 0;
		mxser_start(tty);
	}

	/* Handle sw stopped */
	if ((old_termios->c_iflag & IXON) &&
1960
			!(tty->termios.c_iflag & IXON)) {
J
Jiri Slaby 已提交
1961 1962 1963 1964
		tty->stopped = 0;

		if (info->board->chip_flag) {
			spin_lock_irqsave(&info->slock, flags);
1965 1966
			mxser_disable_must_rx_software_flow_control(
					info->ioaddr);
J
Jiri Slaby 已提交
1967 1968 1969 1970 1971 1972 1973
			spin_unlock_irqrestore(&info->slock, flags);
		}

		mxser_start(tty);
	}
}

L
Linus Torvalds 已提交
1974 1975 1976 1977 1978
/*
 * mxser_wait_until_sent() --- wait until the transmitter is empty
 */
static void mxser_wait_until_sent(struct tty_struct *tty, int timeout)
{
J
Jiri Slaby 已提交
1979
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1980
	unsigned long orig_jiffies, char_time;
1981
	unsigned long flags;
L
Linus Torvalds 已提交
1982 1983 1984 1985 1986 1987 1988 1989 1990 1991 1992 1993 1994 1995 1996 1997 1998 1999 2000 2001 2002 2003 2004 2005 2006 2007 2008 2009 2010 2011 2012 2013 2014 2015
	int lsr;

	if (info->type == PORT_UNKNOWN)
		return;

	if (info->xmit_fifo_size == 0)
		return;		/* Just in case.... */

	orig_jiffies = jiffies;
	/*
	 * Set the check interval to be 1/5 of the estimated time to
	 * send a single character, and make it at least 1.  The check
	 * interval should also be less than the timeout.
	 *
	 * Note: we have to use pretty tight timings here to satisfy
	 * the NIST-PCTS.
	 */
	char_time = (info->timeout - HZ / 50) / info->xmit_fifo_size;
	char_time = char_time / 5;
	if (char_time == 0)
		char_time = 1;
	if (timeout && timeout < char_time)
		char_time = timeout;
	/*
	 * If the transmitter hasn't cleared in twice the approximate
	 * amount of time to send the entire FIFO, it probably won't
	 * ever clear.  This assumes the UART isn't doing flow
	 * control, which is currently the case.  Hence, if it ever
	 * takes longer than info->timeout, this is probably due to a
	 * UART bug of some kind.  So, we clamp the timeout parameter at
	 * 2*info->timeout.
	 */
	if (!timeout || timeout > 2 * info->timeout)
		timeout = 2 * info->timeout;
2016

2017
	spin_lock_irqsave(&info->slock, flags);
J
Jiri Slaby 已提交
2018
	while (!((lsr = inb(info->ioaddr + UART_LSR)) & UART_LSR_TEMT)) {
2019
		spin_unlock_irqrestore(&info->slock, flags);
2020
		schedule_timeout_interruptible(char_time);
2021
		spin_lock_irqsave(&info->slock, flags);
L
Linus Torvalds 已提交
2022
		if (signal_pending(current))
J
Jiri Slaby 已提交
2023 2024 2025
			break;
		if (timeout && time_after(jiffies, orig_jiffies + timeout))
			break;
L
Linus Torvalds 已提交
2026
	}
2027
	spin_unlock_irqrestore(&info->slock, flags);
J
Jiri Slaby 已提交
2028 2029
	set_current_state(TASK_RUNNING);
}
L
Linus Torvalds 已提交
2030

J
Jiri Slaby 已提交
2031 2032 2033 2034 2035 2036
/*
 * This routine is called by tty_hangup() when a hangup is signaled.
 */
static void mxser_hangup(struct tty_struct *tty)
{
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
2037

J
Jiri Slaby 已提交
2038
	mxser_flush_buffer(tty);
A
Alan Cox 已提交
2039
	tty_port_hangup(&info->port);
L
Linus Torvalds 已提交
2040 2041
}

J
Jiri Slaby 已提交
2042 2043 2044
/*
 * mxser_rs_break() --- routine which turns the break handling on or off
 */
A
Alan Cox 已提交
2045
static int mxser_rs_break(struct tty_struct *tty, int break_state)
L
Linus Torvalds 已提交
2046
{
J
Jiri Slaby 已提交
2047
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
2048 2049
	unsigned long flags;

J
Jiri Slaby 已提交
2050 2051 2052 2053 2054 2055 2056 2057
	spin_lock_irqsave(&info->slock, flags);
	if (break_state == -1)
		outb(inb(info->ioaddr + UART_LCR) | UART_LCR_SBC,
			info->ioaddr + UART_LCR);
	else
		outb(inb(info->ioaddr + UART_LCR) & ~UART_LCR_SBC,
			info->ioaddr + UART_LCR);
	spin_unlock_irqrestore(&info->slock, flags);
A
Alan Cox 已提交
2058
	return 0;
J
Jiri Slaby 已提交
2059
}
L
Linus Torvalds 已提交
2060

A
Alan Cox 已提交
2061 2062
static void mxser_receive_chars(struct tty_struct *tty,
				struct mxser_port *port, int *status)
J
Jiri Slaby 已提交
2063 2064 2065 2066 2067 2068
{
	unsigned char ch, gdl;
	int ignored = 0;
	int cnt = 0;
	int recv_room;
	int max = 256;
L
Linus Torvalds 已提交
2069

J
Jiri Slaby 已提交
2070
	recv_room = tty->receive_room;
A
Alan Cox 已提交
2071
	if (recv_room == 0 && !port->ldisc_stop_rx)
J
Jiri Slaby 已提交
2072 2073
		mxser_stoprx(tty);
	if (port->board->chip_flag != MOXA_OTHER_UART) {
L
Linus Torvalds 已提交
2074

J
Jiri Slaby 已提交
2075 2076 2077 2078 2079 2080 2081
		if (*status & UART_LSR_SPECIAL)
			goto intr_old;
		if (port->board->chip_flag == MOXA_MUST_MU860_HWID &&
				(*status & MOXA_MUST_LSR_RERR))
			goto intr_old;
		if (*status & MOXA_MUST_LSR_RERR)
			goto intr_old;
L
Linus Torvalds 已提交
2082

J
Jiri Slaby 已提交
2083 2084 2085 2086 2087 2088 2089 2090 2091 2092
		gdl = inb(port->ioaddr + MOXA_MUST_GDL_REGISTER);

		if (port->board->chip_flag == MOXA_MUST_MU150_HWID)
			gdl &= MOXA_MUST_GDL_MASK;
		if (gdl >= recv_room) {
			if (!port->ldisc_stop_rx)
				mxser_stoprx(tty);
		}
		while (gdl--) {
			ch = inb(port->ioaddr + UART_RX);
J
Jiri Slaby 已提交
2093
			tty_insert_flip_char(&port->port, ch, 0);
J
Jiri Slaby 已提交
2094 2095 2096
			cnt++;
		}
		goto end_intr;
L
Linus Torvalds 已提交
2097
	}
J
Jiri Slaby 已提交
2098 2099 2100 2101 2102
intr_old:

	do {
		if (max-- < 0)
			break;
L
Linus Torvalds 已提交
2103

J
Jiri Slaby 已提交
2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116
		ch = inb(port->ioaddr + UART_RX);
		if (port->board->chip_flag && (*status & UART_LSR_OE))
			outb(0x23, port->ioaddr + UART_FCR);
		*status &= port->read_status_mask;
		if (*status & port->ignore_status_mask) {
			if (++ignored > 100)
				break;
		} else {
			char flag = 0;
			if (*status & UART_LSR_SPECIAL) {
				if (*status & UART_LSR_BI) {
					flag = TTY_BREAK;
					port->icount.brk++;
L
Linus Torvalds 已提交
2117

A
Alan Cox 已提交
2118
					if (port->port.flags & ASYNC_SAK)
J
Jiri Slaby 已提交
2119 2120 2121 2122 2123 2124 2125 2126 2127 2128 2129 2130 2131
						do_SAK(tty);
				} else if (*status & UART_LSR_PE) {
					flag = TTY_PARITY;
					port->icount.parity++;
				} else if (*status & UART_LSR_FE) {
					flag = TTY_FRAME;
					port->icount.frame++;
				} else if (*status & UART_LSR_OE) {
					flag = TTY_OVERRUN;
					port->icount.overrun++;
				} else
					flag = TTY_BREAK;
			}
J
Jiri Slaby 已提交
2132
			tty_insert_flip_char(&port->port, ch, flag);
J
Jiri Slaby 已提交
2133 2134 2135 2136 2137 2138
			cnt++;
			if (cnt >= recv_room) {
				if (!port->ldisc_stop_rx)
					mxser_stoprx(tty);
				break;
			}
L
Linus Torvalds 已提交
2139

J
Jiri Slaby 已提交
2140
		}
L
Linus Torvalds 已提交
2141

J
Jiri Slaby 已提交
2142 2143
		if (port->board->chip_flag)
			break;
L
Linus Torvalds 已提交
2144

J
Jiri Slaby 已提交
2145 2146
		*status = inb(port->ioaddr + UART_LSR);
	} while (*status & UART_LSR_DR);
L
Linus Torvalds 已提交
2147

J
Jiri Slaby 已提交
2148
end_intr:
A
Alan Cox 已提交
2149
	mxvar_log.rxcnt[tty->index] += cnt;
J
Jiri Slaby 已提交
2150 2151
	port->mon_data.rxcnt += cnt;
	port->mon_data.up_rxcnt += cnt;
L
Linus Torvalds 已提交
2152

J
Jiri Slaby 已提交
2153 2154 2155 2156 2157 2158
	/*
	 * We are called from an interrupt context with &port->slock
	 * being held. Drop it temporarily in order to prevent
	 * recursive locking.
	 */
	spin_unlock(&port->slock);
J
Jiri Slaby 已提交
2159
	tty_flip_buffer_push(&port->port);
J
Jiri Slaby 已提交
2160
	spin_lock(&port->slock);
L
Linus Torvalds 已提交
2161 2162
}

A
Alan Cox 已提交
2163
static void mxser_transmit_chars(struct tty_struct *tty, struct mxser_port *port)
L
Linus Torvalds 已提交
2164
{
J
Jiri Slaby 已提交
2165
	int count, cnt;
L
Linus Torvalds 已提交
2166

J
Jiri Slaby 已提交
2167 2168 2169
	if (port->x_char) {
		outb(port->x_char, port->ioaddr + UART_TX);
		port->x_char = 0;
A
Alan Cox 已提交
2170
		mxvar_log.txcnt[tty->index]++;
J
Jiri Slaby 已提交
2171 2172 2173 2174 2175
		port->mon_data.txcnt++;
		port->mon_data.up_txcnt++;
		port->icount.tx++;
		return;
	}
L
Linus Torvalds 已提交
2176

A
Alan Cox 已提交
2177
	if (port->port.xmit_buf == NULL)
J
Jiri Slaby 已提交
2178
		return;
L
Linus Torvalds 已提交
2179

A
Alan Cox 已提交
2180 2181
	if (port->xmit_cnt <= 0 || tty->stopped ||
			(tty->hw_stopped &&
J
Jiri Slaby 已提交
2182 2183 2184 2185 2186
			(port->type != PORT_16550A) &&
			(!port->board->chip_flag))) {
		port->IER &= ~UART_IER_THRI;
		outb(port->IER, port->ioaddr + UART_IER);
		return;
L
Linus Torvalds 已提交
2187 2188
	}

J
Jiri Slaby 已提交
2189 2190 2191
	cnt = port->xmit_cnt;
	count = port->xmit_fifo_size;
	do {
A
Alan Cox 已提交
2192
		outb(port->port.xmit_buf[port->xmit_tail++],
J
Jiri Slaby 已提交
2193 2194 2195 2196 2197
			port->ioaddr + UART_TX);
		port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE - 1);
		if (--port->xmit_cnt <= 0)
			break;
	} while (--count > 0);
A
Alan Cox 已提交
2198
	mxvar_log.txcnt[tty->index] += (cnt - port->xmit_cnt);
L
Linus Torvalds 已提交
2199

J
Jiri Slaby 已提交
2200 2201 2202
	port->mon_data.txcnt += (cnt - port->xmit_cnt);
	port->mon_data.up_txcnt += (cnt - port->xmit_cnt);
	port->icount.tx += (cnt - port->xmit_cnt);
L
Linus Torvalds 已提交
2203

2204
	if (port->xmit_cnt < WAKEUP_CHARS)
A
Alan Cox 已提交
2205
		tty_wakeup(tty);
J
Jiri Slaby 已提交
2206 2207 2208 2209

	if (port->xmit_cnt <= 0) {
		port->IER &= ~UART_IER_THRI;
		outb(port->IER, port->ioaddr + UART_IER);
L
Linus Torvalds 已提交
2210 2211 2212 2213
	}
}

/*
J
Jiri Slaby 已提交
2214
 * This is the serial driver's generic interrupt routine
L
Linus Torvalds 已提交
2215
 */
J
Jiri Slaby 已提交
2216
static irqreturn_t mxser_interrupt(int irq, void *dev_id)
L
Linus Torvalds 已提交
2217
{
J
Jiri Slaby 已提交
2218 2219 2220 2221 2222 2223
	int status, iir, i;
	struct mxser_board *brd = NULL;
	struct mxser_port *port;
	int max, irqbits, bits, msr;
	unsigned int int_cnt, pass_counter = 0;
	int handled = IRQ_NONE;
A
Alan Cox 已提交
2224
	struct tty_struct *tty;
L
Linus Torvalds 已提交
2225

J
Jiri Slaby 已提交
2226 2227 2228 2229 2230
	for (i = 0; i < MXSER_BOARDS; i++)
		if (dev_id == &mxser_boards[i]) {
			brd = dev_id;
			break;
		}
L
Linus Torvalds 已提交
2231

J
Jiri Slaby 已提交
2232 2233 2234 2235 2236 2237 2238 2239 2240
	if (i == MXSER_BOARDS)
		goto irq_stop;
	if (brd == NULL)
		goto irq_stop;
	max = brd->info->nports;
	while (pass_counter++ < MXSER_ISR_PASS_LIMIT) {
		irqbits = inb(brd->vector) & brd->vector_mask;
		if (irqbits == brd->vector_mask)
			break;
L
Linus Torvalds 已提交
2241

J
Jiri Slaby 已提交
2242 2243 2244 2245 2246 2247 2248 2249 2250 2251 2252 2253 2254 2255 2256
		handled = IRQ_HANDLED;
		for (i = 0, bits = 1; i < max; i++, irqbits |= bits, bits <<= 1) {
			if (irqbits == brd->vector_mask)
				break;
			if (bits & irqbits)
				continue;
			port = &brd->ports[i];

			int_cnt = 0;
			spin_lock(&port->slock);
			do {
				iir = inb(port->ioaddr + UART_IIR);
				if (iir & UART_IIR_NO_INT)
					break;
				iir &= MOXA_MUST_IIR_MASK;
A
Alan Cox 已提交
2257 2258
				tty = tty_port_tty_get(&port->port);
				if (!tty ||
A
Alan Cox 已提交
2259 2260
						(port->port.flags & ASYNC_CLOSING) ||
						!(port->port.flags &
J
Jiri Slaby 已提交
2261 2262 2263 2264
							ASYNC_INITIALIZED)) {
					status = inb(port->ioaddr + UART_LSR);
					outb(0x27, port->ioaddr + UART_FCR);
					inb(port->ioaddr + UART_MSR);
A
Alan Cox 已提交
2265
					tty_kref_put(tty);
J
Jiri Slaby 已提交
2266 2267
					break;
				}
L
Linus Torvalds 已提交
2268

J
Jiri Slaby 已提交
2269 2270 2271 2272 2273 2274 2275 2276 2277 2278 2279 2280 2281 2282 2283 2284 2285
				status = inb(port->ioaddr + UART_LSR);

				if (status & UART_LSR_PE)
					port->err_shadow |= NPPI_NOTIFY_PARITY;
				if (status & UART_LSR_FE)
					port->err_shadow |= NPPI_NOTIFY_FRAMING;
				if (status & UART_LSR_OE)
					port->err_shadow |=
						NPPI_NOTIFY_HW_OVERRUN;
				if (status & UART_LSR_BI)
					port->err_shadow |= NPPI_NOTIFY_BREAK;

				if (port->board->chip_flag) {
					if (iir == MOXA_MUST_IIR_GDA ||
					    iir == MOXA_MUST_IIR_RDA ||
					    iir == MOXA_MUST_IIR_RTO ||
					    iir == MOXA_MUST_IIR_LSR)
A
Alan Cox 已提交
2286
						mxser_receive_chars(tty, port,
J
Jiri Slaby 已提交
2287 2288 2289 2290 2291
								&status);

				} else {
					status &= port->read_status_mask;
					if (status & UART_LSR_DR)
A
Alan Cox 已提交
2292
						mxser_receive_chars(tty, port,
J
Jiri Slaby 已提交
2293 2294 2295 2296
								&status);
				}
				msr = inb(port->ioaddr + UART_MSR);
				if (msr & UART_MSR_ANY_DELTA)
A
Alan Cox 已提交
2297
					mxser_check_modem_status(tty, port, msr);
J
Jiri Slaby 已提交
2298 2299 2300 2301

				if (port->board->chip_flag) {
					if (iir == 0x02 && (status &
								UART_LSR_THRE))
A
Alan Cox 已提交
2302
						mxser_transmit_chars(tty, port);
J
Jiri Slaby 已提交
2303 2304
				} else {
					if (status & UART_LSR_THRE)
A
Alan Cox 已提交
2305
						mxser_transmit_chars(tty, port);
J
Jiri Slaby 已提交
2306
				}
A
Alan Cox 已提交
2307
				tty_kref_put(tty);
J
Jiri Slaby 已提交
2308 2309 2310 2311
			} while (int_cnt++ < MXSER_ISR_PASS_LIMIT);
			spin_unlock(&port->slock);
		}
	}
L
Linus Torvalds 已提交
2312

J
Jiri Slaby 已提交
2313 2314 2315
irq_stop:
	return handled;
}
L
Linus Torvalds 已提交
2316

J
Jiri Slaby 已提交
2317 2318 2319 2320 2321 2322 2323 2324 2325 2326 2327 2328 2329 2330 2331 2332 2333 2334 2335 2336
static const struct tty_operations mxser_ops = {
	.open = mxser_open,
	.close = mxser_close,
	.write = mxser_write,
	.put_char = mxser_put_char,
	.flush_chars = mxser_flush_chars,
	.write_room = mxser_write_room,
	.chars_in_buffer = mxser_chars_in_buffer,
	.flush_buffer = mxser_flush_buffer,
	.ioctl = mxser_ioctl,
	.throttle = mxser_throttle,
	.unthrottle = mxser_unthrottle,
	.set_termios = mxser_set_termios,
	.stop = mxser_stop,
	.start = mxser_start,
	.hangup = mxser_hangup,
	.break_ctl = mxser_rs_break,
	.wait_until_sent = mxser_wait_until_sent,
	.tiocmget = mxser_tiocmget,
	.tiocmset = mxser_tiocmset,
2337
	.get_icount = mxser_get_icount,
J
Jiri Slaby 已提交
2338
};
L
Linus Torvalds 已提交
2339

2340
static struct tty_port_operations mxser_port_ops = {
2341
	.carrier_raised = mxser_carrier_raised,
2342
	.dtr_rts = mxser_dtr_rts,
2343 2344
	.activate = mxser_activate,
	.shutdown = mxser_shutdown_port,
2345 2346
};

J
Jiri Slaby 已提交
2347 2348 2349
/*
 * The MOXA Smartio/Industio serial driver boot-time initialization code!
 */
L
Linus Torvalds 已提交
2350

J
Jiri Slaby 已提交
2351
static bool allow_overlapping_vector;
2352
module_param(allow_overlapping_vector, bool, S_IRUGO);
J
Jiri Slaby 已提交
2353 2354 2355 2356 2357 2358 2359 2360 2361 2362 2363 2364 2365 2366 2367 2368 2369 2370 2371 2372 2373 2374 2375
MODULE_PARM_DESC(allow_overlapping_vector, "whether we allow ISA cards to be configured such that vector overlabs IO ports (default=no)");

static bool mxser_overlapping_vector(struct mxser_board *brd)
{
	return allow_overlapping_vector &&
		brd->vector >= brd->ports[0].ioaddr &&
		brd->vector < brd->ports[0].ioaddr + 8 * brd->info->nports;
}

static int mxser_request_vector(struct mxser_board *brd)
{
	if (mxser_overlapping_vector(brd))
		return 0;
	return request_region(brd->vector, 1, "mxser(vector)") ? 0 : -EIO;
}

static void mxser_release_vector(struct mxser_board *brd)
{
	if (mxser_overlapping_vector(brd))
		return;
	release_region(brd->vector, 1);
}

2376
static void mxser_release_ISA_res(struct mxser_board *brd)
J
Jiri Slaby 已提交
2377
{
2378
	release_region(brd->ports[0].ioaddr, 8 * brd->info->nports);
J
Jiri Slaby 已提交
2379
	mxser_release_vector(brd);
L
Linus Torvalds 已提交
2380 2381
}

B
Bill Pemberton 已提交
2382
static int mxser_initbrd(struct mxser_board *brd,
J
Jiri Slaby 已提交
2383
		struct pci_dev *pdev)
L
Linus Torvalds 已提交
2384
{
J
Jiri Slaby 已提交
2385 2386 2387
	struct mxser_port *info;
	unsigned int i;
	int retval;
L
Linus Torvalds 已提交
2388

J
Jiri Slaby 已提交
2389 2390
	printk(KERN_INFO "mxser: max. baud rate = %d bps\n",
			brd->ports[0].max_baud);
L
Linus Torvalds 已提交
2391

J
Jiri Slaby 已提交
2392 2393
	for (i = 0; i < brd->info->nports; i++) {
		info = &brd->ports[i];
A
Alan Cox 已提交
2394
		tty_port_init(&info->port);
2395
		info->port.ops = &mxser_port_ops;
J
Jiri Slaby 已提交
2396 2397 2398
		info->board = brd;
		info->stop_rx = 0;
		info->ldisc_stop_rx = 0;
L
Linus Torvalds 已提交
2399

J
Jiri Slaby 已提交
2400 2401
		/* Enhance mode enabled here */
		if (brd->chip_flag != MOXA_OTHER_UART)
2402
			mxser_enable_must_enchance_mode(info->ioaddr);
L
Linus Torvalds 已提交
2403

A
Alan Cox 已提交
2404
		info->port.flags = ASYNC_SHARE_IRQ;
J
Jiri Slaby 已提交
2405
		info->type = brd->uart_type;
L
Linus Torvalds 已提交
2406

J
Jiri Slaby 已提交
2407
		process_txrx_fifo(info);
L
Linus Torvalds 已提交
2408

J
Jiri Slaby 已提交
2409
		info->custom_divisor = info->baud_base * 16;
A
Alan Cox 已提交
2410 2411
		info->port.close_delay = 5 * HZ / 10;
		info->port.closing_wait = 30 * HZ;
J
Jiri Slaby 已提交
2412 2413 2414 2415
		info->normal_termios = mxvar_sdriver->init_termios;
		memset(&info->mon_data, 0, sizeof(struct mxser_mon));
		info->err_shadow = 0;
		spin_lock_init(&info->slock);
L
Linus Torvalds 已提交
2416

J
Jiri Slaby 已提交
2417 2418 2419 2420
		/* before set INT ISR, disable all int */
		outb(inb(info->ioaddr + UART_IER) & 0xf0,
			info->ioaddr + UART_IER);
	}
L
Linus Torvalds 已提交
2421

J
Jiri Slaby 已提交
2422 2423
	retval = request_irq(brd->irq, mxser_interrupt, IRQF_SHARED, "mxser",
			brd);
2424 2425 2426
	if (retval) {
		for (i = 0; i < brd->info->nports; i++)
			tty_port_destroy(&brd->ports[i].port);
J
Jiri Slaby 已提交
2427 2428 2429
		printk(KERN_ERR "Board %s: Request irq failed, IRQ (%d) may "
			"conflict with another device.\n",
			brd->info->name, brd->irq);
2430
	}
2431

J
Jiri Slaby 已提交
2432 2433
	return retval;
}
L
Linus Torvalds 已提交
2434

2435 2436 2437 2438 2439 2440 2441 2442
static void mxser_board_remove(struct mxser_board *brd)
{
	unsigned int i;

	for (i = 0; i < brd->info->nports; i++) {
		tty_unregister_device(mxvar_sdriver, brd->idx + i);
		tty_port_destroy(&brd->ports[i].port);
	}
2443
	free_irq(brd->irq, brd);
2444 2445
}

J
Jiri Slaby 已提交
2446
static int __init mxser_get_ISA_conf(int cap, struct mxser_board *brd)
L
Linus Torvalds 已提交
2447
{
J
Jiri Slaby 已提交
2448
	int id, i, bits, ret;
L
Linus Torvalds 已提交
2449 2450 2451
	unsigned short regs[16], irq;
	unsigned char scratch, scratch2;

J
Jiri Slaby 已提交
2452
	brd->chip_flag = MOXA_OTHER_UART;
L
Linus Torvalds 已提交
2453 2454

	id = mxser_read_register(cap, regs);
J
Jiri Slaby 已提交
2455 2456 2457 2458 2459 2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474
	switch (id) {
	case C168_ASIC_ID:
		brd->info = &mxser_cards[0];
		break;
	case C104_ASIC_ID:
		brd->info = &mxser_cards[1];
		break;
	case CI104J_ASIC_ID:
		brd->info = &mxser_cards[2];
		break;
	case C102_ASIC_ID:
		brd->info = &mxser_cards[5];
		break;
	case CI132_ASIC_ID:
		brd->info = &mxser_cards[6];
		break;
	case CI134_ASIC_ID:
		brd->info = &mxser_cards[7];
		break;
	default:
2475
		return 0;
J
Jiri Slaby 已提交
2476
	}
L
Linus Torvalds 已提交
2477 2478

	irq = 0;
J
Jiri Slaby 已提交
2479 2480 2481
	/* some ISA cards have 2 ports, but we want to see them as 4-port (why?)
	   Flag-hack checks if configuration should be read as 2-port here. */
	if (brd->info->nports == 2 || (brd->info->flags & MXSER_HAS2)) {
L
Linus Torvalds 已提交
2482 2483 2484
		irq = regs[9] & 0xF000;
		irq = irq | (irq >> 4);
		if (irq != (regs[9] & 0xFF00))
J
Jiri Slaby 已提交
2485
			goto err_irqconflict;
J
Jiri Slaby 已提交
2486
	} else if (brd->info->nports == 4) {
L
Linus Torvalds 已提交
2487 2488 2489 2490
		irq = regs[9] & 0xF000;
		irq = irq | (irq >> 4);
		irq = irq | (irq >> 8);
		if (irq != regs[9])
J
Jiri Slaby 已提交
2491
			goto err_irqconflict;
J
Jiri Slaby 已提交
2492
	} else if (brd->info->nports == 8) {
L
Linus Torvalds 已提交
2493 2494 2495 2496
		irq = regs[9] & 0xF000;
		irq = irq | (irq >> 4);
		irq = irq | (irq >> 8);
		if ((irq != regs[9]) || (irq != regs[10]))
J
Jiri Slaby 已提交
2497
			goto err_irqconflict;
L
Linus Torvalds 已提交
2498 2499
	}

J
Jiri Slaby 已提交
2500 2501 2502 2503
	if (!irq) {
		printk(KERN_ERR "mxser: interrupt number unset\n");
		return -EIO;
	}
J
Jiri Slaby 已提交
2504
	brd->irq = ((int)(irq & 0xF000) >> 12);
L
Linus Torvalds 已提交
2505
	for (i = 0; i < 8; i++)
J
Jiri Slaby 已提交
2506
		brd->ports[i].ioaddr = (int) regs[i + 1] & 0xFFF8;
J
Jiri Slaby 已提交
2507 2508 2509 2510
	if ((regs[12] & 0x80) == 0) {
		printk(KERN_ERR "mxser: invalid interrupt vector\n");
		return -EIO;
	}
J
Jiri Slaby 已提交
2511
	brd->vector = (int)regs[11];	/* interrupt vector */
L
Linus Torvalds 已提交
2512
	if (id == 1)
J
Jiri Slaby 已提交
2513
		brd->vector_mask = 0x00FF;
L
Linus Torvalds 已提交
2514
	else
J
Jiri Slaby 已提交
2515
		brd->vector_mask = 0x000F;
L
Linus Torvalds 已提交
2516 2517
	for (i = 7, bits = 0x0100; i >= 0; i--, bits <<= 1) {
		if (regs[12] & bits) {
J
Jiri Slaby 已提交
2518 2519
			brd->ports[i].baud_base = 921600;
			brd->ports[i].max_baud = 921600;
L
Linus Torvalds 已提交
2520
		} else {
J
Jiri Slaby 已提交
2521 2522
			brd->ports[i].baud_base = 115200;
			brd->ports[i].max_baud = 115200;
L
Linus Torvalds 已提交
2523 2524 2525 2526 2527 2528 2529 2530 2531 2532
		}
	}
	scratch2 = inb(cap + UART_LCR) & (~UART_LCR_DLAB);
	outb(scratch2 | UART_LCR_DLAB, cap + UART_LCR);
	outb(0, cap + UART_EFR);	/* EFR is the same as FCR */
	outb(scratch2, cap + UART_LCR);
	outb(UART_FCR_ENABLE_FIFO, cap + UART_FCR);
	scratch = inb(cap + UART_IIR);

	if (scratch & 0xC0)
J
Jiri Slaby 已提交
2533
		brd->uart_type = PORT_16550A;
L
Linus Torvalds 已提交
2534
	else
J
Jiri Slaby 已提交
2535 2536
		brd->uart_type = PORT_16450;
	if (!request_region(brd->ports[0].ioaddr, 8 * brd->info->nports,
J
Jiri Slaby 已提交
2537 2538 2539 2540 2541 2542 2543
			"mxser(IO)")) {
		printk(KERN_ERR "mxser: can't request ports I/O region: "
				"0x%.8lx-0x%.8lx\n",
				brd->ports[0].ioaddr, brd->ports[0].ioaddr +
				8 * brd->info->nports - 1);
		return -EIO;
	}
J
Jiri Slaby 已提交
2544 2545 2546

	ret = mxser_request_vector(brd);
	if (ret) {
J
Jiri Slaby 已提交
2547
		release_region(brd->ports[0].ioaddr, 8 * brd->info->nports);
J
Jiri Slaby 已提交
2548 2549 2550 2551
		printk(KERN_ERR "mxser: can't request interrupt vector region: "
				"0x%.8lx-0x%.8lx\n",
				brd->ports[0].ioaddr, brd->ports[0].ioaddr +
				8 * brd->info->nports - 1);
J
Jiri Slaby 已提交
2552
		return ret;
J
Jiri Slaby 已提交
2553 2554
	}
	return brd->info->nports;
J
Jiri Slaby 已提交
2555 2556 2557 2558

err_irqconflict:
	printk(KERN_ERR "mxser: invalid interrupt number\n");
	return -EIO;
L
Linus Torvalds 已提交
2559 2560
}

B
Bill Pemberton 已提交
2561
static int mxser_probe(struct pci_dev *pdev,
J
Jiri Slaby 已提交
2562
		const struct pci_device_id *ent)
L
Linus Torvalds 已提交
2563
{
J
Jiri Slaby 已提交
2564 2565 2566 2567
#ifdef CONFIG_PCI
	struct mxser_board *brd;
	unsigned int i, j;
	unsigned long ioaddress;
2568
	struct device *tty_dev;
J
Jiri Slaby 已提交
2569
	int retval = -EINVAL;
L
Linus Torvalds 已提交
2570

J
Jiri Slaby 已提交
2571 2572 2573 2574 2575
	for (i = 0; i < MXSER_BOARDS; i++)
		if (mxser_boards[i].info == NULL)
			break;

	if (i >= MXSER_BOARDS) {
J
Jiri Slaby 已提交
2576 2577
		dev_err(&pdev->dev, "too many boards found (maximum %d), board "
				"not configured\n", MXSER_BOARDS);
J
Jiri Slaby 已提交
2578 2579 2580 2581 2582
		goto err;
	}

	brd = &mxser_boards[i];
	brd->idx = i * MXSER_PORTS_PER_BOARD;
J
Jiri Slaby 已提交
2583
	dev_info(&pdev->dev, "found MOXA %s board (BusNo=%d, DevNo=%d)\n",
J
Jiri Slaby 已提交
2584 2585 2586 2587 2588
		mxser_cards[ent->driver_data].name,
		pdev->bus->number, PCI_SLOT(pdev->devfn));

	retval = pci_enable_device(pdev);
	if (retval) {
J
Jiri Slaby 已提交
2589
		dev_err(&pdev->dev, "PCI enable failed\n");
J
Jiri Slaby 已提交
2590 2591 2592 2593 2594 2595 2596
		goto err;
	}

	/* io address */
	ioaddress = pci_resource_start(pdev, 2);
	retval = pci_request_region(pdev, 2, "mxser(IO)");
	if (retval)
2597
		goto err_dis;
J
Jiri Slaby 已提交
2598 2599 2600 2601 2602 2603 2604 2605 2606

	brd->info = &mxser_cards[ent->driver_data];
	for (i = 0; i < brd->info->nports; i++)
		brd->ports[i].ioaddr = ioaddress + 8 * i;

	/* vector */
	ioaddress = pci_resource_start(pdev, 3);
	retval = pci_request_region(pdev, 3, "mxser(vector)");
	if (retval)
2607
		goto err_zero;
J
Jiri Slaby 已提交
2608 2609 2610 2611 2612 2613 2614 2615 2616 2617 2618 2619 2620 2621 2622 2623 2624 2625 2626
	brd->vector = ioaddress;

	/* irq */
	brd->irq = pdev->irq;

	brd->chip_flag = CheckIsMoxaMust(brd->ports[0].ioaddr);
	brd->uart_type = PORT_16550A;
	brd->vector_mask = 0;

	for (i = 0; i < brd->info->nports; i++) {
		for (j = 0; j < UART_INFO_NUM; j++) {
			if (Gpci_uart_info[j].type == brd->chip_flag) {
				brd->ports[i].max_baud =
					Gpci_uart_info[j].max_baud;

				/* exception....CP-102 */
				if (brd->info->flags & MXSER_HIGHBAUD)
					brd->ports[i].max_baud = 921600;
				break;
L
Linus Torvalds 已提交
2627 2628
			}
		}
J
Jiri Slaby 已提交
2629 2630 2631 2632 2633 2634 2635 2636
	}

	if (brd->chip_flag == MOXA_MUST_MU860_HWID) {
		for (i = 0; i < brd->info->nports; i++) {
			if (i < 4)
				brd->ports[i].opmode_ioaddr = ioaddress + 4;
			else
				brd->ports[i].opmode_ioaddr = ioaddress + 0x0c;
L
Linus Torvalds 已提交
2637
		}
J
Jiri Slaby 已提交
2638 2639
		outb(0, ioaddress + 4);	/* default set to RS232 mode */
		outb(0, ioaddress + 0x0c);	/* default set to RS232 mode */
L
Linus Torvalds 已提交
2640
	}
J
Jiri Slaby 已提交
2641 2642 2643 2644 2645 2646 2647 2648 2649

	for (i = 0; i < brd->info->nports; i++) {
		brd->vector_mask |= (1 << i);
		brd->ports[i].baud_base = 921600;
	}

	/* mxser_initbrd will hook ISR. */
	retval = mxser_initbrd(brd, pdev);
	if (retval)
2650
		goto err_rel3;
J
Jiri Slaby 已提交
2651

2652 2653 2654 2655 2656
	for (i = 0; i < brd->info->nports; i++) {
		tty_dev = tty_port_register_device(&brd->ports[i].port,
				mxvar_sdriver, brd->idx + i, &pdev->dev);
		if (IS_ERR(tty_dev)) {
			retval = PTR_ERR(tty_dev);
2657
			for (; i > 0; i--)
2658
				tty_unregister_device(mxvar_sdriver,
2659
					brd->idx + i - 1);
2660 2661 2662
			goto err_relbrd;
		}
	}
J
Jiri Slaby 已提交
2663 2664 2665 2666

	pci_set_drvdata(pdev, brd);

	return 0;
2667 2668 2669 2670
err_relbrd:
	for (i = 0; i < brd->info->nports; i++)
		tty_port_destroy(&brd->ports[i].port);
	free_irq(brd->irq, brd);
2671 2672 2673
err_rel3:
	pci_release_region(pdev, 3);
err_zero:
J
Jiri Slaby 已提交
2674
	brd->info = NULL;
2675 2676 2677
	pci_release_region(pdev, 2);
err_dis:
	pci_disable_device(pdev);
J
Jiri Slaby 已提交
2678 2679 2680 2681 2682
err:
	return retval;
#else
	return -ENODEV;
#endif
L
Linus Torvalds 已提交
2683 2684
}

B
Bill Pemberton 已提交
2685
static void mxser_remove(struct pci_dev *pdev)
L
Linus Torvalds 已提交
2686
{
2687
#ifdef CONFIG_PCI
J
Jiri Slaby 已提交
2688
	struct mxser_board *brd = pci_get_drvdata(pdev);
L
Linus Torvalds 已提交
2689

2690
	mxser_board_remove(brd);
L
Linus Torvalds 已提交
2691

2692 2693 2694
	pci_release_region(pdev, 2);
	pci_release_region(pdev, 3);
	pci_disable_device(pdev);
J
Jiri Slaby 已提交
2695
	brd->info = NULL;
2696
#endif
L
Linus Torvalds 已提交
2697 2698
}

J
Jiri Slaby 已提交
2699 2700 2701 2702
static struct pci_driver mxser_driver = {
	.name = "mxser",
	.id_table = mxser_pcibrds,
	.probe = mxser_probe,
B
Bill Pemberton 已提交
2703
	.remove = mxser_remove
J
Jiri Slaby 已提交
2704 2705 2706
};

static int __init mxser_module_init(void)
L
Linus Torvalds 已提交
2707
{
J
Jiri Slaby 已提交
2708
	struct mxser_board *brd;
2709
	struct device *tty_dev;
2710 2711
	unsigned int b, i, m;
	int retval;
L
Linus Torvalds 已提交
2712

J
Jiri Slaby 已提交
2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733 2734 2735
	mxvar_sdriver = alloc_tty_driver(MXSER_PORTS + 1);
	if (!mxvar_sdriver)
		return -ENOMEM;

	printk(KERN_INFO "MOXA Smartio/Industio family driver version %s\n",
		MXSER_VERSION);

	/* Initialize the tty_driver structure */
	mxvar_sdriver->name = "ttyMI";
	mxvar_sdriver->major = ttymajor;
	mxvar_sdriver->minor_start = 0;
	mxvar_sdriver->type = TTY_DRIVER_TYPE_SERIAL;
	mxvar_sdriver->subtype = SERIAL_TYPE_NORMAL;
	mxvar_sdriver->init_termios = tty_std_termios;
	mxvar_sdriver->init_termios.c_cflag = B9600|CS8|CREAD|HUPCL|CLOCAL;
	mxvar_sdriver->flags = TTY_DRIVER_REAL_RAW|TTY_DRIVER_DYNAMIC_DEV;
	tty_set_operations(mxvar_sdriver, &mxser_ops);

	retval = tty_register_driver(mxvar_sdriver);
	if (retval) {
		printk(KERN_ERR "Couldn't install MOXA Smartio/Industio family "
				"tty driver !\n");
		goto err_put;
L
Linus Torvalds 已提交
2736
	}
J
Jiri Slaby 已提交
2737 2738

	/* Start finding ISA boards here */
2739 2740 2741 2742 2743
	for (m = 0, b = 0; b < MXSER_BOARDS; b++) {
		if (!ioaddr[b])
			continue;

		brd = &mxser_boards[m];
P
Peter Botha 已提交
2744
		retval = mxser_get_ISA_conf(ioaddr[b], brd);
2745 2746 2747 2748
		if (retval <= 0) {
			brd->info = NULL;
			continue;
		}
J
Jiri Slaby 已提交
2749

2750 2751
		printk(KERN_INFO "mxser: found MOXA %s board (CAP=0x%lx)\n",
				brd->info->name, ioaddr[b]);
J
Jiri Slaby 已提交
2752

2753 2754
		/* mxser_initbrd will hook ISR. */
		if (mxser_initbrd(brd, NULL) < 0) {
2755
			mxser_release_ISA_res(brd);
2756 2757 2758
			brd->info = NULL;
			continue;
		}
J
Jiri Slaby 已提交
2759

2760
		brd->idx = m * MXSER_PORTS_PER_BOARD;
2761 2762
		for (i = 0; i < brd->info->nports; i++) {
			tty_dev = tty_port_register_device(&brd->ports[i].port,
J
Jiri Slaby 已提交
2763
					mxvar_sdriver, brd->idx + i, NULL);
2764
			if (IS_ERR(tty_dev)) {
2765
				for (; i > 0; i--)
2766
					tty_unregister_device(mxvar_sdriver,
2767
						brd->idx + i - 1);
2768 2769 2770 2771 2772 2773 2774 2775 2776 2777
				for (i = 0; i < brd->info->nports; i++)
					tty_port_destroy(&brd->ports[i].port);
				free_irq(brd->irq, brd);
				mxser_release_ISA_res(brd);
				brd->info = NULL;
				break;
			}
		}
		if (brd->info == NULL)
			continue;
J
Jiri Slaby 已提交
2778

2779 2780
		m++;
	}
J
Jiri Slaby 已提交
2781 2782 2783

	retval = pci_register_driver(&mxser_driver);
	if (retval) {
J
Jiri Slaby 已提交
2784
		printk(KERN_ERR "mxser: can't register pci driver\n");
J
Jiri Slaby 已提交
2785 2786 2787 2788 2789 2790 2791 2792 2793 2794 2795 2796 2797 2798 2799 2800
		if (!m) {
			retval = -ENODEV;
			goto err_unr;
		} /* else: we have some ISA cards under control */
	}

	return 0;
err_unr:
	tty_unregister_driver(mxvar_sdriver);
err_put:
	put_tty_driver(mxvar_sdriver);
	return retval;
}

static void __exit mxser_module_exit(void)
{
2801
	unsigned int i;
J
Jiri Slaby 已提交
2802 2803 2804 2805 2806

	pci_unregister_driver(&mxser_driver);

	for (i = 0; i < MXSER_BOARDS; i++) /* ISA remains */
		if (mxser_boards[i].info != NULL)
2807
			mxser_board_remove(&mxser_boards[i]);
J
Jiri Slaby 已提交
2808 2809 2810 2811 2812
	tty_unregister_driver(mxvar_sdriver);
	put_tty_driver(mxvar_sdriver);

	for (i = 0; i < MXSER_BOARDS; i++)
		if (mxser_boards[i].info != NULL)
2813
			mxser_release_ISA_res(&mxser_boards[i]);
L
Linus Torvalds 已提交
2814 2815 2816 2817
}

module_init(mxser_module_init);
module_exit(mxser_module_exit);