tty/vt/keyboard: fix OOB access in do_compute_shiftstate()
[pandora-kernel.git] / drivers / tty / isicom.c
1 /*
2  *      This program is free software; you can redistribute it and/or
3  *      modify it under the terms of the GNU General Public License
4  *      as published by the Free Software Foundation; either version
5  *      2 of the License, or (at your option) any later version.
6  *
7  *      Original driver code supplied by Multi-Tech
8  *
9  *      Changes
10  *      1/9/98  alan@lxorguk.ukuu.org.uk
11  *                                      Merge to 2.0.x kernel tree
12  *                                      Obtain and use official major/minors
13  *                                      Loader switched to a misc device
14  *                                      (fixed range check bug as a side effect)
15  *                                      Printk clean up
16  *      9/12/98 alan@lxorguk.ukuu.org.uk
17  *                                      Rough port to 2.1.x
18  *
19  *      10/6/99 sameer                  Merged the ISA and PCI drivers to
20  *                                      a new unified driver.
21  *
22  *      3/9/99  sameer                  Added support for ISI4616 cards.
23  *
24  *      16/9/99 sameer                  We do not force RTS low anymore.
25  *                                      This is to prevent the firmware
26  *                                      from getting confused.
27  *
28  *      26/10/99 sameer                 Cosmetic changes:The driver now
29  *                                      dumps the Port Count information
30  *                                      along with I/O address and IRQ.
31  *
32  *      13/12/99 sameer                 Fixed the problem with IRQ sharing.
33  *
34  *      10/5/00  sameer                 Fixed isicom_shutdown_board()
35  *                                      to not lower DTR on all the ports
36  *                                      when the last port on the card is
37  *                                      closed.
38  *
39  *      10/5/00  sameer                 Signal mask setup command added
40  *                                      to  isicom_setup_port and
41  *                                      isicom_shutdown_port.
42  *
43  *      24/5/00  sameer                 The driver is now SMP aware.
44  *
45  *
46  *      27/11/00 Vinayak P Risbud       Fixed the Driver Crash Problem
47  *
48  *
49  *      03/01/01  anil .s               Added support for resetting the
50  *                                      internal modems on ISI cards.
51  *
52  *      08/02/01  anil .s               Upgraded the driver for kernel
53  *                                      2.4.x
54  *
55  *      11/04/01  Kevin                 Fixed firmware load problem with
56  *                                      ISIHP-4X card
57  *
58  *      30/04/01  anil .s               Fixed the remote login through
59  *                                      ISI port problem. Now the link
60  *                                      does not go down before password
61  *                                      prompt.
62  *
63  *      03/05/01  anil .s               Fixed the problem with IRQ sharing
64  *                                      among ISI-PCI cards.
65  *
66  *      03/05/01  anil .s               Added support to display the version
67  *                                      info during insmod as well as module
68  *                                      listing by lsmod.
69  *
70  *      10/05/01  anil .s               Done the modifications to the source
71  *                                      file and Install script so that the
72  *                                      same installation can be used for
73  *                                      2.2.x and 2.4.x kernel.
74  *
75  *      06/06/01  anil .s               Now we drop both dtr and rts during
76  *                                      shutdown_port as well as raise them
77  *                                      during isicom_config_port.
78  *
79  *      09/06/01 acme@conectiva.com.br  use capable, not suser, do
80  *                                      restore_flags on failure in
81  *                                      isicom_send_break, verify put_user
82  *                                      result
83  *
84  *      11/02/03  ranjeeth              Added support for 230 Kbps and 460 Kbps
85  *                                      Baud index extended to 21
86  *
87  *      20/03/03  ranjeeth              Made to work for Linux Advanced server.
88  *                                      Taken care of license warning.
89  *
90  *      10/12/03  Ravindra              Made to work for Fedora Core 1 of
91  *                                      Red Hat Distribution
92  *
93  *      06/01/05  Alan Cox              Merged the ISI and base kernel strands
94  *                                      into a single 2.6 driver
95  *
96  *      ***********************************************************
97  *
98  *      To use this driver you also need the support package. You
99  *      can find this in RPM format on
100  *              ftp://ftp.linux.org.uk/pub/linux/alan
101  *
102  *      You can find the original tools for this direct from Multitech
103  *              ftp://ftp.multitech.com/ISI-Cards/
104  *
105  *      Having installed the cards the module options (/etc/modprobe.conf)
106  *
107  *      options isicom   io=card1,card2,card3,card4 irq=card1,card2,card3,card4
108  *
109  *      Omit those entries for boards you don't have installed.
110  *
111  *      TODO
112  *              Merge testing
113  *              64-bit verification
114  */
115
116 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
117
118 #include <linux/module.h>
119 #include <linux/firmware.h>
120 #include <linux/kernel.h>
121 #include <linux/tty.h>
122 #include <linux/tty_flip.h>
123 #include <linux/termios.h>
124 #include <linux/fs.h>
125 #include <linux/sched.h>
126 #include <linux/serial.h>
127 #include <linux/mm.h>
128 #include <linux/interrupt.h>
129 #include <linux/timer.h>
130 #include <linux/delay.h>
131 #include <linux/ioport.h>
132 #include <linux/slab.h>
133
134 #include <linux/uaccess.h>
135 #include <linux/io.h>
136 #include <asm/system.h>
137
138 #include <linux/pci.h>
139
140 #include <linux/isicom.h>
141
142 #define InterruptTheCard(base) outw(0, (base) + 0xc)
143 #define ClearInterrupt(base) inw((base) + 0x0a)
144
145 #ifdef DEBUG
146 #define isicom_paranoia_check(a, b, c) __isicom_paranoia_check((a), (b), (c))
147 #else
148 #define isicom_paranoia_check(a, b, c) 0
149 #endif
150
151 static int isicom_probe(struct pci_dev *, const struct pci_device_id *);
152 static void __devexit isicom_remove(struct pci_dev *);
153
154 static struct pci_device_id isicom_pci_tbl[] = {
155         { PCI_DEVICE(VENDOR_ID, 0x2028) },
156         { PCI_DEVICE(VENDOR_ID, 0x2051) },
157         { PCI_DEVICE(VENDOR_ID, 0x2052) },
158         { PCI_DEVICE(VENDOR_ID, 0x2053) },
159         { PCI_DEVICE(VENDOR_ID, 0x2054) },
160         { PCI_DEVICE(VENDOR_ID, 0x2055) },
161         { PCI_DEVICE(VENDOR_ID, 0x2056) },
162         { PCI_DEVICE(VENDOR_ID, 0x2057) },
163         { PCI_DEVICE(VENDOR_ID, 0x2058) },
164         { 0 }
165 };
166 MODULE_DEVICE_TABLE(pci, isicom_pci_tbl);
167
168 static struct pci_driver isicom_driver = {
169         .name           = "isicom",
170         .id_table       = isicom_pci_tbl,
171         .probe          = isicom_probe,
172         .remove         = __devexit_p(isicom_remove)
173 };
174
175 static int prev_card = 3;       /*      start servicing isi_card[0]     */
176 static struct tty_driver *isicom_normal;
177
178 static void isicom_tx(unsigned long _data);
179 static void isicom_start(struct tty_struct *tty);
180
181 static DEFINE_TIMER(tx, isicom_tx, 0, 0);
182
183 /*   baud index mappings from linux defns to isi */
184
185 static signed char linuxb_to_isib[] = {
186         -1, 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 11, 13, 15, 16, 17, 18, 19, 20, 21
187 };
188
189 struct  isi_board {
190         unsigned long           base;
191         int                     irq;
192         unsigned char           port_count;
193         unsigned short          status;
194         unsigned short          port_status; /* each bit for each port */
195         unsigned short          shift_count;
196         struct isi_port         *ports;
197         signed char             count;
198         spinlock_t              card_lock; /* Card wide lock 11/5/00 -sameer */
199         unsigned long           flags;
200         unsigned int            index;
201 };
202
203 struct  isi_port {
204         unsigned short          magic;
205         struct tty_port         port;
206         u16                     channel;
207         u16                     status;
208         struct isi_board        *card;
209         unsigned char           *xmit_buf;
210         int                     xmit_head;
211         int                     xmit_tail;
212         int                     xmit_cnt;
213 };
214
215 static struct isi_board isi_card[BOARD_COUNT];
216 static struct isi_port  isi_ports[PORT_COUNT];
217
218 /*
219  *      Locking functions for card level locking. We need to own both
220  *      the kernel lock for the card and have the card in a position that
221  *      it wants to talk.
222  */
223
224 static inline int WaitTillCardIsFree(unsigned long base)
225 {
226         unsigned int count = 0;
227         unsigned int a = in_atomic(); /* do we run under spinlock? */
228
229         while (!(inw(base + 0xe) & 0x1) && count++ < 100)
230                 if (a)
231                         mdelay(1);
232                 else
233                         msleep(1);
234
235         return !(inw(base + 0xe) & 0x1);
236 }
237
238 static int lock_card(struct isi_board *card)
239 {
240         unsigned long base = card->base;
241         unsigned int retries, a;
242
243         for (retries = 0; retries < 10; retries++) {
244                 spin_lock_irqsave(&card->card_lock, card->flags);
245                 for (a = 0; a < 10; a++) {
246                         if (inw(base + 0xe) & 0x1)
247                                 return 1;
248                         udelay(10);
249                 }
250                 spin_unlock_irqrestore(&card->card_lock, card->flags);
251                 msleep(10);
252         }
253         pr_warning("Failed to lock Card (0x%lx)\n", card->base);
254
255         return 0;       /* Failed to acquire the card! */
256 }
257
258 static void unlock_card(struct isi_board *card)
259 {
260         spin_unlock_irqrestore(&card->card_lock, card->flags);
261 }
262
263 /*
264  *  ISI Card specific ops ...
265  */
266
267 /* card->lock HAS to be held */
268 static void raise_dtr(struct isi_port *port)
269 {
270         struct isi_board *card = port->card;
271         unsigned long base = card->base;
272         u16 channel = port->channel;
273
274         if (WaitTillCardIsFree(base))
275                 return;
276
277         outw(0x8000 | (channel << card->shift_count) | 0x02, base);
278         outw(0x0504, base);
279         InterruptTheCard(base);
280         port->status |= ISI_DTR;
281 }
282
283 /* card->lock HAS to be held */
284 static inline void drop_dtr(struct isi_port *port)
285 {
286         struct isi_board *card = port->card;
287         unsigned long base = card->base;
288         u16 channel = port->channel;
289
290         if (WaitTillCardIsFree(base))
291                 return;
292
293         outw(0x8000 | (channel << card->shift_count) | 0x02, base);
294         outw(0x0404, base);
295         InterruptTheCard(base);
296         port->status &= ~ISI_DTR;
297 }
298
299 /* card->lock HAS to be held */
300 static inline void raise_rts(struct isi_port *port)
301 {
302         struct isi_board *card = port->card;
303         unsigned long base = card->base;
304         u16 channel = port->channel;
305
306         if (WaitTillCardIsFree(base))
307                 return;
308
309         outw(0x8000 | (channel << card->shift_count) | 0x02, base);
310         outw(0x0a04, base);
311         InterruptTheCard(base);
312         port->status |= ISI_RTS;
313 }
314
315 /* card->lock HAS to be held */
316 static inline void drop_rts(struct isi_port *port)
317 {
318         struct isi_board *card = port->card;
319         unsigned long base = card->base;
320         u16 channel = port->channel;
321
322         if (WaitTillCardIsFree(base))
323                 return;
324
325         outw(0x8000 | (channel << card->shift_count) | 0x02, base);
326         outw(0x0804, base);
327         InterruptTheCard(base);
328         port->status &= ~ISI_RTS;
329 }
330
331 /* card->lock MUST NOT be held */
332
333 static void isicom_dtr_rts(struct tty_port *port, int on)
334 {
335         struct isi_port *ip = container_of(port, struct isi_port, port);
336         struct isi_board *card = ip->card;
337         unsigned long base = card->base;
338         u16 channel = ip->channel;
339
340         if (!lock_card(card))
341                 return;
342
343         if (on) {
344                 outw(0x8000 | (channel << card->shift_count) | 0x02, base);
345                 outw(0x0f04, base);
346                 InterruptTheCard(base);
347                 ip->status |= (ISI_DTR | ISI_RTS);
348         } else {
349                 outw(0x8000 | (channel << card->shift_count) | 0x02, base);
350                 outw(0x0C04, base);
351                 InterruptTheCard(base);
352                 ip->status &= ~(ISI_DTR | ISI_RTS);
353         }
354         unlock_card(card);
355 }
356
357 /* card->lock HAS to be held */
358 static void drop_dtr_rts(struct isi_port *port)
359 {
360         struct isi_board *card = port->card;
361         unsigned long base = card->base;
362         u16 channel = port->channel;
363
364         if (WaitTillCardIsFree(base))
365                 return;
366
367         outw(0x8000 | (channel << card->shift_count) | 0x02, base);
368         outw(0x0c04, base);
369         InterruptTheCard(base);
370         port->status &= ~(ISI_RTS | ISI_DTR);
371 }
372
373 /*
374  *      ISICOM Driver specific routines ...
375  *
376  */
377
378 static inline int __isicom_paranoia_check(struct isi_port const *port,
379         char *name, const char *routine)
380 {
381         if (!port) {
382                 pr_warning("Warning: bad isicom magic for dev %s in %s.\n",
383                            name, routine);
384                 return 1;
385         }
386         if (port->magic != ISICOM_MAGIC) {
387                 pr_warning("Warning: NULL isicom port for dev %s in %s.\n",
388                            name, routine);
389                 return 1;
390         }
391
392         return 0;
393 }
394
395 /*
396  *      Transmitter.
397  *
398  *      We shovel data into the card buffers on a regular basis. The card
399  *      will do the rest of the work for us.
400  */
401
402 static void isicom_tx(unsigned long _data)
403 {
404         unsigned long flags, base;
405         unsigned int retries;
406         short count = (BOARD_COUNT-1), card;
407         short txcount, wrd, residue, word_count, cnt;
408         struct isi_port *port;
409         struct tty_struct *tty;
410
411         /*      find next active board  */
412         card = (prev_card + 1) & 0x0003;
413         while (count-- > 0) {
414                 if (isi_card[card].status & BOARD_ACTIVE)
415                         break;
416                 card = (card + 1) & 0x0003;
417         }
418         if (!(isi_card[card].status & BOARD_ACTIVE))
419                 goto sched_again;
420
421         prev_card = card;
422
423         count = isi_card[card].port_count;
424         port = isi_card[card].ports;
425         base = isi_card[card].base;
426
427         spin_lock_irqsave(&isi_card[card].card_lock, flags);
428         for (retries = 0; retries < 100; retries++) {
429                 if (inw(base + 0xe) & 0x1)
430                         break;
431                 udelay(2);
432         }
433         if (retries >= 100)
434                 goto unlock;
435
436         tty = tty_port_tty_get(&port->port);
437         if (tty == NULL)
438                 goto put_unlock;
439
440         for (; count > 0; count--, port++) {
441                 /* port not active or tx disabled to force flow control */
442                 if (!(port->port.flags & ASYNC_INITIALIZED) ||
443                                 !(port->status & ISI_TXOK))
444                         continue;
445
446                 txcount = min_t(short, TX_SIZE, port->xmit_cnt);
447                 if (txcount <= 0 || tty->stopped || tty->hw_stopped)
448                         continue;
449
450                 if (!(inw(base + 0x02) & (1 << port->channel)))
451                         continue;
452
453                 pr_debug("txing %d bytes, port%d.\n",
454                          txcount, port->channel + 1);
455                 outw((port->channel << isi_card[card].shift_count) | txcount,
456                         base);
457                 residue = NO;
458                 wrd = 0;
459                 while (1) {
460                         cnt = min_t(int, txcount, (SERIAL_XMIT_SIZE
461                                         - port->xmit_tail));
462                         if (residue == YES) {
463                                 residue = NO;
464                                 if (cnt > 0) {
465                                         wrd |= (port->port.xmit_buf[port->xmit_tail]
466                                                                         << 8);
467                                         port->xmit_tail = (port->xmit_tail + 1)
468                                                 & (SERIAL_XMIT_SIZE - 1);
469                                         port->xmit_cnt--;
470                                         txcount--;
471                                         cnt--;
472                                         outw(wrd, base);
473                                 } else {
474                                         outw(wrd, base);
475                                         break;
476                                 }
477                         }
478                         if (cnt <= 0)
479                                 break;
480                         word_count = cnt >> 1;
481                         outsw(base, port->port.xmit_buf+port->xmit_tail, word_count);
482                         port->xmit_tail = (port->xmit_tail
483                                 + (word_count << 1)) & (SERIAL_XMIT_SIZE - 1);
484                         txcount -= (word_count << 1);
485                         port->xmit_cnt -= (word_count << 1);
486                         if (cnt & 0x0001) {
487                                 residue = YES;
488                                 wrd = port->port.xmit_buf[port->xmit_tail];
489                                 port->xmit_tail = (port->xmit_tail + 1)
490                                         & (SERIAL_XMIT_SIZE - 1);
491                                 port->xmit_cnt--;
492                                 txcount--;
493                         }
494                 }
495
496                 InterruptTheCard(base);
497                 if (port->xmit_cnt <= 0)
498                         port->status &= ~ISI_TXOK;
499                 if (port->xmit_cnt <= WAKEUP_CHARS)
500                         tty_wakeup(tty);
501         }
502
503 put_unlock:
504         tty_kref_put(tty);
505 unlock:
506         spin_unlock_irqrestore(&isi_card[card].card_lock, flags);
507         /*      schedule another tx for hopefully in about 10ms */
508 sched_again:
509         mod_timer(&tx, jiffies + msecs_to_jiffies(10));
510 }
511
512 /*
513  *      Main interrupt handler routine
514  */
515
516 static irqreturn_t isicom_interrupt(int irq, void *dev_id)
517 {
518         struct isi_board *card = dev_id;
519         struct isi_port *port;
520         struct tty_struct *tty;
521         unsigned long base;
522         u16 header, word_count, count, channel;
523         short byte_count;
524         unsigned char *rp;
525
526         if (!card || !(card->status & FIRMWARE_LOADED))
527                 return IRQ_NONE;
528
529         base = card->base;
530
531         /* did the card interrupt us? */
532         if (!(inw(base + 0x0e) & 0x02))
533                 return IRQ_NONE;
534
535         spin_lock(&card->card_lock);
536
537         /*
538          * disable any interrupts from the PCI card and lower the
539          * interrupt line
540          */
541         outw(0x8000, base+0x04);
542         ClearInterrupt(base);
543
544         inw(base);              /* get the dummy word out */
545         header = inw(base);
546         channel = (header & 0x7800) >> card->shift_count;
547         byte_count = header & 0xff;
548
549         if (channel + 1 > card->port_count) {
550                 pr_warning("%s(0x%lx): %d(channel) > port_count.\n",
551                            __func__, base, channel+1);
552                 outw(0x0000, base+0x04); /* enable interrupts */
553                 spin_unlock(&card->card_lock);
554                 return IRQ_HANDLED;
555         }
556         port = card->ports + channel;
557         if (!(port->port.flags & ASYNC_INITIALIZED)) {
558                 outw(0x0000, base+0x04); /* enable interrupts */
559                 spin_unlock(&card->card_lock);
560                 return IRQ_HANDLED;
561         }
562
563         tty = tty_port_tty_get(&port->port);
564         if (tty == NULL) {
565                 word_count = byte_count >> 1;
566                 while (byte_count > 1) {
567                         inw(base);
568                         byte_count -= 2;
569                 }
570                 if (byte_count & 0x01)
571                         inw(base);
572                 outw(0x0000, base+0x04); /* enable interrupts */
573                 spin_unlock(&card->card_lock);
574                 return IRQ_HANDLED;
575         }
576
577         if (header & 0x8000) {          /* Status Packet */
578                 header = inw(base);
579                 switch (header & 0xff) {
580                 case 0: /* Change in EIA signals */
581                         if (port->port.flags & ASYNC_CHECK_CD) {
582                                 if (port->status & ISI_DCD) {
583                                         if (!(header & ISI_DCD)) {
584                                         /* Carrier has been lost  */
585                                                 pr_debug("%s: DCD->low.\n",
586                                                          __func__);
587                                                 port->status &= ~ISI_DCD;
588                                                 tty_hangup(tty);
589                                         }
590                                 } else if (header & ISI_DCD) {
591                                 /* Carrier has been detected */
592                                         pr_debug("%s: DCD->high.\n",
593                                                 __func__);
594                                         port->status |= ISI_DCD;
595                                         wake_up_interruptible(&port->port.open_wait);
596                                 }
597                         } else {
598                                 if (header & ISI_DCD)
599                                         port->status |= ISI_DCD;
600                                 else
601                                         port->status &= ~ISI_DCD;
602                         }
603
604                         if (port->port.flags & ASYNC_CTS_FLOW) {
605                                 if (tty->hw_stopped) {
606                                         if (header & ISI_CTS) {
607                                                 port->port.tty->hw_stopped = 0;
608                                                 /* start tx ing */
609                                                 port->status |= (ISI_TXOK
610                                                         | ISI_CTS);
611                                                 tty_wakeup(tty);
612                                         }
613                                 } else if (!(header & ISI_CTS)) {
614                                         tty->hw_stopped = 1;
615                                         /* stop tx ing */
616                                         port->status &= ~(ISI_TXOK | ISI_CTS);
617                                 }
618                         } else {
619                                 if (header & ISI_CTS)
620                                         port->status |= ISI_CTS;
621                                 else
622                                         port->status &= ~ISI_CTS;
623                         }
624
625                         if (header & ISI_DSR)
626                                 port->status |= ISI_DSR;
627                         else
628                                 port->status &= ~ISI_DSR;
629
630                         if (header & ISI_RI)
631                                 port->status |= ISI_RI;
632                         else
633                                 port->status &= ~ISI_RI;
634
635                         break;
636
637                 case 1: /* Received Break !!! */
638                         tty_insert_flip_char(tty, 0, TTY_BREAK);
639                         if (port->port.flags & ASYNC_SAK)
640                                 do_SAK(tty);
641                         tty_flip_buffer_push(tty);
642                         break;
643
644                 case 2: /* Statistics            */
645                         pr_debug("%s: stats!!!\n", __func__);
646                         break;
647
648                 default:
649                         pr_debug("%s: Unknown code in status packet.\n",
650                                  __func__);
651                         break;
652                 }
653         } else {                                /* Data   Packet */
654
655                 count = tty_prepare_flip_string(tty, &rp, byte_count & ~1);
656                 pr_debug("%s: Can rx %d of %d bytes.\n",
657                          __func__, count, byte_count);
658                 word_count = count >> 1;
659                 insw(base, rp, word_count);
660                 byte_count -= (word_count << 1);
661                 if (count & 0x0001) {
662                         tty_insert_flip_char(tty,  inw(base) & 0xff,
663                                 TTY_NORMAL);
664                         byte_count -= 2;
665                 }
666                 if (byte_count > 0) {
667                         pr_debug("%s(0x%lx:%d): Flip buffer overflow! dropping bytes...\n",
668                                  __func__, base, channel + 1);
669                 /* drain out unread xtra data */
670                 while (byte_count > 0) {
671                                 inw(base);
672                                 byte_count -= 2;
673                         }
674                 }
675                 tty_flip_buffer_push(tty);
676         }
677         outw(0x0000, base+0x04); /* enable interrupts */
678         spin_unlock(&card->card_lock);
679         tty_kref_put(tty);
680
681         return IRQ_HANDLED;
682 }
683
684 static void isicom_config_port(struct tty_struct *tty)
685 {
686         struct isi_port *port = tty->driver_data;
687         struct isi_board *card = port->card;
688         unsigned long baud;
689         unsigned long base = card->base;
690         u16 channel_setup, channel = port->channel,
691                 shift_count = card->shift_count;
692         unsigned char flow_ctrl;
693
694         /* FIXME: Switch to new tty baud API */
695         baud = C_BAUD(tty);
696         if (baud & CBAUDEX) {
697                 baud &= ~CBAUDEX;
698
699                 /*  if CBAUDEX bit is on and the baud is set to either 50 or 75
700                  *  then the card is programmed for 57.6Kbps or 115Kbps
701                  *  respectively.
702                  */
703
704                 /* 1,2,3,4 => 57.6, 115.2, 230, 460 kbps resp. */
705                 if (baud < 1 || baud > 4)
706                         tty->termios->c_cflag &= ~CBAUDEX;
707                 else
708                         baud += 15;
709         }
710         if (baud == 15) {
711
712                 /*  the ASYNC_SPD_HI and ASYNC_SPD_VHI options are set
713                  *  by the set_serial_info ioctl ... this is done by
714                  *  the 'setserial' utility.
715                  */
716
717                 if ((port->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_HI)
718                         baud++; /*  57.6 Kbps */
719                 if ((port->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI)
720                         baud += 2; /*  115  Kbps */
721                 if ((port->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_SHI)
722                         baud += 3; /* 230 kbps*/
723                 if ((port->port.flags & ASYNC_SPD_MASK) == ASYNC_SPD_WARP)
724                         baud += 4; /* 460 kbps*/
725         }
726         if (linuxb_to_isib[baud] == -1) {
727                 /* hang up */
728                 drop_dtr(port);
729                 return;
730         } else
731                 raise_dtr(port);
732
733         if (WaitTillCardIsFree(base) == 0) {
734                 outw(0x8000 | (channel << shift_count) | 0x03, base);
735                 outw(linuxb_to_isib[baud] << 8 | 0x03, base);
736                 channel_setup = 0;
737                 switch (C_CSIZE(tty)) {
738                 case CS5:
739                         channel_setup |= ISICOM_CS5;
740                         break;
741                 case CS6:
742                         channel_setup |= ISICOM_CS6;
743                         break;
744                 case CS7:
745                         channel_setup |= ISICOM_CS7;
746                         break;
747                 case CS8:
748                         channel_setup |= ISICOM_CS8;
749                         break;
750                 }
751
752                 if (C_CSTOPB(tty))
753                         channel_setup |= ISICOM_2SB;
754                 if (C_PARENB(tty)) {
755                         channel_setup |= ISICOM_EVPAR;
756                         if (C_PARODD(tty))
757                                 channel_setup |= ISICOM_ODPAR;
758                 }
759                 outw(channel_setup, base);
760                 InterruptTheCard(base);
761         }
762         if (C_CLOCAL(tty))
763                 port->port.flags &= ~ASYNC_CHECK_CD;
764         else
765                 port->port.flags |= ASYNC_CHECK_CD;
766
767         /* flow control settings ...*/
768         flow_ctrl = 0;
769         port->port.flags &= ~ASYNC_CTS_FLOW;
770         if (C_CRTSCTS(tty)) {
771                 port->port.flags |= ASYNC_CTS_FLOW;
772                 flow_ctrl |= ISICOM_CTSRTS;
773         }
774         if (I_IXON(tty))
775                 flow_ctrl |= ISICOM_RESPOND_XONXOFF;
776         if (I_IXOFF(tty))
777                 flow_ctrl |= ISICOM_INITIATE_XONXOFF;
778
779         if (WaitTillCardIsFree(base) == 0) {
780                 outw(0x8000 | (channel << shift_count) | 0x04, base);
781                 outw(flow_ctrl << 8 | 0x05, base);
782                 outw((STOP_CHAR(tty)) << 8 | (START_CHAR(tty)), base);
783                 InterruptTheCard(base);
784         }
785
786         /*      rx enabled -> enable port for rx on the card    */
787         if (C_CREAD(tty)) {
788                 card->port_status |= (1 << channel);
789                 outw(card->port_status, base + 0x02);
790         }
791 }
792
793 /* open et all */
794
795 static inline void isicom_setup_board(struct isi_board *bp)
796 {
797         int channel;
798         struct isi_port *port;
799
800         bp->count++;
801         if (!(bp->status & BOARD_INIT)) {
802                 port = bp->ports;
803                 for (channel = 0; channel < bp->port_count; channel++, port++)
804                         drop_dtr_rts(port);
805         }
806         bp->status |= BOARD_ACTIVE | BOARD_INIT;
807 }
808
809 /* Activate and thus setup board are protected from races against shutdown
810    by the tty_port mutex */
811
812 static int isicom_activate(struct tty_port *tport, struct tty_struct *tty)
813 {
814         struct isi_port *port = container_of(tport, struct isi_port, port);
815         struct isi_board *card = port->card;
816         unsigned long flags;
817
818         if (tty_port_alloc_xmit_buf(tport) < 0)
819                 return -ENOMEM;
820
821         spin_lock_irqsave(&card->card_lock, flags);
822         isicom_setup_board(card);
823
824         port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
825
826         /*      discard any residual data       */
827         if (WaitTillCardIsFree(card->base) == 0) {
828                 outw(0x8000 | (port->channel << card->shift_count) | 0x02,
829                                 card->base);
830                 outw(((ISICOM_KILLTX | ISICOM_KILLRX) << 8) | 0x06, card->base);
831                 InterruptTheCard(card->base);
832         }
833         isicom_config_port(tty);
834         spin_unlock_irqrestore(&card->card_lock, flags);
835
836         return 0;
837 }
838
839 static int isicom_carrier_raised(struct tty_port *port)
840 {
841         struct isi_port *ip = container_of(port, struct isi_port, port);
842         return (ip->status & ISI_DCD)?1 : 0;
843 }
844
845 static struct tty_port *isicom_find_port(struct tty_struct *tty)
846 {
847         struct isi_port *port;
848         struct isi_board *card;
849         unsigned int board;
850         int line = tty->index;
851
852         if (line < 0 || line > PORT_COUNT-1)
853                 return NULL;
854         board = BOARD(line);
855         card = &isi_card[board];
856
857         if (!(card->status & FIRMWARE_LOADED))
858                 return NULL;
859
860         /*  open on a port greater than the port count for the card !!! */
861         if (line > ((board * 16) + card->port_count - 1))
862                 return NULL;
863
864         port = &isi_ports[line];
865         if (isicom_paranoia_check(port, tty->name, "isicom_open"))
866                 return NULL;
867
868         return &port->port;
869 }
870
871 static int isicom_open(struct tty_struct *tty, struct file *filp)
872 {
873         struct isi_port *port;
874         struct tty_port *tport;
875
876         tport = isicom_find_port(tty);
877         if (tport == NULL)
878                 return -ENODEV;
879         port = container_of(tport, struct isi_port, port);
880
881         tty->driver_data = port;
882         return tty_port_open(tport, tty, filp);
883 }
884
885 /* close et all */
886
887 /* card->lock HAS to be held */
888 static void isicom_shutdown_port(struct isi_port *port)
889 {
890         struct isi_board *card = port->card;
891
892         if (--card->count < 0) {
893                 pr_debug("%s: bad board(0x%lx) count %d.\n",
894                          __func__, card->base, card->count);
895                 card->count = 0;
896         }
897         /* last port was closed, shutdown that board too */
898         if (!card->count)
899                 card->status &= BOARD_ACTIVE;
900 }
901
902 static void isicom_flush_buffer(struct tty_struct *tty)
903 {
904         struct isi_port *port = tty->driver_data;
905         struct isi_board *card = port->card;
906         unsigned long flags;
907
908         if (isicom_paranoia_check(port, tty->name, "isicom_flush_buffer"))
909                 return;
910
911         spin_lock_irqsave(&card->card_lock, flags);
912         port->xmit_cnt = port->xmit_head = port->xmit_tail = 0;
913         spin_unlock_irqrestore(&card->card_lock, flags);
914
915         tty_wakeup(tty);
916 }
917
918 static void isicom_shutdown(struct tty_port *port)
919 {
920         struct isi_port *ip = container_of(port, struct isi_port, port);
921         struct isi_board *card = ip->card;
922         unsigned long flags;
923
924         /* indicate to the card that no more data can be received
925            on this port */
926         spin_lock_irqsave(&card->card_lock, flags);
927         card->port_status &= ~(1 << ip->channel);
928         outw(card->port_status, card->base + 0x02);
929         isicom_shutdown_port(ip);
930         spin_unlock_irqrestore(&card->card_lock, flags);
931         tty_port_free_xmit_buf(port);
932 }
933
934 static void isicom_close(struct tty_struct *tty, struct file *filp)
935 {
936         struct isi_port *ip = tty->driver_data;
937         struct tty_port *port;
938
939         if (ip == NULL)
940                 return;
941
942         port = &ip->port;
943         if (isicom_paranoia_check(ip, tty->name, "isicom_close"))
944                 return;
945         tty_port_close(port, tty, filp);
946 }
947
948 /* write et all */
949 static int isicom_write(struct tty_struct *tty, const unsigned char *buf,
950         int count)
951 {
952         struct isi_port *port = tty->driver_data;
953         struct isi_board *card = port->card;
954         unsigned long flags;
955         int cnt, total = 0;
956
957         if (isicom_paranoia_check(port, tty->name, "isicom_write"))
958                 return 0;
959
960         spin_lock_irqsave(&card->card_lock, flags);
961
962         while (1) {
963                 cnt = min_t(int, count, min(SERIAL_XMIT_SIZE - port->xmit_cnt
964                                 - 1, SERIAL_XMIT_SIZE - port->xmit_head));
965                 if (cnt <= 0)
966                         break;
967
968                 memcpy(port->port.xmit_buf + port->xmit_head, buf, cnt);
969                 port->xmit_head = (port->xmit_head + cnt) & (SERIAL_XMIT_SIZE
970                         - 1);
971                 port->xmit_cnt += cnt;
972                 buf += cnt;
973                 count -= cnt;
974                 total += cnt;
975         }
976         if (port->xmit_cnt && !tty->stopped && !tty->hw_stopped)
977                 port->status |= ISI_TXOK;
978         spin_unlock_irqrestore(&card->card_lock, flags);
979         return total;
980 }
981
982 /* put_char et all */
983 static int isicom_put_char(struct tty_struct *tty, unsigned char ch)
984 {
985         struct isi_port *port = tty->driver_data;
986         struct isi_board *card = port->card;
987         unsigned long flags;
988
989         if (isicom_paranoia_check(port, tty->name, "isicom_put_char"))
990                 return 0;
991
992         spin_lock_irqsave(&card->card_lock, flags);
993         if (port->xmit_cnt >= SERIAL_XMIT_SIZE - 1) {
994                 spin_unlock_irqrestore(&card->card_lock, flags);
995                 return 0;
996         }
997
998         port->port.xmit_buf[port->xmit_head++] = ch;
999         port->xmit_head &= (SERIAL_XMIT_SIZE - 1);
1000         port->xmit_cnt++;
1001         spin_unlock_irqrestore(&card->card_lock, flags);
1002         return 1;
1003 }
1004
1005 /* flush_chars et all */
1006 static void isicom_flush_chars(struct tty_struct *tty)
1007 {
1008         struct isi_port *port = tty->driver_data;
1009
1010         if (isicom_paranoia_check(port, tty->name, "isicom_flush_chars"))
1011                 return;
1012
1013         if (port->xmit_cnt <= 0 || tty->stopped || tty->hw_stopped ||
1014                         !port->port.xmit_buf)
1015                 return;
1016
1017         /* this tells the transmitter to consider this port for
1018            data output to the card ... that's the best we can do. */
1019         port->status |= ISI_TXOK;
1020 }
1021
1022 /* write_room et all */
1023 static int isicom_write_room(struct tty_struct *tty)
1024 {
1025         struct isi_port *port = tty->driver_data;
1026         int free;
1027
1028         if (isicom_paranoia_check(port, tty->name, "isicom_write_room"))
1029                 return 0;
1030
1031         free = SERIAL_XMIT_SIZE - port->xmit_cnt - 1;
1032         if (free < 0)
1033                 free = 0;
1034         return free;
1035 }
1036
1037 /* chars_in_buffer et all */
1038 static int isicom_chars_in_buffer(struct tty_struct *tty)
1039 {
1040         struct isi_port *port = tty->driver_data;
1041         if (isicom_paranoia_check(port, tty->name, "isicom_chars_in_buffer"))
1042                 return 0;
1043         return port->xmit_cnt;
1044 }
1045
1046 /* ioctl et all */
1047 static int isicom_send_break(struct tty_struct *tty, int length)
1048 {
1049         struct isi_port *port = tty->driver_data;
1050         struct isi_board *card = port->card;
1051         unsigned long base = card->base;
1052
1053         if (length == -1)
1054                 return -EOPNOTSUPP;
1055
1056         if (!lock_card(card))
1057                 return -EINVAL;
1058
1059         outw(0x8000 | ((port->channel) << (card->shift_count)) | 0x3, base);
1060         outw((length & 0xff) << 8 | 0x00, base);
1061         outw((length & 0xff00), base);
1062         InterruptTheCard(base);
1063
1064         unlock_card(card);
1065         return 0;
1066 }
1067
1068 static int isicom_tiocmget(struct tty_struct *tty)
1069 {
1070         struct isi_port *port = tty->driver_data;
1071         /* just send the port status */
1072         u16 status = port->status;
1073
1074         if (isicom_paranoia_check(port, tty->name, "isicom_ioctl"))
1075                 return -ENODEV;
1076
1077         return  ((status & ISI_RTS) ? TIOCM_RTS : 0) |
1078                 ((status & ISI_DTR) ? TIOCM_DTR : 0) |
1079                 ((status & ISI_DCD) ? TIOCM_CAR : 0) |
1080                 ((status & ISI_DSR) ? TIOCM_DSR : 0) |
1081                 ((status & ISI_CTS) ? TIOCM_CTS : 0) |
1082                 ((status & ISI_RI ) ? TIOCM_RI  : 0);
1083 }
1084
1085 static int isicom_tiocmset(struct tty_struct *tty,
1086                                         unsigned int set, unsigned int clear)
1087 {
1088         struct isi_port *port = tty->driver_data;
1089         unsigned long flags;
1090
1091         if (isicom_paranoia_check(port, tty->name, "isicom_ioctl"))
1092                 return -ENODEV;
1093
1094         spin_lock_irqsave(&port->card->card_lock, flags);
1095         if (set & TIOCM_RTS)
1096                 raise_rts(port);
1097         if (set & TIOCM_DTR)
1098                 raise_dtr(port);
1099
1100         if (clear & TIOCM_RTS)
1101                 drop_rts(port);
1102         if (clear & TIOCM_DTR)
1103                 drop_dtr(port);
1104         spin_unlock_irqrestore(&port->card->card_lock, flags);
1105
1106         return 0;
1107 }
1108
1109 static int isicom_set_serial_info(struct tty_struct *tty,
1110                                         struct serial_struct __user *info)
1111 {
1112         struct isi_port *port = tty->driver_data;
1113         struct serial_struct newinfo;
1114         int reconfig_port;
1115
1116         if (copy_from_user(&newinfo, info, sizeof(newinfo)))
1117                 return -EFAULT;
1118
1119         mutex_lock(&port->port.mutex);
1120         reconfig_port = ((port->port.flags & ASYNC_SPD_MASK) !=
1121                 (newinfo.flags & ASYNC_SPD_MASK));
1122
1123         if (!capable(CAP_SYS_ADMIN)) {
1124                 if ((newinfo.close_delay != port->port.close_delay) ||
1125                                 (newinfo.closing_wait != port->port.closing_wait) ||
1126                                 ((newinfo.flags & ~ASYNC_USR_MASK) !=
1127                                 (port->port.flags & ~ASYNC_USR_MASK))) {
1128                         mutex_unlock(&port->port.mutex);
1129                         return -EPERM;
1130                 }
1131                 port->port.flags = ((port->port.flags & ~ASYNC_USR_MASK) |
1132                                 (newinfo.flags & ASYNC_USR_MASK));
1133         } else {
1134                 port->port.close_delay = newinfo.close_delay;
1135                 port->port.closing_wait = newinfo.closing_wait;
1136                 port->port.flags = ((port->port.flags & ~ASYNC_FLAGS) |
1137                                 (newinfo.flags & ASYNC_FLAGS));
1138         }
1139         if (reconfig_port) {
1140                 unsigned long flags;
1141                 spin_lock_irqsave(&port->card->card_lock, flags);
1142                 isicom_config_port(tty);
1143                 spin_unlock_irqrestore(&port->card->card_lock, flags);
1144         }
1145         mutex_unlock(&port->port.mutex);
1146         return 0;
1147 }
1148
1149 static int isicom_get_serial_info(struct isi_port *port,
1150         struct serial_struct __user *info)
1151 {
1152         struct serial_struct out_info;
1153
1154         mutex_lock(&port->port.mutex);
1155         memset(&out_info, 0, sizeof(out_info));
1156 /*      out_info.type = ? */
1157         out_info.line = port - isi_ports;
1158         out_info.port = port->card->base;
1159         out_info.irq = port->card->irq;
1160         out_info.flags = port->port.flags;
1161 /*      out_info.baud_base = ? */
1162         out_info.close_delay = port->port.close_delay;
1163         out_info.closing_wait = port->port.closing_wait;
1164         mutex_unlock(&port->port.mutex);
1165         if (copy_to_user(info, &out_info, sizeof(out_info)))
1166                 return -EFAULT;
1167         return 0;
1168 }
1169
1170 static int isicom_ioctl(struct tty_struct *tty,
1171         unsigned int cmd, unsigned long arg)
1172 {
1173         struct isi_port *port = tty->driver_data;
1174         void __user *argp = (void __user *)arg;
1175
1176         if (isicom_paranoia_check(port, tty->name, "isicom_ioctl"))
1177                 return -ENODEV;
1178
1179         switch (cmd) {
1180         case TIOCGSERIAL:
1181                 return isicom_get_serial_info(port, argp);
1182
1183         case TIOCSSERIAL:
1184                 return isicom_set_serial_info(tty, argp);
1185
1186         default:
1187                 return -ENOIOCTLCMD;
1188         }
1189         return 0;
1190 }
1191
1192 /* set_termios et all */
1193 static void isicom_set_termios(struct tty_struct *tty,
1194         struct ktermios *old_termios)
1195 {
1196         struct isi_port *port = tty->driver_data;
1197         unsigned long flags;
1198
1199         if (isicom_paranoia_check(port, tty->name, "isicom_set_termios"))
1200                 return;
1201
1202         if (tty->termios->c_cflag == old_termios->c_cflag &&
1203                         tty->termios->c_iflag == old_termios->c_iflag)
1204                 return;
1205
1206         spin_lock_irqsave(&port->card->card_lock, flags);
1207         isicom_config_port(tty);
1208         spin_unlock_irqrestore(&port->card->card_lock, flags);
1209
1210         if ((old_termios->c_cflag & CRTSCTS) &&
1211                         !(tty->termios->c_cflag & CRTSCTS)) {
1212                 tty->hw_stopped = 0;
1213                 isicom_start(tty);
1214         }
1215 }
1216
1217 /* throttle et all */
1218 static void isicom_throttle(struct tty_struct *tty)
1219 {
1220         struct isi_port *port = tty->driver_data;
1221         struct isi_board *card = port->card;
1222
1223         if (isicom_paranoia_check(port, tty->name, "isicom_throttle"))
1224                 return;
1225
1226         /* tell the card that this port cannot handle any more data for now */
1227         card->port_status &= ~(1 << port->channel);
1228         outw(card->port_status, card->base + 0x02);
1229 }
1230
1231 /* unthrottle et all */
1232 static void isicom_unthrottle(struct tty_struct *tty)
1233 {
1234         struct isi_port *port = tty->driver_data;
1235         struct isi_board *card = port->card;
1236
1237         if (isicom_paranoia_check(port, tty->name, "isicom_unthrottle"))
1238                 return;
1239
1240         /* tell the card that this port is ready to accept more data */
1241         card->port_status |= (1 << port->channel);
1242         outw(card->port_status, card->base + 0x02);
1243 }
1244
1245 /* stop et all */
1246 static void isicom_stop(struct tty_struct *tty)
1247 {
1248         struct isi_port *port = tty->driver_data;
1249
1250         if (isicom_paranoia_check(port, tty->name, "isicom_stop"))
1251                 return;
1252
1253         /* this tells the transmitter not to consider this port for
1254            data output to the card. */
1255         port->status &= ~ISI_TXOK;
1256 }
1257
1258 /* start et all */
1259 static void isicom_start(struct tty_struct *tty)
1260 {
1261         struct isi_port *port = tty->driver_data;
1262
1263         if (isicom_paranoia_check(port, tty->name, "isicom_start"))
1264                 return;
1265
1266         /* this tells the transmitter to consider this port for
1267            data output to the card. */
1268         port->status |= ISI_TXOK;
1269 }
1270
1271 static void isicom_hangup(struct tty_struct *tty)
1272 {
1273         struct isi_port *port = tty->driver_data;
1274
1275         if (isicom_paranoia_check(port, tty->name, "isicom_hangup"))
1276                 return;
1277         tty_port_hangup(&port->port);
1278 }
1279
1280
1281 /*
1282  * Driver init and deinit functions
1283  */
1284
1285 static const struct tty_operations isicom_ops = {
1286         .open                   = isicom_open,
1287         .close                  = isicom_close,
1288         .write                  = isicom_write,
1289         .put_char               = isicom_put_char,
1290         .flush_chars            = isicom_flush_chars,
1291         .write_room             = isicom_write_room,
1292         .chars_in_buffer        = isicom_chars_in_buffer,
1293         .ioctl                  = isicom_ioctl,
1294         .set_termios            = isicom_set_termios,
1295         .throttle               = isicom_throttle,
1296         .unthrottle             = isicom_unthrottle,
1297         .stop                   = isicom_stop,
1298         .start                  = isicom_start,
1299         .hangup                 = isicom_hangup,
1300         .flush_buffer           = isicom_flush_buffer,
1301         .tiocmget               = isicom_tiocmget,
1302         .tiocmset               = isicom_tiocmset,
1303         .break_ctl              = isicom_send_break,
1304 };
1305
1306 static const struct tty_port_operations isicom_port_ops = {
1307         .carrier_raised         = isicom_carrier_raised,
1308         .dtr_rts                = isicom_dtr_rts,
1309         .activate               = isicom_activate,
1310         .shutdown               = isicom_shutdown,
1311 };
1312
1313 static int __devinit reset_card(struct pci_dev *pdev,
1314         const unsigned int card, unsigned int *signature)
1315 {
1316         struct isi_board *board = pci_get_drvdata(pdev);
1317         unsigned long base = board->base;
1318         unsigned int sig, portcount = 0;
1319         int retval = 0;
1320
1321         dev_dbg(&pdev->dev, "ISILoad:Resetting Card%d at 0x%lx\n", card + 1,
1322                 base);
1323
1324         inw(base + 0x8);
1325
1326         msleep(10);
1327
1328         outw(0, base + 0x8); /* Reset */
1329
1330         msleep(1000);
1331
1332         sig = inw(base + 0x4) & 0xff;
1333
1334         if (sig != 0xa5 && sig != 0xbb && sig != 0xcc && sig != 0xdd &&
1335                         sig != 0xee) {
1336                 dev_warn(&pdev->dev, "ISILoad:Card%u reset failure (Possible "
1337                         "bad I/O Port Address 0x%lx).\n", card + 1, base);
1338                 dev_dbg(&pdev->dev, "Sig=0x%x\n", sig);
1339                 retval = -EIO;
1340                 goto end;
1341         }
1342
1343         msleep(10);
1344
1345         portcount = inw(base + 0x2);
1346         if (!(inw(base + 0xe) & 0x1) || (portcount != 0 && portcount != 4 &&
1347                                 portcount != 8 && portcount != 16)) {
1348                 dev_err(&pdev->dev, "ISILoad:PCI Card%d reset failure.\n",
1349                         card + 1);
1350                 retval = -EIO;
1351                 goto end;
1352         }
1353
1354         switch (sig) {
1355         case 0xa5:
1356         case 0xbb:
1357         case 0xdd:
1358                 board->port_count = (portcount == 4) ? 4 : 8;
1359                 board->shift_count = 12;
1360                 break;
1361         case 0xcc:
1362         case 0xee:
1363                 board->port_count = 16;
1364                 board->shift_count = 11;
1365                 break;
1366         }
1367         dev_info(&pdev->dev, "-Done\n");
1368         *signature = sig;
1369
1370 end:
1371         return retval;
1372 }
1373
1374 static int __devinit load_firmware(struct pci_dev *pdev,
1375         const unsigned int index, const unsigned int signature)
1376 {
1377         struct isi_board *board = pci_get_drvdata(pdev);
1378         const struct firmware *fw;
1379         unsigned long base = board->base;
1380         unsigned int a;
1381         u16 word_count, status;
1382         int retval = -EIO;
1383         char *name;
1384         u8 *data;
1385
1386         struct stframe {
1387                 u16     addr;
1388                 u16     count;
1389                 u8      data[0];
1390         } *frame;
1391
1392         switch (signature) {
1393         case 0xa5:
1394                 name = "isi608.bin";
1395                 break;
1396         case 0xbb:
1397                 name = "isi608em.bin";
1398                 break;
1399         case 0xcc:
1400                 name = "isi616em.bin";
1401                 break;
1402         case 0xdd:
1403                 name = "isi4608.bin";
1404                 break;
1405         case 0xee:
1406                 name = "isi4616.bin";
1407                 break;
1408         default:
1409                 dev_err(&pdev->dev, "Unknown signature.\n");
1410                 goto end;
1411         }
1412
1413         retval = request_firmware(&fw, name, &pdev->dev);
1414         if (retval)
1415                 goto end;
1416
1417         retval = -EIO;
1418
1419         for (frame = (struct stframe *)fw->data;
1420                         frame < (struct stframe *)(fw->data + fw->size);
1421                         frame = (struct stframe *)((u8 *)(frame + 1) +
1422                                 frame->count)) {
1423                 if (WaitTillCardIsFree(base))
1424                         goto errrelfw;
1425
1426                 outw(0xf0, base);       /* start upload sequence */
1427                 outw(0x00, base);
1428                 outw(frame->addr, base); /* lsb of address */
1429
1430                 word_count = frame->count / 2 + frame->count % 2;
1431                 outw(word_count, base);
1432                 InterruptTheCard(base);
1433
1434                 udelay(100); /* 0x2f */
1435
1436                 if (WaitTillCardIsFree(base))
1437                         goto errrelfw;
1438
1439                 status = inw(base + 0x4);
1440                 if (status != 0) {
1441                         dev_warn(&pdev->dev, "Card%d rejected load header:\n"
1442                                  "Address:0x%x\n"
1443                                  "Count:0x%x\n"
1444                                  "Status:0x%x\n",
1445                                  index + 1, frame->addr, frame->count, status);
1446                         goto errrelfw;
1447                 }
1448                 outsw(base, frame->data, word_count);
1449
1450                 InterruptTheCard(base);
1451
1452                 udelay(50); /* 0x0f */
1453
1454                 if (WaitTillCardIsFree(base))
1455                         goto errrelfw;
1456
1457                 status = inw(base + 0x4);
1458                 if (status != 0) {
1459                         dev_err(&pdev->dev, "Card%d got out of sync.Card "
1460                                 "Status:0x%x\n", index + 1, status);
1461                         goto errrelfw;
1462                 }
1463         }
1464
1465 /* XXX: should we test it by reading it back and comparing with original like
1466  * in load firmware package? */
1467         for (frame = (struct stframe *)fw->data;
1468                         frame < (struct stframe *)(fw->data + fw->size);
1469                         frame = (struct stframe *)((u8 *)(frame + 1) +
1470                                 frame->count)) {
1471                 if (WaitTillCardIsFree(base))
1472                         goto errrelfw;
1473
1474                 outw(0xf1, base); /* start download sequence */
1475                 outw(0x00, base);
1476                 outw(frame->addr, base); /* lsb of address */
1477
1478                 word_count = (frame->count >> 1) + frame->count % 2;
1479                 outw(word_count + 1, base);
1480                 InterruptTheCard(base);
1481
1482                 udelay(50); /* 0xf */
1483
1484                 if (WaitTillCardIsFree(base))
1485                         goto errrelfw;
1486
1487                 status = inw(base + 0x4);
1488                 if (status != 0) {
1489                         dev_warn(&pdev->dev, "Card%d rejected verify header:\n"
1490                                  "Address:0x%x\n"
1491                                  "Count:0x%x\n"
1492                                  "Status: 0x%x\n",
1493                                  index + 1, frame->addr, frame->count, status);
1494                         goto errrelfw;
1495                 }
1496
1497                 data = kmalloc(word_count * 2, GFP_KERNEL);
1498                 if (data == NULL) {
1499                         dev_err(&pdev->dev, "Card%d, firmware upload "
1500                                 "failed, not enough memory\n", index + 1);
1501                         goto errrelfw;
1502                 }
1503                 inw(base);
1504                 insw(base, data, word_count);
1505                 InterruptTheCard(base);
1506
1507                 for (a = 0; a < frame->count; a++)
1508                         if (data[a] != frame->data[a]) {
1509                                 kfree(data);
1510                                 dev_err(&pdev->dev, "Card%d, firmware upload "
1511                                         "failed\n", index + 1);
1512                                 goto errrelfw;
1513                         }
1514                 kfree(data);
1515
1516                 udelay(50); /* 0xf */
1517
1518                 if (WaitTillCardIsFree(base))
1519                         goto errrelfw;
1520
1521                 status = inw(base + 0x4);
1522                 if (status != 0) {
1523                         dev_err(&pdev->dev, "Card%d verify got out of sync. "
1524                                 "Card Status:0x%x\n", index + 1, status);
1525                         goto errrelfw;
1526                 }
1527         }
1528
1529         /* xfer ctrl */
1530         if (WaitTillCardIsFree(base))
1531                 goto errrelfw;
1532
1533         outw(0xf2, base);
1534         outw(0x800, base);
1535         outw(0x0, base);
1536         outw(0x0, base);
1537         InterruptTheCard(base);
1538         outw(0x0, base + 0x4); /* for ISI4608 cards */
1539
1540         board->status |= FIRMWARE_LOADED;
1541         retval = 0;
1542
1543 errrelfw:
1544         release_firmware(fw);
1545 end:
1546         return retval;
1547 }
1548
1549 /*
1550  *      Insmod can set static symbols so keep these static
1551  */
1552 static unsigned int card_count;
1553
1554 static int __devinit isicom_probe(struct pci_dev *pdev,
1555         const struct pci_device_id *ent)
1556 {
1557         unsigned int uninitialized_var(signature), index;
1558         int retval = -EPERM;
1559         struct isi_board *board = NULL;
1560
1561         if (card_count >= BOARD_COUNT)
1562                 goto err;
1563
1564         retval = pci_enable_device(pdev);
1565         if (retval) {
1566                 dev_err(&pdev->dev, "failed to enable\n");
1567                 goto err;
1568         }
1569
1570         dev_info(&pdev->dev, "ISI PCI Card(Device ID 0x%x)\n", ent->device);
1571
1572         /* allot the first empty slot in the array */
1573         for (index = 0; index < BOARD_COUNT; index++) {
1574                 if (isi_card[index].base == 0) {
1575                         board = &isi_card[index];
1576                         break;
1577                 }
1578         }
1579         if (index == BOARD_COUNT) {
1580                 retval = -ENODEV;
1581                 goto err_disable;
1582         }
1583
1584         board->index = index;
1585         board->base = pci_resource_start(pdev, 3);
1586         board->irq = pdev->irq;
1587         card_count++;
1588
1589         pci_set_drvdata(pdev, board);
1590
1591         retval = pci_request_region(pdev, 3, ISICOM_NAME);
1592         if (retval) {
1593                 dev_err(&pdev->dev, "I/O Region 0x%lx-0x%lx is busy. Card%d "
1594                         "will be disabled.\n", board->base, board->base + 15,
1595                         index + 1);
1596                 retval = -EBUSY;
1597                 goto errdec;
1598         }
1599
1600         retval = request_irq(board->irq, isicom_interrupt,
1601                         IRQF_SHARED, ISICOM_NAME, board);
1602         if (retval < 0) {
1603                 dev_err(&pdev->dev, "Could not install handler at Irq %d. "
1604                         "Card%d will be disabled.\n", board->irq, index + 1);
1605                 goto errunrr;
1606         }
1607
1608         retval = reset_card(pdev, index, &signature);
1609         if (retval < 0)
1610                 goto errunri;
1611
1612         retval = load_firmware(pdev, index, signature);
1613         if (retval < 0)
1614                 goto errunri;
1615
1616         for (index = 0; index < board->port_count; index++)
1617                 tty_register_device(isicom_normal, board->index * 16 + index,
1618                                 &pdev->dev);
1619
1620         return 0;
1621
1622 errunri:
1623         free_irq(board->irq, board);
1624 errunrr:
1625         pci_release_region(pdev, 3);
1626 errdec:
1627         board->base = 0;
1628         card_count--;
1629 err_disable:
1630         pci_disable_device(pdev);
1631 err:
1632         return retval;
1633 }
1634
1635 static void __devexit isicom_remove(struct pci_dev *pdev)
1636 {
1637         struct isi_board *board = pci_get_drvdata(pdev);
1638         unsigned int i;
1639
1640         for (i = 0; i < board->port_count; i++)
1641                 tty_unregister_device(isicom_normal, board->index * 16 + i);
1642
1643         free_irq(board->irq, board);
1644         pci_release_region(pdev, 3);
1645         board->base = 0;
1646         card_count--;
1647         pci_disable_device(pdev);
1648 }
1649
1650 static int __init isicom_init(void)
1651 {
1652         int retval, idx, channel;
1653         struct isi_port *port;
1654
1655         for (idx = 0; idx < BOARD_COUNT; idx++) {
1656                 port = &isi_ports[idx * 16];
1657                 isi_card[idx].ports = port;
1658                 spin_lock_init(&isi_card[idx].card_lock);
1659                 for (channel = 0; channel < 16; channel++, port++) {
1660                         tty_port_init(&port->port);
1661                         port->port.ops = &isicom_port_ops;
1662                         port->magic = ISICOM_MAGIC;
1663                         port->card = &isi_card[idx];
1664                         port->channel = channel;
1665                         port->port.close_delay = 50 * HZ/100;
1666                         port->port.closing_wait = 3000 * HZ/100;
1667                         port->status = 0;
1668                         /*  . . .  */
1669                 }
1670                 isi_card[idx].base = 0;
1671                 isi_card[idx].irq = 0;
1672         }
1673
1674         /* tty driver structure initialization */
1675         isicom_normal = alloc_tty_driver(PORT_COUNT);
1676         if (!isicom_normal) {
1677                 retval = -ENOMEM;
1678                 goto error;
1679         }
1680
1681         isicom_normal->owner                    = THIS_MODULE;
1682         isicom_normal->name                     = "ttyM";
1683         isicom_normal->major                    = ISICOM_NMAJOR;
1684         isicom_normal->minor_start              = 0;
1685         isicom_normal->type                     = TTY_DRIVER_TYPE_SERIAL;
1686         isicom_normal->subtype                  = SERIAL_TYPE_NORMAL;
1687         isicom_normal->init_termios             = tty_std_termios;
1688         isicom_normal->init_termios.c_cflag     = B9600 | CS8 | CREAD | HUPCL |
1689                 CLOCAL;
1690         isicom_normal->flags                    = TTY_DRIVER_REAL_RAW |
1691                 TTY_DRIVER_DYNAMIC_DEV | TTY_DRIVER_HARDWARE_BREAK;
1692         tty_set_operations(isicom_normal, &isicom_ops);
1693
1694         retval = tty_register_driver(isicom_normal);
1695         if (retval) {
1696                 pr_debug("Couldn't register the dialin driver\n");
1697                 goto err_puttty;
1698         }
1699
1700         retval = pci_register_driver(&isicom_driver);
1701         if (retval < 0) {
1702                 pr_err("Unable to register pci driver.\n");
1703                 goto err_unrtty;
1704         }
1705
1706         mod_timer(&tx, jiffies + 1);
1707
1708         return 0;
1709 err_unrtty:
1710         tty_unregister_driver(isicom_normal);
1711 err_puttty:
1712         put_tty_driver(isicom_normal);
1713 error:
1714         return retval;
1715 }
1716
1717 static void __exit isicom_exit(void)
1718 {
1719         del_timer_sync(&tx);
1720
1721         pci_unregister_driver(&isicom_driver);
1722         tty_unregister_driver(isicom_normal);
1723         put_tty_driver(isicom_normal);
1724 }
1725
1726 module_init(isicom_init);
1727 module_exit(isicom_exit);
1728
1729 MODULE_AUTHOR("MultiTech");
1730 MODULE_DESCRIPTION("Driver for the ISI series of cards by MultiTech");
1731 MODULE_LICENSE("GPL");
1732 MODULE_FIRMWARE("isi608.bin");
1733 MODULE_FIRMWARE("isi608em.bin");
1734 MODULE_FIRMWARE("isi616em.bin");
1735 MODULE_FIRMWARE("isi4608.bin");
1736 MODULE_FIRMWARE("isi4616.bin");