mxser.c 68.8 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
 *	- Fixed x86_64 cleanness
 */

#include <linux/module.h>
#include <linux/errno.h>
#include <linux/signal.h>
#include <linux/sched.h>
A
Alexey Dobriyan 已提交
26
#include <linux/smp_lock.h>
L
Linus Torvalds 已提交
27 28 29 30 31 32 33 34 35 36 37 38 39 40 41
#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/gfp.h>
#include <linux/ioport.h>
#include <linux/mm.h>
#include <linux/delay.h>
#include <linux/pci.h>
J
Jiri Slaby 已提交
42
#include <linux/bitops.h>
L
Linus Torvalds 已提交
43 44 45 46 47 48 49 50

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

#include "mxser.h"

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

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

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

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

#define UART_MCR_AFE		0x20
#define UART_LSR_SPECIAL	0x1E

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


#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 已提交
86 87
#define MXSER_HIGHBAUD	1
#define MXSER_HAS2	2
L
Linus Torvalds 已提交
88

89
/* This is only for PCI */
J
Jiri Slaby 已提交
90
static const struct {
L
Linus Torvalds 已提交
91 92 93 94 95 96 97 98
	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 已提交
99
} Gpci_uart_info[] = {
L
Linus Torvalds 已提交
100 101 102 103
	{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 已提交
104
#define UART_INFO_NUM	ARRAY_SIZE(Gpci_uart_info)
L
Linus Torvalds 已提交
105

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

J
Jiri Slaby 已提交
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 140
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, },
141
	{ "POS-104UL series",	4, },
J
Jiri Slaby 已提交
142
	{ "CP-114UL series",	4, },
143 144
/*30*/	{ "CP-102UF series",	2, },
	{ "CP-112UL series",	2, },
J
Jiri Slaby 已提交
145
};
L
Linus Torvalds 已提交
146

J
Jiri Slaby 已提交
147 148
/* driver_data correspond to the lines in the structure above
   see also ISA probe function before you change something */
L
Linus Torvalds 已提交
149
static struct pci_device_id mxser_pcibrds[] = {
J
Jiri Slaby 已提交
150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172
	{ 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 },
173
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP114UL),	.driver_data = 29 },
J
Jiri Slaby 已提交
174
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP102UF),	.driver_data = 30 },
175
	{ PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP112UL),	.driver_data = 31 },
J
Jiri Slaby 已提交
176
	{ }
L
Linus Torvalds 已提交
177 178 179
};
MODULE_DEVICE_TABLE(pci, mxser_pcibrds);

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

/* Variables for insmod */

MODULE_AUTHOR("Casper Yang");
MODULE_DESCRIPTION("MOXA Smartio/Industio Family Multiport Board Device Driver");
187 188
module_param_array(ioaddr, ulong, NULL, 0);
MODULE_PARM_DESC(ioaddr, "ISA io addresses to look for a moxa board");
R
Rusty Russell 已提交
189
module_param(ttymajor, int, 0);
L
Linus Torvalds 已提交
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 221
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];
};
222

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

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

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

	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 已提交
238

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

	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 已提交
255 256 257
	int xmit_head;
	int xmit_tail;
	int xmit_cnt;
J
Jiri Slaby 已提交
258

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

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

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

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 已提交
277 278 279 280 281 282 283 284 285 286
};

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

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

292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 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 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410 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
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);
}

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

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

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

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

486
#ifdef CONFIG_PCI
J
Jiri Slaby 已提交
487
static int __devinit CheckIsMoxaMust(unsigned long io)
L
Linus Torvalds 已提交
488 489 490 491 492
{
	u8 oldmcr, hwid;
	int i;

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

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

J
Jiri Slaby 已提交
511
static void process_txrx_fifo(struct mxser_port *info)
L
Linus Torvalds 已提交
512 513 514 515 516 517 518 519
{
	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 已提交
520 521 522
	} else
		for (i = 0; i < UART_INFO_NUM; i++)
			if (info->board->chip_flag == Gpci_uart_info[i].type) {
L
Linus Torvalds 已提交
523 524 525 526 527 528 529 530
				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 已提交
531
static unsigned char mxser_get_msr(int baseaddr, int mode, int port)
L
Linus Torvalds 已提交
532
{
J
Jiri Slaby 已提交
533
	static unsigned char mxser_msr[MXSER_PORTS + 1];
J
Jiri Slaby 已提交
534
	unsigned char status = 0;
L
Linus Torvalds 已提交
535

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

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

J
Jiri Slaby 已提交
544 545
	return status;
}
L
Linus Torvalds 已提交
546

547 548 549 550 551 552
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;
}

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

	spin_lock_irqsave(&mp->slock, flags);
559 560 561 562 563 564
	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 已提交
565 566 567
	spin_unlock_irqrestore(&mp->slock, flags);
}

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

A
Alan Cox 已提交
574
	if (!info->ioaddr)
J
Jiri Slaby 已提交
575
		return -1;
L
Linus Torvalds 已提交
576

J
Jiri Slaby 已提交
577 578
	if (newspd > info->max_baud)
		return -1;
L
Linus Torvalds 已提交
579

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

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

J
Jiri Slaby 已提交
596 597 598 599 600 601 602 603
	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 已提交
604

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

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

J
Jiri Slaby 已提交
609 610 611
	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 已提交
612

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

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

628
	return 0;
L
Linus Torvalds 已提交
629 630
}

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

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

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

J
Jiri Slaby 已提交
650 651 652 653 654 655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675
	/* 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 已提交
676

J
Jiri Slaby 已提交
677 678 679 680
	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;
681
			mxser_set_must_fifo_value(info);
J
Jiri Slaby 已提交
682 683 684 685 686 687
		} else
			fcr = 0;
	} else {
		fcr = UART_FCR_ENABLE_FIFO;
		if (info->board->chip_flag) {
			fcr |= MOXA_MUST_FCR_GDA_MODE_ENABLE;
688
			mxser_set_must_fifo_value(info);
J
Jiri Slaby 已提交
689 690 691 692 693 694 695 696 697 698 699 700 701 702 703
		} 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 已提交
704 705 706
		}
	}

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

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

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


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

J
Jiri Slaby 已提交
807
	return ret;
L
Linus Torvalds 已提交
808 809
}

A
Alan Cox 已提交
810 811
static void mxser_check_modem_status(struct tty_struct *tty,
				struct mxser_port *port, int status)
L
Linus Torvalds 已提交
812
{
J
Jiri Slaby 已提交
813 814 815 816 817 818 819 820 821 822
	/* 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;
823
	wake_up_interruptible(&port->port.delta_msr_wait);
L
Linus Torvalds 已提交
824

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

A
Alan Cox 已提交
830
	if (port->port.flags & ASYNC_CTS_FLOW) {
A
Alan Cox 已提交
831
		if (tty->hw_stopped) {
J
Jiri Slaby 已提交
832
			if (status & UART_MSR_CTS) {
A
Alan Cox 已提交
833
				tty->hw_stopped = 0;
J
Jiri Slaby 已提交
834 835 836 837 838 839 840 841 842

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

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

J
Jiri Slaby 已提交
865 866 867
	page = __get_free_page(GFP_KERNEL);
	if (!page)
		return -ENOMEM;
L
Linus Torvalds 已提交
868

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

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

	/*
J
Jiri Slaby 已提交
880 881
	 * Clear the FIFO buffers and disable them
	 * (they will be reenabled in mxser_change_speed())
L
Linus Torvalds 已提交
882
	 */
J
Jiri Slaby 已提交
883 884 885 886 887 888 889
	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 已提交
890

J
Jiri Slaby 已提交
891 892 893 894 895 896 897 898
	/*
	 * 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)) {
A
Alan Cox 已提交
899 900
			if (tty)
				set_bit(TTY_IO_ERROR, &tty->flags);
J
Jiri Slaby 已提交
901 902 903 904
			return 0;
		} else
			return -ENODEV;
	}
L
Linus Torvalds 已提交
905

J
Jiri Slaby 已提交
906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937
	/*
	 * 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 已提交
938
	clear_bit(TTY_IO_ERROR, &tty->flags);
J
Jiri Slaby 已提交
939 940 941 942 943
	info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;

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

	return 0;
}

/*
951
 * This routine will shutdown a serial port
J
Jiri Slaby 已提交
952
 */
953
static void mxser_shutdown_port(struct tty_port *port)
J
Jiri Slaby 已提交
954
{
955
	struct mxser_port *info = container_of(port, struct mxser_port, port);
J
Jiri Slaby 已提交
956 957 958 959 960 961 962 963
	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
	 */
964
	wake_up_interruptible(&info->port.delta_msr_wait);
J
Jiri Slaby 已提交
965 966

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

J
Jiri Slaby 已提交
974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004
	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;
1005
	int line;
J
Jiri Slaby 已提交
1006 1007 1008 1009 1010 1011 1012 1013 1014 1015

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

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

1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039
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);
}


1040
static void mxser_close_port(struct tty_port *port)
L
Linus Torvalds 已提交
1041
{
1042
	struct mxser_port *info = container_of(port, struct mxser_port, port);
L
Linus Torvalds 已提交
1043 1044 1045 1046 1047 1048 1049 1050
	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 已提交
1051
	if (info->board->chip_flag)
L
Linus Torvalds 已提交
1052
		info->IER &= ~MOXA_MUST_RECV_ISR;
J
Jiri Slaby 已提交
1053

1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064
	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 已提交
1065
	}
1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
}

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

	if (tty->index == MXSER_PORTS)
		return;
	if (tty_port_close_start(port, tty, filp) == 0)
		return;
1083 1084
	mutex_lock(&port->mutex);
	mxser_close_port(port);
1085
	mxser_flush_buffer(tty);
1086 1087 1088
	mxser_shutdown_port(port);
	clear_bit(ASYNCB_INITIALIZED, &port->flags);
	mutex_unlock(&port->mutex);
1089 1090 1091 1092
	/* 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 已提交
1093 1094 1095 1096 1097
}

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

A
Alan Cox 已提交
1101
	if (!info->port.xmit_buf)
1102
		return 0;
L
Linus Torvalds 已提交
1103 1104

	while (1) {
1105 1106
		c = min_t(int, count, min(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
					  SERIAL_XMIT_SIZE - info->xmit_head));
L
Linus Torvalds 已提交
1107 1108 1109
		if (c <= 0)
			break;

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

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

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

A
Alan Cox 已提交
1137
static int mxser_put_char(struct tty_struct *tty, unsigned char ch)
L
Linus Torvalds 已提交
1138
{
J
Jiri Slaby 已提交
1139
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1140 1141
	unsigned long flags;

A
Alan Cox 已提交
1142
	if (!info->port.xmit_buf)
A
Alan Cox 已提交
1143
		return 0;
L
Linus Torvalds 已提交
1144 1145

	if (info->xmit_cnt >= SERIAL_XMIT_SIZE - 1)
A
Alan Cox 已提交
1146
		return 0;
L
Linus Torvalds 已提交
1147 1148

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


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

J
Jiri Slaby 已提交
1173 1174 1175
	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 已提交
1176 1177 1178 1179
		return;

	spin_lock_irqsave(&info->slock, flags);

J
Jiri Slaby 已提交
1180
	outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1181
	info->IER |= UART_IER_THRI;
J
Jiri Slaby 已提交
1182
	outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1183 1184 1185 1186 1187 1188

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

static int mxser_write_room(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1189
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1190 1191 1192
	int ret;

	ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
J
Jiri Slaby 已提交
1193
	return ret < 0 ? 0 : ret;
L
Linus Torvalds 已提交
1194 1195 1196 1197
}

static int mxser_chars_in_buffer(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1198
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1199 1200 1201
	return info->xmit_cnt;
}

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

A
Alan Cox 已提交
1228
static int mxser_set_serial_info(struct tty_struct *tty,
J
Jiri Slaby 已提交
1229
		struct serial_struct __user *new_info)
L
Linus Torvalds 已提交
1230
{
A
Alan Cox 已提交
1231
	struct mxser_port *info = tty->driver_data;
J
Jiri Slaby 已提交
1232
	struct serial_struct new_serial;
1233
	speed_t baud;
J
Jiri Slaby 已提交
1234 1235 1236
	unsigned long sl_flags;
	unsigned int flags;
	int retval = 0;
L
Linus Torvalds 已提交
1237

J
Jiri Slaby 已提交
1238
	if (!new_info || !info->ioaddr)
1239
		return -ENODEV;
J
Jiri Slaby 已提交
1240 1241
	if (copy_from_user(&new_serial, new_info, sizeof(new_serial)))
		return -EFAULT;
L
Linus Torvalds 已提交
1242

1243 1244 1245
	if (new_serial.irq != info->board->irq ||
			new_serial.port != info->ioaddr)
		return -EINVAL;
L
Linus Torvalds 已提交
1246

A
Alan Cox 已提交
1247
	flags = info->port.flags & ASYNC_SPD_MASK;
L
Linus Torvalds 已提交
1248

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

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

J
Jiri Slaby 已提交
1278 1279
	process_txrx_fifo(info);

A
Alan Cox 已提交
1280 1281
	if (info->port.flags & ASYNC_INITIALIZED) {
		if (flags != (info->port.flags & ASYNC_SPD_MASK)) {
J
Jiri Slaby 已提交
1282
			spin_lock_irqsave(&info->slock, sl_flags);
A
Alan Cox 已提交
1283
			mxser_change_speed(tty, NULL);
J
Jiri Slaby 已提交
1284
			spin_unlock_irqrestore(&info->slock, sl_flags);
L
Linus Torvalds 已提交
1285
		}
1286 1287 1288 1289 1290 1291 1292
	} else {
		mutex_lock(&info->port.mutex);
		retval = mxser_activate(&info->port, tty);
		if (retval == 0)
			set_bit(ASYNCB_INITIALIZED, &info->port.flags);
		mutex_unlock(&info->port.mutex);
	}
J
Jiri Slaby 已提交
1293 1294
	return retval;
}
L
Linus Torvalds 已提交
1295

J
Jiri Slaby 已提交
1296 1297 1298 1299 1300 1301 1302 1303 1304 1305 1306 1307 1308 1309 1310 1311
/*
 * 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 已提交
1312

J
Jiri Slaby 已提交
1313 1314 1315 1316 1317 1318
	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 已提交
1319

J
Jiri Slaby 已提交
1320 1321 1322 1323 1324
static int mxser_tiocmget(struct tty_struct *tty, struct file *file)
{
	struct mxser_port *info = tty->driver_data;
	unsigned char control, status;
	unsigned long flags;
L
Linus Torvalds 已提交
1325

1326

J
Jiri Slaby 已提交
1327 1328 1329 1330
	if (tty->index == MXSER_PORTS)
		return -ENOIOCTLCMD;
	if (test_bit(TTY_IO_ERROR, &tty->flags))
		return -EIO;
L
Linus Torvalds 已提交
1331

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

J
Jiri Slaby 已提交
1334 1335 1336
	spin_lock_irqsave(&info->slock, flags);
	status = inb(info->ioaddr + UART_MSR);
	if (status & UART_MSR_ANY_DELTA)
A
Alan Cox 已提交
1337
		mxser_check_modem_status(tty, info, status);
J
Jiri Slaby 已提交
1338 1339 1340 1341 1342 1343 1344 1345
	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 已提交
1346

J
Jiri Slaby 已提交
1347 1348 1349 1350 1351
static int mxser_tiocmset(struct tty_struct *tty, struct file *file,
		unsigned int set, unsigned int clear)
{
	struct mxser_port *info = tty->driver_data;
	unsigned long flags;
L
Linus Torvalds 已提交
1352 1353


J
Jiri Slaby 已提交
1354 1355 1356 1357
	if (tty->index == MXSER_PORTS)
		return -ENOIOCTLCMD;
	if (test_bit(TTY_IO_ERROR, &tty->flags))
		return -EIO;
L
Linus Torvalds 已提交
1358

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

J
Jiri Slaby 已提交
1361 1362 1363 1364
	if (set & TIOCM_RTS)
		info->MCR |= UART_MCR_RTS;
	if (set & TIOCM_DTR)
		info->MCR |= UART_MCR_DTR;
L
Linus Torvalds 已提交
1365

J
Jiri Slaby 已提交
1366 1367 1368 1369
	if (clear & TIOCM_RTS)
		info->MCR &= ~UART_MCR_RTS;
	if (clear & TIOCM_DTR)
		info->MCR &= ~UART_MCR_DTR;
1370

J
Jiri Slaby 已提交
1371 1372 1373 1374
	outb(info->MCR, info->ioaddr + UART_MCR);
	spin_unlock_irqrestore(&info->slock, flags);
	return 0;
}
L
Linus Torvalds 已提交
1375

J
Jiri Slaby 已提交
1376 1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404
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 已提交
1405
	}
J
Jiri Slaby 已提交
1406 1407 1408
	if (j != 2)
		id = -2;
	return id;
L
Linus Torvalds 已提交
1409 1410
}

J
Jiri Slaby 已提交
1411 1412 1413 1414 1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436 1437 1438 1439 1440 1441 1442 1443 1444 1445 1446 1447 1448 1449 1450 1451 1452 1453 1454 1455 1456 1457 1458 1459 1460 1461 1462 1463 1464 1465 1466 1467 1468 1469 1470 1471 1472 1473 1474 1475 1476 1477
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 已提交
1478 1479 1480

static int mxser_ioctl_special(unsigned int cmd, void __user *argp)
{
J
Jiri Slaby 已提交
1481
	struct mxser_port *port;
A
Alan Cox 已提交
1482
	struct tty_struct *tty;
J
Jiri Slaby 已提交
1483 1484
	int result, status;
	unsigned int i, j;
A
Alan Cox 已提交
1485
	int ret = 0;
L
Linus Torvalds 已提交
1486 1487 1488

	switch (cmd) {
	case MOXA_GET_MAJOR:
1489 1490 1491 1492
		if (printk_ratelimit())
			printk(KERN_WARNING "mxser: '%s' uses deprecated ioctl "
					"%x (GET_MAJOR), fix your userspace\n",
					current->comm, cmd);
J
Jiri Slaby 已提交
1493
		return put_user(ttymajor, (int __user *)argp);
L
Linus Torvalds 已提交
1494 1495 1496

	case MOXA_CHKPORTENABLE:
		result = 0;
A
Alan Cox 已提交
1497
		lock_kernel();
J
Jiri Slaby 已提交
1498 1499 1500 1501
		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);
A
Alan Cox 已提交
1502
		unlock_kernel();
1503
		return put_user(result, (unsigned long __user *)argp);
L
Linus Torvalds 已提交
1504
	case MOXA_GETDATACOUNT:
A
Alan Cox 已提交
1505
		lock_kernel();
L
Linus Torvalds 已提交
1506
		if (copy_to_user(argp, &mxvar_log, sizeof(mxvar_log)))
A
Alan Cox 已提交
1507 1508 1509
			ret = -EFAULT;
		unlock_kernel();
		return ret;
J
Jiri Slaby 已提交
1510 1511
	case MOXA_GETMSTATUS: {
		struct mxser_mstatus ms, __user *msu = argp;
A
Alan Cox 已提交
1512
		lock_kernel();
J
Jiri Slaby 已提交
1513 1514 1515
		for (i = 0; i < MXSER_BOARDS; i++)
			for (j = 0; j < MXSER_PORTS_PER_BOARD; j++) {
				port = &mxser_boards[i].ports[j];
J
Jiri Slaby 已提交
1516
				memset(&ms, 0, sizeof(ms));
J
Jiri Slaby 已提交
1517

J
Jiri Slaby 已提交
1518 1519
				if (!port->ioaddr)
					goto copy;
A
Alan Cox 已提交
1520 1521
				
				tty = tty_port_tty_get(&port->port);
L
Linus Torvalds 已提交
1522

A
Alan Cox 已提交
1523
				if (!tty || !tty->termios)
J
Jiri Slaby 已提交
1524
					ms.cflag = port->normal_termios.c_cflag;
J
Jiri Slaby 已提交
1525
				else
A
Alan Cox 已提交
1526 1527
					ms.cflag = tty->termios->c_cflag;
				tty_kref_put(tty);
J
Jiri Slaby 已提交
1528
				status = inb(port->ioaddr + UART_MSR);
J
Jiri Slaby 已提交
1529 1530 1531 1532 1533 1534 1535 1536 1537 1538 1539 1540
				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:
				if (copy_to_user(msu, &ms, sizeof(ms))) {
					unlock_kernel();
					return -EFAULT;
				}
				msu++;
J
Jiri Slaby 已提交
1541
			}
A
Alan Cox 已提交
1542
		unlock_kernel();
L
Linus Torvalds 已提交
1543
		return 0;
J
Jiri Slaby 已提交
1544
	}
1545
	case MOXA_ASPP_MON_EXT: {
J
Jiri Slaby 已提交
1546 1547 1548 1549 1550 1551 1552
		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 已提交
1553

A
Alan Cox 已提交
1554
		lock_kernel();
J
Jiri Slaby 已提交
1555 1556 1557 1558 1559 1560
		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;
				}
J
Jiri Slaby 已提交
1561 1562
				port = &mxser_boards[i].ports[j];
				if (!port->ioaddr)
L
Linus Torvalds 已提交
1563 1564
					continue;

J
Jiri Slaby 已提交
1565
				status = mxser_get_msr(port->ioaddr, 0, p);
J
Jiri Slaby 已提交
1566

L
Linus Torvalds 已提交
1567
				if (status & UART_MSR_TERI)
J
Jiri Slaby 已提交
1568
					port->icount.rng++;
L
Linus Torvalds 已提交
1569
				if (status & UART_MSR_DDSR)
J
Jiri Slaby 已提交
1570
					port->icount.dsr++;
L
Linus Torvalds 已提交
1571
				if (status & UART_MSR_DDCD)
J
Jiri Slaby 已提交
1572
					port->icount.dcd++;
L
Linus Torvalds 已提交
1573
				if (status & UART_MSR_DCTS)
J
Jiri Slaby 已提交
1574 1575 1576
					port->icount.cts++;

				port->mon_data.modem_status = status;
J
Jiri Slaby 已提交
1577 1578 1579 1580 1581
				me->rx_cnt[p] = port->mon_data.rxcnt;
				me->tx_cnt[p] = port->mon_data.txcnt;
				me->up_rxcnt[p] = port->mon_data.up_rxcnt;
				me->up_txcnt[p] = port->mon_data.up_txcnt;
				me->modem_status[p] =
J
Jiri Slaby 已提交
1582
					port->mon_data.modem_status;
A
Alan Cox 已提交
1583
				tty = tty_port_tty_get(&port->port);
J
Jiri Slaby 已提交
1584

A
Alan Cox 已提交
1585
				if (!tty || !tty->termios) {
J
Jiri Slaby 已提交
1586 1587
					cflag = port->normal_termios.c_cflag;
					iflag = port->normal_termios.c_iflag;
A
Alan Cox 已提交
1588
					me->baudrate[p] = tty_termios_baud_rate(&port->normal_termios);
L
Linus Torvalds 已提交
1589
				} else {
A
Alan Cox 已提交
1590 1591 1592
					cflag = tty->termios->c_cflag;
					iflag = tty->termios->c_iflag;
					me->baudrate[p] = tty_get_baud_rate(tty);
L
Linus Torvalds 已提交
1593
				}
A
Alan Cox 已提交
1594
				tty_kref_put(tty);
L
Linus Torvalds 已提交
1595

J
Jiri Slaby 已提交
1596 1597 1598 1599
				me->databits[p] = cflag & CSIZE;
				me->stopbits[p] = cflag & CSTOPB;
				me->parity[p] = cflag & (PARENB | PARODD |
						CMSPAR);
L
Linus Torvalds 已提交
1600 1601

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

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

J
Jiri Slaby 已提交
1607
				if (port->type == PORT_16550A)
J
Jiri Slaby 已提交
1608
					me->fifo[p] = 1;
L
Linus Torvalds 已提交
1609

J
Jiri Slaby 已提交
1610 1611
				opmode = inb(port->opmode_ioaddr) >>
						((p % 4) * 2);
L
Linus Torvalds 已提交
1612
				opmode &= OP_MODE_MASK;
J
Jiri Slaby 已提交
1613
				me->iftype[p] = opmode;
L
Linus Torvalds 已提交
1614
			}
A
Alan Cox 已提交
1615 1616
		}
		unlock_kernel();
J
Jiri Slaby 已提交
1617 1618 1619 1620
		if (copy_to_user(argp, me, sizeof(*me)))
			ret = -EFAULT;
		kfree(me);
		return ret;
A
Alan Cox 已提交
1621 1622
	}
	default:
L
Linus Torvalds 已提交
1623 1624 1625 1626 1627
		return -ENOIOCTLCMD;
	}
	return 0;
}

J
Jiri Slaby 已提交
1628 1629
static int mxser_cflags_changed(struct mxser_port *info, unsigned long arg,
		struct async_icount *cprev)
L
Linus Torvalds 已提交
1630
{
J
Jiri Slaby 已提交
1631 1632 1633
	struct async_icount cnow;
	unsigned long flags;
	int ret;
L
Linus Torvalds 已提交
1634

J
Jiri Slaby 已提交
1635 1636 1637
	spin_lock_irqsave(&info->slock, flags);
	cnow = info->icount;	/* atomic copy */
	spin_unlock_irqrestore(&info->slock, flags);
L
Linus Torvalds 已提交
1638

J
Jiri Slaby 已提交
1639 1640 1641 1642
	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 已提交
1643

J
Jiri Slaby 已提交
1644 1645 1646 1647 1648 1649 1650
	*cprev = cnow;

	return ret;
}

static int mxser_ioctl(struct tty_struct *tty, struct file *file,
		unsigned int cmd, unsigned long arg)
L
Linus Torvalds 已提交
1651
{
J
Jiri Slaby 已提交
1652 1653 1654 1655 1656
	struct mxser_port *info = tty->driver_data;
	struct async_icount cnow;
	unsigned long flags;
	void __user *argp = (void __user *)arg;
	int retval;
L
Linus Torvalds 已提交
1657

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

J
Jiri Slaby 已提交
1661 1662 1663 1664 1665 1666
	if (cmd == MOXA_SET_OP_MODE || cmd == MOXA_GET_OP_MODE) {
		int p;
		unsigned long opmode;
		static unsigned char ModeMask[] = { 0xfc, 0xf3, 0xcf, 0x3f };
		int shiftbit;
		unsigned char val, mask;
L
Linus Torvalds 已提交
1667

J
Jiri Slaby 已提交
1668 1669 1670 1671 1672 1673 1674 1675 1676
		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;
A
Alan Cox 已提交
1677
			lock_kernel();
J
Jiri Slaby 已提交
1678 1679 1680 1681 1682 1683
			mask = ModeMask[p];
			shiftbit = p * 2;
			val = inb(info->opmode_ioaddr);
			val &= mask;
			val |= (opmode << shiftbit);
			outb(val, info->opmode_ioaddr);
A
Alan Cox 已提交
1684
			unlock_kernel();
J
Jiri Slaby 已提交
1685
		} else {
A
Alan Cox 已提交
1686
			lock_kernel();
J
Jiri Slaby 已提交
1687 1688 1689
			shiftbit = p * 2;
			opmode = inb(info->opmode_ioaddr) >> shiftbit;
			opmode &= OP_MODE_MASK;
A
Alan Cox 已提交
1690
			unlock_kernel();
J
Jiri Slaby 已提交
1691 1692 1693 1694 1695 1696 1697 1698 1699 1700 1701 1702
			if (put_user(opmode, (int __user *)argp))
				return -EFAULT;
		}
		return 0;
	}

	if (cmd != TIOCGSERIAL && cmd != TIOCMIWAIT && cmd != TIOCGICOUNT &&
			test_bit(TTY_IO_ERROR, &tty->flags))
		return -EIO;

	switch (cmd) {
	case TIOCGSERIAL:
A
Alan Cox 已提交
1703
		lock_kernel();
A
Alan Cox 已提交
1704
		retval = mxser_get_serial_info(tty, argp);
A
Alan Cox 已提交
1705 1706
		unlock_kernel();
		return retval;
J
Jiri Slaby 已提交
1707
	case TIOCSSERIAL:
A
Alan Cox 已提交
1708
		lock_kernel();
A
Alan Cox 已提交
1709
		retval = mxser_set_serial_info(tty, argp);
A
Alan Cox 已提交
1710 1711
		unlock_kernel();
		return retval;
J
Jiri Slaby 已提交
1712
	case TIOCSERGETLSR:	/* Get line status register */
A
Alan Cox 已提交
1713
		return  mxser_get_lsr_info(info, argp);
J
Jiri Slaby 已提交
1714 1715 1716 1717 1718 1719 1720 1721 1722 1723 1724
		/*
		 * 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);

1725
		return wait_event_interruptible(info->port.delta_msr_wait,
J
Jiri Slaby 已提交
1726 1727 1728 1729 1730 1731 1732
				mxser_cflags_changed(info, arg, &cnow));
	/*
	 * 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.
	 */
J
Jiri Slaby 已提交
1733 1734
	case TIOCGICOUNT: {
		struct serial_icounter_struct icnt = { 0 };
J
Jiri Slaby 已提交
1735 1736 1737
		spin_lock_irqsave(&info->slock, flags);
		cnow = info->icount;
		spin_unlock_irqrestore(&info->slock, flags);
J
Jiri Slaby 已提交
1738 1739 1740 1741 1742 1743 1744 1745 1746 1747 1748 1749 1750 1751 1752

		icnt.frame = cnow.frame;
		icnt.brk = cnow.brk;
		icnt.overrun = cnow.overrun;
		icnt.buf_overrun = cnow.buf_overrun;
		icnt.parity = cnow.parity;
		icnt.rx = cnow.rx;
		icnt.tx = cnow.tx;
		icnt.cts = cnow.cts;
		icnt.dsr = cnow.dsr;
		icnt.rng = cnow.rng;
		icnt.dcd = cnow.dcd;

		return copy_to_user(argp, &icnt, sizeof(icnt)) ? -EFAULT : 0;
	}
J
Jiri Slaby 已提交
1753 1754 1755
	case MOXA_HighSpeedOn:
		return put_user(info->baud_base != 115200 ? 1 : 0, (int __user *)argp);
	case MOXA_SDS_RSTICOUNTER:
A
Alan Cox 已提交
1756
		lock_kernel();
J
Jiri Slaby 已提交
1757 1758
		info->mon_data.rxcnt = 0;
		info->mon_data.txcnt = 0;
A
Alan Cox 已提交
1759
		unlock_kernel();
J
Jiri Slaby 已提交
1760 1761 1762 1763 1764
		return 0;

	case MOXA_ASPP_OQUEUE:{
		int len, lsr;

A
Alan Cox 已提交
1765
		lock_kernel();
J
Jiri Slaby 已提交
1766
		len = mxser_chars_in_buffer(tty);
1767
		lsr = inb(info->ioaddr + UART_LSR) & UART_LSR_THRE;
J
Jiri Slaby 已提交
1768
		len += (lsr ? 0 : 1);
A
Alan Cox 已提交
1769
		unlock_kernel();
J
Jiri Slaby 已提交
1770 1771 1772 1773 1774 1775

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

A
Alan Cox 已提交
1776
		lock_kernel();
J
Jiri Slaby 已提交
1777
		status = mxser_get_msr(info->ioaddr, 1, tty->index);
A
Alan Cox 已提交
1778
		mxser_check_modem_status(tty, info, status);
J
Jiri Slaby 已提交
1779 1780 1781 1782 1783 1784 1785 1786 1787 1788 1789 1790

		mcr = inb(info->ioaddr + UART_MCR);
		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 已提交
1791
		if (tty->hw_stopped)
J
Jiri Slaby 已提交
1792 1793 1794
			info->mon_data.hold_reason |= NPPI_NOTIFY_CTSHOLD;
		else
			info->mon_data.hold_reason &= ~NPPI_NOTIFY_CTSHOLD;
A
Alan Cox 已提交
1795
		unlock_kernel();
J
Jiri Slaby 已提交
1796 1797 1798 1799 1800 1801 1802 1803 1804 1805 1806 1807 1808 1809 1810 1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830 1831 1832 1833 1834 1835 1836
		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;
}

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 已提交
1837 1838 1839
		}
	}

A
Alan Cox 已提交
1840
	if (tty->termios->c_cflag & CRTSCTS) {
J
Jiri Slaby 已提交
1841 1842
		info->MCR &= ~UART_MCR_RTS;
		outb(info->MCR, info->ioaddr + UART_MCR);
L
Linus Torvalds 已提交
1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856
	}
}

/*
 * 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 已提交
1857
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1858

J
Jiri Slaby 已提交
1859 1860 1861 1862 1863 1864 1865 1866 1867 1868 1869 1870 1871 1872 1873
	/* 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 已提交
1874
		}
J
Jiri Slaby 已提交
1875
	}
L
Linus Torvalds 已提交
1876

A
Alan Cox 已提交
1877
	if (tty->termios->c_cflag & CRTSCTS) {
J
Jiri Slaby 已提交
1878 1879
		info->MCR |= UART_MCR_RTS;
		outb(info->MCR, info->ioaddr + UART_MCR);
L
Linus Torvalds 已提交
1880 1881 1882 1883 1884 1885 1886 1887 1888 1889 1890
	}
}

/*
 * 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 已提交
1891
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1892 1893 1894 1895 1896
	unsigned long flags;

	spin_lock_irqsave(&info->slock, flags);
	if (info->IER & UART_IER_THRI) {
		info->IER &= ~UART_IER_THRI;
J
Jiri Slaby 已提交
1897
		outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1898 1899 1900 1901 1902 1903
	}
	spin_unlock_irqrestore(&info->slock, flags);
}

static void mxser_start(struct tty_struct *tty)
{
J
Jiri Slaby 已提交
1904
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1905 1906 1907
	unsigned long flags;

	spin_lock_irqsave(&info->slock, flags);
A
Alan Cox 已提交
1908
	if (info->xmit_cnt && info->port.xmit_buf) {
J
Jiri Slaby 已提交
1909
		outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1910
		info->IER |= UART_IER_THRI;
J
Jiri Slaby 已提交
1911
		outb(info->IER, info->ioaddr + UART_IER);
L
Linus Torvalds 已提交
1912 1913 1914 1915
	}
	spin_unlock_irqrestore(&info->slock, flags);
}

J
Jiri Slaby 已提交
1916 1917 1918 1919 1920 1921
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 已提交
1922
	mxser_change_speed(tty, old_termios);
J
Jiri Slaby 已提交
1923 1924 1925 1926 1927 1928 1929 1930 1931 1932 1933 1934 1935 1936 1937
	spin_unlock_irqrestore(&info->slock, flags);

	if ((old_termios->c_cflag & CRTSCTS) &&
			!(tty->termios->c_cflag & CRTSCTS)) {
		tty->hw_stopped = 0;
		mxser_start(tty);
	}

	/* Handle sw stopped */
	if ((old_termios->c_iflag & IXON) &&
			!(tty->termios->c_iflag & IXON)) {
		tty->stopped = 0;

		if (info->board->chip_flag) {
			spin_lock_irqsave(&info->slock, flags);
1938 1939
			mxser_disable_must_rx_software_flow_control(
					info->ioaddr);
J
Jiri Slaby 已提交
1940 1941 1942 1943 1944 1945 1946
			spin_unlock_irqrestore(&info->slock, flags);
		}

		mxser_start(tty);
	}
}

L
Linus Torvalds 已提交
1947 1948 1949 1950 1951
/*
 * 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 已提交
1952
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988
	unsigned long orig_jiffies, char_time;
	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;
#ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
1989 1990
	printk(KERN_DEBUG "In rs_wait_until_sent(%d) check=%lu...",
		timeout, char_time);
L
Linus Torvalds 已提交
1991 1992
	printk("jiff=%lu...", jiffies);
#endif
1993
	lock_kernel();
J
Jiri Slaby 已提交
1994
	while (!((lsr = inb(info->ioaddr + UART_LSR)) & UART_LSR_TEMT)) {
L
Linus Torvalds 已提交
1995 1996 1997
#ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
		printk("lsr = %d (jiff=%lu)...", lsr, jiffies);
#endif
1998
		schedule_timeout_interruptible(char_time);
L
Linus Torvalds 已提交
1999
		if (signal_pending(current))
J
Jiri Slaby 已提交
2000 2001 2002
			break;
		if (timeout && time_after(jiffies, orig_jiffies + timeout))
			break;
L
Linus Torvalds 已提交
2003
	}
J
Jiri Slaby 已提交
2004
	set_current_state(TASK_RUNNING);
2005
	unlock_kernel();
L
Linus Torvalds 已提交
2006

J
Jiri Slaby 已提交
2007 2008 2009 2010
#ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
	printk("lsr = %d (jiff=%lu)...done\n", lsr, jiffies);
#endif
}
L
Linus Torvalds 已提交
2011

J
Jiri Slaby 已提交
2012 2013 2014 2015 2016 2017
/*
 * 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 已提交
2018

J
Jiri Slaby 已提交
2019
	mxser_flush_buffer(tty);
A
Alan Cox 已提交
2020
	tty_port_hangup(&info->port);
L
Linus Torvalds 已提交
2021 2022
}

J
Jiri Slaby 已提交
2023 2024 2025
/*
 * mxser_rs_break() --- routine which turns the break handling on or off
 */
A
Alan Cox 已提交
2026
static int mxser_rs_break(struct tty_struct *tty, int break_state)
L
Linus Torvalds 已提交
2027
{
J
Jiri Slaby 已提交
2028
	struct mxser_port *info = tty->driver_data;
L
Linus Torvalds 已提交
2029 2030
	unsigned long flags;

J
Jiri Slaby 已提交
2031 2032 2033 2034 2035 2036 2037 2038
	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 已提交
2039
	return 0;
J
Jiri Slaby 已提交
2040
}
L
Linus Torvalds 已提交
2041

A
Alan Cox 已提交
2042 2043
static void mxser_receive_chars(struct tty_struct *tty,
				struct mxser_port *port, int *status)
J
Jiri Slaby 已提交
2044 2045 2046 2047 2048 2049
{
	unsigned char ch, gdl;
	int ignored = 0;
	int cnt = 0;
	int recv_room;
	int max = 256;
L
Linus Torvalds 已提交
2050

J
Jiri Slaby 已提交
2051
	recv_room = tty->receive_room;
A
Alan Cox 已提交
2052
	if (recv_room == 0 && !port->ldisc_stop_rx)
J
Jiri Slaby 已提交
2053 2054
		mxser_stoprx(tty);
	if (port->board->chip_flag != MOXA_OTHER_UART) {
L
Linus Torvalds 已提交
2055

J
Jiri Slaby 已提交
2056 2057 2058 2059 2060 2061 2062
		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 已提交
2063

J
Jiri Slaby 已提交
2064 2065 2066 2067 2068 2069 2070 2071 2072 2073 2074 2075 2076 2077
		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);
			tty_insert_flip_char(tty, ch, 0);
			cnt++;
		}
		goto end_intr;
L
Linus Torvalds 已提交
2078
	}
J
Jiri Slaby 已提交
2079 2080 2081 2082 2083
intr_old:

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

J
Jiri Slaby 已提交
2085 2086 2087 2088 2089 2090 2091 2092 2093 2094 2095 2096 2097
		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 已提交
2098

A
Alan Cox 已提交
2099
					if (port->port.flags & ASYNC_SAK)
J
Jiri Slaby 已提交
2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116 2117 2118 2119
						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;
			}
			tty_insert_flip_char(tty, ch, flag);
			cnt++;
			if (cnt >= recv_room) {
				if (!port->ldisc_stop_rx)
					mxser_stoprx(tty);
				break;
			}
L
Linus Torvalds 已提交
2120

J
Jiri Slaby 已提交
2121
		}
L
Linus Torvalds 已提交
2122

J
Jiri Slaby 已提交
2123 2124
		if (port->board->chip_flag)
			break;
L
Linus Torvalds 已提交
2125

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

J
Jiri Slaby 已提交
2129
end_intr:
A
Alan Cox 已提交
2130
	mxvar_log.rxcnt[tty->index] += cnt;
J
Jiri Slaby 已提交
2131 2132
	port->mon_data.rxcnt += cnt;
	port->mon_data.up_rxcnt += cnt;
L
Linus Torvalds 已提交
2133

J
Jiri Slaby 已提交
2134 2135 2136 2137 2138 2139 2140 2141
	/*
	 * 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);
	tty_flip_buffer_push(tty);
	spin_lock(&port->slock);
L
Linus Torvalds 已提交
2142 2143
}

A
Alan Cox 已提交
2144
static void mxser_transmit_chars(struct tty_struct *tty, struct mxser_port *port)
L
Linus Torvalds 已提交
2145
{
J
Jiri Slaby 已提交
2146
	int count, cnt;
L
Linus Torvalds 已提交
2147

J
Jiri Slaby 已提交
2148 2149 2150
	if (port->x_char) {
		outb(port->x_char, port->ioaddr + UART_TX);
		port->x_char = 0;
A
Alan Cox 已提交
2151
		mxvar_log.txcnt[tty->index]++;
J
Jiri Slaby 已提交
2152 2153 2154 2155 2156
		port->mon_data.txcnt++;
		port->mon_data.up_txcnt++;
		port->icount.tx++;
		return;
	}
L
Linus Torvalds 已提交
2157

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

A
Alan Cox 已提交
2161 2162
	if (port->xmit_cnt <= 0 || tty->stopped ||
			(tty->hw_stopped &&
J
Jiri Slaby 已提交
2163 2164 2165 2166 2167
			(port->type != PORT_16550A) &&
			(!port->board->chip_flag))) {
		port->IER &= ~UART_IER_THRI;
		outb(port->IER, port->ioaddr + UART_IER);
		return;
L
Linus Torvalds 已提交
2168 2169
	}

J
Jiri Slaby 已提交
2170 2171 2172
	cnt = port->xmit_cnt;
	count = port->xmit_fifo_size;
	do {
A
Alan Cox 已提交
2173
		outb(port->port.xmit_buf[port->xmit_tail++],
J
Jiri Slaby 已提交
2174 2175 2176 2177 2178
			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 已提交
2179
	mxvar_log.txcnt[tty->index] += (cnt - port->xmit_cnt);
L
Linus Torvalds 已提交
2180

J
Jiri Slaby 已提交
2181 2182 2183
	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 已提交
2184

A
Alan Cox 已提交
2185 2186
	if (port->xmit_cnt < WAKEUP_CHARS && tty)
		tty_wakeup(tty);
J
Jiri Slaby 已提交
2187 2188 2189 2190

	if (port->xmit_cnt <= 0) {
		port->IER &= ~UART_IER_THRI;
		outb(port->IER, port->ioaddr + UART_IER);
L
Linus Torvalds 已提交
2191 2192 2193 2194
	}
}

/*
J
Jiri Slaby 已提交
2195
 * This is the serial driver's generic interrupt routine
L
Linus Torvalds 已提交
2196
 */
J
Jiri Slaby 已提交
2197
static irqreturn_t mxser_interrupt(int irq, void *dev_id)
L
Linus Torvalds 已提交
2198
{
J
Jiri Slaby 已提交
2199 2200 2201 2202 2203 2204
	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 已提交
2205
	struct tty_struct *tty;
L
Linus Torvalds 已提交
2206

J
Jiri Slaby 已提交
2207 2208 2209 2210 2211
	for (i = 0; i < MXSER_BOARDS; i++)
		if (dev_id == &mxser_boards[i]) {
			brd = dev_id;
			break;
		}
L
Linus Torvalds 已提交
2212

J
Jiri Slaby 已提交
2213 2214 2215 2216 2217 2218 2219 2220 2221
	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 已提交
2222

J
Jiri Slaby 已提交
2223 2224 2225 2226 2227 2228 2229 2230 2231 2232 2233 2234 2235 2236 2237
		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 已提交
2238 2239
				tty = tty_port_tty_get(&port->port);
				if (!tty ||
A
Alan Cox 已提交
2240 2241
						(port->port.flags & ASYNC_CLOSING) ||
						!(port->port.flags &
J
Jiri Slaby 已提交
2242 2243 2244 2245
							ASYNC_INITIALIZED)) {
					status = inb(port->ioaddr + UART_LSR);
					outb(0x27, port->ioaddr + UART_FCR);
					inb(port->ioaddr + UART_MSR);
A
Alan Cox 已提交
2246
					tty_kref_put(tty);
J
Jiri Slaby 已提交
2247 2248
					break;
				}
L
Linus Torvalds 已提交
2249

J
Jiri Slaby 已提交
2250 2251 2252 2253 2254 2255 2256 2257 2258 2259 2260 2261 2262 2263 2264 2265 2266
				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 已提交
2267
						mxser_receive_chars(tty, port,
J
Jiri Slaby 已提交
2268 2269 2270 2271 2272
								&status);

				} else {
					status &= port->read_status_mask;
					if (status & UART_LSR_DR)
A
Alan Cox 已提交
2273
						mxser_receive_chars(tty, port,
J
Jiri Slaby 已提交
2274 2275 2276 2277
								&status);
				}
				msr = inb(port->ioaddr + UART_MSR);
				if (msr & UART_MSR_ANY_DELTA)
A
Alan Cox 已提交
2278
					mxser_check_modem_status(tty, port, msr);
J
Jiri Slaby 已提交
2279 2280 2281 2282

				if (port->board->chip_flag) {
					if (iir == 0x02 && (status &
								UART_LSR_THRE))
A
Alan Cox 已提交
2283
						mxser_transmit_chars(tty, port);
J
Jiri Slaby 已提交
2284 2285
				} else {
					if (status & UART_LSR_THRE)
A
Alan Cox 已提交
2286
						mxser_transmit_chars(tty, port);
J
Jiri Slaby 已提交
2287
				}
A
Alan Cox 已提交
2288
				tty_kref_put(tty);
J
Jiri Slaby 已提交
2289 2290 2291 2292
			} while (int_cnt++ < MXSER_ISR_PASS_LIMIT);
			spin_unlock(&port->slock);
		}
	}
L
Linus Torvalds 已提交
2293

J
Jiri Slaby 已提交
2294 2295 2296
irq_stop:
	return handled;
}
L
Linus Torvalds 已提交
2297

J
Jiri Slaby 已提交
2298 2299 2300 2301 2302 2303 2304 2305 2306 2307 2308 2309 2310 2311 2312 2313 2314 2315 2316 2317 2318
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,
};
L
Linus Torvalds 已提交
2319

2320 2321
struct tty_port_operations mxser_port_ops = {
	.carrier_raised = mxser_carrier_raised,
2322
	.dtr_rts = mxser_dtr_rts,
2323 2324
	.activate = mxser_activate,
	.shutdown = mxser_shutdown_port,
2325 2326
};

J
Jiri Slaby 已提交
2327 2328 2329
/*
 * The MOXA Smartio/Industio serial driver boot-time initialization code!
 */
L
Linus Torvalds 已提交
2330

J
Jiri Slaby 已提交
2331 2332 2333 2334 2335 2336 2337 2338 2339 2340 2341 2342 2343 2344
static void mxser_release_res(struct mxser_board *brd, struct pci_dev *pdev,
		unsigned int irq)
{
	if (irq)
		free_irq(brd->irq, brd);
	if (pdev != NULL) {	/* PCI */
#ifdef CONFIG_PCI
		pci_release_region(pdev, 2);
		pci_release_region(pdev, 3);
#endif
	} else {
		release_region(brd->ports[0].ioaddr, 8 * brd->info->nports);
		release_region(brd->vector, 1);
	}
L
Linus Torvalds 已提交
2345 2346
}

J
Jiri Slaby 已提交
2347 2348
static int __devinit mxser_initbrd(struct mxser_board *brd,
		struct pci_dev *pdev)
L
Linus Torvalds 已提交
2349
{
J
Jiri Slaby 已提交
2350 2351 2352
	struct mxser_port *info;
	unsigned int i;
	int retval;
L
Linus Torvalds 已提交
2353

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

J
Jiri Slaby 已提交
2357 2358
	for (i = 0; i < brd->info->nports; i++) {
		info = &brd->ports[i];
A
Alan Cox 已提交
2359
		tty_port_init(&info->port);
2360
		info->port.ops = &mxser_port_ops;
J
Jiri Slaby 已提交
2361 2362 2363
		info->board = brd;
		info->stop_rx = 0;
		info->ldisc_stop_rx = 0;
L
Linus Torvalds 已提交
2364

J
Jiri Slaby 已提交
2365 2366
		/* Enhance mode enabled here */
		if (brd->chip_flag != MOXA_OTHER_UART)
2367
			mxser_enable_must_enchance_mode(info->ioaddr);
L
Linus Torvalds 已提交
2368

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

J
Jiri Slaby 已提交
2372
		process_txrx_fifo(info);
L
Linus Torvalds 已提交
2373

J
Jiri Slaby 已提交
2374
		info->custom_divisor = info->baud_base * 16;
A
Alan Cox 已提交
2375 2376
		info->port.close_delay = 5 * HZ / 10;
		info->port.closing_wait = 30 * HZ;
J
Jiri Slaby 已提交
2377 2378 2379 2380
		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 已提交
2381

J
Jiri Slaby 已提交
2382 2383 2384 2385
		/* before set INT ISR, disable all int */
		outb(inb(info->ioaddr + UART_IER) & 0xf0,
			info->ioaddr + UART_IER);
	}
L
Linus Torvalds 已提交
2386

J
Jiri Slaby 已提交
2387 2388 2389 2390 2391 2392 2393 2394 2395 2396 2397
	retval = request_irq(brd->irq, mxser_interrupt, IRQF_SHARED, "mxser",
			brd);
	if (retval) {
		printk(KERN_ERR "Board %s: Request irq failed, IRQ (%d) may "
			"conflict with another device.\n",
			brd->info->name, brd->irq);
		/* We hold resources, we need to release them. */
		mxser_release_res(brd, pdev, 0);
	}
	return retval;
}
L
Linus Torvalds 已提交
2398

J
Jiri Slaby 已提交
2399
static int __init mxser_get_ISA_conf(int cap, struct mxser_board *brd)
L
Linus Torvalds 已提交
2400 2401 2402 2403 2404
{
	int id, i, bits;
	unsigned short regs[16], irq;
	unsigned char scratch, scratch2;

J
Jiri Slaby 已提交
2405
	brd->chip_flag = MOXA_OTHER_UART;
L
Linus Torvalds 已提交
2406 2407

	id = mxser_read_register(cap, regs);
J
Jiri Slaby 已提交
2408 2409 2410 2411 2412 2413 2414 2415 2416 2417 2418 2419 2420 2421 2422 2423 2424 2425 2426 2427
	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:
2428
		return 0;
J
Jiri Slaby 已提交
2429
	}
L
Linus Torvalds 已提交
2430 2431

	irq = 0;
J
Jiri Slaby 已提交
2432 2433 2434
	/* 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 已提交
2435 2436 2437
		irq = regs[9] & 0xF000;
		irq = irq | (irq >> 4);
		if (irq != (regs[9] & 0xFF00))
J
Jiri Slaby 已提交
2438
			goto err_irqconflict;
J
Jiri Slaby 已提交
2439
	} else if (brd->info->nports == 4) {
L
Linus Torvalds 已提交
2440 2441 2442 2443
		irq = regs[9] & 0xF000;
		irq = irq | (irq >> 4);
		irq = irq | (irq >> 8);
		if (irq != regs[9])
J
Jiri Slaby 已提交
2444
			goto err_irqconflict;
J
Jiri Slaby 已提交
2445
	} else if (brd->info->nports == 8) {
L
Linus Torvalds 已提交
2446 2447 2448 2449
		irq = regs[9] & 0xF000;
		irq = irq | (irq >> 4);
		irq = irq | (irq >> 8);
		if ((irq != regs[9]) || (irq != regs[10]))
J
Jiri Slaby 已提交
2450
			goto err_irqconflict;
L
Linus Torvalds 已提交
2451 2452
	}

J
Jiri Slaby 已提交
2453 2454 2455 2456
	if (!irq) {
		printk(KERN_ERR "mxser: interrupt number unset\n");
		return -EIO;
	}
J
Jiri Slaby 已提交
2457
	brd->irq = ((int)(irq & 0xF000) >> 12);
L
Linus Torvalds 已提交
2458
	for (i = 0; i < 8; i++)
J
Jiri Slaby 已提交
2459
		brd->ports[i].ioaddr = (int) regs[i + 1] & 0xFFF8;
J
Jiri Slaby 已提交
2460 2461 2462 2463
	if ((regs[12] & 0x80) == 0) {
		printk(KERN_ERR "mxser: invalid interrupt vector\n");
		return -EIO;
	}
J
Jiri Slaby 已提交
2464
	brd->vector = (int)regs[11];	/* interrupt vector */
L
Linus Torvalds 已提交
2465
	if (id == 1)
J
Jiri Slaby 已提交
2466
		brd->vector_mask = 0x00FF;
L
Linus Torvalds 已提交
2467
	else
J
Jiri Slaby 已提交
2468
		brd->vector_mask = 0x000F;
L
Linus Torvalds 已提交
2469 2470
	for (i = 7, bits = 0x0100; i >= 0; i--, bits <<= 1) {
		if (regs[12] & bits) {
J
Jiri Slaby 已提交
2471 2472
			brd->ports[i].baud_base = 921600;
			brd->ports[i].max_baud = 921600;
L
Linus Torvalds 已提交
2473
		} else {
J
Jiri Slaby 已提交
2474 2475
			brd->ports[i].baud_base = 115200;
			brd->ports[i].max_baud = 115200;
L
Linus Torvalds 已提交
2476 2477 2478 2479 2480 2481 2482 2483 2484 2485
		}
	}
	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 已提交
2486
		brd->uart_type = PORT_16550A;
L
Linus Torvalds 已提交
2487
	else
J
Jiri Slaby 已提交
2488 2489
		brd->uart_type = PORT_16450;
	if (!request_region(brd->ports[0].ioaddr, 8 * brd->info->nports,
J
Jiri Slaby 已提交
2490 2491 2492 2493 2494 2495 2496
			"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 已提交
2497 2498
	if (!request_region(brd->vector, 1, "mxser(vector)")) {
		release_region(brd->ports[0].ioaddr, 8 * brd->info->nports);
J
Jiri Slaby 已提交
2499 2500 2501 2502 2503
		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);
		return -EIO;
J
Jiri Slaby 已提交
2504 2505
	}
	return brd->info->nports;
J
Jiri Slaby 已提交
2506 2507 2508 2509

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

J
Jiri Slaby 已提交
2512 2513
static int __devinit mxser_probe(struct pci_dev *pdev,
		const struct pci_device_id *ent)
L
Linus Torvalds 已提交
2514
{
J
Jiri Slaby 已提交
2515 2516 2517 2518 2519
#ifdef CONFIG_PCI
	struct mxser_board *brd;
	unsigned int i, j;
	unsigned long ioaddress;
	int retval = -EINVAL;
L
Linus Torvalds 已提交
2520

J
Jiri Slaby 已提交
2521 2522 2523 2524 2525
	for (i = 0; i < MXSER_BOARDS; i++)
		if (mxser_boards[i].info == NULL)
			break;

	if (i >= MXSER_BOARDS) {
J
Jiri Slaby 已提交
2526 2527
		dev_err(&pdev->dev, "too many boards found (maximum %d), board "
				"not configured\n", MXSER_BOARDS);
J
Jiri Slaby 已提交
2528 2529 2530 2531 2532
		goto err;
	}

	brd = &mxser_boards[i];
	brd->idx = i * MXSER_PORTS_PER_BOARD;
J
Jiri Slaby 已提交
2533
	dev_info(&pdev->dev, "found MOXA %s board (BusNo=%d, DevNo=%d)\n",
J
Jiri Slaby 已提交
2534 2535 2536 2537 2538
		mxser_cards[ent->driver_data].name,
		pdev->bus->number, PCI_SLOT(pdev->devfn));

	retval = pci_enable_device(pdev);
	if (retval) {
J
Jiri Slaby 已提交
2539
		dev_err(&pdev->dev, "PCI enable failed\n");
J
Jiri Slaby 已提交
2540 2541 2542 2543 2544 2545 2546 2547 2548 2549 2550 2551 2552 2553 2554 2555 2556 2557 2558 2559 2560 2561 2562 2563 2564 2565 2566 2567 2568 2569 2570 2571 2572 2573 2574 2575 2576
		goto err;
	}

	/* io address */
	ioaddress = pci_resource_start(pdev, 2);
	retval = pci_request_region(pdev, 2, "mxser(IO)");
	if (retval)
		goto err;

	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)
		goto err_relio;
	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 已提交
2577 2578
			}
		}
J
Jiri Slaby 已提交
2579 2580 2581 2582 2583 2584 2585 2586
	}

	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 已提交
2587
		}
J
Jiri Slaby 已提交
2588 2589
		outb(0, ioaddress + 4);	/* default set to RS232 mode */
		outb(0, ioaddress + 0x0c);	/* default set to RS232 mode */
L
Linus Torvalds 已提交
2590
	}
J
Jiri Slaby 已提交
2591 2592 2593 2594 2595 2596 2597 2598 2599 2600 2601 2602 2603 2604 2605 2606 2607 2608 2609 2610 2611 2612 2613 2614 2615 2616

	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)
		goto err_null;

	for (i = 0; i < brd->info->nports; i++)
		tty_register_device(mxvar_sdriver, brd->idx + i, &pdev->dev);

	pci_set_drvdata(pdev, brd);

	return 0;
err_relio:
	pci_release_region(pdev, 2);
err_null:
	brd->info = NULL;
err:
	return retval;
#else
	return -ENODEV;
#endif
L
Linus Torvalds 已提交
2617 2618
}

J
Jiri Slaby 已提交
2619
static void __devexit mxser_remove(struct pci_dev *pdev)
L
Linus Torvalds 已提交
2620
{
J
Jiri Slaby 已提交
2621 2622
	struct mxser_board *brd = pci_get_drvdata(pdev);
	unsigned int i;
L
Linus Torvalds 已提交
2623

J
Jiri Slaby 已提交
2624 2625
	for (i = 0; i < brd->info->nports; i++)
		tty_unregister_device(mxvar_sdriver, brd->idx + i);
L
Linus Torvalds 已提交
2626

J
Jiri Slaby 已提交
2627 2628
	mxser_release_res(brd, pdev, 1);
	brd->info = NULL;
L
Linus Torvalds 已提交
2629 2630
}

J
Jiri Slaby 已提交
2631 2632 2633 2634 2635 2636 2637 2638
static struct pci_driver mxser_driver = {
	.name = "mxser",
	.id_table = mxser_pcibrds,
	.probe = mxser_probe,
	.remove = __devexit_p(mxser_remove)
};

static int __init mxser_module_init(void)
L
Linus Torvalds 已提交
2639
{
J
Jiri Slaby 已提交
2640
	struct mxser_board *brd;
2641 2642
	unsigned int b, i, m;
	int retval;
L
Linus Torvalds 已提交
2643

J
Jiri Slaby 已提交
2644 2645 2646 2647 2648 2649 2650 2651 2652 2653 2654 2655 2656 2657 2658 2659 2660 2661 2662 2663 2664 2665 2666 2667 2668 2669
	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->owner = THIS_MODULE;
	mxvar_sdriver->magic = TTY_DRIVER_MAGIC;
	mxvar_sdriver->name = "ttyMI";
	mxvar_sdriver->major = ttymajor;
	mxvar_sdriver->minor_start = 0;
	mxvar_sdriver->num = MXSER_PORTS + 1;
	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 已提交
2670
	}
J
Jiri Slaby 已提交
2671 2672

	/* Start finding ISA boards here */
2673 2674 2675 2676 2677
	for (m = 0, b = 0; b < MXSER_BOARDS; b++) {
		if (!ioaddr[b])
			continue;

		brd = &mxser_boards[m];
P
Peter Botha 已提交
2678
		retval = mxser_get_ISA_conf(ioaddr[b], brd);
2679 2680 2681 2682
		if (retval <= 0) {
			brd->info = NULL;
			continue;
		}
J
Jiri Slaby 已提交
2683

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

2687 2688 2689 2690 2691
		/* mxser_initbrd will hook ISR. */
		if (mxser_initbrd(brd, NULL) < 0) {
			brd->info = NULL;
			continue;
		}
J
Jiri Slaby 已提交
2692

2693 2694 2695
		brd->idx = m * MXSER_PORTS_PER_BOARD;
		for (i = 0; i < brd->info->nports; i++)
			tty_register_device(mxvar_sdriver, brd->idx + i, NULL);
J
Jiri Slaby 已提交
2696

2697 2698
		m++;
	}
J
Jiri Slaby 已提交
2699 2700 2701

	retval = pci_register_driver(&mxser_driver);
	if (retval) {
J
Jiri Slaby 已提交
2702
		printk(KERN_ERR "mxser: can't register pci driver\n");
J
Jiri Slaby 已提交
2703 2704 2705 2706 2707 2708 2709 2710 2711 2712 2713 2714 2715 2716 2717 2718 2719 2720 2721 2722 2723 2724 2725 2726 2727 2728 2729 2730 2731 2732 2733
		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)
{
	unsigned int i, j;

	pci_unregister_driver(&mxser_driver);

	for (i = 0; i < MXSER_BOARDS; i++) /* ISA remains */
		if (mxser_boards[i].info != NULL)
			for (j = 0; j < mxser_boards[i].info->nports; j++)
				tty_unregister_device(mxvar_sdriver,
						mxser_boards[i].idx + j);
	tty_unregister_driver(mxvar_sdriver);
	put_tty_driver(mxvar_sdriver);

	for (i = 0; i < MXSER_BOARDS; i++)
		if (mxser_boards[i].info != NULL)
			mxser_release_res(&mxser_boards[i], NULL, 1);
L
Linus Torvalds 已提交
2734 2735 2736 2737
}

module_init(mxser_module_init);
module_exit(mxser_module_exit);