Merge branch 'for-2.6.27' of git://linux-nfs.org/~bfields/linux
[pandora-kernel.git] / drivers / char / mxser.c
1 /*
2  *          mxser.c  -- MOXA Smartio/Industio family multiport serial driver.
3  *
4  *      Copyright (C) 1999-2006  Moxa Technologies (support@moxa.com).
5  *      Copyright (C) 2006-2008  Jiri Slaby <jirislaby@gmail.com>
6  *
7  *      This code is loosely based on the 1.8 moxa driver which is based on
8  *      Linux serial driver, written by Linus Torvalds, Theodore T'so and
9  *      others.
10  *
11  *      This program is free software; you can redistribute it and/or modify
12  *      it under the terms of the GNU General Public License as published by
13  *      the Free Software Foundation; either version 2 of the License, or
14  *      (at your option) any later version.
15  *
16  *      Fed through a cleanup, indent and remove of non 2.6 code by Alan Cox
17  *      <alan@redhat.com>. The original 1.8 code is available on www.moxa.com.
18  *      - Fixed x86_64 cleanness
19  *      - Fixed sleep with spinlock held in mxser_send_break
20  */
21
22 #include <linux/module.h>
23 #include <linux/errno.h>
24 #include <linux/signal.h>
25 #include <linux/sched.h>
26 #include <linux/timer.h>
27 #include <linux/interrupt.h>
28 #include <linux/tty.h>
29 #include <linux/tty_flip.h>
30 #include <linux/serial.h>
31 #include <linux/serial_reg.h>
32 #include <linux/major.h>
33 #include <linux/string.h>
34 #include <linux/fcntl.h>
35 #include <linux/ptrace.h>
36 #include <linux/gfp.h>
37 #include <linux/ioport.h>
38 #include <linux/mm.h>
39 #include <linux/delay.h>
40 #include <linux/pci.h>
41 #include <linux/bitops.h>
42
43 #include <asm/system.h>
44 #include <asm/io.h>
45 #include <asm/irq.h>
46 #include <asm/uaccess.h>
47
48 #include "mxser.h"
49
50 #define MXSER_VERSION   "2.0.3"         /* 1.11 */
51 #define MXSERMAJOR       174
52 #define MXSERCUMAJOR     175
53
54 #define MXSER_BOARDS            4       /* Max. boards */
55 #define MXSER_PORTS_PER_BOARD   8       /* Max. ports per board */
56 #define MXSER_PORTS             (MXSER_BOARDS * MXSER_PORTS_PER_BOARD)
57 #define MXSER_ISR_PASS_LIMIT    100
58
59 #define MXSER_ERR_IOADDR        -1
60 #define MXSER_ERR_IRQ           -2
61 #define MXSER_ERR_IRQ_CONFLIT   -3
62 #define MXSER_ERR_VECTOR        -4
63
64 /*CheckIsMoxaMust return value*/
65 #define MOXA_OTHER_UART         0x00
66 #define MOXA_MUST_MU150_HWID    0x01
67 #define MOXA_MUST_MU860_HWID    0x02
68
69 #define WAKEUP_CHARS            256
70
71 #define UART_MCR_AFE            0x20
72 #define UART_LSR_SPECIAL        0x1E
73
74 #define PCI_DEVICE_ID_CB108     0x1080
75 #define PCI_DEVICE_ID_CB114     0x1142
76 #define PCI_DEVICE_ID_CP114UL   0x1143
77 #define PCI_DEVICE_ID_CB134I    0x1341
78 #define PCI_DEVICE_ID_CP138U    0x1380
79 #define PCI_DEVICE_ID_POS104UL  0x1044
80
81
82 #define C168_ASIC_ID    1
83 #define C104_ASIC_ID    2
84 #define C102_ASIC_ID    0xB
85 #define CI132_ASIC_ID   4
86 #define CI134_ASIC_ID   3
87 #define CI104J_ASIC_ID  5
88
89 #define MXSER_HIGHBAUD  1
90 #define MXSER_HAS2      2
91
92 /* This is only for PCI */
93 static const struct {
94         int type;
95         int tx_fifo;
96         int rx_fifo;
97         int xmit_fifo_size;
98         int rx_high_water;
99         int rx_trigger;
100         int rx_low_water;
101         long max_baud;
102 } Gpci_uart_info[] = {
103         {MOXA_OTHER_UART, 16, 16, 16, 14, 14, 1, 921600L},
104         {MOXA_MUST_MU150_HWID, 64, 64, 64, 48, 48, 16, 230400L},
105         {MOXA_MUST_MU860_HWID, 128, 128, 128, 96, 96, 32, 921600L}
106 };
107 #define UART_INFO_NUM   ARRAY_SIZE(Gpci_uart_info)
108
109 struct mxser_cardinfo {
110         char *name;
111         unsigned int nports;
112         unsigned int flags;
113 };
114
115 static const struct mxser_cardinfo mxser_cards[] = {
116 /* 0*/  { "C168 series",        8, },
117         { "C104 series",        4, },
118         { "CI-104J series",     4, },
119         { "C168H/PCI series",   8, },
120         { "C104H/PCI series",   4, },
121 /* 5*/  { "C102 series",        4, MXSER_HAS2 },        /* C102-ISA */
122         { "CI-132 series",      4, MXSER_HAS2 },
123         { "CI-134 series",      4, },
124         { "CP-132 series",      2, },
125         { "CP-114 series",      4, },
126 /*10*/  { "CT-114 series",      4, },
127         { "CP-102 series",      2, MXSER_HIGHBAUD },
128         { "CP-104U series",     4, },
129         { "CP-168U series",     8, },
130         { "CP-132U series",     2, },
131 /*15*/  { "CP-134U series",     4, },
132         { "CP-104JU series",    4, },
133         { "Moxa UC7000 Serial", 8, },           /* RC7000 */
134         { "CP-118U series",     8, },
135         { "CP-102UL series",    2, },
136 /*20*/  { "CP-102U series",     2, },
137         { "CP-118EL series",    8, },
138         { "CP-168EL series",    8, },
139         { "CP-104EL series",    4, },
140         { "CB-108 series",      8, },
141 /*25*/  { "CB-114 series",      4, },
142         { "CB-134I series",     4, },
143         { "CP-138U series",     8, },
144         { "POS-104UL series",   4, },
145         { "CP-114UL series",    4, }
146 };
147
148 /* driver_data correspond to the lines in the structure above
149    see also ISA probe function before you change something */
150 static struct pci_device_id mxser_pcibrds[] = {
151         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_C168),   .driver_data = 3 },
152         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_C104),   .driver_data = 4 },
153         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP132),  .driver_data = 8 },
154         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP114),  .driver_data = 9 },
155         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CT114),  .driver_data = 10 },
156         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP102),  .driver_data = 11 },
157         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP104U), .driver_data = 12 },
158         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP168U), .driver_data = 13 },
159         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP132U), .driver_data = 14 },
160         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP134U), .driver_data = 15 },
161         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP104JU),.driver_data = 16 },
162         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_RC7000), .driver_data = 17 },
163         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP118U), .driver_data = 18 },
164         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP102UL),.driver_data = 19 },
165         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP102U), .driver_data = 20 },
166         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP118EL),.driver_data = 21 },
167         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP168EL),.driver_data = 22 },
168         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_MOXA_CP104EL),.driver_data = 23 },
169         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CB108),       .driver_data = 24 },
170         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CB114),       .driver_data = 25 },
171         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CB134I),      .driver_data = 26 },
172         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP138U),      .driver_data = 27 },
173         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_POS104UL),    .driver_data = 28 },
174         { PCI_VDEVICE(MOXA, PCI_DEVICE_ID_CP114UL),     .driver_data = 29 },
175         { }
176 };
177 MODULE_DEVICE_TABLE(pci, mxser_pcibrds);
178
179 static int ioaddr[MXSER_BOARDS] = { 0, 0, 0, 0 };
180 static int ttymajor = MXSERMAJOR;
181
182 /* Variables for insmod */
183
184 MODULE_AUTHOR("Casper Yang");
185 MODULE_DESCRIPTION("MOXA Smartio/Industio Family Multiport Board Device Driver");
186 module_param_array(ioaddr, int, NULL, 0);
187 module_param(ttymajor, int, 0);
188 MODULE_LICENSE("GPL");
189
190 struct mxser_log {
191         int tick;
192         unsigned long rxcnt[MXSER_PORTS];
193         unsigned long txcnt[MXSER_PORTS];
194 };
195
196
197 struct mxser_mon {
198         unsigned long rxcnt;
199         unsigned long txcnt;
200         unsigned long up_rxcnt;
201         unsigned long up_txcnt;
202         int modem_status;
203         unsigned char hold_reason;
204 };
205
206 struct mxser_mon_ext {
207         unsigned long rx_cnt[32];
208         unsigned long tx_cnt[32];
209         unsigned long up_rxcnt[32];
210         unsigned long up_txcnt[32];
211         int modem_status[32];
212
213         long baudrate[32];
214         int databits[32];
215         int stopbits[32];
216         int parity[32];
217         int flowctrl[32];
218         int fifo[32];
219         int iftype[32];
220 };
221
222 struct mxser_board;
223
224 struct mxser_port {
225         struct tty_port port;
226         struct mxser_board *board;
227
228         unsigned long ioaddr;
229         unsigned long opmode_ioaddr;
230         int max_baud;
231
232         int rx_high_water;
233         int rx_trigger;         /* Rx fifo trigger level */
234         int rx_low_water;
235         int baud_base;          /* max. speed */
236         int type;               /* UART type */
237
238         int x_char;             /* xon/xoff character */
239         int IER;                /* Interrupt Enable Register */
240         int MCR;                /* Modem control register */
241
242         unsigned char stop_rx;
243         unsigned char ldisc_stop_rx;
244
245         int custom_divisor;
246         unsigned char err_shadow;
247
248         struct async_icount icount; /* kernel counters for 4 input interrupts */
249         int timeout;
250
251         int read_status_mask;
252         int ignore_status_mask;
253         int xmit_fifo_size;
254         int xmit_head;
255         int xmit_tail;
256         int xmit_cnt;
257
258         struct ktermios normal_termios;
259
260         struct mxser_mon mon_data;
261
262         spinlock_t slock;
263         wait_queue_head_t delta_msr_wait;
264 };
265
266 struct mxser_board {
267         unsigned int idx;
268         int irq;
269         const struct mxser_cardinfo *info;
270         unsigned long vector;
271         unsigned long vector_mask;
272
273         int chip_flag;
274         int uart_type;
275
276         struct mxser_port ports[MXSER_PORTS_PER_BOARD];
277 };
278
279 struct mxser_mstatus {
280         tcflag_t cflag;
281         int cts;
282         int dsr;
283         int ri;
284         int dcd;
285 };
286
287 static struct mxser_mstatus GMStatus[MXSER_PORTS];
288
289 static int mxserBoardCAP[MXSER_BOARDS] = {
290         0, 0, 0, 0
291         /*  0x180, 0x280, 0x200, 0x320 */
292 };
293
294 static struct mxser_board mxser_boards[MXSER_BOARDS];
295 static struct tty_driver *mxvar_sdriver;
296 static struct mxser_log mxvar_log;
297 static int mxvar_diagflag;
298 static unsigned char mxser_msr[MXSER_PORTS + 1];
299 static struct mxser_mon_ext mon_data_ext;
300 static int mxser_set_baud_method[MXSER_PORTS + 1];
301
302 static void mxser_enable_must_enchance_mode(unsigned long baseio)
303 {
304         u8 oldlcr;
305         u8 efr;
306
307         oldlcr = inb(baseio + UART_LCR);
308         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
309
310         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
311         efr |= MOXA_MUST_EFR_EFRB_ENABLE;
312
313         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
314         outb(oldlcr, baseio + UART_LCR);
315 }
316
317 static void mxser_disable_must_enchance_mode(unsigned long baseio)
318 {
319         u8 oldlcr;
320         u8 efr;
321
322         oldlcr = inb(baseio + UART_LCR);
323         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
324
325         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
326         efr &= ~MOXA_MUST_EFR_EFRB_ENABLE;
327
328         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
329         outb(oldlcr, baseio + UART_LCR);
330 }
331
332 static void mxser_set_must_xon1_value(unsigned long baseio, u8 value)
333 {
334         u8 oldlcr;
335         u8 efr;
336
337         oldlcr = inb(baseio + UART_LCR);
338         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
339
340         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
341         efr &= ~MOXA_MUST_EFR_BANK_MASK;
342         efr |= MOXA_MUST_EFR_BANK0;
343
344         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
345         outb(value, baseio + MOXA_MUST_XON1_REGISTER);
346         outb(oldlcr, baseio + UART_LCR);
347 }
348
349 static void mxser_set_must_xoff1_value(unsigned long baseio, u8 value)
350 {
351         u8 oldlcr;
352         u8 efr;
353
354         oldlcr = inb(baseio + UART_LCR);
355         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
356
357         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
358         efr &= ~MOXA_MUST_EFR_BANK_MASK;
359         efr |= MOXA_MUST_EFR_BANK0;
360
361         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
362         outb(value, baseio + MOXA_MUST_XOFF1_REGISTER);
363         outb(oldlcr, baseio + UART_LCR);
364 }
365
366 static void mxser_set_must_fifo_value(struct mxser_port *info)
367 {
368         u8 oldlcr;
369         u8 efr;
370
371         oldlcr = inb(info->ioaddr + UART_LCR);
372         outb(MOXA_MUST_ENTER_ENCHANCE, info->ioaddr + UART_LCR);
373
374         efr = inb(info->ioaddr + MOXA_MUST_EFR_REGISTER);
375         efr &= ~MOXA_MUST_EFR_BANK_MASK;
376         efr |= MOXA_MUST_EFR_BANK1;
377
378         outb(efr, info->ioaddr + MOXA_MUST_EFR_REGISTER);
379         outb((u8)info->rx_high_water, info->ioaddr + MOXA_MUST_RBRTH_REGISTER);
380         outb((u8)info->rx_trigger, info->ioaddr + MOXA_MUST_RBRTI_REGISTER);
381         outb((u8)info->rx_low_water, info->ioaddr + MOXA_MUST_RBRTL_REGISTER);
382         outb(oldlcr, info->ioaddr + UART_LCR);
383 }
384
385 static void mxser_set_must_enum_value(unsigned long baseio, u8 value)
386 {
387         u8 oldlcr;
388         u8 efr;
389
390         oldlcr = inb(baseio + UART_LCR);
391         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
392
393         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
394         efr &= ~MOXA_MUST_EFR_BANK_MASK;
395         efr |= MOXA_MUST_EFR_BANK2;
396
397         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
398         outb(value, baseio + MOXA_MUST_ENUM_REGISTER);
399         outb(oldlcr, baseio + UART_LCR);
400 }
401
402 static void mxser_get_must_hardware_id(unsigned long baseio, u8 *pId)
403 {
404         u8 oldlcr;
405         u8 efr;
406
407         oldlcr = inb(baseio + UART_LCR);
408         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
409
410         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
411         efr &= ~MOXA_MUST_EFR_BANK_MASK;
412         efr |= MOXA_MUST_EFR_BANK2;
413
414         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
415         *pId = inb(baseio + MOXA_MUST_HWID_REGISTER);
416         outb(oldlcr, baseio + UART_LCR);
417 }
418
419 static void SET_MOXA_MUST_NO_SOFTWARE_FLOW_CONTROL(unsigned long baseio)
420 {
421         u8 oldlcr;
422         u8 efr;
423
424         oldlcr = inb(baseio + UART_LCR);
425         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
426
427         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
428         efr &= ~MOXA_MUST_EFR_SF_MASK;
429
430         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
431         outb(oldlcr, baseio + UART_LCR);
432 }
433
434 static void mxser_enable_must_tx_software_flow_control(unsigned long baseio)
435 {
436         u8 oldlcr;
437         u8 efr;
438
439         oldlcr = inb(baseio + UART_LCR);
440         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
441
442         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
443         efr &= ~MOXA_MUST_EFR_SF_TX_MASK;
444         efr |= MOXA_MUST_EFR_SF_TX1;
445
446         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
447         outb(oldlcr, baseio + UART_LCR);
448 }
449
450 static void mxser_disable_must_tx_software_flow_control(unsigned long baseio)
451 {
452         u8 oldlcr;
453         u8 efr;
454
455         oldlcr = inb(baseio + UART_LCR);
456         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
457
458         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
459         efr &= ~MOXA_MUST_EFR_SF_TX_MASK;
460
461         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
462         outb(oldlcr, baseio + UART_LCR);
463 }
464
465 static void mxser_enable_must_rx_software_flow_control(unsigned long baseio)
466 {
467         u8 oldlcr;
468         u8 efr;
469
470         oldlcr = inb(baseio + UART_LCR);
471         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
472
473         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
474         efr &= ~MOXA_MUST_EFR_SF_RX_MASK;
475         efr |= MOXA_MUST_EFR_SF_RX1;
476
477         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
478         outb(oldlcr, baseio + UART_LCR);
479 }
480
481 static void mxser_disable_must_rx_software_flow_control(unsigned long baseio)
482 {
483         u8 oldlcr;
484         u8 efr;
485
486         oldlcr = inb(baseio + UART_LCR);
487         outb(MOXA_MUST_ENTER_ENCHANCE, baseio + UART_LCR);
488
489         efr = inb(baseio + MOXA_MUST_EFR_REGISTER);
490         efr &= ~MOXA_MUST_EFR_SF_RX_MASK;
491
492         outb(efr, baseio + MOXA_MUST_EFR_REGISTER);
493         outb(oldlcr, baseio + UART_LCR);
494 }
495
496 #ifdef CONFIG_PCI
497 static int __devinit CheckIsMoxaMust(unsigned long io)
498 {
499         u8 oldmcr, hwid;
500         int i;
501
502         outb(0, io + UART_LCR);
503         mxser_disable_must_enchance_mode(io);
504         oldmcr = inb(io + UART_MCR);
505         outb(0, io + UART_MCR);
506         mxser_set_must_xon1_value(io, 0x11);
507         if ((hwid = inb(io + UART_MCR)) != 0) {
508                 outb(oldmcr, io + UART_MCR);
509                 return MOXA_OTHER_UART;
510         }
511
512         mxser_get_must_hardware_id(io, &hwid);
513         for (i = 1; i < UART_INFO_NUM; i++) { /* 0 = OTHER_UART */
514                 if (hwid == Gpci_uart_info[i].type)
515                         return (int)hwid;
516         }
517         return MOXA_OTHER_UART;
518 }
519 #endif
520
521 static void process_txrx_fifo(struct mxser_port *info)
522 {
523         int i;
524
525         if ((info->type == PORT_16450) || (info->type == PORT_8250)) {
526                 info->rx_trigger = 1;
527                 info->rx_high_water = 1;
528                 info->rx_low_water = 1;
529                 info->xmit_fifo_size = 1;
530         } else
531                 for (i = 0; i < UART_INFO_NUM; i++)
532                         if (info->board->chip_flag == Gpci_uart_info[i].type) {
533                                 info->rx_trigger = Gpci_uart_info[i].rx_trigger;
534                                 info->rx_low_water = Gpci_uart_info[i].rx_low_water;
535                                 info->rx_high_water = Gpci_uart_info[i].rx_high_water;
536                                 info->xmit_fifo_size = Gpci_uart_info[i].xmit_fifo_size;
537                                 break;
538                         }
539 }
540
541 static unsigned char mxser_get_msr(int baseaddr, int mode, int port)
542 {
543         unsigned char status = 0;
544
545         status = inb(baseaddr + UART_MSR);
546
547         mxser_msr[port] &= 0x0F;
548         mxser_msr[port] |= status;
549         status = mxser_msr[port];
550         if (mode)
551                 mxser_msr[port] = 0;
552
553         return status;
554 }
555
556 static int mxser_block_til_ready(struct tty_struct *tty, struct file *filp,
557                 struct mxser_port *port)
558 {
559         DECLARE_WAITQUEUE(wait, current);
560         int retval;
561         int do_clocal = 0;
562         unsigned long flags;
563
564         /*
565          * If non-blocking mode is set, or the port is not enabled,
566          * then make the check up front and then exit.
567          */
568         if ((filp->f_flags & O_NONBLOCK) ||
569                         test_bit(TTY_IO_ERROR, &tty->flags)) {
570                 port->port.flags |= ASYNC_NORMAL_ACTIVE;
571                 return 0;
572         }
573
574         if (tty->termios->c_cflag & CLOCAL)
575                 do_clocal = 1;
576
577         /*
578          * Block waiting for the carrier detect and the line to become
579          * free (i.e., not in use by the callout).  While we are in
580          * this loop, port->port.count is dropped by one, so that
581          * mxser_close() knows when to free things.  We restore it upon
582          * exit, either normal or abnormal.
583          */
584         retval = 0;
585         add_wait_queue(&port->port.open_wait, &wait);
586
587         spin_lock_irqsave(&port->slock, flags);
588         if (!tty_hung_up_p(filp))
589                 port->port.count--;
590         spin_unlock_irqrestore(&port->slock, flags);
591         port->port.blocked_open++;
592         while (1) {
593                 spin_lock_irqsave(&port->slock, flags);
594                 outb(inb(port->ioaddr + UART_MCR) |
595                         UART_MCR_DTR | UART_MCR_RTS, port->ioaddr + UART_MCR);
596                 spin_unlock_irqrestore(&port->slock, flags);
597                 set_current_state(TASK_INTERRUPTIBLE);
598                 if (tty_hung_up_p(filp) || !(port->port.flags & ASYNC_INITIALIZED)) {
599                         if (port->port.flags & ASYNC_HUP_NOTIFY)
600                                 retval = -EAGAIN;
601                         else
602                                 retval = -ERESTARTSYS;
603                         break;
604                 }
605                 if (!(port->port.flags & ASYNC_CLOSING) &&
606                                 (do_clocal ||
607                                 (inb(port->ioaddr + UART_MSR) & UART_MSR_DCD)))
608                         break;
609                 if (signal_pending(current)) {
610                         retval = -ERESTARTSYS;
611                         break;
612                 }
613                 schedule();
614         }
615         set_current_state(TASK_RUNNING);
616         remove_wait_queue(&port->port.open_wait, &wait);
617         if (!tty_hung_up_p(filp))
618                 port->port.count++;
619         port->port.blocked_open--;
620         if (retval)
621                 return retval;
622         port->port.flags |= ASYNC_NORMAL_ACTIVE;
623         return 0;
624 }
625
626 static int mxser_set_baud(struct mxser_port *info, long newspd)
627 {
628         int quot = 0, baud;
629         unsigned char cval;
630
631         if (!info->port.tty || !info->port.tty->termios)
632                 return -1;
633
634         if (!(info->ioaddr))
635                 return -1;
636
637         if (newspd > info->max_baud)
638                 return -1;
639
640         if (newspd == 134) {
641                 quot = 2 * info->baud_base / 269;
642                 tty_encode_baud_rate(info->port.tty, 134, 134);
643         } else if (newspd) {
644                 quot = info->baud_base / newspd;
645                 if (quot == 0)
646                         quot = 1;
647                 baud = info->baud_base/quot;
648                 tty_encode_baud_rate(info->port.tty, baud, baud);
649         } else {
650                 quot = 0;
651         }
652
653         info->timeout = ((info->xmit_fifo_size * HZ * 10 * quot) / info->baud_base);
654         info->timeout += HZ / 50;       /* Add .02 seconds of slop */
655
656         if (quot) {
657                 info->MCR |= UART_MCR_DTR;
658                 outb(info->MCR, info->ioaddr + UART_MCR);
659         } else {
660                 info->MCR &= ~UART_MCR_DTR;
661                 outb(info->MCR, info->ioaddr + UART_MCR);
662                 return 0;
663         }
664
665         cval = inb(info->ioaddr + UART_LCR);
666
667         outb(cval | UART_LCR_DLAB, info->ioaddr + UART_LCR);    /* set DLAB */
668
669         outb(quot & 0xff, info->ioaddr + UART_DLL);     /* LS of divisor */
670         outb(quot >> 8, info->ioaddr + UART_DLM);       /* MS of divisor */
671         outb(cval, info->ioaddr + UART_LCR);    /* reset DLAB */
672
673 #ifdef BOTHER
674         if (C_BAUD(info->port.tty) == BOTHER) {
675                 quot = info->baud_base % newspd;
676                 quot *= 8;
677                 if (quot % newspd > newspd / 2) {
678                         quot /= newspd;
679                         quot++;
680                 } else
681                         quot /= newspd;
682
683                 mxser_set_must_enum_value(info->ioaddr, quot);
684         } else
685 #endif
686                 mxser_set_must_enum_value(info->ioaddr, 0);
687
688         return 0;
689 }
690
691 /*
692  * This routine is called to set the UART divisor registers to match
693  * the specified baud rate for a serial port.
694  */
695 static int mxser_change_speed(struct mxser_port *info,
696                 struct ktermios *old_termios)
697 {
698         unsigned cflag, cval, fcr;
699         int ret = 0;
700         unsigned char status;
701
702         if (!info->port.tty || !info->port.tty->termios)
703                 return ret;
704         cflag = info->port.tty->termios->c_cflag;
705         if (!(info->ioaddr))
706                 return ret;
707
708         if (mxser_set_baud_method[info->port.tty->index] == 0)
709                 mxser_set_baud(info, tty_get_baud_rate(info->port.tty));
710
711         /* byte size and parity */
712         switch (cflag & CSIZE) {
713         case CS5:
714                 cval = 0x00;
715                 break;
716         case CS6:
717                 cval = 0x01;
718                 break;
719         case CS7:
720                 cval = 0x02;
721                 break;
722         case CS8:
723                 cval = 0x03;
724                 break;
725         default:
726                 cval = 0x00;
727                 break;          /* too keep GCC shut... */
728         }
729         if (cflag & CSTOPB)
730                 cval |= 0x04;
731         if (cflag & PARENB)
732                 cval |= UART_LCR_PARITY;
733         if (!(cflag & PARODD))
734                 cval |= UART_LCR_EPAR;
735         if (cflag & CMSPAR)
736                 cval |= UART_LCR_SPAR;
737
738         if ((info->type == PORT_8250) || (info->type == PORT_16450)) {
739                 if (info->board->chip_flag) {
740                         fcr = UART_FCR_ENABLE_FIFO;
741                         fcr |= MOXA_MUST_FCR_GDA_MODE_ENABLE;
742                         mxser_set_must_fifo_value(info);
743                 } else
744                         fcr = 0;
745         } else {
746                 fcr = UART_FCR_ENABLE_FIFO;
747                 if (info->board->chip_flag) {
748                         fcr |= MOXA_MUST_FCR_GDA_MODE_ENABLE;
749                         mxser_set_must_fifo_value(info);
750                 } else {
751                         switch (info->rx_trigger) {
752                         case 1:
753                                 fcr |= UART_FCR_TRIGGER_1;
754                                 break;
755                         case 4:
756                                 fcr |= UART_FCR_TRIGGER_4;
757                                 break;
758                         case 8:
759                                 fcr |= UART_FCR_TRIGGER_8;
760                                 break;
761                         default:
762                                 fcr |= UART_FCR_TRIGGER_14;
763                                 break;
764                         }
765                 }
766         }
767
768         /* CTS flow control flag and modem status interrupts */
769         info->IER &= ~UART_IER_MSI;
770         info->MCR &= ~UART_MCR_AFE;
771         if (cflag & CRTSCTS) {
772                 info->port.flags |= ASYNC_CTS_FLOW;
773                 info->IER |= UART_IER_MSI;
774                 if ((info->type == PORT_16550A) || (info->board->chip_flag)) {
775                         info->MCR |= UART_MCR_AFE;
776                 } else {
777                         status = inb(info->ioaddr + UART_MSR);
778                         if (info->port.tty->hw_stopped) {
779                                 if (status & UART_MSR_CTS) {
780                                         info->port.tty->hw_stopped = 0;
781                                         if (info->type != PORT_16550A &&
782                                                         !info->board->chip_flag) {
783                                                 outb(info->IER & ~UART_IER_THRI,
784                                                         info->ioaddr +
785                                                         UART_IER);
786                                                 info->IER |= UART_IER_THRI;
787                                                 outb(info->IER, info->ioaddr +
788                                                                 UART_IER);
789                                         }
790                                         tty_wakeup(info->port.tty);
791                                 }
792                         } else {
793                                 if (!(status & UART_MSR_CTS)) {
794                                         info->port.tty->hw_stopped = 1;
795                                         if ((info->type != PORT_16550A) &&
796                                                         (!info->board->chip_flag)) {
797                                                 info->IER &= ~UART_IER_THRI;
798                                                 outb(info->IER, info->ioaddr +
799                                                                 UART_IER);
800                                         }
801                                 }
802                         }
803                 }
804         } else {
805                 info->port.flags &= ~ASYNC_CTS_FLOW;
806         }
807         outb(info->MCR, info->ioaddr + UART_MCR);
808         if (cflag & CLOCAL) {
809                 info->port.flags &= ~ASYNC_CHECK_CD;
810         } else {
811                 info->port.flags |= ASYNC_CHECK_CD;
812                 info->IER |= UART_IER_MSI;
813         }
814         outb(info->IER, info->ioaddr + UART_IER);
815
816         /*
817          * Set up parity check flag
818          */
819         info->read_status_mask = UART_LSR_OE | UART_LSR_THRE | UART_LSR_DR;
820         if (I_INPCK(info->port.tty))
821                 info->read_status_mask |= UART_LSR_FE | UART_LSR_PE;
822         if (I_BRKINT(info->port.tty) || I_PARMRK(info->port.tty))
823                 info->read_status_mask |= UART_LSR_BI;
824
825         info->ignore_status_mask = 0;
826
827         if (I_IGNBRK(info->port.tty)) {
828                 info->ignore_status_mask |= UART_LSR_BI;
829                 info->read_status_mask |= UART_LSR_BI;
830                 /*
831                  * If we're ignore parity and break indicators, ignore
832                  * overruns too.  (For real raw support).
833                  */
834                 if (I_IGNPAR(info->port.tty)) {
835                         info->ignore_status_mask |=
836                                                 UART_LSR_OE |
837                                                 UART_LSR_PE |
838                                                 UART_LSR_FE;
839                         info->read_status_mask |=
840                                                 UART_LSR_OE |
841                                                 UART_LSR_PE |
842                                                 UART_LSR_FE;
843                 }
844         }
845         if (info->board->chip_flag) {
846                 mxser_set_must_xon1_value(info->ioaddr, START_CHAR(info->port.tty));
847                 mxser_set_must_xoff1_value(info->ioaddr, STOP_CHAR(info->port.tty));
848                 if (I_IXON(info->port.tty)) {
849                         mxser_enable_must_rx_software_flow_control(
850                                         info->ioaddr);
851                 } else {
852                         mxser_disable_must_rx_software_flow_control(
853                                         info->ioaddr);
854                 }
855                 if (I_IXOFF(info->port.tty)) {
856                         mxser_enable_must_tx_software_flow_control(
857                                         info->ioaddr);
858                 } else {
859                         mxser_disable_must_tx_software_flow_control(
860                                         info->ioaddr);
861                 }
862         }
863
864
865         outb(fcr, info->ioaddr + UART_FCR);     /* set fcr */
866         outb(cval, info->ioaddr + UART_LCR);
867
868         return ret;
869 }
870
871 static void mxser_check_modem_status(struct mxser_port *port, int status)
872 {
873         /* update input line counters */
874         if (status & UART_MSR_TERI)
875                 port->icount.rng++;
876         if (status & UART_MSR_DDSR)
877                 port->icount.dsr++;
878         if (status & UART_MSR_DDCD)
879                 port->icount.dcd++;
880         if (status & UART_MSR_DCTS)
881                 port->icount.cts++;
882         port->mon_data.modem_status = status;
883         wake_up_interruptible(&port->delta_msr_wait);
884
885         if ((port->port.flags & ASYNC_CHECK_CD) && (status & UART_MSR_DDCD)) {
886                 if (status & UART_MSR_DCD)
887                         wake_up_interruptible(&port->port.open_wait);
888         }
889
890         if (port->port.flags & ASYNC_CTS_FLOW) {
891                 if (port->port.tty->hw_stopped) {
892                         if (status & UART_MSR_CTS) {
893                                 port->port.tty->hw_stopped = 0;
894
895                                 if ((port->type != PORT_16550A) &&
896                                                 (!port->board->chip_flag)) {
897                                         outb(port->IER & ~UART_IER_THRI,
898                                                 port->ioaddr + UART_IER);
899                                         port->IER |= UART_IER_THRI;
900                                         outb(port->IER, port->ioaddr +
901                                                         UART_IER);
902                                 }
903                                 tty_wakeup(port->port.tty);
904                         }
905                 } else {
906                         if (!(status & UART_MSR_CTS)) {
907                                 port->port.tty->hw_stopped = 1;
908                                 if (port->type != PORT_16550A &&
909                                                 !port->board->chip_flag) {
910                                         port->IER &= ~UART_IER_THRI;
911                                         outb(port->IER, port->ioaddr +
912                                                         UART_IER);
913                                 }
914                         }
915                 }
916         }
917 }
918
919 static int mxser_startup(struct mxser_port *info)
920 {
921         unsigned long page;
922         unsigned long flags;
923
924         page = __get_free_page(GFP_KERNEL);
925         if (!page)
926                 return -ENOMEM;
927
928         spin_lock_irqsave(&info->slock, flags);
929
930         if (info->port.flags & ASYNC_INITIALIZED) {
931                 free_page(page);
932                 spin_unlock_irqrestore(&info->slock, flags);
933                 return 0;
934         }
935
936         if (!info->ioaddr || !info->type) {
937                 if (info->port.tty)
938                         set_bit(TTY_IO_ERROR, &info->port.tty->flags);
939                 free_page(page);
940                 spin_unlock_irqrestore(&info->slock, flags);
941                 return 0;
942         }
943         if (info->port.xmit_buf)
944                 free_page(page);
945         else
946                 info->port.xmit_buf = (unsigned char *) page;
947
948         /*
949          * Clear the FIFO buffers and disable them
950          * (they will be reenabled in mxser_change_speed())
951          */
952         if (info->board->chip_flag)
953                 outb((UART_FCR_CLEAR_RCVR |
954                         UART_FCR_CLEAR_XMIT |
955                         MOXA_MUST_FCR_GDA_MODE_ENABLE), info->ioaddr + UART_FCR);
956         else
957                 outb((UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT),
958                         info->ioaddr + UART_FCR);
959
960         /*
961          * At this point there's no way the LSR could still be 0xFF;
962          * if it is, then bail out, because there's likely no UART
963          * here.
964          */
965         if (inb(info->ioaddr + UART_LSR) == 0xff) {
966                 spin_unlock_irqrestore(&info->slock, flags);
967                 if (capable(CAP_SYS_ADMIN)) {
968                         if (info->port.tty)
969                                 set_bit(TTY_IO_ERROR, &info->port.tty->flags);
970                         return 0;
971                 } else
972                         return -ENODEV;
973         }
974
975         /*
976          * Clear the interrupt registers.
977          */
978         (void) inb(info->ioaddr + UART_LSR);
979         (void) inb(info->ioaddr + UART_RX);
980         (void) inb(info->ioaddr + UART_IIR);
981         (void) inb(info->ioaddr + UART_MSR);
982
983         /*
984          * Now, initialize the UART
985          */
986         outb(UART_LCR_WLEN8, info->ioaddr + UART_LCR);  /* reset DLAB */
987         info->MCR = UART_MCR_DTR | UART_MCR_RTS;
988         outb(info->MCR, info->ioaddr + UART_MCR);
989
990         /*
991          * Finally, enable interrupts
992          */
993         info->IER = UART_IER_MSI | UART_IER_RLSI | UART_IER_RDI;
994
995         if (info->board->chip_flag)
996                 info->IER |= MOXA_MUST_IER_EGDAI;
997         outb(info->IER, info->ioaddr + UART_IER);       /* enable interrupts */
998
999         /*
1000          * And clear the interrupt registers again for luck.
1001          */
1002         (void) inb(info->ioaddr + UART_LSR);
1003         (void) inb(info->ioaddr + UART_RX);
1004         (void) inb(info->ioaddr + UART_IIR);
1005         (void) inb(info->ioaddr + UART_MSR);
1006
1007         if (info->port.tty)
1008                 clear_bit(TTY_IO_ERROR, &info->port.tty->flags);
1009         info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
1010
1011         /*
1012          * and set the speed of the serial port
1013          */
1014         mxser_change_speed(info, NULL);
1015         info->port.flags |= ASYNC_INITIALIZED;
1016         spin_unlock_irqrestore(&info->slock, flags);
1017
1018         return 0;
1019 }
1020
1021 /*
1022  * This routine will shutdown a serial port; interrupts maybe disabled, and
1023  * DTR is dropped if the hangup on close termio flag is on.
1024  */
1025 static void mxser_shutdown(struct mxser_port *info)
1026 {
1027         unsigned long flags;
1028
1029         if (!(info->port.flags & ASYNC_INITIALIZED))
1030                 return;
1031
1032         spin_lock_irqsave(&info->slock, flags);
1033
1034         /*
1035          * clear delta_msr_wait queue to avoid mem leaks: we may free the irq
1036          * here so the queue might never be waken up
1037          */
1038         wake_up_interruptible(&info->delta_msr_wait);
1039
1040         /*
1041          * Free the IRQ, if necessary
1042          */
1043         if (info->port.xmit_buf) {
1044                 free_page((unsigned long) info->port.xmit_buf);
1045                 info->port.xmit_buf = NULL;
1046         }
1047
1048         info->IER = 0;
1049         outb(0x00, info->ioaddr + UART_IER);
1050
1051         if (!info->port.tty || (info->port.tty->termios->c_cflag & HUPCL))
1052                 info->MCR &= ~(UART_MCR_DTR | UART_MCR_RTS);
1053         outb(info->MCR, info->ioaddr + UART_MCR);
1054
1055         /* clear Rx/Tx FIFO's */
1056         if (info->board->chip_flag)
1057                 outb(UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT |
1058                                 MOXA_MUST_FCR_GDA_MODE_ENABLE,
1059                                 info->ioaddr + UART_FCR);
1060         else
1061                 outb(UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT,
1062                         info->ioaddr + UART_FCR);
1063
1064         /* read data port to reset things */
1065         (void) inb(info->ioaddr + UART_RX);
1066
1067         if (info->port.tty)
1068                 set_bit(TTY_IO_ERROR, &info->port.tty->flags);
1069
1070         info->port.flags &= ~ASYNC_INITIALIZED;
1071
1072         if (info->board->chip_flag)
1073                 SET_MOXA_MUST_NO_SOFTWARE_FLOW_CONTROL(info->ioaddr);
1074
1075         spin_unlock_irqrestore(&info->slock, flags);
1076 }
1077
1078 /*
1079  * This routine is called whenever a serial port is opened.  It
1080  * enables interrupts for a serial port, linking in its async structure into
1081  * the IRQ chain.   It also performs the serial-specific
1082  * initialization for the tty structure.
1083  */
1084 static int mxser_open(struct tty_struct *tty, struct file *filp)
1085 {
1086         struct mxser_port *info;
1087         unsigned long flags;
1088         int retval, line;
1089
1090         line = tty->index;
1091         if (line == MXSER_PORTS)
1092                 return 0;
1093         if (line < 0 || line > MXSER_PORTS)
1094                 return -ENODEV;
1095         info = &mxser_boards[line / MXSER_PORTS_PER_BOARD].ports[line % MXSER_PORTS_PER_BOARD];
1096         if (!info->ioaddr)
1097                 return -ENODEV;
1098
1099         tty->driver_data = info;
1100         info->port.tty = tty;
1101         /*
1102          * Start up serial port
1103          */
1104         spin_lock_irqsave(&info->slock, flags);
1105         info->port.count++;
1106         spin_unlock_irqrestore(&info->slock, flags);
1107         retval = mxser_startup(info);
1108         if (retval)
1109                 return retval;
1110
1111         retval = mxser_block_til_ready(tty, filp, info);
1112         if (retval)
1113                 return retval;
1114
1115         /* unmark here for very high baud rate (ex. 921600 bps) used */
1116         tty->low_latency = 1;
1117         return 0;
1118 }
1119
1120 static void mxser_flush_buffer(struct tty_struct *tty)
1121 {
1122         struct mxser_port *info = tty->driver_data;
1123         char fcr;
1124         unsigned long flags;
1125
1126
1127         spin_lock_irqsave(&info->slock, flags);
1128         info->xmit_cnt = info->xmit_head = info->xmit_tail = 0;
1129
1130         fcr = inb(info->ioaddr + UART_FCR);
1131         outb((fcr | UART_FCR_CLEAR_RCVR | UART_FCR_CLEAR_XMIT),
1132                 info->ioaddr + UART_FCR);
1133         outb(fcr, info->ioaddr + UART_FCR);
1134
1135         spin_unlock_irqrestore(&info->slock, flags);
1136
1137         tty_wakeup(tty);
1138 }
1139
1140
1141 /*
1142  * This routine is called when the serial port gets closed.  First, we
1143  * wait for the last remaining data to be sent.  Then, we unlink its
1144  * async structure from the interrupt chain if necessary, and we free
1145  * that IRQ if nothing is left in the chain.
1146  */
1147 static void mxser_close(struct tty_struct *tty, struct file *filp)
1148 {
1149         struct mxser_port *info = tty->driver_data;
1150
1151         unsigned long timeout;
1152         unsigned long flags;
1153
1154         if (tty->index == MXSER_PORTS)
1155                 return;
1156         if (!info)
1157                 return;
1158
1159         spin_lock_irqsave(&info->slock, flags);
1160
1161         if (tty_hung_up_p(filp)) {
1162                 spin_unlock_irqrestore(&info->slock, flags);
1163                 return;
1164         }
1165         if ((tty->count == 1) && (info->port.count != 1)) {
1166                 /*
1167                  * Uh, oh.  tty->count is 1, which means that the tty
1168                  * structure will be freed.  Info->port.count should always
1169                  * be one in these conditions.  If it's greater than
1170                  * one, we've got real problems, since it means the
1171                  * serial port won't be shutdown.
1172                  */
1173                 printk(KERN_ERR "mxser_close: bad serial port count; "
1174                         "tty->count is 1, info->port.count is %d\n", info->port.count);
1175                 info->port.count = 1;
1176         }
1177         if (--info->port.count < 0) {
1178                 printk(KERN_ERR "mxser_close: bad serial port count for "
1179                         "ttys%d: %d\n", tty->index, info->port.count);
1180                 info->port.count = 0;
1181         }
1182         if (info->port.count) {
1183                 spin_unlock_irqrestore(&info->slock, flags);
1184                 return;
1185         }
1186         info->port.flags |= ASYNC_CLOSING;
1187         spin_unlock_irqrestore(&info->slock, flags);
1188         /*
1189          * Save the termios structure, since this port may have
1190          * separate termios for callout and dialin.
1191          */
1192         if (info->port.flags & ASYNC_NORMAL_ACTIVE)
1193                 info->normal_termios = *tty->termios;
1194         /*
1195          * Now we wait for the transmit buffer to clear; and we notify
1196          * the line discipline to only process XON/XOFF characters.
1197          */
1198         tty->closing = 1;
1199         if (info->port.closing_wait != ASYNC_CLOSING_WAIT_NONE)
1200                 tty_wait_until_sent(tty, info->port.closing_wait);
1201         /*
1202          * At this point we stop accepting input.  To do this, we
1203          * disable the receive line status interrupts, and tell the
1204          * interrupt driver to stop checking the data ready bit in the
1205          * line status register.
1206          */
1207         info->IER &= ~UART_IER_RLSI;
1208         if (info->board->chip_flag)
1209                 info->IER &= ~MOXA_MUST_RECV_ISR;
1210
1211         if (info->port.flags & ASYNC_INITIALIZED) {
1212                 outb(info->IER, info->ioaddr + UART_IER);
1213                 /*
1214                  * Before we drop DTR, make sure the UART transmitter
1215                  * has completely drained; this is especially
1216                  * important if there is a transmit FIFO!
1217                  */
1218                 timeout = jiffies + HZ;
1219                 while (!(inb(info->ioaddr + UART_LSR) & UART_LSR_TEMT)) {
1220                         schedule_timeout_interruptible(5);
1221                         if (time_after(jiffies, timeout))
1222                                 break;
1223                 }
1224         }
1225         mxser_shutdown(info);
1226
1227         mxser_flush_buffer(tty);
1228         tty_ldisc_flush(tty);
1229
1230         tty->closing = 0;
1231         info->port.tty = NULL;
1232         if (info->port.blocked_open) {
1233                 if (info->port.close_delay)
1234                         schedule_timeout_interruptible(info->port.close_delay);
1235                 wake_up_interruptible(&info->port.open_wait);
1236         }
1237
1238         info->port.flags &= ~(ASYNC_NORMAL_ACTIVE | ASYNC_CLOSING);
1239 }
1240
1241 static int mxser_write(struct tty_struct *tty, const unsigned char *buf, int count)
1242 {
1243         int c, total = 0;
1244         struct mxser_port *info = tty->driver_data;
1245         unsigned long flags;
1246
1247         if (!info->port.xmit_buf)
1248                 return 0;
1249
1250         while (1) {
1251                 c = min_t(int, count, min(SERIAL_XMIT_SIZE - info->xmit_cnt - 1,
1252                                           SERIAL_XMIT_SIZE - info->xmit_head));
1253                 if (c <= 0)
1254                         break;
1255
1256                 memcpy(info->port.xmit_buf + info->xmit_head, buf, c);
1257                 spin_lock_irqsave(&info->slock, flags);
1258                 info->xmit_head = (info->xmit_head + c) &
1259                                   (SERIAL_XMIT_SIZE - 1);
1260                 info->xmit_cnt += c;
1261                 spin_unlock_irqrestore(&info->slock, flags);
1262
1263                 buf += c;
1264                 count -= c;
1265                 total += c;
1266         }
1267
1268         if (info->xmit_cnt && !tty->stopped) {
1269                 if (!tty->hw_stopped ||
1270                                 (info->type == PORT_16550A) ||
1271                                 (info->board->chip_flag)) {
1272                         spin_lock_irqsave(&info->slock, flags);
1273                         outb(info->IER & ~UART_IER_THRI, info->ioaddr +
1274                                         UART_IER);
1275                         info->IER |= UART_IER_THRI;
1276                         outb(info->IER, info->ioaddr + UART_IER);
1277                         spin_unlock_irqrestore(&info->slock, flags);
1278                 }
1279         }
1280         return total;
1281 }
1282
1283 static int mxser_put_char(struct tty_struct *tty, unsigned char ch)
1284 {
1285         struct mxser_port *info = tty->driver_data;
1286         unsigned long flags;
1287
1288         if (!info->port.xmit_buf)
1289                 return 0;
1290
1291         if (info->xmit_cnt >= SERIAL_XMIT_SIZE - 1)
1292                 return 0;
1293
1294         spin_lock_irqsave(&info->slock, flags);
1295         info->port.xmit_buf[info->xmit_head++] = ch;
1296         info->xmit_head &= SERIAL_XMIT_SIZE - 1;
1297         info->xmit_cnt++;
1298         spin_unlock_irqrestore(&info->slock, flags);
1299         if (!tty->stopped) {
1300                 if (!tty->hw_stopped ||
1301                                 (info->type == PORT_16550A) ||
1302                                 info->board->chip_flag) {
1303                         spin_lock_irqsave(&info->slock, flags);
1304                         outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
1305                         info->IER |= UART_IER_THRI;
1306                         outb(info->IER, info->ioaddr + UART_IER);
1307                         spin_unlock_irqrestore(&info->slock, flags);
1308                 }
1309         }
1310         return 1;
1311 }
1312
1313
1314 static void mxser_flush_chars(struct tty_struct *tty)
1315 {
1316         struct mxser_port *info = tty->driver_data;
1317         unsigned long flags;
1318
1319         if (info->xmit_cnt <= 0 ||
1320                         tty->stopped ||
1321                         !info->port.xmit_buf ||
1322                         (tty->hw_stopped &&
1323                          (info->type != PORT_16550A) &&
1324                          (!info->board->chip_flag)
1325                         ))
1326                 return;
1327
1328         spin_lock_irqsave(&info->slock, flags);
1329
1330         outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
1331         info->IER |= UART_IER_THRI;
1332         outb(info->IER, info->ioaddr + UART_IER);
1333
1334         spin_unlock_irqrestore(&info->slock, flags);
1335 }
1336
1337 static int mxser_write_room(struct tty_struct *tty)
1338 {
1339         struct mxser_port *info = tty->driver_data;
1340         int ret;
1341
1342         ret = SERIAL_XMIT_SIZE - info->xmit_cnt - 1;
1343         if (ret < 0)
1344                 ret = 0;
1345         return ret;
1346 }
1347
1348 static int mxser_chars_in_buffer(struct tty_struct *tty)
1349 {
1350         struct mxser_port *info = tty->driver_data;
1351         return info->xmit_cnt;
1352 }
1353
1354 /*
1355  * ------------------------------------------------------------
1356  * friends of mxser_ioctl()
1357  * ------------------------------------------------------------
1358  */
1359 static int mxser_get_serial_info(struct mxser_port *info,
1360                 struct serial_struct __user *retinfo)
1361 {
1362         struct serial_struct tmp = {
1363                 .type = info->type,
1364                 .line = info->port.tty->index,
1365                 .port = info->ioaddr,
1366                 .irq = info->board->irq,
1367                 .flags = info->port.flags,
1368                 .baud_base = info->baud_base,
1369                 .close_delay = info->port.close_delay,
1370                 .closing_wait = info->port.closing_wait,
1371                 .custom_divisor = info->custom_divisor,
1372                 .hub6 = 0
1373         };
1374         if (copy_to_user(retinfo, &tmp, sizeof(*retinfo)))
1375                 return -EFAULT;
1376         return 0;
1377 }
1378
1379 static int mxser_set_serial_info(struct mxser_port *info,
1380                 struct serial_struct __user *new_info)
1381 {
1382         struct serial_struct new_serial;
1383         speed_t baud;
1384         unsigned long sl_flags;
1385         unsigned int flags;
1386         int retval = 0;
1387
1388         if (!new_info || !info->ioaddr)
1389                 return -ENODEV;
1390         if (copy_from_user(&new_serial, new_info, sizeof(new_serial)))
1391                 return -EFAULT;
1392
1393         if (new_serial.irq != info->board->irq ||
1394                         new_serial.port != info->ioaddr)
1395                 return -EINVAL;
1396
1397         flags = info->port.flags & ASYNC_SPD_MASK;
1398
1399         if (!capable(CAP_SYS_ADMIN)) {
1400                 if ((new_serial.baud_base != info->baud_base) ||
1401                                 (new_serial.close_delay != info->port.close_delay) ||
1402                                 ((new_serial.flags & ~ASYNC_USR_MASK) != (info->port.flags & ~ASYNC_USR_MASK)))
1403                         return -EPERM;
1404                 info->port.flags = ((info->port.flags & ~ASYNC_USR_MASK) |
1405                                 (new_serial.flags & ASYNC_USR_MASK));
1406         } else {
1407                 /*
1408                  * OK, past this point, all the error checking has been done.
1409                  * At this point, we start making changes.....
1410                  */
1411                 info->port.flags = ((info->port.flags & ~ASYNC_FLAGS) |
1412                                 (new_serial.flags & ASYNC_FLAGS));
1413                 info->port.close_delay = new_serial.close_delay * HZ / 100;
1414                 info->port.closing_wait = new_serial.closing_wait * HZ / 100;
1415                 info->port.tty->low_latency =
1416                                 (info->port.flags & ASYNC_LOW_LATENCY) ? 1 : 0;
1417                 info->port.tty->low_latency = 0;
1418                 if ((info->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST &&
1419                                 (new_serial.baud_base != info->baud_base ||
1420                                 new_serial.custom_divisor !=
1421                                 info->custom_divisor)) {
1422                         baud = new_serial.baud_base / new_serial.custom_divisor;
1423                         tty_encode_baud_rate(info->port.tty, baud, baud);
1424                 }
1425         }
1426
1427         info->type = new_serial.type;
1428
1429         process_txrx_fifo(info);
1430
1431         if (info->port.flags & ASYNC_INITIALIZED) {
1432                 if (flags != (info->port.flags & ASYNC_SPD_MASK)) {
1433                         spin_lock_irqsave(&info->slock, sl_flags);
1434                         mxser_change_speed(info, NULL);
1435                         spin_unlock_irqrestore(&info->slock, sl_flags);
1436                 }
1437         } else
1438                 retval = mxser_startup(info);
1439
1440         return retval;
1441 }
1442
1443 /*
1444  * mxser_get_lsr_info - get line status register info
1445  *
1446  * Purpose: Let user call ioctl() to get info when the UART physically
1447  *          is emptied.  On bus types like RS485, the transmitter must
1448  *          release the bus after transmitting. This must be done when
1449  *          the transmit shift register is empty, not be done when the
1450  *          transmit holding register is empty.  This functionality
1451  *          allows an RS485 driver to be written in user space.
1452  */
1453 static int mxser_get_lsr_info(struct mxser_port *info,
1454                 unsigned int __user *value)
1455 {
1456         unsigned char status;
1457         unsigned int result;
1458         unsigned long flags;
1459
1460         spin_lock_irqsave(&info->slock, flags);
1461         status = inb(info->ioaddr + UART_LSR);
1462         spin_unlock_irqrestore(&info->slock, flags);
1463         result = ((status & UART_LSR_TEMT) ? TIOCSER_TEMT : 0);
1464         return put_user(result, value);
1465 }
1466
1467 /*
1468  * This routine sends a break character out the serial port.
1469  */
1470 static void mxser_send_break(struct mxser_port *info, int duration)
1471 {
1472         unsigned long flags;
1473
1474         if (!info->ioaddr)
1475                 return;
1476         set_current_state(TASK_INTERRUPTIBLE);
1477         spin_lock_irqsave(&info->slock, flags);
1478         outb(inb(info->ioaddr + UART_LCR) | UART_LCR_SBC,
1479                 info->ioaddr + UART_LCR);
1480         spin_unlock_irqrestore(&info->slock, flags);
1481         schedule_timeout(duration);
1482         spin_lock_irqsave(&info->slock, flags);
1483         outb(inb(info->ioaddr + UART_LCR) & ~UART_LCR_SBC,
1484                 info->ioaddr + UART_LCR);
1485         spin_unlock_irqrestore(&info->slock, flags);
1486 }
1487
1488 static int mxser_tiocmget(struct tty_struct *tty, struct file *file)
1489 {
1490         struct mxser_port *info = tty->driver_data;
1491         unsigned char control, status;
1492         unsigned long flags;
1493
1494
1495         if (tty->index == MXSER_PORTS)
1496                 return -ENOIOCTLCMD;
1497         if (test_bit(TTY_IO_ERROR, &tty->flags))
1498                 return -EIO;
1499
1500         control = info->MCR;
1501
1502         spin_lock_irqsave(&info->slock, flags);
1503         status = inb(info->ioaddr + UART_MSR);
1504         if (status & UART_MSR_ANY_DELTA)
1505                 mxser_check_modem_status(info, status);
1506         spin_unlock_irqrestore(&info->slock, flags);
1507         return ((control & UART_MCR_RTS) ? TIOCM_RTS : 0) |
1508                     ((control & UART_MCR_DTR) ? TIOCM_DTR : 0) |
1509                     ((status & UART_MSR_DCD) ? TIOCM_CAR : 0) |
1510                     ((status & UART_MSR_RI) ? TIOCM_RNG : 0) |
1511                     ((status & UART_MSR_DSR) ? TIOCM_DSR : 0) |
1512                     ((status & UART_MSR_CTS) ? TIOCM_CTS : 0);
1513 }
1514
1515 static int mxser_tiocmset(struct tty_struct *tty, struct file *file,
1516                 unsigned int set, unsigned int clear)
1517 {
1518         struct mxser_port *info = tty->driver_data;
1519         unsigned long flags;
1520
1521
1522         if (tty->index == MXSER_PORTS)
1523                 return -ENOIOCTLCMD;
1524         if (test_bit(TTY_IO_ERROR, &tty->flags))
1525                 return -EIO;
1526
1527         spin_lock_irqsave(&info->slock, flags);
1528
1529         if (set & TIOCM_RTS)
1530                 info->MCR |= UART_MCR_RTS;
1531         if (set & TIOCM_DTR)
1532                 info->MCR |= UART_MCR_DTR;
1533
1534         if (clear & TIOCM_RTS)
1535                 info->MCR &= ~UART_MCR_RTS;
1536         if (clear & TIOCM_DTR)
1537                 info->MCR &= ~UART_MCR_DTR;
1538
1539         outb(info->MCR, info->ioaddr + UART_MCR);
1540         spin_unlock_irqrestore(&info->slock, flags);
1541         return 0;
1542 }
1543
1544 static int __init mxser_program_mode(int port)
1545 {
1546         int id, i, j, n;
1547
1548         outb(0, port);
1549         outb(0, port);
1550         outb(0, port);
1551         (void)inb(port);
1552         (void)inb(port);
1553         outb(0, port);
1554         (void)inb(port);
1555
1556         id = inb(port + 1) & 0x1F;
1557         if ((id != C168_ASIC_ID) &&
1558                         (id != C104_ASIC_ID) &&
1559                         (id != C102_ASIC_ID) &&
1560                         (id != CI132_ASIC_ID) &&
1561                         (id != CI134_ASIC_ID) &&
1562                         (id != CI104J_ASIC_ID))
1563                 return -1;
1564         for (i = 0, j = 0; i < 4; i++) {
1565                 n = inb(port + 2);
1566                 if (n == 'M') {
1567                         j = 1;
1568                 } else if ((j == 1) && (n == 1)) {
1569                         j = 2;
1570                         break;
1571                 } else
1572                         j = 0;
1573         }
1574         if (j != 2)
1575                 id = -2;
1576         return id;
1577 }
1578
1579 static void __init mxser_normal_mode(int port)
1580 {
1581         int i, n;
1582
1583         outb(0xA5, port + 1);
1584         outb(0x80, port + 3);
1585         outb(12, port + 0);     /* 9600 bps */
1586         outb(0, port + 1);
1587         outb(0x03, port + 3);   /* 8 data bits */
1588         outb(0x13, port + 4);   /* loop back mode */
1589         for (i = 0; i < 16; i++) {
1590                 n = inb(port + 5);
1591                 if ((n & 0x61) == 0x60)
1592                         break;
1593                 if ((n & 1) == 1)
1594                         (void)inb(port);
1595         }
1596         outb(0x00, port + 4);
1597 }
1598
1599 #define CHIP_SK         0x01    /* Serial Data Clock  in Eprom */
1600 #define CHIP_DO         0x02    /* Serial Data Output in Eprom */
1601 #define CHIP_CS         0x04    /* Serial Chip Select in Eprom */
1602 #define CHIP_DI         0x08    /* Serial Data Input  in Eprom */
1603 #define EN_CCMD         0x000   /* Chip's command register     */
1604 #define EN0_RSARLO      0x008   /* Remote start address reg 0  */
1605 #define EN0_RSARHI      0x009   /* Remote start address reg 1  */
1606 #define EN0_RCNTLO      0x00A   /* Remote byte count reg WR    */
1607 #define EN0_RCNTHI      0x00B   /* Remote byte count reg WR    */
1608 #define EN0_DCFG        0x00E   /* Data configuration reg WR   */
1609 #define EN0_PORT        0x010   /* Rcv missed frame error counter RD */
1610 #define ENC_PAGE0       0x000   /* Select page 0 of chip registers   */
1611 #define ENC_PAGE3       0x0C0   /* Select page 3 of chip registers   */
1612 static int __init mxser_read_register(int port, unsigned short *regs)
1613 {
1614         int i, k, value, id;
1615         unsigned int j;
1616
1617         id = mxser_program_mode(port);
1618         if (id < 0)
1619                 return id;
1620         for (i = 0; i < 14; i++) {
1621                 k = (i & 0x3F) | 0x180;
1622                 for (j = 0x100; j > 0; j >>= 1) {
1623                         outb(CHIP_CS, port);
1624                         if (k & j) {
1625                                 outb(CHIP_CS | CHIP_DO, port);
1626                                 outb(CHIP_CS | CHIP_DO | CHIP_SK, port);        /* A? bit of read */
1627                         } else {
1628                                 outb(CHIP_CS, port);
1629                                 outb(CHIP_CS | CHIP_SK, port);  /* A? bit of read */
1630                         }
1631                 }
1632                 (void)inb(port);
1633                 value = 0;
1634                 for (k = 0, j = 0x8000; k < 16; k++, j >>= 1) {
1635                         outb(CHIP_CS, port);
1636                         outb(CHIP_CS | CHIP_SK, port);
1637                         if (inb(port) & CHIP_DI)
1638                                 value |= j;
1639                 }
1640                 regs[i] = value;
1641                 outb(0, port);
1642         }
1643         mxser_normal_mode(port);
1644         return id;
1645 }
1646
1647 static int mxser_ioctl_special(unsigned int cmd, void __user *argp)
1648 {
1649         struct mxser_port *port;
1650         int result, status;
1651         unsigned int i, j;
1652         int ret = 0;
1653
1654         switch (cmd) {
1655         case MOXA_GET_MAJOR:
1656                 return put_user(ttymajor, (int __user *)argp);
1657
1658         case MOXA_CHKPORTENABLE:
1659                 result = 0;
1660                 lock_kernel();
1661                 for (i = 0; i < MXSER_BOARDS; i++)
1662                         for (j = 0; j < MXSER_PORTS_PER_BOARD; j++)
1663                                 if (mxser_boards[i].ports[j].ioaddr)
1664                                         result |= (1 << i);
1665                 unlock_kernel();
1666                 return put_user(result, (unsigned long __user *)argp);
1667         case MOXA_GETDATACOUNT:
1668                 lock_kernel();
1669                 if (copy_to_user(argp, &mxvar_log, sizeof(mxvar_log)))
1670                         ret = -EFAULT;
1671                 unlock_kernel();
1672                 return ret;
1673         case MOXA_GETMSTATUS:
1674                 lock_kernel();
1675                 for (i = 0; i < MXSER_BOARDS; i++)
1676                         for (j = 0; j < MXSER_PORTS_PER_BOARD; j++) {
1677                                 port = &mxser_boards[i].ports[j];
1678
1679                                 GMStatus[i].ri = 0;
1680                                 if (!port->ioaddr) {
1681                                         GMStatus[i].dcd = 0;
1682                                         GMStatus[i].dsr = 0;
1683                                         GMStatus[i].cts = 0;
1684                                         continue;
1685                                 }
1686
1687                                 if (!port->port.tty || !port->port.tty->termios)
1688                                         GMStatus[i].cflag =
1689                                                 port->normal_termios.c_cflag;
1690                                 else
1691                                         GMStatus[i].cflag =
1692                                                 port->port.tty->termios->c_cflag;
1693
1694                                 status = inb(port->ioaddr + UART_MSR);
1695                                 if (status & 0x80 /*UART_MSR_DCD */ )
1696                                         GMStatus[i].dcd = 1;
1697                                 else
1698                                         GMStatus[i].dcd = 0;
1699
1700                                 if (status & 0x20 /*UART_MSR_DSR */ )
1701                                         GMStatus[i].dsr = 1;
1702                                 else
1703                                         GMStatus[i].dsr = 0;
1704
1705
1706                                 if (status & 0x10 /*UART_MSR_CTS */ )
1707                                         GMStatus[i].cts = 1;
1708                                 else
1709                                         GMStatus[i].cts = 0;
1710                         }
1711                 unlock_kernel();
1712                 if (copy_to_user(argp, GMStatus,
1713                                 sizeof(struct mxser_mstatus) * MXSER_PORTS))
1714                         return -EFAULT;
1715                 return 0;
1716         case MOXA_ASPP_MON_EXT: {
1717                 int p, shiftbit;
1718                 unsigned long opmode;
1719                 unsigned cflag, iflag;
1720
1721                 lock_kernel();
1722                 for (i = 0; i < MXSER_BOARDS; i++) {
1723                         for (j = 0; j < MXSER_PORTS_PER_BOARD; j++) {
1724                                 port = &mxser_boards[i].ports[j];
1725                                 if (!port->ioaddr)
1726                                         continue;
1727
1728                                 status = mxser_get_msr(port->ioaddr, 0, i);
1729
1730                                 if (status & UART_MSR_TERI)
1731                                         port->icount.rng++;
1732                                 if (status & UART_MSR_DDSR)
1733                                         port->icount.dsr++;
1734                                 if (status & UART_MSR_DDCD)
1735                                         port->icount.dcd++;
1736                                 if (status & UART_MSR_DCTS)
1737                                         port->icount.cts++;
1738
1739                                 port->mon_data.modem_status = status;
1740                                 mon_data_ext.rx_cnt[i] = port->mon_data.rxcnt;
1741                                 mon_data_ext.tx_cnt[i] = port->mon_data.txcnt;
1742                                 mon_data_ext.up_rxcnt[i] =
1743                                         port->mon_data.up_rxcnt;
1744                                 mon_data_ext.up_txcnt[i] =
1745                                         port->mon_data.up_txcnt;
1746                                 mon_data_ext.modem_status[i] =
1747                                         port->mon_data.modem_status;
1748                                 mon_data_ext.baudrate[i] =
1749                                         tty_get_baud_rate(port->port.tty);
1750
1751                                 if (!port->port.tty || !port->port.tty->termios) {
1752                                         cflag = port->normal_termios.c_cflag;
1753                                         iflag = port->normal_termios.c_iflag;
1754                                 } else {
1755                                         cflag = port->port.tty->termios->c_cflag;
1756                                         iflag = port->port.tty->termios->c_iflag;
1757                                 }
1758
1759                                 mon_data_ext.databits[i] = cflag & CSIZE;
1760
1761                                 mon_data_ext.stopbits[i] = cflag & CSTOPB;
1762
1763                                 mon_data_ext.parity[i] =
1764                                         cflag & (PARENB | PARODD | CMSPAR);
1765
1766                                 mon_data_ext.flowctrl[i] = 0x00;
1767
1768                                 if (cflag & CRTSCTS)
1769                                         mon_data_ext.flowctrl[i] |= 0x03;
1770
1771                                 if (iflag & (IXON | IXOFF))
1772                                         mon_data_ext.flowctrl[i] |= 0x0C;
1773
1774                                 if (port->type == PORT_16550A)
1775                                         mon_data_ext.fifo[i] = 1;
1776                                 else
1777                                         mon_data_ext.fifo[i] = 0;
1778
1779                                 p = i % 4;
1780                                 shiftbit = p * 2;
1781                                 opmode = inb(port->opmode_ioaddr) >> shiftbit;
1782                                 opmode &= OP_MODE_MASK;
1783
1784                                 mon_data_ext.iftype[i] = opmode;
1785
1786                         }
1787                 }
1788                 unlock_kernel();
1789                 if (copy_to_user(argp, &mon_data_ext,
1790                                         sizeof(mon_data_ext)))
1791                         return -EFAULT;
1792                 return 0;
1793         }
1794         default:
1795                 return -ENOIOCTLCMD;
1796         }
1797         return 0;
1798 }
1799
1800 static int mxser_cflags_changed(struct mxser_port *info, unsigned long arg,
1801                 struct async_icount *cprev)
1802 {
1803         struct async_icount cnow;
1804         unsigned long flags;
1805         int ret;
1806
1807         spin_lock_irqsave(&info->slock, flags);
1808         cnow = info->icount;    /* atomic copy */
1809         spin_unlock_irqrestore(&info->slock, flags);
1810
1811         ret =   ((arg & TIOCM_RNG) && (cnow.rng != cprev->rng)) ||
1812                 ((arg & TIOCM_DSR) && (cnow.dsr != cprev->dsr)) ||
1813                 ((arg & TIOCM_CD)  && (cnow.dcd != cprev->dcd)) ||
1814                 ((arg & TIOCM_CTS) && (cnow.cts != cprev->cts));
1815
1816         *cprev = cnow;
1817
1818         return ret;
1819 }
1820
1821 static int mxser_ioctl(struct tty_struct *tty, struct file *file,
1822                 unsigned int cmd, unsigned long arg)
1823 {
1824         struct mxser_port *info = tty->driver_data;
1825         struct async_icount cnow;
1826         struct serial_icounter_struct __user *p_cuser;
1827         unsigned long flags;
1828         void __user *argp = (void __user *)arg;
1829         int retval;
1830
1831         if (tty->index == MXSER_PORTS)
1832                 return mxser_ioctl_special(cmd, argp);
1833
1834         if (cmd == MOXA_SET_OP_MODE || cmd == MOXA_GET_OP_MODE) {
1835                 int p;
1836                 unsigned long opmode;
1837                 static unsigned char ModeMask[] = { 0xfc, 0xf3, 0xcf, 0x3f };
1838                 int shiftbit;
1839                 unsigned char val, mask;
1840
1841                 p = tty->index % 4;
1842                 if (cmd == MOXA_SET_OP_MODE) {
1843                         if (get_user(opmode, (int __user *) argp))
1844                                 return -EFAULT;
1845                         if (opmode != RS232_MODE &&
1846                                         opmode != RS485_2WIRE_MODE &&
1847                                         opmode != RS422_MODE &&
1848                                         opmode != RS485_4WIRE_MODE)
1849                                 return -EFAULT;
1850                         lock_kernel();
1851                         mask = ModeMask[p];
1852                         shiftbit = p * 2;
1853                         val = inb(info->opmode_ioaddr);
1854                         val &= mask;
1855                         val |= (opmode << shiftbit);
1856                         outb(val, info->opmode_ioaddr);
1857                         unlock_kernel();
1858                 } else {
1859                         lock_kernel();
1860                         shiftbit = p * 2;
1861                         opmode = inb(info->opmode_ioaddr) >> shiftbit;
1862                         opmode &= OP_MODE_MASK;
1863                         unlock_kernel();
1864                         if (put_user(opmode, (int __user *)argp))
1865                                 return -EFAULT;
1866                 }
1867                 return 0;
1868         }
1869
1870         if (cmd != TIOCGSERIAL && cmd != TIOCMIWAIT && cmd != TIOCGICOUNT &&
1871                         test_bit(TTY_IO_ERROR, &tty->flags))
1872                 return -EIO;
1873
1874         switch (cmd) {
1875         case TCSBRK:            /* SVID version: non-zero arg --> no break */
1876                 retval = tty_check_change(tty);
1877                 if (retval)
1878                         return retval;
1879                 tty_wait_until_sent(tty, 0);
1880                 if (!arg)
1881                         mxser_send_break(info, HZ / 4); /* 1/4 second */
1882                 return 0;
1883         case TCSBRKP:           /* support for POSIX tcsendbreak() */
1884                 retval = tty_check_change(tty);
1885                 if (retval)
1886                         return retval;
1887                 tty_wait_until_sent(tty, 0);
1888                 mxser_send_break(info, arg ? arg * (HZ / 10) : HZ / 4);
1889                 return 0;
1890         case TIOCGSERIAL:
1891                 lock_kernel();
1892                 retval = mxser_get_serial_info(info, argp);
1893                 unlock_kernel();
1894                 return retval;
1895         case TIOCSSERIAL:
1896                 lock_kernel();
1897                 retval = mxser_set_serial_info(info, argp);
1898                 unlock_kernel();
1899                 return retval;
1900         case TIOCSERGETLSR:     /* Get line status register */
1901                 return  mxser_get_lsr_info(info, argp);
1902                 /*
1903                  * Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change
1904                  * - mask passed in arg for lines of interest
1905                  *   (use |'ed TIOCM_RNG/DSR/CD/CTS for masking)
1906                  * Caller should use TIOCGICOUNT to see which one it was
1907                  */
1908         case TIOCMIWAIT:
1909                 spin_lock_irqsave(&info->slock, flags);
1910                 cnow = info->icount;    /* note the counters on entry */
1911                 spin_unlock_irqrestore(&info->slock, flags);
1912
1913                 return wait_event_interruptible(info->delta_msr_wait,
1914                                 mxser_cflags_changed(info, arg, &cnow));
1915         /*
1916          * Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
1917          * Return: write counters to the user passed counter struct
1918          * NB: both 1->0 and 0->1 transitions are counted except for
1919          *     RI where only 0->1 is counted.
1920          */
1921         case TIOCGICOUNT:
1922                 spin_lock_irqsave(&info->slock, flags);
1923                 cnow = info->icount;
1924                 spin_unlock_irqrestore(&info->slock, flags);
1925                 p_cuser = argp;
1926                 if (put_user(cnow.frame, &p_cuser->frame))
1927                         return -EFAULT;
1928                 if (put_user(cnow.brk, &p_cuser->brk))
1929                         return -EFAULT;
1930                 if (put_user(cnow.overrun, &p_cuser->overrun))
1931                         return -EFAULT;
1932                 if (put_user(cnow.buf_overrun, &p_cuser->buf_overrun))
1933                         return -EFAULT;
1934                 if (put_user(cnow.parity, &p_cuser->parity))
1935                         return -EFAULT;
1936                 if (put_user(cnow.rx, &p_cuser->rx))
1937                         return -EFAULT;
1938                 if (put_user(cnow.tx, &p_cuser->tx))
1939                         return -EFAULT;
1940                 put_user(cnow.cts, &p_cuser->cts);
1941                 put_user(cnow.dsr, &p_cuser->dsr);
1942                 put_user(cnow.rng, &p_cuser->rng);
1943                 put_user(cnow.dcd, &p_cuser->dcd);
1944                 return 0;
1945         case MOXA_HighSpeedOn:
1946                 return put_user(info->baud_base != 115200 ? 1 : 0, (int __user *)argp);
1947         case MOXA_SDS_RSTICOUNTER:
1948                 lock_kernel();
1949                 info->mon_data.rxcnt = 0;
1950                 info->mon_data.txcnt = 0;
1951                 unlock_kernel();
1952                 return 0;
1953
1954         case MOXA_ASPP_OQUEUE:{
1955                 int len, lsr;
1956
1957                 lock_kernel();
1958                 len = mxser_chars_in_buffer(tty);
1959                 lsr = inb(info->ioaddr + UART_LSR) & UART_LSR_TEMT;
1960                 len += (lsr ? 0 : 1);
1961                 unlock_kernel();
1962
1963                 return put_user(len, (int __user *)argp);
1964         }
1965         case MOXA_ASPP_MON: {
1966                 int mcr, status;
1967
1968                 lock_kernel();
1969                 status = mxser_get_msr(info->ioaddr, 1, tty->index);
1970                 mxser_check_modem_status(info, status);
1971
1972                 mcr = inb(info->ioaddr + UART_MCR);
1973                 if (mcr & MOXA_MUST_MCR_XON_FLAG)
1974                         info->mon_data.hold_reason &= ~NPPI_NOTIFY_XOFFHOLD;
1975                 else
1976                         info->mon_data.hold_reason |= NPPI_NOTIFY_XOFFHOLD;
1977
1978                 if (mcr & MOXA_MUST_MCR_TX_XON)
1979                         info->mon_data.hold_reason &= ~NPPI_NOTIFY_XOFFXENT;
1980                 else
1981                         info->mon_data.hold_reason |= NPPI_NOTIFY_XOFFXENT;
1982
1983                 if (info->port.tty->hw_stopped)
1984                         info->mon_data.hold_reason |= NPPI_NOTIFY_CTSHOLD;
1985                 else
1986                         info->mon_data.hold_reason &= ~NPPI_NOTIFY_CTSHOLD;
1987                 unlock_kernel();
1988                 if (copy_to_user(argp, &info->mon_data,
1989                                 sizeof(struct mxser_mon)))
1990                         return -EFAULT;
1991
1992                 return 0;
1993         }
1994         case MOXA_ASPP_LSTATUS: {
1995                 if (put_user(info->err_shadow, (unsigned char __user *)argp))
1996                         return -EFAULT;
1997
1998                 info->err_shadow = 0;
1999                 return 0;
2000         }
2001         case MOXA_SET_BAUD_METHOD: {
2002                 int method;
2003
2004                 if (get_user(method, (int __user *)argp))
2005                         return -EFAULT;
2006                 mxser_set_baud_method[tty->index] = method;
2007                 return put_user(method, (int __user *)argp);
2008         }
2009         default:
2010                 return -ENOIOCTLCMD;
2011         }
2012         return 0;
2013 }
2014
2015 static void mxser_stoprx(struct tty_struct *tty)
2016 {
2017         struct mxser_port *info = tty->driver_data;
2018
2019         info->ldisc_stop_rx = 1;
2020         if (I_IXOFF(tty)) {
2021                 if (info->board->chip_flag) {
2022                         info->IER &= ~MOXA_MUST_RECV_ISR;
2023                         outb(info->IER, info->ioaddr + UART_IER);
2024                 } else {
2025                         info->x_char = STOP_CHAR(tty);
2026                         outb(0, info->ioaddr + UART_IER);
2027                         info->IER |= UART_IER_THRI;
2028                         outb(info->IER, info->ioaddr + UART_IER);
2029                 }
2030         }
2031
2032         if (info->port.tty->termios->c_cflag & CRTSCTS) {
2033                 info->MCR &= ~UART_MCR_RTS;
2034                 outb(info->MCR, info->ioaddr + UART_MCR);
2035         }
2036 }
2037
2038 /*
2039  * This routine is called by the upper-layer tty layer to signal that
2040  * incoming characters should be throttled.
2041  */
2042 static void mxser_throttle(struct tty_struct *tty)
2043 {
2044         mxser_stoprx(tty);
2045 }
2046
2047 static void mxser_unthrottle(struct tty_struct *tty)
2048 {
2049         struct mxser_port *info = tty->driver_data;
2050
2051         /* startrx */
2052         info->ldisc_stop_rx = 0;
2053         if (I_IXOFF(tty)) {
2054                 if (info->x_char)
2055                         info->x_char = 0;
2056                 else {
2057                         if (info->board->chip_flag) {
2058                                 info->IER |= MOXA_MUST_RECV_ISR;
2059                                 outb(info->IER, info->ioaddr + UART_IER);
2060                         } else {
2061                                 info->x_char = START_CHAR(tty);
2062                                 outb(0, info->ioaddr + UART_IER);
2063                                 info->IER |= UART_IER_THRI;
2064                                 outb(info->IER, info->ioaddr + UART_IER);
2065                         }
2066                 }
2067         }
2068
2069         if (info->port.tty->termios->c_cflag & CRTSCTS) {
2070                 info->MCR |= UART_MCR_RTS;
2071                 outb(info->MCR, info->ioaddr + UART_MCR);
2072         }
2073 }
2074
2075 /*
2076  * mxser_stop() and mxser_start()
2077  *
2078  * This routines are called before setting or resetting tty->stopped.
2079  * They enable or disable transmitter interrupts, as necessary.
2080  */
2081 static void mxser_stop(struct tty_struct *tty)
2082 {
2083         struct mxser_port *info = tty->driver_data;
2084         unsigned long flags;
2085
2086         spin_lock_irqsave(&info->slock, flags);
2087         if (info->IER & UART_IER_THRI) {
2088                 info->IER &= ~UART_IER_THRI;
2089                 outb(info->IER, info->ioaddr + UART_IER);
2090         }
2091         spin_unlock_irqrestore(&info->slock, flags);
2092 }
2093
2094 static void mxser_start(struct tty_struct *tty)
2095 {
2096         struct mxser_port *info = tty->driver_data;
2097         unsigned long flags;
2098
2099         spin_lock_irqsave(&info->slock, flags);
2100         if (info->xmit_cnt && info->port.xmit_buf) {
2101                 outb(info->IER & ~UART_IER_THRI, info->ioaddr + UART_IER);
2102                 info->IER |= UART_IER_THRI;
2103                 outb(info->IER, info->ioaddr + UART_IER);
2104         }
2105         spin_unlock_irqrestore(&info->slock, flags);
2106 }
2107
2108 static void mxser_set_termios(struct tty_struct *tty, struct ktermios *old_termios)
2109 {
2110         struct mxser_port *info = tty->driver_data;
2111         unsigned long flags;
2112
2113         spin_lock_irqsave(&info->slock, flags);
2114         mxser_change_speed(info, old_termios);
2115         spin_unlock_irqrestore(&info->slock, flags);
2116
2117         if ((old_termios->c_cflag & CRTSCTS) &&
2118                         !(tty->termios->c_cflag & CRTSCTS)) {
2119                 tty->hw_stopped = 0;
2120                 mxser_start(tty);
2121         }
2122
2123         /* Handle sw stopped */
2124         if ((old_termios->c_iflag & IXON) &&
2125                         !(tty->termios->c_iflag & IXON)) {
2126                 tty->stopped = 0;
2127
2128                 if (info->board->chip_flag) {
2129                         spin_lock_irqsave(&info->slock, flags);
2130                         mxser_disable_must_rx_software_flow_control(
2131                                         info->ioaddr);
2132                         spin_unlock_irqrestore(&info->slock, flags);
2133                 }
2134
2135                 mxser_start(tty);
2136         }
2137 }
2138
2139 /*
2140  * mxser_wait_until_sent() --- wait until the transmitter is empty
2141  */
2142 static void mxser_wait_until_sent(struct tty_struct *tty, int timeout)
2143 {
2144         struct mxser_port *info = tty->driver_data;
2145         unsigned long orig_jiffies, char_time;
2146         int lsr;
2147
2148         if (info->type == PORT_UNKNOWN)
2149                 return;
2150
2151         if (info->xmit_fifo_size == 0)
2152                 return;         /* Just in case.... */
2153
2154         orig_jiffies = jiffies;
2155         /*
2156          * Set the check interval to be 1/5 of the estimated time to
2157          * send a single character, and make it at least 1.  The check
2158          * interval should also be less than the timeout.
2159          *
2160          * Note: we have to use pretty tight timings here to satisfy
2161          * the NIST-PCTS.
2162          */
2163         char_time = (info->timeout - HZ / 50) / info->xmit_fifo_size;
2164         char_time = char_time / 5;
2165         if (char_time == 0)
2166                 char_time = 1;
2167         if (timeout && timeout < char_time)
2168                 char_time = timeout;
2169         /*
2170          * If the transmitter hasn't cleared in twice the approximate
2171          * amount of time to send the entire FIFO, it probably won't
2172          * ever clear.  This assumes the UART isn't doing flow
2173          * control, which is currently the case.  Hence, if it ever
2174          * takes longer than info->timeout, this is probably due to a
2175          * UART bug of some kind.  So, we clamp the timeout parameter at
2176          * 2*info->timeout.
2177          */
2178         if (!timeout || timeout > 2 * info->timeout)
2179                 timeout = 2 * info->timeout;
2180 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
2181         printk(KERN_DEBUG "In rs_wait_until_sent(%d) check=%lu...",
2182                 timeout, char_time);
2183         printk("jiff=%lu...", jiffies);
2184 #endif
2185         lock_kernel();
2186         while (!((lsr = inb(info->ioaddr + UART_LSR)) & UART_LSR_TEMT)) {
2187 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
2188                 printk("lsr = %d (jiff=%lu)...", lsr, jiffies);
2189 #endif
2190                 schedule_timeout_interruptible(char_time);
2191                 if (signal_pending(current))
2192                         break;
2193                 if (timeout && time_after(jiffies, orig_jiffies + timeout))
2194                         break;
2195         }
2196         set_current_state(TASK_RUNNING);
2197         unlock_kernel();
2198
2199 #ifdef SERIAL_DEBUG_RS_WAIT_UNTIL_SENT
2200         printk("lsr = %d (jiff=%lu)...done\n", lsr, jiffies);
2201 #endif
2202 }
2203
2204 /*
2205  * This routine is called by tty_hangup() when a hangup is signaled.
2206  */
2207 static void mxser_hangup(struct tty_struct *tty)
2208 {
2209         struct mxser_port *info = tty->driver_data;
2210
2211         mxser_flush_buffer(tty);
2212         mxser_shutdown(info);
2213         info->port.count = 0;
2214         info->port.flags &= ~ASYNC_NORMAL_ACTIVE;
2215         info->port.tty = NULL;
2216         wake_up_interruptible(&info->port.open_wait);
2217 }
2218
2219 /*
2220  * mxser_rs_break() --- routine which turns the break handling on or off
2221  */
2222 static void mxser_rs_break(struct tty_struct *tty, int break_state)
2223 {
2224         struct mxser_port *info = tty->driver_data;
2225         unsigned long flags;
2226
2227         spin_lock_irqsave(&info->slock, flags);
2228         if (break_state == -1)
2229                 outb(inb(info->ioaddr + UART_LCR) | UART_LCR_SBC,
2230                         info->ioaddr + UART_LCR);
2231         else
2232                 outb(inb(info->ioaddr + UART_LCR) & ~UART_LCR_SBC,
2233                         info->ioaddr + UART_LCR);
2234         spin_unlock_irqrestore(&info->slock, flags);
2235 }
2236
2237 static void mxser_receive_chars(struct mxser_port *port, int *status)
2238 {
2239         struct tty_struct *tty = port->port.tty;
2240         unsigned char ch, gdl;
2241         int ignored = 0;
2242         int cnt = 0;
2243         int recv_room;
2244         int max = 256;
2245
2246         recv_room = tty->receive_room;
2247         if ((recv_room == 0) && (!port->ldisc_stop_rx))
2248                 mxser_stoprx(tty);
2249
2250         if (port->board->chip_flag != MOXA_OTHER_UART) {
2251
2252                 if (*status & UART_LSR_SPECIAL)
2253                         goto intr_old;
2254                 if (port->board->chip_flag == MOXA_MUST_MU860_HWID &&
2255                                 (*status & MOXA_MUST_LSR_RERR))
2256                         goto intr_old;
2257                 if (*status & MOXA_MUST_LSR_RERR)
2258                         goto intr_old;
2259
2260                 gdl = inb(port->ioaddr + MOXA_MUST_GDL_REGISTER);
2261
2262                 if (port->board->chip_flag == MOXA_MUST_MU150_HWID)
2263                         gdl &= MOXA_MUST_GDL_MASK;
2264                 if (gdl >= recv_room) {
2265                         if (!port->ldisc_stop_rx)
2266                                 mxser_stoprx(tty);
2267                 }
2268                 while (gdl--) {
2269                         ch = inb(port->ioaddr + UART_RX);
2270                         tty_insert_flip_char(tty, ch, 0);
2271                         cnt++;
2272                 }
2273                 goto end_intr;
2274         }
2275 intr_old:
2276
2277         do {
2278                 if (max-- < 0)
2279                         break;
2280
2281                 ch = inb(port->ioaddr + UART_RX);
2282                 if (port->board->chip_flag && (*status & UART_LSR_OE))
2283                         outb(0x23, port->ioaddr + UART_FCR);
2284                 *status &= port->read_status_mask;
2285                 if (*status & port->ignore_status_mask) {
2286                         if (++ignored > 100)
2287                                 break;
2288                 } else {
2289                         char flag = 0;
2290                         if (*status & UART_LSR_SPECIAL) {
2291                                 if (*status & UART_LSR_BI) {
2292                                         flag = TTY_BREAK;
2293                                         port->icount.brk++;
2294
2295                                         if (port->port.flags & ASYNC_SAK)
2296                                                 do_SAK(tty);
2297                                 } else if (*status & UART_LSR_PE) {
2298                                         flag = TTY_PARITY;
2299                                         port->icount.parity++;
2300                                 } else if (*status & UART_LSR_FE) {
2301                                         flag = TTY_FRAME;
2302                                         port->icount.frame++;
2303                                 } else if (*status & UART_LSR_OE) {
2304                                         flag = TTY_OVERRUN;
2305                                         port->icount.overrun++;
2306                                 } else
2307                                         flag = TTY_BREAK;
2308                         }
2309                         tty_insert_flip_char(tty, ch, flag);
2310                         cnt++;
2311                         if (cnt >= recv_room) {
2312                                 if (!port->ldisc_stop_rx)
2313                                         mxser_stoprx(tty);
2314                                 break;
2315                         }
2316
2317                 }
2318
2319                 if (port->board->chip_flag)
2320                         break;
2321
2322                 *status = inb(port->ioaddr + UART_LSR);
2323         } while (*status & UART_LSR_DR);
2324
2325 end_intr:
2326         mxvar_log.rxcnt[port->port.tty->index] += cnt;
2327         port->mon_data.rxcnt += cnt;
2328         port->mon_data.up_rxcnt += cnt;
2329
2330         /*
2331          * We are called from an interrupt context with &port->slock
2332          * being held. Drop it temporarily in order to prevent
2333          * recursive locking.
2334          */
2335         spin_unlock(&port->slock);
2336         tty_flip_buffer_push(tty);
2337         spin_lock(&port->slock);
2338 }
2339
2340 static void mxser_transmit_chars(struct mxser_port *port)
2341 {
2342         int count, cnt;
2343
2344         if (port->x_char) {
2345                 outb(port->x_char, port->ioaddr + UART_TX);
2346                 port->x_char = 0;
2347                 mxvar_log.txcnt[port->port.tty->index]++;
2348                 port->mon_data.txcnt++;
2349                 port->mon_data.up_txcnt++;
2350                 port->icount.tx++;
2351                 return;
2352         }
2353
2354         if (port->port.xmit_buf == NULL)
2355                 return;
2356
2357         if ((port->xmit_cnt <= 0) || port->port.tty->stopped ||
2358                         (port->port.tty->hw_stopped &&
2359                         (port->type != PORT_16550A) &&
2360                         (!port->board->chip_flag))) {
2361                 port->IER &= ~UART_IER_THRI;
2362                 outb(port->IER, port->ioaddr + UART_IER);
2363                 return;
2364         }
2365
2366         cnt = port->xmit_cnt;
2367         count = port->xmit_fifo_size;
2368         do {
2369                 outb(port->port.xmit_buf[port->xmit_tail++],
2370                         port->ioaddr + UART_TX);
2371                 port->xmit_tail = port->xmit_tail & (SERIAL_XMIT_SIZE - 1);
2372                 if (--port->xmit_cnt <= 0)
2373                         break;
2374         } while (--count > 0);
2375         mxvar_log.txcnt[port->port.tty->index] += (cnt - port->xmit_cnt);
2376
2377         port->mon_data.txcnt += (cnt - port->xmit_cnt);
2378         port->mon_data.up_txcnt += (cnt - port->xmit_cnt);
2379         port->icount.tx += (cnt - port->xmit_cnt);
2380
2381         if (port->xmit_cnt < WAKEUP_CHARS)
2382                 tty_wakeup(port->port.tty);
2383
2384         if (port->xmit_cnt <= 0) {
2385                 port->IER &= ~UART_IER_THRI;
2386                 outb(port->IER, port->ioaddr + UART_IER);
2387         }
2388 }
2389
2390 /*
2391  * This is the serial driver's generic interrupt routine
2392  */
2393 static irqreturn_t mxser_interrupt(int irq, void *dev_id)
2394 {
2395         int status, iir, i;
2396         struct mxser_board *brd = NULL;
2397         struct mxser_port *port;
2398         int max, irqbits, bits, msr;
2399         unsigned int int_cnt, pass_counter = 0;
2400         int handled = IRQ_NONE;
2401
2402         for (i = 0; i < MXSER_BOARDS; i++)
2403                 if (dev_id == &mxser_boards[i]) {
2404                         brd = dev_id;
2405                         break;
2406                 }
2407
2408         if (i == MXSER_BOARDS)
2409                 goto irq_stop;
2410         if (brd == NULL)
2411                 goto irq_stop;
2412         max = brd->info->nports;
2413         while (pass_counter++ < MXSER_ISR_PASS_LIMIT) {
2414                 irqbits = inb(brd->vector) & brd->vector_mask;
2415                 if (irqbits == brd->vector_mask)
2416                         break;
2417
2418                 handled = IRQ_HANDLED;
2419                 for (i = 0, bits = 1; i < max; i++, irqbits |= bits, bits <<= 1) {
2420                         if (irqbits == brd->vector_mask)
2421                                 break;
2422                         if (bits & irqbits)
2423                                 continue;
2424                         port = &brd->ports[i];
2425
2426                         int_cnt = 0;
2427                         spin_lock(&port->slock);
2428                         do {
2429                                 iir = inb(port->ioaddr + UART_IIR);
2430                                 if (iir & UART_IIR_NO_INT)
2431                                         break;
2432                                 iir &= MOXA_MUST_IIR_MASK;
2433                                 if (!port->port.tty ||
2434                                                 (port->port.flags & ASYNC_CLOSING) ||
2435                                                 !(port->port.flags &
2436                                                         ASYNC_INITIALIZED)) {
2437                                         status = inb(port->ioaddr + UART_LSR);
2438                                         outb(0x27, port->ioaddr + UART_FCR);
2439                                         inb(port->ioaddr + UART_MSR);
2440                                         break;
2441                                 }
2442
2443                                 status = inb(port->ioaddr + UART_LSR);
2444
2445                                 if (status & UART_LSR_PE)
2446                                         port->err_shadow |= NPPI_NOTIFY_PARITY;
2447                                 if (status & UART_LSR_FE)
2448                                         port->err_shadow |= NPPI_NOTIFY_FRAMING;
2449                                 if (status & UART_LSR_OE)
2450                                         port->err_shadow |=
2451                                                 NPPI_NOTIFY_HW_OVERRUN;
2452                                 if (status & UART_LSR_BI)
2453                                         port->err_shadow |= NPPI_NOTIFY_BREAK;
2454
2455                                 if (port->board->chip_flag) {
2456                                         if (iir == MOXA_MUST_IIR_GDA ||
2457                                             iir == MOXA_MUST_IIR_RDA ||
2458                                             iir == MOXA_MUST_IIR_RTO ||
2459                                             iir == MOXA_MUST_IIR_LSR)
2460                                                 mxser_receive_chars(port,
2461                                                                 &status);
2462
2463                                 } else {
2464                                         status &= port->read_status_mask;
2465                                         if (status & UART_LSR_DR)
2466                                                 mxser_receive_chars(port,
2467                                                                 &status);
2468                                 }
2469                                 msr = inb(port->ioaddr + UART_MSR);
2470                                 if (msr & UART_MSR_ANY_DELTA)
2471                                         mxser_check_modem_status(port, msr);
2472
2473                                 if (port->board->chip_flag) {
2474                                         if (iir == 0x02 && (status &
2475                                                                 UART_LSR_THRE))
2476                                                 mxser_transmit_chars(port);
2477                                 } else {
2478                                         if (status & UART_LSR_THRE)
2479                                                 mxser_transmit_chars(port);
2480                                 }
2481                         } while (int_cnt++ < MXSER_ISR_PASS_LIMIT);
2482                         spin_unlock(&port->slock);
2483                 }
2484         }
2485
2486 irq_stop:
2487         return handled;
2488 }
2489
2490 static const struct tty_operations mxser_ops = {
2491         .open = mxser_open,
2492         .close = mxser_close,
2493         .write = mxser_write,
2494         .put_char = mxser_put_char,
2495         .flush_chars = mxser_flush_chars,
2496         .write_room = mxser_write_room,
2497         .chars_in_buffer = mxser_chars_in_buffer,
2498         .flush_buffer = mxser_flush_buffer,
2499         .ioctl = mxser_ioctl,
2500         .throttle = mxser_throttle,
2501         .unthrottle = mxser_unthrottle,
2502         .set_termios = mxser_set_termios,
2503         .stop = mxser_stop,
2504         .start = mxser_start,
2505         .hangup = mxser_hangup,
2506         .break_ctl = mxser_rs_break,
2507         .wait_until_sent = mxser_wait_until_sent,
2508         .tiocmget = mxser_tiocmget,
2509         .tiocmset = mxser_tiocmset,
2510 };
2511
2512 /*
2513  * The MOXA Smartio/Industio serial driver boot-time initialization code!
2514  */
2515
2516 static void mxser_release_res(struct mxser_board *brd, struct pci_dev *pdev,
2517                 unsigned int irq)
2518 {
2519         if (irq)
2520                 free_irq(brd->irq, brd);
2521         if (pdev != NULL) {     /* PCI */
2522 #ifdef CONFIG_PCI
2523                 pci_release_region(pdev, 2);
2524                 pci_release_region(pdev, 3);
2525 #endif
2526         } else {
2527                 release_region(brd->ports[0].ioaddr, 8 * brd->info->nports);
2528                 release_region(brd->vector, 1);
2529         }
2530 }
2531
2532 static int __devinit mxser_initbrd(struct mxser_board *brd,
2533                 struct pci_dev *pdev)
2534 {
2535         struct mxser_port *info;
2536         unsigned int i;
2537         int retval;
2538
2539         printk(KERN_INFO "max. baud rate = %d bps.\n", brd->ports[0].max_baud);
2540
2541         for (i = 0; i < brd->info->nports; i++) {
2542                 info = &brd->ports[i];
2543                 tty_port_init(&info->port);
2544                 info->board = brd;
2545                 info->stop_rx = 0;
2546                 info->ldisc_stop_rx = 0;
2547
2548                 /* Enhance mode enabled here */
2549                 if (brd->chip_flag != MOXA_OTHER_UART)
2550                         mxser_enable_must_enchance_mode(info->ioaddr);
2551
2552                 info->port.flags = ASYNC_SHARE_IRQ;
2553                 info->type = brd->uart_type;
2554
2555                 process_txrx_fifo(info);
2556
2557                 info->custom_divisor = info->baud_base * 16;
2558                 info->port.close_delay = 5 * HZ / 10;
2559                 info->port.closing_wait = 30 * HZ;
2560                 info->normal_termios = mxvar_sdriver->init_termios;
2561                 init_waitqueue_head(&info->delta_msr_wait);
2562                 memset(&info->mon_data, 0, sizeof(struct mxser_mon));
2563                 info->err_shadow = 0;
2564                 spin_lock_init(&info->slock);
2565
2566                 /* before set INT ISR, disable all int */
2567                 outb(inb(info->ioaddr + UART_IER) & 0xf0,
2568                         info->ioaddr + UART_IER);
2569         }
2570
2571         retval = request_irq(brd->irq, mxser_interrupt, IRQF_SHARED, "mxser",
2572                         brd);
2573         if (retval) {
2574                 printk(KERN_ERR "Board %s: Request irq failed, IRQ (%d) may "
2575                         "conflict with another device.\n",
2576                         brd->info->name, brd->irq);
2577                 /* We hold resources, we need to release them. */
2578                 mxser_release_res(brd, pdev, 0);
2579         }
2580         return retval;
2581 }
2582
2583 static int __init mxser_get_ISA_conf(int cap, struct mxser_board *brd)
2584 {
2585         int id, i, bits;
2586         unsigned short regs[16], irq;
2587         unsigned char scratch, scratch2;
2588
2589         brd->chip_flag = MOXA_OTHER_UART;
2590
2591         id = mxser_read_register(cap, regs);
2592         switch (id) {
2593         case C168_ASIC_ID:
2594                 brd->info = &mxser_cards[0];
2595                 break;
2596         case C104_ASIC_ID:
2597                 brd->info = &mxser_cards[1];
2598                 break;
2599         case CI104J_ASIC_ID:
2600                 brd->info = &mxser_cards[2];
2601                 break;
2602         case C102_ASIC_ID:
2603                 brd->info = &mxser_cards[5];
2604                 break;
2605         case CI132_ASIC_ID:
2606                 brd->info = &mxser_cards[6];
2607                 break;
2608         case CI134_ASIC_ID:
2609                 brd->info = &mxser_cards[7];
2610                 break;
2611         default:
2612                 return 0;
2613         }
2614
2615         irq = 0;
2616         /* some ISA cards have 2 ports, but we want to see them as 4-port (why?)
2617            Flag-hack checks if configuration should be read as 2-port here. */
2618         if (brd->info->nports == 2 || (brd->info->flags & MXSER_HAS2)) {
2619                 irq = regs[9] & 0xF000;
2620                 irq = irq | (irq >> 4);
2621                 if (irq != (regs[9] & 0xFF00))
2622                         return MXSER_ERR_IRQ_CONFLIT;
2623         } else if (brd->info->nports == 4) {
2624                 irq = regs[9] & 0xF000;
2625                 irq = irq | (irq >> 4);
2626                 irq = irq | (irq >> 8);
2627                 if (irq != regs[9])
2628                         return MXSER_ERR_IRQ_CONFLIT;
2629         } else if (brd->info->nports == 8) {
2630                 irq = regs[9] & 0xF000;
2631                 irq = irq | (irq >> 4);
2632                 irq = irq | (irq >> 8);
2633                 if ((irq != regs[9]) || (irq != regs[10]))
2634                         return MXSER_ERR_IRQ_CONFLIT;
2635         }
2636
2637         if (!irq)
2638                 return MXSER_ERR_IRQ;
2639         brd->irq = ((int)(irq & 0xF000) >> 12);
2640         for (i = 0; i < 8; i++)
2641                 brd->ports[i].ioaddr = (int) regs[i + 1] & 0xFFF8;
2642         if ((regs[12] & 0x80) == 0)
2643                 return MXSER_ERR_VECTOR;
2644         brd->vector = (int)regs[11];    /* interrupt vector */
2645         if (id == 1)
2646                 brd->vector_mask = 0x00FF;
2647         else
2648                 brd->vector_mask = 0x000F;
2649         for (i = 7, bits = 0x0100; i >= 0; i--, bits <<= 1) {
2650                 if (regs[12] & bits) {
2651                         brd->ports[i].baud_base = 921600;
2652                         brd->ports[i].max_baud = 921600;
2653                 } else {
2654                         brd->ports[i].baud_base = 115200;
2655                         brd->ports[i].max_baud = 115200;
2656                 }
2657         }
2658         scratch2 = inb(cap + UART_LCR) & (~UART_LCR_DLAB);
2659         outb(scratch2 | UART_LCR_DLAB, cap + UART_LCR);
2660         outb(0, cap + UART_EFR);        /* EFR is the same as FCR */
2661         outb(scratch2, cap + UART_LCR);
2662         outb(UART_FCR_ENABLE_FIFO, cap + UART_FCR);
2663         scratch = inb(cap + UART_IIR);
2664
2665         if (scratch & 0xC0)
2666                 brd->uart_type = PORT_16550A;
2667         else
2668                 brd->uart_type = PORT_16450;
2669         if (!request_region(brd->ports[0].ioaddr, 8 * brd->info->nports,
2670                         "mxser(IO)"))
2671                 return MXSER_ERR_IOADDR;
2672         if (!request_region(brd->vector, 1, "mxser(vector)")) {
2673                 release_region(brd->ports[0].ioaddr, 8 * brd->info->nports);
2674                 return MXSER_ERR_VECTOR;
2675         }
2676         return brd->info->nports;
2677 }
2678
2679 static int __devinit mxser_probe(struct pci_dev *pdev,
2680                 const struct pci_device_id *ent)
2681 {
2682 #ifdef CONFIG_PCI
2683         struct mxser_board *brd;
2684         unsigned int i, j;
2685         unsigned long ioaddress;
2686         int retval = -EINVAL;
2687
2688         for (i = 0; i < MXSER_BOARDS; i++)
2689                 if (mxser_boards[i].info == NULL)
2690                         break;
2691
2692         if (i >= MXSER_BOARDS) {
2693                 printk(KERN_ERR "Too many Smartio/Industio family boards found "
2694                         "(maximum %d), board not configured\n", MXSER_BOARDS);
2695                 goto err;
2696         }
2697
2698         brd = &mxser_boards[i];
2699         brd->idx = i * MXSER_PORTS_PER_BOARD;
2700         printk(KERN_INFO "Found MOXA %s board (BusNo=%d, DevNo=%d)\n",
2701                 mxser_cards[ent->driver_data].name,
2702                 pdev->bus->number, PCI_SLOT(pdev->devfn));
2703
2704         retval = pci_enable_device(pdev);
2705         if (retval) {
2706                 printk(KERN_ERR "Moxa SmartI/O PCI enable fail !\n");
2707                 goto err;
2708         }
2709
2710         /* io address */
2711         ioaddress = pci_resource_start(pdev, 2);
2712         retval = pci_request_region(pdev, 2, "mxser(IO)");
2713         if (retval)
2714                 goto err;
2715
2716         brd->info = &mxser_cards[ent->driver_data];
2717         for (i = 0; i < brd->info->nports; i++)
2718                 brd->ports[i].ioaddr = ioaddress + 8 * i;
2719
2720         /* vector */
2721         ioaddress = pci_resource_start(pdev, 3);
2722         retval = pci_request_region(pdev, 3, "mxser(vector)");
2723         if (retval)
2724                 goto err_relio;
2725         brd->vector = ioaddress;
2726
2727         /* irq */
2728         brd->irq = pdev->irq;
2729
2730         brd->chip_flag = CheckIsMoxaMust(brd->ports[0].ioaddr);
2731         brd->uart_type = PORT_16550A;
2732         brd->vector_mask = 0;
2733
2734         for (i = 0; i < brd->info->nports; i++) {
2735                 for (j = 0; j < UART_INFO_NUM; j++) {
2736                         if (Gpci_uart_info[j].type == brd->chip_flag) {
2737                                 brd->ports[i].max_baud =
2738                                         Gpci_uart_info[j].max_baud;
2739
2740                                 /* exception....CP-102 */
2741                                 if (brd->info->flags & MXSER_HIGHBAUD)
2742                                         brd->ports[i].max_baud = 921600;
2743                                 break;
2744                         }
2745                 }
2746         }
2747
2748         if (brd->chip_flag == MOXA_MUST_MU860_HWID) {
2749                 for (i = 0; i < brd->info->nports; i++) {
2750                         if (i < 4)
2751                                 brd->ports[i].opmode_ioaddr = ioaddress + 4;
2752                         else
2753                                 brd->ports[i].opmode_ioaddr = ioaddress + 0x0c;
2754                 }
2755                 outb(0, ioaddress + 4); /* default set to RS232 mode */
2756                 outb(0, ioaddress + 0x0c);      /* default set to RS232 mode */
2757         }
2758
2759         for (i = 0; i < brd->info->nports; i++) {
2760                 brd->vector_mask |= (1 << i);
2761                 brd->ports[i].baud_base = 921600;
2762         }
2763
2764         /* mxser_initbrd will hook ISR. */
2765         retval = mxser_initbrd(brd, pdev);
2766         if (retval)
2767                 goto err_null;
2768
2769         for (i = 0; i < brd->info->nports; i++)
2770                 tty_register_device(mxvar_sdriver, brd->idx + i, &pdev->dev);
2771
2772         pci_set_drvdata(pdev, brd);
2773
2774         return 0;
2775 err_relio:
2776         pci_release_region(pdev, 2);
2777 err_null:
2778         brd->info = NULL;
2779 err:
2780         return retval;
2781 #else
2782         return -ENODEV;
2783 #endif
2784 }
2785
2786 static void __devexit mxser_remove(struct pci_dev *pdev)
2787 {
2788         struct mxser_board *brd = pci_get_drvdata(pdev);
2789         unsigned int i;
2790
2791         for (i = 0; i < brd->info->nports; i++)
2792                 tty_unregister_device(mxvar_sdriver, brd->idx + i);
2793
2794         mxser_release_res(brd, pdev, 1);
2795         brd->info = NULL;
2796 }
2797
2798 static struct pci_driver mxser_driver = {
2799         .name = "mxser",
2800         .id_table = mxser_pcibrds,
2801         .probe = mxser_probe,
2802         .remove = __devexit_p(mxser_remove)
2803 };
2804
2805 static int __init mxser_module_init(void)
2806 {
2807         struct mxser_board *brd;
2808         unsigned long cap;
2809         unsigned int i, m, isaloop;
2810         int retval, b;
2811
2812         pr_debug("Loading module mxser ...\n");
2813
2814         mxvar_sdriver = alloc_tty_driver(MXSER_PORTS + 1);
2815         if (!mxvar_sdriver)
2816                 return -ENOMEM;
2817
2818         printk(KERN_INFO "MOXA Smartio/Industio family driver version %s\n",
2819                 MXSER_VERSION);
2820
2821         /* Initialize the tty_driver structure */
2822         mxvar_sdriver->owner = THIS_MODULE;
2823         mxvar_sdriver->magic = TTY_DRIVER_MAGIC;
2824         mxvar_sdriver->name = "ttyMI";
2825         mxvar_sdriver->major = ttymajor;
2826         mxvar_sdriver->minor_start = 0;
2827         mxvar_sdriver->num = MXSER_PORTS + 1;
2828         mxvar_sdriver->type = TTY_DRIVER_TYPE_SERIAL;
2829         mxvar_sdriver->subtype = SERIAL_TYPE_NORMAL;
2830         mxvar_sdriver->init_termios = tty_std_termios;
2831         mxvar_sdriver->init_termios.c_cflag = B9600|CS8|CREAD|HUPCL|CLOCAL;
2832         mxvar_sdriver->flags = TTY_DRIVER_REAL_RAW|TTY_DRIVER_DYNAMIC_DEV;
2833         tty_set_operations(mxvar_sdriver, &mxser_ops);
2834
2835         retval = tty_register_driver(mxvar_sdriver);
2836         if (retval) {
2837                 printk(KERN_ERR "Couldn't install MOXA Smartio/Industio family "
2838                                 "tty driver !\n");
2839                 goto err_put;
2840         }
2841
2842         mxvar_diagflag = 0;
2843
2844         m = 0;
2845         /* Start finding ISA boards here */
2846         for (isaloop = 0; isaloop < 2; isaloop++)
2847                 for (b = 0; b < MXSER_BOARDS && m < MXSER_BOARDS; b++) {
2848                         if (!isaloop)
2849                                 cap = mxserBoardCAP[b]; /* predefined */
2850                         else
2851                                 cap = ioaddr[b]; /* module param */
2852
2853                         if (!cap)
2854                                 continue;
2855
2856                         brd = &mxser_boards[m];
2857                         retval = mxser_get_ISA_conf(cap, brd);
2858
2859                         if (retval != 0)
2860                                 printk(KERN_INFO "Found MOXA %s board "
2861                                         "(CAP=0x%x)\n",
2862                                         brd->info->name, ioaddr[b]);
2863
2864                         if (retval <= 0) {
2865                                 if (retval == MXSER_ERR_IRQ)
2866                                         printk(KERN_ERR "Invalid interrupt "
2867                                                 "number, board not "
2868                                                 "configured\n");
2869                                 else if (retval == MXSER_ERR_IRQ_CONFLIT)
2870                                         printk(KERN_ERR "Invalid interrupt "
2871                                                 "number, board not "
2872                                                 "configured\n");
2873                                 else if (retval == MXSER_ERR_VECTOR)
2874                                         printk(KERN_ERR "Invalid interrupt "
2875                                                 "vector, board not "
2876                                                 "configured\n");
2877                                 else if (retval == MXSER_ERR_IOADDR)
2878                                         printk(KERN_ERR "Invalid I/O address, "
2879                                                 "board not configured\n");
2880
2881                                 brd->info = NULL;
2882                                 continue;
2883                         }
2884
2885                         /* mxser_initbrd will hook ISR. */
2886                         if (mxser_initbrd(brd, NULL) < 0) {
2887                                 brd->info = NULL;
2888                                 continue;
2889                         }
2890
2891                         brd->idx = m * MXSER_PORTS_PER_BOARD;
2892                         for (i = 0; i < brd->info->nports; i++)
2893                                 tty_register_device(mxvar_sdriver, brd->idx + i,
2894                                                 NULL);
2895
2896                         m++;
2897                 }
2898
2899         retval = pci_register_driver(&mxser_driver);
2900         if (retval) {
2901                 printk(KERN_ERR "Can't register pci driver\n");
2902                 if (!m) {
2903                         retval = -ENODEV;
2904                         goto err_unr;
2905                 } /* else: we have some ISA cards under control */
2906         }
2907
2908         pr_debug("Done.\n");
2909
2910         return 0;
2911 err_unr:
2912         tty_unregister_driver(mxvar_sdriver);
2913 err_put:
2914         put_tty_driver(mxvar_sdriver);
2915         return retval;
2916 }
2917
2918 static void __exit mxser_module_exit(void)
2919 {
2920         unsigned int i, j;
2921
2922         pr_debug("Unloading module mxser ...\n");
2923
2924         pci_unregister_driver(&mxser_driver);
2925
2926         for (i = 0; i < MXSER_BOARDS; i++) /* ISA remains */
2927                 if (mxser_boards[i].info != NULL)
2928                         for (j = 0; j < mxser_boards[i].info->nports; j++)
2929                                 tty_unregister_device(mxvar_sdriver,
2930                                                 mxser_boards[i].idx + j);
2931         tty_unregister_driver(mxvar_sdriver);
2932         put_tty_driver(mxvar_sdriver);
2933
2934         for (i = 0; i < MXSER_BOARDS; i++)
2935                 if (mxser_boards[i].info != NULL)
2936                         mxser_release_res(&mxser_boards[i], NULL, 1);
2937
2938         pr_debug("Done.\n");
2939 }
2940
2941 module_init(mxser_module_init);
2942 module_exit(mxser_module_exit);