e04e66cf2c68c53c6bc829d2923fbc8c5910a909
[sfrench/cifs-2.6.git] / drivers / char / ip2 / ip2main.c
1 /*
2 *
3 *   (c) 1999 by Computone Corporation
4 *
5 ********************************************************************************
6 *
7 *   PACKAGE:     Linux tty Device Driver for IntelliPort family of multiport
8 *                serial I/O controllers.
9 *
10 *   DESCRIPTION: Mainline code for the device driver
11 *
12 *******************************************************************************/
13 // ToDo:
14 //
15 // Fix the immediate DSS_NOW problem.
16 // Work over the channel stats return logic in ip2_ipl_ioctl so they
17 //      make sense for all 256 possible channels and so the user space
18 //      utilities will compile and work properly.
19 //
20 // Done:
21 //
22 // 1.2.14       /\/\|=mhw=|\/\/
23 // Added bounds checking to ip2_ipl_ioctl to avoid potential terroristic acts.
24 // Changed the definition of ip2trace to be more consistent with kernel style
25 //      Thanks to Andreas Dilger <adilger@turbolabs.com> for these updates
26 //
27 // 1.2.13       /\/\|=mhw=|\/\/
28 // DEVFS: Renamed ttf/{n} to tts/F{n} and cuf/{n} to cua/F{n} to conform
29 //      to agreed devfs serial device naming convention.
30 //
31 // 1.2.12       /\/\|=mhw=|\/\/
32 // Cleaned up some remove queue cut and paste errors
33 //
34 // 1.2.11       /\/\|=mhw=|\/\/
35 // Clean up potential NULL pointer dereferences
36 // Clean up devfs registration
37 // Add kernel command line parsing for io and irq
38 //      Compile defaults for io and irq are now set in ip2.c not ip2.h!
39 // Reworked poll_only hack for explicit parameter setting
40 //      You must now EXPLICITLY set poll_only = 1 or set all irqs to 0
41 // Merged ip2_loadmain and old_ip2_init
42 // Converted all instances of interruptible_sleep_on into queue calls
43 //      Most of these had no race conditions but better to clean up now
44 //
45 // 1.2.10       /\/\|=mhw=|\/\/
46 // Fixed the bottom half interrupt handler and enabled USE_IQI
47 //      to split the interrupt handler into a formal top-half / bottom-half
48 // Fixed timing window on high speed processors that queued messages to
49 //      the outbound mail fifo faster than the board could handle.
50 //
51 // 1.2.9
52 // Four box EX was barfing on >128k kmalloc, made structure smaller by
53 // reducing output buffer size
54 //
55 // 1.2.8
56 // Device file system support (MHW)
57 //
58 // 1.2.7 
59 // Fixed
60 // Reload of ip2 without unloading ip2main hangs system on cat of /proc/modules
61 //
62 // 1.2.6
63 //Fixes DCD problems
64 //      DCD was not reported when CLOCAL was set on call to TIOCMGET
65 //
66 //Enhancements:
67 //      TIOCMGET requests and waits for status return
68 //      No DSS interrupts enabled except for DCD when needed
69 //
70 // For internal use only
71 //
72 //#define IP2DEBUG_INIT
73 //#define IP2DEBUG_OPEN
74 //#define IP2DEBUG_WRITE
75 //#define IP2DEBUG_READ
76 //#define IP2DEBUG_IOCTL
77 //#define IP2DEBUG_IPL
78
79 //#define IP2DEBUG_TRACE
80 //#define DEBUG_FIFO
81
82 /************/
83 /* Includes */
84 /************/
85
86 #include <linux/ctype.h>
87 #include <linux/string.h>
88 #include <linux/fcntl.h>
89 #include <linux/errno.h>
90 #include <linux/module.h>
91 #include <linux/signal.h>
92 #include <linux/sched.h>
93 #include <linux/timer.h>
94 #include <linux/interrupt.h>
95 #include <linux/pci.h>
96 #include <linux/mm.h>
97 #include <linux/slab.h>
98 #include <linux/major.h>
99 #include <linux/wait.h>
100 #include <linux/device.h>
101
102 #include <linux/tty.h>
103 #include <linux/tty_flip.h>
104 #include <linux/termios.h>
105 #include <linux/tty_driver.h>
106 #include <linux/serial.h>
107 #include <linux/ptrace.h>
108 #include <linux/ioport.h>
109
110 #include <linux/cdk.h>
111 #include <linux/comstats.h>
112 #include <linux/delay.h>
113 #include <linux/bitops.h>
114
115 #include <asm/system.h>
116 #include <asm/io.h>
117 #include <asm/irq.h>
118
119 #include <linux/vmalloc.h>
120 #include <linux/init.h>
121
122 #include <asm/uaccess.h>
123
124 #include "ip2types.h"
125 #include "ip2trace.h"
126 #include "ip2ioctl.h"
127 #include "ip2.h"
128 #include "i2ellis.h"
129 #include "i2lib.h"
130
131 /*****************
132  * /proc/ip2mem  *
133  *****************/
134
135 #include <linux/proc_fs.h>
136
137 static int ip2_read_procmem(char *, char **, off_t, int);
138 static int ip2_read_proc(char *, char **, off_t, int, int *, void * );
139
140 /********************/
141 /* Type Definitions */
142 /********************/
143
144 /*************/
145 /* Constants */
146 /*************/
147
148 /* String constants to identify ourselves */
149 static char *pcName    = "Computone IntelliPort Plus multiport driver";
150 static char *pcVersion = "1.2.14";
151
152 /* String constants for port names */
153 static char *pcDriver_name   = "ip2";
154 static char *pcIpl               = "ip2ipl";
155
156 /* Serial subtype definitions */
157 #define SERIAL_TYPE_NORMAL    1
158
159 // cheezy kludge or genius - you decide?
160 int ip2_loadmain(int *, int *, unsigned char *, int);
161 static unsigned char *Fip_firmware;
162 static int Fip_firmware_size;
163
164 /***********************/
165 /* Function Prototypes */
166 /***********************/
167
168 /* Global module entry functions */
169
170 /* Private (static) functions */
171 static int  ip2_open(PTTY, struct file *);
172 static void ip2_close(PTTY, struct file *);
173 static int  ip2_write(PTTY, const unsigned char *, int);
174 static void ip2_putchar(PTTY, unsigned char);
175 static void ip2_flush_chars(PTTY);
176 static int  ip2_write_room(PTTY);
177 static int  ip2_chars_in_buf(PTTY);
178 static void ip2_flush_buffer(PTTY);
179 static int  ip2_ioctl(PTTY, struct file *, UINT, ULONG);
180 static void ip2_set_termios(PTTY, struct ktermios *);
181 static void ip2_set_line_discipline(PTTY);
182 static void ip2_throttle(PTTY);
183 static void ip2_unthrottle(PTTY);
184 static void ip2_stop(PTTY);
185 static void ip2_start(PTTY);
186 static void ip2_hangup(PTTY);
187 static int  ip2_tiocmget(struct tty_struct *tty, struct file *file);
188 static int  ip2_tiocmset(struct tty_struct *tty, struct file *file,
189                          unsigned int set, unsigned int clear);
190
191 static void set_irq(int, int);
192 static void ip2_interrupt_bh(struct work_struct *work);
193 static irqreturn_t ip2_interrupt(int irq, void *dev_id);
194 static void ip2_poll(unsigned long arg);
195 static inline void service_all_boards(void);
196 static void do_input(struct work_struct *);
197 static void do_status(struct work_struct *);
198
199 static void ip2_wait_until_sent(PTTY,int);
200
201 static void set_params (i2ChanStrPtr, struct ktermios *);
202 static int get_serial_info(i2ChanStrPtr, struct serial_struct __user *);
203 static int set_serial_info(i2ChanStrPtr, struct serial_struct __user *);
204
205 static ssize_t ip2_ipl_read(struct file *, char __user *, size_t, loff_t *);
206 static ssize_t ip2_ipl_write(struct file *, const char __user *, size_t, loff_t *);
207 static int ip2_ipl_ioctl(struct inode *, struct file *, UINT, ULONG);
208 static int ip2_ipl_open(struct inode *, struct file *);
209
210 static int DumpTraceBuffer(char __user *, int);
211 static int DumpFifoBuffer( char __user *, int);
212
213 static void ip2_init_board(int);
214 static unsigned short find_eisa_board(int);
215
216 /***************/
217 /* Static Data */
218 /***************/
219
220 static struct tty_driver *ip2_tty_driver;
221
222 /* Here, then is a table of board pointers which the interrupt routine should
223  * scan through to determine who it must service.
224  */
225 static unsigned short i2nBoards; // Number of boards here
226
227 static i2eBordStrPtr i2BoardPtrTable[IP2_MAX_BOARDS];
228
229 static i2ChanStrPtr  DevTable[IP2_MAX_PORTS];
230 //DevTableMem just used to save addresses for kfree
231 static void  *DevTableMem[IP2_MAX_BOARDS];
232
233 /* This is the driver descriptor for the ip2ipl device, which is used to
234  * download the loadware to the boards.
235  */
236 static const struct file_operations ip2_ipl = {
237         .owner          = THIS_MODULE,
238         .read           = ip2_ipl_read,
239         .write          = ip2_ipl_write,
240         .ioctl          = ip2_ipl_ioctl,
241         .open           = ip2_ipl_open,
242 }; 
243
244 static unsigned long irq_counter = 0;
245 static unsigned long bh_counter = 0;
246
247 // Use immediate queue to service interrupts
248 #define USE_IQI
249 //#define USE_IQ        // PCI&2.2 needs work
250
251 /* The timer_list entry for our poll routine. If interrupt operation is not
252  * selected, the board is serviced periodically to see if anything needs doing.
253  */
254 #define  POLL_TIMEOUT   (jiffies + 1)
255 static DEFINE_TIMER(PollTimer, ip2_poll, 0, 0);
256 static char  TimerOn;
257
258 #ifdef IP2DEBUG_TRACE
259 /* Trace (debug) buffer data */
260 #define TRACEMAX  1000
261 static unsigned long tracebuf[TRACEMAX];
262 static int tracestuff;
263 static int tracestrip;
264 static int tracewrap;
265 #endif
266
267 /**********/
268 /* Macros */
269 /**********/
270
271 #if defined(MODULE) && defined(IP2DEBUG_OPEN)
272 #define DBG_CNT(s) printk(KERN_DEBUG "(%s): [%x] refc=%d, ttyc=%d, modc=%x -> %s\n", \
273                     tty->name,(pCh->flags),ip2_tty_driver->refcount, \
274                     tty->count,/*GET_USE_COUNT(module)*/0,s)
275 #else
276 #define DBG_CNT(s)
277 #endif
278
279 /********/
280 /* Code */
281 /********/
282
283 #include "i2ellis.c"    /* Extremely low-level interface services */
284 #include "i2cmd.c"      /* Standard loadware command definitions */
285 #include "i2lib.c"      /* High level interface services */
286
287 /* Configuration area for modprobe */
288
289 MODULE_AUTHOR("Doug McNash");
290 MODULE_DESCRIPTION("Computone IntelliPort Plus Driver");
291
292 static int poll_only = 0;
293
294 static int Eisa_irq;
295 static int Eisa_slot;
296
297 static int iindx;
298 static char rirqs[IP2_MAX_BOARDS];
299 static int Valid_Irqs[] = { 3, 4, 5, 7, 10, 11, 12, 15, 0};
300
301 /* for sysfs class support */
302 static struct class *ip2_class;
303
304 // Some functions to keep track of what irq's we have
305
306 static int
307 is_valid_irq(int irq)
308 {
309         int *i = Valid_Irqs;
310         
311         while ((*i != 0) && (*i != irq)) {
312                 i++;
313         }
314         return (*i);
315 }
316
317 static void
318 mark_requested_irq( char irq )
319 {
320         rirqs[iindx++] = irq;
321 }
322
323 #ifdef MODULE
324 static int
325 clear_requested_irq( char irq )
326 {
327         int i;
328         for ( i = 0; i < IP2_MAX_BOARDS; ++i ) {
329                 if (rirqs[i] == irq) {
330                         rirqs[i] = 0;
331                         return 1;
332                 }
333         }
334         return 0;
335 }
336 #endif
337
338 static int
339 have_requested_irq( char irq )
340 {
341         // array init to zeros so 0 irq will not be requested as a side effect
342         int i;
343         for ( i = 0; i < IP2_MAX_BOARDS; ++i ) {
344                 if (rirqs[i] == irq)
345                         return 1;
346         }
347         return 0;
348 }
349
350 /******************************************************************************/
351 /* Function:   init_module()                                                  */
352 /* Parameters: None                                                           */
353 /* Returns:    Success (0)                                                    */
354 /*                                                                            */
355 /* Description:                                                               */
356 /* This is a required entry point for an installable module. It simply calls  */
357 /* the driver initialisation function and returns what it returns.            */
358 /******************************************************************************/
359 #ifdef MODULE
360 int
361 init_module(void)
362 {
363 #ifdef IP2DEBUG_INIT
364         printk (KERN_DEBUG "Loading module ...\n" );
365 #endif
366     return 0;
367 }
368 #endif /* MODULE */
369
370 /******************************************************************************/
371 /* Function:   cleanup_module()                                               */
372 /* Parameters: None                                                           */
373 /* Returns:    Nothing                                                        */
374 /*                                                                            */
375 /* Description:                                                               */
376 /* This is a required entry point for an installable module. It has to return */
377 /* the device and the driver to a passive state. It should not be necessary   */
378 /* to reset the board fully, especially as the loadware is downloaded         */
379 /* externally rather than in the driver. We just want to disable the board    */
380 /* and clear the loadware to a reset state. To allow this there has to be a   */
381 /* way to detect whether the board has the loadware running at init time to   */
382 /* handle subsequent installations of the driver. All memory allocated by the */
383 /* driver should be returned since it may be unloaded from memory.            */
384 /******************************************************************************/
385 #ifdef MODULE
386 void
387 cleanup_module(void)
388 {
389         int err;
390         int i;
391
392 #ifdef IP2DEBUG_INIT
393         printk (KERN_DEBUG "Unloading %s: version %s\n", pcName, pcVersion );
394 #endif
395         /* Stop poll timer if we had one. */
396         if ( TimerOn ) {
397                 del_timer ( &PollTimer );
398                 TimerOn = 0;
399         }
400
401         /* Reset the boards we have. */
402         for( i = 0; i < IP2_MAX_BOARDS; ++i ) {
403                 if ( i2BoardPtrTable[i] ) {
404                         iiReset( i2BoardPtrTable[i] );
405                 }
406         }
407
408         /* The following is done at most once, if any boards were installed. */
409         for ( i = 0; i < IP2_MAX_BOARDS; ++i ) {
410                 if ( i2BoardPtrTable[i] ) {
411                         iiResetDelay( i2BoardPtrTable[i] );
412                         /* free io addresses and Tibet */
413                         release_region( ip2config.addr[i], 8 );
414                         device_destroy(ip2_class, MKDEV(IP2_IPL_MAJOR, 4 * i));
415                         device_destroy(ip2_class, MKDEV(IP2_IPL_MAJOR, 4 * i + 1));
416                 }
417                 /* Disable and remove interrupt handler. */
418                 if ( (ip2config.irq[i] > 0) && have_requested_irq(ip2config.irq[i]) ) { 
419                         free_irq ( ip2config.irq[i], (void *)&pcName);
420                         clear_requested_irq( ip2config.irq[i]);
421                 }
422         }
423         class_destroy(ip2_class);
424         if ( ( err = tty_unregister_driver ( ip2_tty_driver ) ) ) {
425                 printk(KERN_ERR "IP2: failed to unregister tty driver (%d)\n", err);
426         }
427         put_tty_driver(ip2_tty_driver);
428         unregister_chrdev(IP2_IPL_MAJOR, pcIpl);
429         remove_proc_entry("ip2mem", &proc_root);
430
431         // free memory
432         for (i = 0; i < IP2_MAX_BOARDS; i++) {
433                 void *pB;
434 #ifdef CONFIG_PCI
435                 if (ip2config.type[i] == PCI && ip2config.pci_dev[i]) {
436                         pci_disable_device(ip2config.pci_dev[i]);
437                         pci_dev_put(ip2config.pci_dev[i]);
438                         ip2config.pci_dev[i] = NULL;
439                 }
440 #endif
441                 if ((pB = i2BoardPtrTable[i]) != 0 ) {
442                         kfree ( pB );
443                         i2BoardPtrTable[i] = NULL;
444                 }
445                 if ((DevTableMem[i]) != NULL ) {
446                         kfree ( DevTableMem[i]  );
447                         DevTableMem[i] = NULL;
448                 }
449         }
450
451         /* Cleanup the iiEllis subsystem. */
452         iiEllisCleanup();
453 #ifdef IP2DEBUG_INIT
454         printk (KERN_DEBUG "IP2 Unloaded\n" );
455 #endif
456 }
457 #endif /* MODULE */
458
459 static const struct tty_operations ip2_ops = {
460         .open            = ip2_open,
461         .close           = ip2_close,
462         .write           = ip2_write,
463         .put_char        = ip2_putchar,
464         .flush_chars     = ip2_flush_chars,
465         .write_room      = ip2_write_room,
466         .chars_in_buffer = ip2_chars_in_buf,
467         .flush_buffer    = ip2_flush_buffer,
468         .ioctl           = ip2_ioctl,
469         .throttle        = ip2_throttle,
470         .unthrottle      = ip2_unthrottle,
471         .set_termios     = ip2_set_termios,
472         .set_ldisc       = ip2_set_line_discipline,
473         .stop            = ip2_stop,
474         .start           = ip2_start,
475         .hangup          = ip2_hangup,
476         .read_proc       = ip2_read_proc,
477         .tiocmget        = ip2_tiocmget,
478         .tiocmset        = ip2_tiocmset,
479 };
480
481 /******************************************************************************/
482 /* Function:   ip2_loadmain()                                                 */
483 /* Parameters: irq, io from command line of insmod et. al.                    */
484 /*              pointer to fip firmware and firmware size for boards          */
485 /* Returns:    Success (0)                                                    */
486 /*                                                                            */
487 /* Description:                                                               */
488 /* This was the required entry point for all drivers (now in ip2.c)           */
489 /* It performs all                                                            */
490 /* initialisation of the devices and driver structures, and registers itself  */
491 /* with the relevant kernel modules.                                          */
492 /******************************************************************************/
493 /* IRQF_DISABLED - if set blocks all interrupts else only this line */
494 /* IRQF_SHARED    - for shared irq PCI or maybe EISA only */
495 /* SA_RANDOM   - can be source for cert. random number generators */
496 #define IP2_SA_FLAGS    0
497
498 int
499 ip2_loadmain(int *iop, int *irqp, unsigned char *firmware, int firmsize) 
500 {
501         int i, j, box;
502         int err = 0;
503         static int loaded;
504         i2eBordStrPtr pB = NULL;
505         int rc = -1;
506         static struct pci_dev *pci_dev_i = NULL;
507
508         ip2trace (ITRC_NO_PORT, ITRC_INIT, ITRC_ENTER, 0 );
509
510         /* process command line arguments to modprobe or
511                 insmod i.e. iop & irqp */
512         /* irqp and iop should ALWAYS be specified now...  But we check
513                 them individually just to be sure, anyways... */
514         for ( i = 0; i < IP2_MAX_BOARDS; ++i ) {
515                 if (iop) {
516                         ip2config.addr[i] = iop[i];
517                         if (irqp) {
518                                 if( irqp[i] >= 0 ) {
519                                         ip2config.irq[i] = irqp[i];
520                                 } else {
521                                         ip2config.irq[i] = 0;
522                                 }
523         // This is a little bit of a hack.  If poll_only=1 on command
524         // line back in ip2.c OR all IRQs on all specified boards are
525         // explicitly set to 0, then drop to poll only mode and override
526         // PCI or EISA interrupts.  This superceeds the old hack of
527         // triggering if all interrupts were zero (like da default).
528         // Still a hack but less prone to random acts of terrorism.
529         //
530         // What we really should do, now that the IRQ default is set
531         // to -1, is to use 0 as a hard coded, do not probe.
532         //
533         //      /\/\|=mhw=|\/\/
534                                 poll_only |= irqp[i];
535                         }
536                 }
537         }
538         poll_only = !poll_only;
539
540         Fip_firmware = firmware;
541         Fip_firmware_size = firmsize;
542
543         /* Announce our presence */
544         printk( KERN_INFO "%s version %s\n", pcName, pcVersion );
545
546         // ip2 can be unloaded and reloaded for no good reason
547         // we can't let that happen here or bad things happen
548         // second load hoses board but not system - fixme later
549         if (loaded) {
550                 printk( KERN_INFO "Still loaded\n" );
551                 return 0;
552         }
553         loaded++;
554
555         ip2_tty_driver = alloc_tty_driver(IP2_MAX_PORTS);
556         if (!ip2_tty_driver)
557                 return -ENOMEM;
558
559         /* Initialise the iiEllis subsystem. */
560         iiEllisInit();
561
562         /* Initialize arrays. */
563         memset( i2BoardPtrTable, 0, sizeof i2BoardPtrTable );
564         memset( DevTable, 0, sizeof DevTable );
565
566         /* Initialise all the boards we can find (up to the maximum). */
567         for ( i = 0; i < IP2_MAX_BOARDS; ++i ) {
568                 switch ( ip2config.addr[i] ) { 
569                 case 0: /* skip this slot even if card is present */
570                         break;
571                 default: /* ISA */
572                    /* ISA address must be specified */
573                         if ( (ip2config.addr[i] < 0x100) || (ip2config.addr[i] > 0x3f8) ) {
574                                 printk ( KERN_ERR "IP2: Bad ISA board %d address %x\n",
575                                                          i, ip2config.addr[i] );
576                                 ip2config.addr[i] = 0;
577                         } else {
578                                 ip2config.type[i] = ISA;
579
580                                 /* Check for valid irq argument, set for polling if invalid */
581                                 if (ip2config.irq[i] && !is_valid_irq(ip2config.irq[i])) {
582                                         printk(KERN_ERR "IP2: Bad IRQ(%d) specified\n",ip2config.irq[i]);
583                                         ip2config.irq[i] = 0;// 0 is polling and is valid in that sense
584                                 }
585                         }
586                         break;
587                 case PCI:
588 #ifdef CONFIG_PCI
589                         {
590                                 int status;
591
592                                 pci_dev_i = pci_get_device(PCI_VENDOR_ID_COMPUTONE,
593                                                           PCI_DEVICE_ID_COMPUTONE_IP2EX, pci_dev_i);
594                                 if (pci_dev_i != NULL) {
595                                         unsigned int addr;
596
597                                         if (pci_enable_device(pci_dev_i)) {
598                                                 printk( KERN_ERR "IP2: can't enable PCI device at %s\n",
599                                                         pci_name(pci_dev_i));
600                                                 break;
601                                         }
602                                         ip2config.type[i] = PCI;
603                                         ip2config.pci_dev[i] = pci_dev_get(pci_dev_i);
604                                         status =
605                                         pci_read_config_dword(pci_dev_i, PCI_BASE_ADDRESS_1, &addr);
606                                         if ( addr & 1 ) {
607                                                 ip2config.addr[i]=(USHORT)(addr&0xfffe);
608                                         } else {
609                                                 printk( KERN_ERR "IP2: PCI I/O address error\n");
610                                         }
611
612 //              If the PCI BIOS assigned it, lets try and use it.  If we
613 //              can't acquire it or it screws up, deal with it then.
614
615 //                                      if (!is_valid_irq(pci_irq)) {
616 //                                              printk( KERN_ERR "IP2: Bad PCI BIOS IRQ(%d)\n",pci_irq);
617 //                                              pci_irq = 0;
618 //                                      }
619                                         ip2config.irq[i] = pci_dev_i->irq;
620                                 } else {        // ann error
621                                         ip2config.addr[i] = 0;
622                                         printk(KERN_ERR "IP2: PCI board %d not found\n", i);
623                                 } 
624                         }
625 #else
626                         printk( KERN_ERR "IP2: PCI card specified but PCI support not\n");
627                         printk( KERN_ERR "IP2: configured in this kernel.\n");
628                         printk( KERN_ERR "IP2: Recompile kernel with CONFIG_PCI defined!\n");
629 #endif /* CONFIG_PCI */
630                         break;
631                 case EISA:
632                         if ( (ip2config.addr[i] = find_eisa_board( Eisa_slot + 1 )) != 0) {
633                                 /* Eisa_irq set as side effect, boo */
634                                 ip2config.type[i] = EISA;
635                         } 
636                         ip2config.irq[i] = Eisa_irq;
637                         break;
638                 }       /* switch */
639         }       /* for */
640         if (pci_dev_i)
641                 pci_dev_put(pci_dev_i);
642
643         for ( i = 0; i < IP2_MAX_BOARDS; ++i ) {
644                 if ( ip2config.addr[i] ) {
645                         pB = kzalloc(sizeof(i2eBordStr), GFP_KERNEL);
646                         if (pB) {
647                                 i2BoardPtrTable[i] = pB;
648                                 iiSetAddress( pB, ip2config.addr[i], ii2DelayTimer );
649                                 iiReset( pB );
650                         } else {
651                                 printk(KERN_ERR "IP2: board memory allocation error\n");
652                         }
653                 }
654         }
655         for ( i = 0; i < IP2_MAX_BOARDS; ++i ) {
656                 if ( ( pB = i2BoardPtrTable[i] ) != NULL ) {
657                         iiResetDelay( pB );
658                         break;
659                 }
660         }
661         for ( i = 0; i < IP2_MAX_BOARDS; ++i ) {
662                 if ( i2BoardPtrTable[i] != NULL ) {
663                         ip2_init_board( i );
664                 }
665         }
666
667         ip2trace (ITRC_NO_PORT, ITRC_INIT, 2, 0 );
668
669         ip2_tty_driver->owner               = THIS_MODULE;
670         ip2_tty_driver->name                 = "ttyF";
671         ip2_tty_driver->driver_name          = pcDriver_name;
672         ip2_tty_driver->major                = IP2_TTY_MAJOR;
673         ip2_tty_driver->minor_start          = 0;
674         ip2_tty_driver->type                 = TTY_DRIVER_TYPE_SERIAL;
675         ip2_tty_driver->subtype              = SERIAL_TYPE_NORMAL;
676         ip2_tty_driver->init_termios         = tty_std_termios;
677         ip2_tty_driver->init_termios.c_cflag = B9600|CS8|CREAD|HUPCL|CLOCAL;
678         ip2_tty_driver->flags                = TTY_DRIVER_REAL_RAW | TTY_DRIVER_DYNAMIC_DEV;
679         tty_set_operations(ip2_tty_driver, &ip2_ops);
680
681         ip2trace (ITRC_NO_PORT, ITRC_INIT, 3, 0 );
682
683         /* Register the tty devices. */
684         if ( ( err = tty_register_driver ( ip2_tty_driver ) ) ) {
685                 printk(KERN_ERR "IP2: failed to register tty driver (%d)\n", err);
686                 put_tty_driver(ip2_tty_driver);
687                 return -EINVAL;
688         } else
689         /* Register the IPL driver. */
690         if ( ( err = register_chrdev ( IP2_IPL_MAJOR, pcIpl, &ip2_ipl ) ) ) {
691                 printk(KERN_ERR "IP2: failed to register IPL device (%d)\n", err );
692         } else {
693                 /* create the sysfs class */
694                 ip2_class = class_create(THIS_MODULE, "ip2");
695                 if (IS_ERR(ip2_class)) {
696                         err = PTR_ERR(ip2_class);
697                         goto out_chrdev;        
698                 }
699         }
700         /* Register the read_procmem thing */
701         if (!create_proc_info_entry("ip2mem",0,&proc_root,ip2_read_procmem)) {
702                 printk(KERN_ERR "IP2: failed to register read_procmem\n");
703         } else {
704
705         ip2trace (ITRC_NO_PORT, ITRC_INIT, 4, 0 );
706                 /* Register the interrupt handler or poll handler, depending upon the
707                  * specified interrupt.
708                  */
709
710                 for( i = 0; i < IP2_MAX_BOARDS; ++i ) {
711                         if ( 0 == ip2config.addr[i] ) {
712                                 continue;
713                         }
714
715                         if ( NULL != ( pB = i2BoardPtrTable[i] ) ) {
716                                 device_create(ip2_class, NULL,
717                                                 MKDEV(IP2_IPL_MAJOR, 4 * i),
718                                                 "ipl%d", i);
719                                 device_create(ip2_class, NULL,
720                                                 MKDEV(IP2_IPL_MAJOR, 4 * i + 1),
721                                                 "stat%d", i);
722
723                             for ( box = 0; box < ABS_MAX_BOXES; ++box )
724                             {
725                                 for ( j = 0; j < ABS_BIGGEST_BOX; ++j )
726                                 {
727                                     if ( pB->i2eChannelMap[box] & (1 << j) )
728                                     {
729                                         tty_register_device(ip2_tty_driver,
730                                             j + ABS_BIGGEST_BOX *
731                                                     (box+i*ABS_MAX_BOXES), NULL);
732                                     }
733                                 }
734                             }
735                         }
736
737                         if (poll_only) {
738 //              Poll only forces driver to only use polling and
739 //              to ignore the probed PCI or EISA interrupts.
740                                 ip2config.irq[i] = CIR_POLL;
741                         }
742                         if ( ip2config.irq[i] == CIR_POLL ) {
743 retry:
744                                 if (!TimerOn) {
745                                         PollTimer.expires = POLL_TIMEOUT;
746                                         add_timer ( &PollTimer );
747                                         TimerOn = 1;
748                                         printk( KERN_INFO "IP2: polling\n");
749                                 }
750                         } else {
751                                 if (have_requested_irq(ip2config.irq[i]))
752                                         continue;
753                                 rc = request_irq( ip2config.irq[i], ip2_interrupt,
754                                         IP2_SA_FLAGS | (ip2config.type[i] == PCI ? IRQF_SHARED : 0),
755                                         pcName, i2BoardPtrTable[i]);
756                                 if (rc) {
757                                         printk(KERN_ERR "IP2: an request_irq failed: error %d\n",rc);
758                                         ip2config.irq[i] = CIR_POLL;
759                                         printk( KERN_INFO "IP2: Polling %ld/sec.\n",
760                                                         (POLL_TIMEOUT - jiffies));
761                                         goto retry;
762                                 } 
763                                 mark_requested_irq(ip2config.irq[i]);
764                                 /* Initialise the interrupt handler bottom half (aka slih). */
765                         }
766                 }
767                 for( i = 0; i < IP2_MAX_BOARDS; ++i ) {
768                         if ( i2BoardPtrTable[i] ) {
769                                 set_irq( i, ip2config.irq[i] ); /* set and enable board interrupt */
770                         }
771                 }
772         }
773         ip2trace (ITRC_NO_PORT, ITRC_INIT, ITRC_RETURN, 0 );
774         goto out;
775
776 out_chrdev:
777         unregister_chrdev(IP2_IPL_MAJOR, "ip2");
778 out:
779         return err;
780 }
781
782 EXPORT_SYMBOL(ip2_loadmain);
783
784 /******************************************************************************/
785 /* Function:   ip2_init_board()                                               */
786 /* Parameters: Index of board in configuration structure                      */
787 /* Returns:    Success (0)                                                    */
788 /*                                                                            */
789 /* Description:                                                               */
790 /* This function initializes the specified board. The loadware is copied to   */
791 /* the board, the channel structures are initialized, and the board details   */
792 /* are reported on the console.                                               */
793 /******************************************************************************/
794 static void
795 ip2_init_board( int boardnum )
796 {
797         int i;
798         int nports = 0, nboxes = 0;
799         i2ChanStrPtr pCh;
800         i2eBordStrPtr pB = i2BoardPtrTable[boardnum];
801
802         if ( !iiInitialize ( pB ) ) {
803                 printk ( KERN_ERR "IP2: Failed to initialize board at 0x%x, error %d\n",
804                          pB->i2eBase, pB->i2eError );
805                 goto err_initialize;
806         }
807         printk(KERN_INFO "IP2: Board %d: addr=0x%x irq=%d\n", boardnum + 1,
808                ip2config.addr[boardnum], ip2config.irq[boardnum] );
809
810         if (!request_region( ip2config.addr[boardnum], 8, pcName )) {
811                 printk(KERN_ERR "IP2: bad addr=0x%x\n", ip2config.addr[boardnum]);
812                 goto err_initialize;
813         }
814
815         if ( iiDownloadAll ( pB, (loadHdrStrPtr)Fip_firmware, 1, Fip_firmware_size )
816             != II_DOWN_GOOD ) {
817                 printk ( KERN_ERR "IP2: failed to download loadware\n" );
818                 goto err_release_region;
819         } else {
820                 printk ( KERN_INFO "IP2: fv=%d.%d.%d lv=%d.%d.%d\n",
821                          pB->i2ePom.e.porVersion,
822                          pB->i2ePom.e.porRevision,
823                          pB->i2ePom.e.porSubRev, pB->i2eLVersion,
824                          pB->i2eLRevision, pB->i2eLSub );
825         }
826
827         switch ( pB->i2ePom.e.porID & ~POR_ID_RESERVED ) {
828
829         default:
830                 printk( KERN_ERR "IP2: Unknown board type, ID = %x\n",
831                                 pB->i2ePom.e.porID );
832                 nports = 0;
833                 goto err_release_region;
834                 break;
835
836         case POR_ID_II_4: /* IntelliPort-II, ISA-4 (4xRJ45) */
837                 printk ( KERN_INFO "IP2: ISA-4\n" );
838                 nports = 4;
839                 break;
840
841         case POR_ID_II_8: /* IntelliPort-II, 8-port using standard brick. */
842                 printk ( KERN_INFO "IP2: ISA-8 std\n" );
843                 nports = 8;
844                 break;
845
846         case POR_ID_II_8R: /* IntelliPort-II, 8-port using RJ11's (no CTS) */
847                 printk ( KERN_INFO "IP2: ISA-8 RJ11\n" );
848                 nports = 8;
849                 break;
850
851         case POR_ID_FIIEX: /* IntelliPort IIEX */
852         {
853                 int portnum = IP2_PORTS_PER_BOARD * boardnum;
854                 int            box;
855
856                 for( box = 0; box < ABS_MAX_BOXES; ++box ) {
857                         if ( pB->i2eChannelMap[box] != 0 ) {
858                                 ++nboxes;
859                         }
860                         for( i = 0; i < ABS_BIGGEST_BOX; ++i ) {
861                                 if ( pB->i2eChannelMap[box] & 1<< i ) {
862                                         ++nports;
863                                 }
864                         }
865                 }
866                 DevTableMem[boardnum] = pCh =
867                         kmalloc( sizeof(i2ChanStr) * nports, GFP_KERNEL );
868                 if ( !pCh ) {
869                         printk ( KERN_ERR "IP2: (i2_init_channel:) Out of memory.\n");
870                         goto err_release_region;
871                 }
872                 if ( !i2InitChannels( pB, nports, pCh ) ) {
873                         printk(KERN_ERR "IP2: i2InitChannels failed: %d\n",pB->i2eError);
874                         kfree ( pCh );
875                         goto err_release_region;
876                 }
877                 pB->i2eChannelPtr = &DevTable[portnum];
878                 pB->i2eChannelCnt = ABS_MOST_PORTS;
879
880                 for( box = 0; box < ABS_MAX_BOXES; ++box, portnum += ABS_BIGGEST_BOX ) {
881                         for( i = 0; i < ABS_BIGGEST_BOX; ++i ) {
882                                 if ( pB->i2eChannelMap[box] & (1 << i) ) {
883                                         DevTable[portnum + i] = pCh;
884                                         pCh->port_index = portnum + i;
885                                         pCh++;
886                                 }
887                         }
888                 }
889                 printk(KERN_INFO "IP2: EX box=%d ports=%d %d bit\n",
890                         nboxes, nports, pB->i2eDataWidth16 ? 16 : 8 );
891                 }
892                 goto ex_exit;
893         }
894         DevTableMem[boardnum] = pCh =
895                 kmalloc ( sizeof (i2ChanStr) * nports, GFP_KERNEL );
896         if ( !pCh ) {
897                 printk ( KERN_ERR "IP2: (i2_init_channel:) Out of memory.\n");
898                 goto err_release_region;
899         }
900         pB->i2eChannelPtr = pCh;
901         pB->i2eChannelCnt = nports;
902         if ( !i2InitChannels( pB, nports, pCh ) ) {
903                 printk(KERN_ERR "IP2: i2InitChannels failed: %d\n",pB->i2eError);
904                 kfree ( pCh );
905                 goto err_release_region;
906         }
907         pB->i2eChannelPtr = &DevTable[IP2_PORTS_PER_BOARD * boardnum];
908
909         for( i = 0; i < pB->i2eChannelCnt; ++i ) {
910                 DevTable[IP2_PORTS_PER_BOARD * boardnum + i] = pCh;
911                 pCh->port_index = (IP2_PORTS_PER_BOARD * boardnum) + i;
912                 pCh++;
913         }
914 ex_exit:
915         INIT_WORK(&pB->tqueue_interrupt, ip2_interrupt_bh);
916         return;
917
918 err_release_region:
919         release_region(ip2config.addr[boardnum], 8);
920 err_initialize:
921         kfree ( pB );
922         i2BoardPtrTable[boardnum] = NULL;
923         return;
924 }
925
926 /******************************************************************************/
927 /* Function:   find_eisa_board ( int start_slot )                             */
928 /* Parameters: First slot to check                                            */
929 /* Returns:    Address of EISA IntelliPort II controller                      */
930 /*                                                                            */
931 /* Description:                                                               */
932 /* This function searches for an EISA IntelliPort controller, starting        */
933 /* from the specified slot number. If the motherboard is not identified as an */
934 /* EISA motherboard, or no valid board ID is selected it returns 0. Otherwise */
935 /* it returns the base address of the controller.                             */
936 /******************************************************************************/
937 static unsigned short
938 find_eisa_board( int start_slot )
939 {
940         int i, j;
941         unsigned int idm = 0;
942         unsigned int idp = 0;
943         unsigned int base = 0;
944         unsigned int value;
945         int setup_address;
946         int setup_irq;
947         int ismine = 0;
948
949         /*
950          * First a check for an EISA motherboard, which we do by comparing the
951          * EISA ID registers for the system board and the first couple of slots.
952          * No slot ID should match the system board ID, but on an ISA or PCI
953          * machine the odds are that an empty bus will return similar values for
954          * each slot.
955          */
956         i = 0x0c80;
957         value = (inb(i) << 24) + (inb(i+1) << 16) + (inb(i+2) << 8) + inb(i+3);
958         for( i = 0x1c80; i <= 0x4c80; i += 0x1000 ) {
959                 j = (inb(i)<<24)+(inb(i+1)<<16)+(inb(i+2)<<8)+inb(i+3);
960                 if ( value == j )
961                         return 0;
962         }
963
964         /*
965          * OK, so we are inclined to believe that this is an EISA machine. Find
966          * an IntelliPort controller.
967          */
968         for( i = start_slot; i < 16; i++ ) {
969                 base = i << 12;
970                 idm = (inb(base + 0xc80) << 8) | (inb(base + 0xc81) & 0xff);
971                 idp = (inb(base + 0xc82) << 8) | (inb(base + 0xc83) & 0xff);
972                 ismine = 0;
973                 if ( idm == 0x0e8e ) {
974                         if ( idp == 0x0281 || idp == 0x0218 ) {
975                                 ismine = 1;
976                         } else if ( idp == 0x0282 || idp == 0x0283 ) {
977                                 ismine = 3;     /* Can do edge-trigger */
978                         }
979                         if ( ismine ) {
980                                 Eisa_slot = i;
981                                 break;
982                         }
983                 }
984         }
985         if ( !ismine )
986                 return 0;
987
988         /* It's some sort of EISA card, but at what address is it configured? */
989
990         setup_address = base + 0xc88;
991         value = inb(base + 0xc86);
992         setup_irq = (value & 8) ? Valid_Irqs[value & 7] : 0;
993
994         if ( (ismine & 2) && !(value & 0x10) ) {
995                 ismine = 1;     /* Could be edging, but not */
996         }
997
998         if ( Eisa_irq == 0 ) {
999                 Eisa_irq = setup_irq;
1000         } else if ( Eisa_irq != setup_irq ) {
1001                 printk ( KERN_ERR "IP2: EISA irq mismatch between EISA controllers\n" );
1002         }
1003
1004 #ifdef IP2DEBUG_INIT
1005 printk(KERN_DEBUG "Computone EISA board in slot %d, I.D. 0x%x%x, Address 0x%x",
1006                base >> 12, idm, idp, setup_address);
1007         if ( Eisa_irq ) {
1008                 printk(KERN_DEBUG ", Interrupt %d %s\n",
1009                        setup_irq, (ismine & 2) ? "(edge)" : "(level)");
1010         } else {
1011                 printk(KERN_DEBUG ", (polled)\n");
1012         }
1013 #endif
1014         return setup_address;
1015 }
1016
1017 /******************************************************************************/
1018 /* Function:   set_irq()                                                      */
1019 /* Parameters: index to board in board table                                  */
1020 /*             IRQ to use                                                     */
1021 /* Returns:    Success (0)                                                    */
1022 /*                                                                            */
1023 /* Description:                                                               */
1024 /******************************************************************************/
1025 static void
1026 set_irq( int boardnum, int boardIrq )
1027 {
1028         unsigned char tempCommand[16];
1029         i2eBordStrPtr pB = i2BoardPtrTable[boardnum];
1030         unsigned long flags;
1031
1032         /*
1033          * Notify the boards they may generate interrupts. This is done by
1034          * sending an in-line command to channel 0 on each board. This is why
1035          * the channels have to be defined already. For each board, if the
1036          * interrupt has never been defined, we must do so NOW, directly, since
1037          * board will not send flow control or even give an interrupt until this
1038          * is done.  If polling we must send 0 as the interrupt parameter.
1039          */
1040
1041         // We will get an interrupt here at the end of this function
1042
1043         iiDisableMailIrq(pB);
1044
1045         /* We build up the entire packet header. */
1046         CHANNEL_OF(tempCommand) = 0;
1047         PTYPE_OF(tempCommand) = PTYPE_INLINE;
1048         CMD_COUNT_OF(tempCommand) = 2;
1049         (CMD_OF(tempCommand))[0] = CMDVALUE_IRQ;
1050         (CMD_OF(tempCommand))[1] = boardIrq;
1051         /*
1052          * Write to FIFO; don't bother to adjust fifo capacity for this, since
1053          * board will respond almost immediately after SendMail hit.
1054          */
1055         WRITE_LOCK_IRQSAVE(&pB->write_fifo_spinlock,flags);
1056         iiWriteBuf(pB, tempCommand, 4);
1057         WRITE_UNLOCK_IRQRESTORE(&pB->write_fifo_spinlock,flags);
1058         pB->i2eUsingIrq = boardIrq;
1059         pB->i2eOutMailWaiting |= MB_OUT_STUFFED;
1060
1061         /* Need to update number of boards before you enable mailbox int */
1062         ++i2nBoards;
1063
1064         CHANNEL_OF(tempCommand) = 0;
1065         PTYPE_OF(tempCommand) = PTYPE_BYPASS;
1066         CMD_COUNT_OF(tempCommand) = 6;
1067         (CMD_OF(tempCommand))[0] = 88;  // SILO
1068         (CMD_OF(tempCommand))[1] = 64;  // chars
1069         (CMD_OF(tempCommand))[2] = 32;  // ms
1070
1071         (CMD_OF(tempCommand))[3] = 28;  // MAX_BLOCK
1072         (CMD_OF(tempCommand))[4] = 64;  // chars
1073
1074         (CMD_OF(tempCommand))[5] = 87;  // HW_TEST
1075         WRITE_LOCK_IRQSAVE(&pB->write_fifo_spinlock,flags);
1076         iiWriteBuf(pB, tempCommand, 8);
1077         WRITE_UNLOCK_IRQRESTORE(&pB->write_fifo_spinlock,flags);
1078
1079         CHANNEL_OF(tempCommand) = 0;
1080         PTYPE_OF(tempCommand) = PTYPE_BYPASS;
1081         CMD_COUNT_OF(tempCommand) = 1;
1082         (CMD_OF(tempCommand))[0] = 84;  /* get BOX_IDS */
1083         iiWriteBuf(pB, tempCommand, 3);
1084
1085 #ifdef XXX
1086         // enable heartbeat for test porpoises
1087         CHANNEL_OF(tempCommand) = 0;
1088         PTYPE_OF(tempCommand) = PTYPE_BYPASS;
1089         CMD_COUNT_OF(tempCommand) = 2;
1090         (CMD_OF(tempCommand))[0] = 44;  /* get ping */
1091         (CMD_OF(tempCommand))[1] = 200; /* 200 ms */
1092         WRITE_LOCK_IRQSAVE(&pB->write_fifo_spinlock,flags);
1093         iiWriteBuf(pB, tempCommand, 4);
1094         WRITE_UNLOCK_IRQRESTORE(&pB->write_fifo_spinlock,flags);
1095 #endif
1096
1097         iiEnableMailIrq(pB);
1098         iiSendPendingMail(pB);
1099 }
1100
1101 /******************************************************************************/
1102 /* Interrupt Handler Section                                                  */
1103 /******************************************************************************/
1104
1105 static inline void
1106 service_all_boards(void)
1107 {
1108         int i;
1109         i2eBordStrPtr  pB;
1110
1111         /* Service every board on the list */
1112         for( i = 0; i < IP2_MAX_BOARDS; ++i ) {
1113                 pB = i2BoardPtrTable[i];
1114                 if ( pB ) {
1115                         i2ServiceBoard( pB );
1116                 }
1117         }
1118 }
1119
1120
1121 /******************************************************************************/
1122 /* Function:   ip2_interrupt_bh(work)                                         */
1123 /* Parameters: work - pointer to the board structure                          */
1124 /* Returns:    Nothing                                                        */
1125 /*                                                                            */
1126 /* Description:                                                               */
1127 /*      Service the board in a bottom half interrupt handler and then         */
1128 /*      reenable the board's interrupts if it has an IRQ number               */
1129 /*                                                                            */
1130 /******************************************************************************/
1131 static void
1132 ip2_interrupt_bh(struct work_struct *work)
1133 {
1134         i2eBordStrPtr pB = container_of(work, i2eBordStr, tqueue_interrupt);
1135 //      pB better well be set or we have a problem!  We can only get
1136 //      here from the IMMEDIATE queue.  Here, we process the boards.
1137 //      Checking pB doesn't cost much and it saves us from the sanity checkers.
1138
1139         bh_counter++; 
1140
1141         if ( pB ) {
1142                 i2ServiceBoard( pB );
1143                 if( pB->i2eUsingIrq ) {
1144 //                      Re-enable his interrupts
1145                         iiEnableMailIrq(pB);
1146                 }
1147         }
1148 }
1149
1150
1151 /******************************************************************************/
1152 /* Function:   ip2_interrupt(int irq, void *dev_id)    */
1153 /* Parameters: irq - interrupt number                                         */
1154 /*             pointer to optional device ID structure                        */
1155 /* Returns:    Nothing                                                        */
1156 /*                                                                            */
1157 /* Description:                                                               */
1158 /*                                                                            */
1159 /*      Our task here is simply to identify each board which needs servicing. */
1160 /*      If we are queuing then, queue it to be serviced, and disable its irq  */
1161 /*      mask otherwise process the board directly.                            */
1162 /*                                                                            */
1163 /*      We could queue by IRQ but that just complicates things on both ends   */
1164 /*      with very little gain in performance (how many instructions does      */
1165 /*      it take to iterate on the immediate queue).                           */
1166 /*                                                                            */
1167 /*                                                                            */
1168 /******************************************************************************/
1169 static void
1170 ip2_irq_work(i2eBordStrPtr pB)
1171 {
1172 #ifdef USE_IQI
1173         if (NO_MAIL_HERE != ( pB->i2eStartMail = iiGetMail(pB))) {
1174 //              Disable his interrupt (will be enabled when serviced)
1175 //              This is mostly to protect from reentrancy.
1176                 iiDisableMailIrq(pB);
1177
1178 //              Park the board on the immediate queue for processing.
1179                 schedule_work(&pB->tqueue_interrupt);
1180
1181 //              Make sure the immediate queue is flagged to fire.
1182         }
1183 #else
1184
1185 //      We are using immediate servicing here.  This sucks and can
1186 //      cause all sorts of havoc with ppp and others.  The failsafe
1187 //      check on iiSendPendingMail could also throw a hairball.
1188
1189         i2ServiceBoard( pB );
1190
1191 #endif /* USE_IQI */
1192 }
1193
1194 static void
1195 ip2_polled_interrupt(void)
1196 {
1197         int i;
1198         i2eBordStrPtr  pB;
1199         const int irq = 0;
1200
1201         ip2trace (ITRC_NO_PORT, ITRC_INTR, 99, 1, irq );
1202
1203         /* Service just the boards on the list using this irq */
1204         for( i = 0; i < i2nBoards; ++i ) {
1205                 pB = i2BoardPtrTable[i];
1206
1207 //              Only process those boards which match our IRQ.
1208 //                      IRQ = 0 for polled boards, we won't poll "IRQ" boards
1209
1210                 if ( pB && (pB->i2eUsingIrq == irq) ) {
1211                         ip2_irq_work(pB);
1212                 }
1213         }
1214
1215         ++irq_counter;
1216
1217         ip2trace (ITRC_NO_PORT, ITRC_INTR, ITRC_RETURN, 0 );
1218 }
1219
1220 static irqreturn_t
1221 ip2_interrupt(int irq, void *dev_id)
1222 {
1223         i2eBordStrPtr pB = dev_id;
1224
1225         ip2trace (ITRC_NO_PORT, ITRC_INTR, 99, 1, pB->i2eUsingIrq );
1226
1227         ip2_irq_work(pB);
1228
1229         ++irq_counter;
1230
1231         ip2trace (ITRC_NO_PORT, ITRC_INTR, ITRC_RETURN, 0 );
1232         return IRQ_HANDLED;
1233 }
1234
1235 /******************************************************************************/
1236 /* Function:   ip2_poll(unsigned long arg)                                    */
1237 /* Parameters: ?                                                              */
1238 /* Returns:    Nothing                                                        */
1239 /*                                                                            */
1240 /* Description:                                                               */
1241 /* This function calls the library routine i2ServiceBoard for each board in   */
1242 /* the board table. This is used instead of the interrupt routine when polled */
1243 /* mode is specified.                                                         */
1244 /******************************************************************************/
1245 static void
1246 ip2_poll(unsigned long arg)
1247 {
1248         ip2trace (ITRC_NO_PORT, ITRC_INTR, 100, 0 );
1249
1250         TimerOn = 0; // it's the truth but not checked in service
1251
1252         // Just polled boards, IRQ = 0 will hit all non-interrupt boards.
1253         // It will NOT poll boards handled by hard interrupts.
1254         // The issue of queued BH interrups is handled in ip2_interrupt().
1255         ip2_polled_interrupt();
1256
1257         PollTimer.expires = POLL_TIMEOUT;
1258         add_timer( &PollTimer );
1259         TimerOn = 1;
1260
1261         ip2trace (ITRC_NO_PORT, ITRC_INTR, ITRC_RETURN, 0 );
1262 }
1263
1264 static void do_input(struct work_struct *work)
1265 {
1266         i2ChanStrPtr pCh = container_of(work, i2ChanStr, tqueue_input);
1267         unsigned long flags;
1268
1269         ip2trace(CHANN, ITRC_INPUT, 21, 0 );
1270
1271         // Data input
1272         if ( pCh->pTTY != NULL ) {
1273                 READ_LOCK_IRQSAVE(&pCh->Ibuf_spinlock,flags)
1274                 if (!pCh->throttled && (pCh->Ibuf_stuff != pCh->Ibuf_strip)) {
1275                         READ_UNLOCK_IRQRESTORE(&pCh->Ibuf_spinlock,flags)
1276                         i2Input( pCh );
1277                 } else
1278                         READ_UNLOCK_IRQRESTORE(&pCh->Ibuf_spinlock,flags)
1279         } else {
1280                 ip2trace(CHANN, ITRC_INPUT, 22, 0 );
1281
1282                 i2InputFlush( pCh );
1283         }
1284 }
1285
1286 // code duplicated from n_tty (ldisc)
1287 static inline void  isig(int sig, struct tty_struct *tty, int flush)
1288 {
1289         if (tty->pgrp)
1290                 kill_pgrp(tty->pgrp, sig, 1);
1291         if (flush || !L_NOFLSH(tty)) {
1292                 if ( tty->ldisc.flush_buffer )  
1293                         tty->ldisc.flush_buffer(tty);
1294                 i2InputFlush( tty->driver_data );
1295         }
1296 }
1297
1298 static void do_status(struct work_struct *work)
1299 {
1300         i2ChanStrPtr pCh = container_of(work, i2ChanStr, tqueue_status);
1301         int status;
1302
1303         status =  i2GetStatus( pCh, (I2_BRK|I2_PAR|I2_FRA|I2_OVR) );
1304
1305         ip2trace (CHANN, ITRC_STATUS, 21, 1, status );
1306
1307         if (pCh->pTTY && (status & (I2_BRK|I2_PAR|I2_FRA|I2_OVR)) ) {
1308                 if ( (status & I2_BRK) ) {
1309                         // code duplicated from n_tty (ldisc)
1310                         if (I_IGNBRK(pCh->pTTY))
1311                                 goto skip_this;
1312                         if (I_BRKINT(pCh->pTTY)) {
1313                                 isig(SIGINT, pCh->pTTY, 1);
1314                                 goto skip_this;
1315                         }
1316                         wake_up_interruptible(&pCh->pTTY->read_wait);
1317                 }
1318 #ifdef NEVER_HAPPENS_AS_SETUP_XXX
1319         // and can't work because we don't know the_char
1320         // as the_char is reported on a separate path
1321         // The intelligent board does this stuff as setup
1322         {
1323         char brkf = TTY_NORMAL;
1324         unsigned char brkc = '\0';
1325         unsigned char tmp;
1326                 if ( (status & I2_BRK) ) {
1327                         brkf = TTY_BREAK;
1328                         brkc = '\0';
1329                 } 
1330                 else if (status & I2_PAR) {
1331                         brkf = TTY_PARITY;
1332                         brkc = the_char;
1333                 } else if (status & I2_FRA) {
1334                         brkf = TTY_FRAME;
1335                         brkc = the_char;
1336                 } else if (status & I2_OVR) {
1337                         brkf = TTY_OVERRUN;
1338                         brkc = the_char;
1339                 }
1340                 tmp = pCh->pTTY->real_raw;
1341                 pCh->pTTY->real_raw = 0;
1342                 pCh->pTTY->ldisc.receive_buf( pCh->pTTY, &brkc, &brkf, 1 );
1343                 pCh->pTTY->real_raw = tmp;
1344         }
1345 #endif /* NEVER_HAPPENS_AS_SETUP_XXX */
1346         }
1347 skip_this:
1348
1349         if ( status & (I2_DDCD | I2_DDSR | I2_DCTS | I2_DRI) ) {
1350                 wake_up_interruptible(&pCh->delta_msr_wait);
1351
1352                 if ( (pCh->flags & ASYNC_CHECK_CD) && (status & I2_DDCD) ) {
1353                         if ( status & I2_DCD ) {
1354                                 if ( pCh->wopen ) {
1355                                         wake_up_interruptible ( &pCh->open_wait );
1356                                 }
1357                         } else {
1358                                 if (pCh->pTTY &&  (!(pCh->pTTY->termios->c_cflag & CLOCAL)) ) {
1359                                         tty_hangup( pCh->pTTY );
1360                                 }
1361                         }
1362                 }
1363         }
1364
1365         ip2trace (CHANN, ITRC_STATUS, 26, 0 );
1366 }
1367
1368 /******************************************************************************/
1369 /* Device Open/Close/Ioctl Entry Point Section                                */
1370 /******************************************************************************/
1371
1372 /******************************************************************************/
1373 /* Function:   open_sanity_check()                                            */
1374 /* Parameters: Pointer to tty structure                                       */
1375 /*             Pointer to file structure                                      */
1376 /* Returns:    Success or failure                                             */
1377 /*                                                                            */
1378 /* Description:                                                               */
1379 /* Verifies the structure magic numbers and cross links.                      */
1380 /******************************************************************************/
1381 #ifdef IP2DEBUG_OPEN
1382 static void 
1383 open_sanity_check( i2ChanStrPtr pCh, i2eBordStrPtr pBrd )
1384 {
1385         if ( pBrd->i2eValid != I2E_MAGIC ) {
1386                 printk(KERN_ERR "IP2: invalid board structure\n" );
1387         } else if ( pBrd != pCh->pMyBord ) {
1388                 printk(KERN_ERR "IP2: board structure pointer mismatch (%p)\n",
1389                          pCh->pMyBord );
1390         } else if ( pBrd->i2eChannelCnt < pCh->port_index ) {
1391                 printk(KERN_ERR "IP2: bad device index (%d)\n", pCh->port_index );
1392         } else if (&((i2ChanStrPtr)pBrd->i2eChannelPtr)[pCh->port_index] != pCh) {
1393         } else {
1394                 printk(KERN_INFO "IP2: all pointers check out!\n" );
1395         }
1396 }
1397 #endif
1398
1399
1400 /******************************************************************************/
1401 /* Function:   ip2_open()                                                     */
1402 /* Parameters: Pointer to tty structure                                       */
1403 /*             Pointer to file structure                                      */
1404 /* Returns:    Success or failure                                             */
1405 /*                                                                            */
1406 /* Description: (MANDATORY)                                                   */
1407 /* A successful device open has to run a gauntlet of checks before it         */
1408 /* completes. After some sanity checking and pointer setup, the function      */
1409 /* blocks until all conditions are satisfied. It then initialises the port to */
1410 /* the default characteristics and returns.                                   */
1411 /******************************************************************************/
1412 static int
1413 ip2_open( PTTY tty, struct file *pFile )
1414 {
1415         wait_queue_t wait;
1416         int rc = 0;
1417         int do_clocal = 0;
1418         i2ChanStrPtr  pCh = DevTable[tty->index];
1419
1420         ip2trace (tty->index, ITRC_OPEN, ITRC_ENTER, 0 );
1421
1422         if ( pCh == NULL ) {
1423                 return -ENODEV;
1424         }
1425         /* Setup pointer links in device and tty structures */
1426         pCh->pTTY = tty;
1427         tty->driver_data = pCh;
1428
1429 #ifdef IP2DEBUG_OPEN
1430         printk(KERN_DEBUG \
1431                         "IP2:open(tty=%p,pFile=%p):dev=%s,ch=%d,idx=%d\n",
1432                tty, pFile, tty->name, pCh->infl.hd.i2sChannel, pCh->port_index);
1433         open_sanity_check ( pCh, pCh->pMyBord );
1434 #endif
1435
1436         i2QueueCommands(PTYPE_INLINE, pCh, 100, 3, CMD_DTRUP,CMD_RTSUP,CMD_DCD_REP);
1437         pCh->dataSetOut |= (I2_DTR | I2_RTS);
1438         serviceOutgoingFifo( pCh->pMyBord );
1439
1440         /* Block here until the port is ready (per serial and istallion) */
1441         /*
1442          * 1. If the port is in the middle of closing wait for the completion
1443          *    and then return the appropriate error.
1444          */
1445         init_waitqueue_entry(&wait, current);
1446         add_wait_queue(&pCh->close_wait, &wait);
1447         set_current_state( TASK_INTERRUPTIBLE );
1448
1449         if ( tty_hung_up_p(pFile) || ( pCh->flags & ASYNC_CLOSING )) {
1450                 if ( pCh->flags & ASYNC_CLOSING ) {
1451                         schedule();
1452                 }
1453                 if ( tty_hung_up_p(pFile) ) {
1454                         set_current_state( TASK_RUNNING );
1455                         remove_wait_queue(&pCh->close_wait, &wait);
1456                         return( pCh->flags & ASYNC_HUP_NOTIFY ) ? -EAGAIN : -ERESTARTSYS;
1457                 }
1458         }
1459         set_current_state( TASK_RUNNING );
1460         remove_wait_queue(&pCh->close_wait, &wait);
1461
1462         /*
1463          * 3. Handle a non-blocking open of a normal port.
1464          */
1465         if ( (pFile->f_flags & O_NONBLOCK) || (tty->flags & (1<<TTY_IO_ERROR) )) {
1466                 pCh->flags |= ASYNC_NORMAL_ACTIVE;
1467                 goto noblock;
1468         }
1469         /*
1470          * 4. Now loop waiting for the port to be free and carrier present
1471          *    (if required).
1472          */
1473         if ( tty->termios->c_cflag & CLOCAL )
1474                 do_clocal = 1;
1475
1476 #ifdef IP2DEBUG_OPEN
1477         printk(KERN_DEBUG "OpenBlock: do_clocal = %d\n", do_clocal);
1478 #endif
1479
1480         ++pCh->wopen;
1481
1482         init_waitqueue_entry(&wait, current);
1483         add_wait_queue(&pCh->open_wait, &wait);
1484
1485         for(;;) {
1486                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 2, CMD_DTRUP, CMD_RTSUP);
1487                 pCh->dataSetOut |= (I2_DTR | I2_RTS);
1488                 set_current_state( TASK_INTERRUPTIBLE );
1489                 serviceOutgoingFifo( pCh->pMyBord );
1490                 if ( tty_hung_up_p(pFile) ) {
1491                         set_current_state( TASK_RUNNING );
1492                         remove_wait_queue(&pCh->open_wait, &wait);
1493                         return ( pCh->flags & ASYNC_HUP_NOTIFY ) ? -EBUSY : -ERESTARTSYS;
1494                 }
1495                 if (!(pCh->flags & ASYNC_CLOSING) && 
1496                                 (do_clocal || (pCh->dataSetIn & I2_DCD) )) {
1497                         rc = 0;
1498                         break;
1499                 }
1500
1501 #ifdef IP2DEBUG_OPEN
1502                 printk(KERN_DEBUG "ASYNC_CLOSING = %s\n",
1503                         (pCh->flags & ASYNC_CLOSING)?"True":"False");
1504                 printk(KERN_DEBUG "OpenBlock: waiting for CD or signal\n");
1505 #endif
1506                 ip2trace (CHANN, ITRC_OPEN, 3, 2, 0,
1507                                 (pCh->flags & ASYNC_CLOSING) );
1508                 /* check for signal */
1509                 if (signal_pending(current)) {
1510                         rc = (( pCh->flags & ASYNC_HUP_NOTIFY ) ? -EAGAIN : -ERESTARTSYS);
1511                         break;
1512                 }
1513                 schedule();
1514         }
1515         set_current_state( TASK_RUNNING );
1516         remove_wait_queue(&pCh->open_wait, &wait);
1517
1518         --pCh->wopen; //why count?
1519
1520         ip2trace (CHANN, ITRC_OPEN, 4, 0 );
1521
1522         if (rc != 0 ) {
1523                 return rc;
1524         }
1525         pCh->flags |= ASYNC_NORMAL_ACTIVE;
1526
1527 noblock:
1528
1529         /* first open - Assign termios structure to port */
1530         if ( tty->count == 1 ) {
1531                 i2QueueCommands(PTYPE_INLINE, pCh, 0, 2, CMD_CTSFL_DSAB, CMD_RTSFL_DSAB);
1532                 /* Now we must send the termios settings to the loadware */
1533                 set_params( pCh, NULL );
1534         }
1535
1536         /*
1537          * Now set any i2lib options. These may go away if the i2lib code ends
1538          * up rolled into the mainline.
1539          */
1540         pCh->channelOptions |= CO_NBLOCK_WRITE;
1541
1542 #ifdef IP2DEBUG_OPEN
1543         printk (KERN_DEBUG "IP2: open completed\n" );
1544 #endif
1545         serviceOutgoingFifo( pCh->pMyBord );
1546
1547         ip2trace (CHANN, ITRC_OPEN, ITRC_RETURN, 0 );
1548
1549         return 0;
1550 }
1551
1552 /******************************************************************************/
1553 /* Function:   ip2_close()                                                    */
1554 /* Parameters: Pointer to tty structure                                       */
1555 /*             Pointer to file structure                                      */
1556 /* Returns:    Nothing                                                        */
1557 /*                                                                            */
1558 /* Description:                                                               */
1559 /*                                                                            */
1560 /*                                                                            */
1561 /******************************************************************************/
1562 static void
1563 ip2_close( PTTY tty, struct file *pFile )
1564 {
1565         i2ChanStrPtr  pCh = tty->driver_data;
1566
1567         if ( !pCh ) {
1568                 return;
1569         }
1570
1571         ip2trace (CHANN, ITRC_CLOSE, ITRC_ENTER, 0 );
1572
1573 #ifdef IP2DEBUG_OPEN
1574         printk(KERN_DEBUG "IP2:close %s:\n",tty->name);
1575 #endif
1576
1577         if ( tty_hung_up_p ( pFile ) ) {
1578
1579                 ip2trace (CHANN, ITRC_CLOSE, 2, 1, 2 );
1580
1581                 return;
1582         }
1583         if ( tty->count > 1 ) { /* not the last close */
1584
1585                 ip2trace (CHANN, ITRC_CLOSE, 2, 1, 3 );
1586
1587                 return;
1588         }
1589         pCh->flags |= ASYNC_CLOSING;    // last close actually
1590
1591         tty->closing = 1;
1592
1593         if (pCh->ClosingWaitTime != ASYNC_CLOSING_WAIT_NONE) {
1594                 /*
1595                  * Before we drop DTR, make sure the transmitter has completely drained.
1596                  * This uses an timeout, after which the close
1597                  * completes.
1598                  */
1599                 ip2_wait_until_sent(tty, pCh->ClosingWaitTime );
1600         }
1601         /*
1602          * At this point we stop accepting input. Here we flush the channel
1603          * input buffer which will allow the board to send up more data. Any
1604          * additional input is tossed at interrupt/poll time.
1605          */
1606         i2InputFlush( pCh );
1607
1608         /* disable DSS reporting */
1609         i2QueueCommands(PTYPE_INLINE, pCh, 100, 4,
1610                                 CMD_DCD_NREP, CMD_CTS_NREP, CMD_DSR_NREP, CMD_RI_NREP);
1611         if ( !tty || (tty->termios->c_cflag & HUPCL) ) {
1612                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 2, CMD_RTSDN, CMD_DTRDN);
1613                 pCh->dataSetOut &= ~(I2_DTR | I2_RTS);
1614                 i2QueueCommands( PTYPE_INLINE, pCh, 100, 1, CMD_PAUSE(25));
1615         }
1616
1617         serviceOutgoingFifo ( pCh->pMyBord );
1618
1619         if ( tty->driver->flush_buffer ) 
1620                 tty->driver->flush_buffer(tty);
1621         if ( tty->ldisc.flush_buffer )  
1622                 tty->ldisc.flush_buffer(tty);
1623         tty->closing = 0;
1624         
1625         pCh->pTTY = NULL;
1626
1627         if (pCh->wopen) {
1628                 if (pCh->ClosingDelay) {
1629                         msleep_interruptible(jiffies_to_msecs(pCh->ClosingDelay));
1630                 }
1631                 wake_up_interruptible(&pCh->open_wait);
1632         }
1633
1634         pCh->flags &=~(ASYNC_NORMAL_ACTIVE|ASYNC_CLOSING);
1635         wake_up_interruptible(&pCh->close_wait);
1636
1637 #ifdef IP2DEBUG_OPEN
1638         DBG_CNT("ip2_close: after wakeups--");
1639 #endif
1640
1641
1642         ip2trace (CHANN, ITRC_CLOSE, ITRC_RETURN, 1, 1 );
1643
1644         return;
1645 }
1646
1647 /******************************************************************************/
1648 /* Function:   ip2_hangup()                                                   */
1649 /* Parameters: Pointer to tty structure                                       */
1650 /* Returns:    Nothing                                                        */
1651 /*                                                                            */
1652 /* Description:                                                               */
1653 /*                                                                            */
1654 /*                                                                            */
1655 /******************************************************************************/
1656 static void
1657 ip2_hangup ( PTTY tty )
1658 {
1659         i2ChanStrPtr  pCh = tty->driver_data;
1660
1661         if( !pCh ) {
1662                 return;
1663         }
1664
1665         ip2trace (CHANN, ITRC_HANGUP, ITRC_ENTER, 0 );
1666
1667         ip2_flush_buffer(tty);
1668
1669         /* disable DSS reporting */
1670
1671         i2QueueCommands(PTYPE_BYPASS, pCh, 0, 1, CMD_DCD_NREP);
1672         i2QueueCommands(PTYPE_INLINE, pCh, 0, 2, CMD_CTSFL_DSAB, CMD_RTSFL_DSAB);
1673         if ( (tty->termios->c_cflag & HUPCL) ) {
1674                 i2QueueCommands(PTYPE_BYPASS, pCh, 0, 2, CMD_RTSDN, CMD_DTRDN);
1675                 pCh->dataSetOut &= ~(I2_DTR | I2_RTS);
1676                 i2QueueCommands( PTYPE_INLINE, pCh, 100, 1, CMD_PAUSE(25));
1677         }
1678         i2QueueCommands(PTYPE_INLINE, pCh, 1, 3, 
1679                                 CMD_CTS_NREP, CMD_DSR_NREP, CMD_RI_NREP);
1680         serviceOutgoingFifo ( pCh->pMyBord );
1681
1682         wake_up_interruptible ( &pCh->delta_msr_wait );
1683
1684         pCh->flags &= ~ASYNC_NORMAL_ACTIVE;
1685         pCh->pTTY = NULL;
1686         wake_up_interruptible ( &pCh->open_wait );
1687
1688         ip2trace (CHANN, ITRC_HANGUP, ITRC_RETURN, 0 );
1689 }
1690
1691 /******************************************************************************/
1692 /******************************************************************************/
1693 /* Device Output Section                                                      */
1694 /******************************************************************************/
1695 /******************************************************************************/
1696
1697 /******************************************************************************/
1698 /* Function:   ip2_write()                                                    */
1699 /* Parameters: Pointer to tty structure                                       */
1700 /*             Flag denoting data is in user (1) or kernel (0) space          */
1701 /*             Pointer to data                                                */
1702 /*             Number of bytes to write                                       */
1703 /* Returns:    Number of bytes actually written                               */
1704 /*                                                                            */
1705 /* Description: (MANDATORY)                                                   */
1706 /*                                                                            */
1707 /*                                                                            */
1708 /******************************************************************************/
1709 static int
1710 ip2_write( PTTY tty, const unsigned char *pData, int count)
1711 {
1712         i2ChanStrPtr  pCh = tty->driver_data;
1713         int bytesSent = 0;
1714         unsigned long flags;
1715
1716         ip2trace (CHANN, ITRC_WRITE, ITRC_ENTER, 2, count, -1 );
1717
1718         /* Flush out any buffered data left over from ip2_putchar() calls. */
1719         ip2_flush_chars( tty );
1720
1721         /* This is the actual move bit. Make sure it does what we need!!!!! */
1722         WRITE_LOCK_IRQSAVE(&pCh->Pbuf_spinlock,flags);
1723         bytesSent = i2Output( pCh, pData, count);
1724         WRITE_UNLOCK_IRQRESTORE(&pCh->Pbuf_spinlock,flags);
1725
1726         ip2trace (CHANN, ITRC_WRITE, ITRC_RETURN, 1, bytesSent );
1727
1728         return bytesSent > 0 ? bytesSent : 0;
1729 }
1730
1731 /******************************************************************************/
1732 /* Function:   ip2_putchar()                                                  */
1733 /* Parameters: Pointer to tty structure                                       */
1734 /*             Character to write                                             */
1735 /* Returns:    Nothing                                                        */
1736 /*                                                                            */
1737 /* Description:                                                               */
1738 /*                                                                            */
1739 /*                                                                            */
1740 /******************************************************************************/
1741 static void
1742 ip2_putchar( PTTY tty, unsigned char ch )
1743 {
1744         i2ChanStrPtr  pCh = tty->driver_data;
1745         unsigned long flags;
1746
1747 //      ip2trace (CHANN, ITRC_PUTC, ITRC_ENTER, 1, ch );
1748
1749         WRITE_LOCK_IRQSAVE(&pCh->Pbuf_spinlock,flags);
1750         pCh->Pbuf[pCh->Pbuf_stuff++] = ch;
1751         if ( pCh->Pbuf_stuff == sizeof pCh->Pbuf ) {
1752                 WRITE_UNLOCK_IRQRESTORE(&pCh->Pbuf_spinlock,flags);
1753                 ip2_flush_chars( tty );
1754         } else
1755                 WRITE_UNLOCK_IRQRESTORE(&pCh->Pbuf_spinlock,flags);
1756
1757 //      ip2trace (CHANN, ITRC_PUTC, ITRC_RETURN, 1, ch );
1758 }
1759
1760 /******************************************************************************/
1761 /* Function:   ip2_flush_chars()                                              */
1762 /* Parameters: Pointer to tty structure                                       */
1763 /* Returns:    Nothing                                                        */
1764 /*                                                                            */
1765 /* Description:                                                               */
1766 /*                                                                            */
1767 /******************************************************************************/
1768 static void
1769 ip2_flush_chars( PTTY tty )
1770 {
1771         int   strip;
1772         i2ChanStrPtr  pCh = tty->driver_data;
1773         unsigned long flags;
1774
1775         WRITE_LOCK_IRQSAVE(&pCh->Pbuf_spinlock,flags);
1776         if ( pCh->Pbuf_stuff ) {
1777
1778 //              ip2trace (CHANN, ITRC_PUTC, 10, 1, strip );
1779
1780                 //
1781                 // We may need to restart i2Output if it does not fullfill this request
1782                 //
1783                 strip = i2Output( pCh, pCh->Pbuf, pCh->Pbuf_stuff);
1784                 if ( strip != pCh->Pbuf_stuff ) {
1785                         memmove( pCh->Pbuf, &pCh->Pbuf[strip], pCh->Pbuf_stuff - strip );
1786                 }
1787                 pCh->Pbuf_stuff -= strip;
1788         }
1789         WRITE_UNLOCK_IRQRESTORE(&pCh->Pbuf_spinlock,flags);
1790 }
1791
1792 /******************************************************************************/
1793 /* Function:   ip2_write_room()                                               */
1794 /* Parameters: Pointer to tty structure                                       */
1795 /* Returns:    Number of bytes that the driver can accept                     */
1796 /*                                                                            */
1797 /* Description:                                                               */
1798 /*                                                                            */
1799 /******************************************************************************/
1800 static int
1801 ip2_write_room ( PTTY tty )
1802 {
1803         int bytesFree;
1804         i2ChanStrPtr  pCh = tty->driver_data;
1805         unsigned long flags;
1806
1807         READ_LOCK_IRQSAVE(&pCh->Pbuf_spinlock,flags);
1808         bytesFree = i2OutputFree( pCh ) - pCh->Pbuf_stuff;
1809         READ_UNLOCK_IRQRESTORE(&pCh->Pbuf_spinlock,flags);
1810
1811         ip2trace (CHANN, ITRC_WRITE, 11, 1, bytesFree );
1812
1813         return ((bytesFree > 0) ? bytesFree : 0);
1814 }
1815
1816 /******************************************************************************/
1817 /* Function:   ip2_chars_in_buf()                                             */
1818 /* Parameters: Pointer to tty structure                                       */
1819 /* Returns:    Number of bytes queued for transmission                        */
1820 /*                                                                            */
1821 /* Description:                                                               */
1822 /*                                                                            */
1823 /*                                                                            */
1824 /******************************************************************************/
1825 static int
1826 ip2_chars_in_buf ( PTTY tty )
1827 {
1828         i2ChanStrPtr  pCh = tty->driver_data;
1829         int rc;
1830         unsigned long flags;
1831
1832         ip2trace (CHANN, ITRC_WRITE, 12, 1, pCh->Obuf_char_count + pCh->Pbuf_stuff );
1833
1834 #ifdef IP2DEBUG_WRITE
1835         printk (KERN_DEBUG "IP2: chars in buffer = %d (%d,%d)\n",
1836                                  pCh->Obuf_char_count + pCh->Pbuf_stuff,
1837                                  pCh->Obuf_char_count, pCh->Pbuf_stuff );
1838 #endif
1839         READ_LOCK_IRQSAVE(&pCh->Obuf_spinlock,flags);
1840         rc =  pCh->Obuf_char_count;
1841         READ_UNLOCK_IRQRESTORE(&pCh->Obuf_spinlock,flags);
1842         READ_LOCK_IRQSAVE(&pCh->Pbuf_spinlock,flags);
1843         rc +=  pCh->Pbuf_stuff;
1844         READ_UNLOCK_IRQRESTORE(&pCh->Pbuf_spinlock,flags);
1845         return rc;
1846 }
1847
1848 /******************************************************************************/
1849 /* Function:   ip2_flush_buffer()                                             */
1850 /* Parameters: Pointer to tty structure                                       */
1851 /* Returns:    Nothing                                                        */
1852 /*                                                                            */
1853 /* Description:                                                               */
1854 /*                                                                            */
1855 /*                                                                            */
1856 /******************************************************************************/
1857 static void
1858 ip2_flush_buffer( PTTY tty )
1859 {
1860         i2ChanStrPtr  pCh = tty->driver_data;
1861         unsigned long flags;
1862
1863         ip2trace (CHANN, ITRC_FLUSH, ITRC_ENTER, 0 );
1864
1865 #ifdef IP2DEBUG_WRITE
1866         printk (KERN_DEBUG "IP2: flush buffer\n" );
1867 #endif
1868         WRITE_LOCK_IRQSAVE(&pCh->Pbuf_spinlock,flags);
1869         pCh->Pbuf_stuff = 0;
1870         WRITE_UNLOCK_IRQRESTORE(&pCh->Pbuf_spinlock,flags);
1871         i2FlushOutput( pCh );
1872         ip2_owake(tty);
1873
1874         ip2trace (CHANN, ITRC_FLUSH, ITRC_RETURN, 0 );
1875
1876 }
1877
1878 /******************************************************************************/
1879 /* Function:   ip2_wait_until_sent()                                          */
1880 /* Parameters: Pointer to tty structure                                       */
1881 /*             Timeout for wait.                                              */
1882 /* Returns:    Nothing                                                        */
1883 /*                                                                            */
1884 /* Description:                                                               */
1885 /* This function is used in place of the normal tty_wait_until_sent, which    */
1886 /* only waits for the driver buffers to be empty (or rather, those buffers    */
1887 /* reported by chars_in_buffer) which doesn't work for IP2 due to the         */
1888 /* indeterminate number of bytes buffered on the board.                       */
1889 /******************************************************************************/
1890 static void
1891 ip2_wait_until_sent ( PTTY tty, int timeout )
1892 {
1893         int i = jiffies;
1894         i2ChanStrPtr  pCh = tty->driver_data;
1895
1896         tty_wait_until_sent(tty, timeout );
1897         if ( (i = timeout - (jiffies -i)) > 0)
1898                 i2DrainOutput( pCh, i );
1899 }
1900
1901 /******************************************************************************/
1902 /******************************************************************************/
1903 /* Device Input Section                                                       */
1904 /******************************************************************************/
1905 /******************************************************************************/
1906
1907 /******************************************************************************/
1908 /* Function:   ip2_throttle()                                                 */
1909 /* Parameters: Pointer to tty structure                                       */
1910 /* Returns:    Nothing                                                        */
1911 /*                                                                            */
1912 /* Description:                                                               */
1913 /*                                                                            */
1914 /*                                                                            */
1915 /******************************************************************************/
1916 static void
1917 ip2_throttle ( PTTY tty )
1918 {
1919         i2ChanStrPtr  pCh = tty->driver_data;
1920
1921 #ifdef IP2DEBUG_READ
1922         printk (KERN_DEBUG "IP2: throttle\n" );
1923 #endif
1924         /*
1925          * Signal the poll/interrupt handlers not to forward incoming data to
1926          * the line discipline. This will cause the buffers to fill up in the
1927          * library and thus cause the library routines to send the flow control
1928          * stuff.
1929          */
1930         pCh->throttled = 1;
1931 }
1932
1933 /******************************************************************************/
1934 /* Function:   ip2_unthrottle()                                               */
1935 /* Parameters: Pointer to tty structure                                       */
1936 /* Returns:    Nothing                                                        */
1937 /*                                                                            */
1938 /* Description:                                                               */
1939 /*                                                                            */
1940 /*                                                                            */
1941 /******************************************************************************/
1942 static void
1943 ip2_unthrottle ( PTTY tty )
1944 {
1945         i2ChanStrPtr  pCh = tty->driver_data;
1946         unsigned long flags;
1947
1948 #ifdef IP2DEBUG_READ
1949         printk (KERN_DEBUG "IP2: unthrottle\n" );
1950 #endif
1951
1952         /* Pass incoming data up to the line discipline again. */
1953         pCh->throttled = 0;
1954         i2QueueCommands(PTYPE_BYPASS, pCh, 0, 1, CMD_RESUME);
1955         serviceOutgoingFifo( pCh->pMyBord );
1956         READ_LOCK_IRQSAVE(&pCh->Ibuf_spinlock,flags)
1957         if ( pCh->Ibuf_stuff != pCh->Ibuf_strip ) {
1958                 READ_UNLOCK_IRQRESTORE(&pCh->Ibuf_spinlock,flags)
1959 #ifdef IP2DEBUG_READ
1960                 printk (KERN_DEBUG "i2Input called from unthrottle\n" );
1961 #endif
1962                 i2Input( pCh );
1963         } else
1964                 READ_UNLOCK_IRQRESTORE(&pCh->Ibuf_spinlock,flags)
1965 }
1966
1967 static void
1968 ip2_start ( PTTY tty )
1969 {
1970         i2ChanStrPtr  pCh = DevTable[tty->index];
1971
1972         i2QueueCommands(PTYPE_BYPASS, pCh, 0, 1, CMD_RESUME);
1973         i2QueueCommands(PTYPE_BYPASS, pCh, 100, 1, CMD_UNSUSPEND);
1974         i2QueueCommands(PTYPE_BYPASS, pCh, 100, 1, CMD_RESUME);
1975 #ifdef IP2DEBUG_WRITE
1976         printk (KERN_DEBUG "IP2: start tx\n" );
1977 #endif
1978 }
1979
1980 static void
1981 ip2_stop ( PTTY tty )
1982 {
1983         i2ChanStrPtr  pCh = DevTable[tty->index];
1984
1985         i2QueueCommands(PTYPE_BYPASS, pCh, 100, 1, CMD_SUSPEND);
1986 #ifdef IP2DEBUG_WRITE
1987         printk (KERN_DEBUG "IP2: stop tx\n" );
1988 #endif
1989 }
1990
1991 /******************************************************************************/
1992 /* Device Ioctl Section                                                       */
1993 /******************************************************************************/
1994
1995 static int ip2_tiocmget(struct tty_struct *tty, struct file *file)
1996 {
1997         i2ChanStrPtr pCh = DevTable[tty->index];
1998 #ifdef  ENABLE_DSSNOW
1999         wait_queue_t wait;
2000 #endif
2001
2002         if (pCh == NULL)
2003                 return -ENODEV;
2004
2005 /*
2006         FIXME - the following code is causing a NULL pointer dereference in
2007         2.3.51 in an interrupt handler.  It's suppose to prompt the board
2008         to return the DSS signal status immediately.  Why doesn't it do
2009         the same thing in 2.2.14?
2010 */
2011
2012 /*      This thing is still busted in the 1.2.12 driver on 2.4.x
2013         and even hoses the serial console so the oops can be trapped.
2014                 /\/\|=mhw=|\/\/                 */
2015
2016 #ifdef  ENABLE_DSSNOW
2017         i2QueueCommands(PTYPE_BYPASS, pCh, 100, 1, CMD_DSS_NOW);
2018
2019         init_waitqueue_entry(&wait, current);
2020         add_wait_queue(&pCh->dss_now_wait, &wait);
2021         set_current_state( TASK_INTERRUPTIBLE );
2022
2023         serviceOutgoingFifo( pCh->pMyBord );
2024
2025         schedule();
2026
2027         set_current_state( TASK_RUNNING );
2028         remove_wait_queue(&pCh->dss_now_wait, &wait);
2029
2030         if (signal_pending(current)) {
2031                 return -EINTR;
2032         }
2033 #endif
2034         return  ((pCh->dataSetOut & I2_RTS) ? TIOCM_RTS : 0)
2035               | ((pCh->dataSetOut & I2_DTR) ? TIOCM_DTR : 0)
2036               | ((pCh->dataSetIn  & I2_DCD) ? TIOCM_CAR : 0)
2037               | ((pCh->dataSetIn  & I2_RI)  ? TIOCM_RNG : 0)
2038               | ((pCh->dataSetIn  & I2_DSR) ? TIOCM_DSR : 0)
2039               | ((pCh->dataSetIn  & I2_CTS) ? TIOCM_CTS : 0);
2040 }
2041
2042 static int ip2_tiocmset(struct tty_struct *tty, struct file *file,
2043                         unsigned int set, unsigned int clear)
2044 {
2045         i2ChanStrPtr pCh = DevTable[tty->index];
2046
2047         if (pCh == NULL)
2048                 return -ENODEV;
2049
2050         if (set & TIOCM_RTS) {
2051                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_RTSUP);
2052                 pCh->dataSetOut |= I2_RTS;
2053         }
2054         if (set & TIOCM_DTR) {
2055                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_DTRUP);
2056                 pCh->dataSetOut |= I2_DTR;
2057         }
2058
2059         if (clear & TIOCM_RTS) {
2060                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_RTSDN);
2061                 pCh->dataSetOut &= ~I2_RTS;
2062         }
2063         if (clear & TIOCM_DTR) {
2064                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_DTRDN);
2065                 pCh->dataSetOut &= ~I2_DTR;
2066         }
2067         serviceOutgoingFifo( pCh->pMyBord );
2068         return 0;
2069 }
2070
2071 /******************************************************************************/
2072 /* Function:   ip2_ioctl()                                                    */
2073 /* Parameters: Pointer to tty structure                                       */
2074 /*             Pointer to file structure                                      */
2075 /*             Command                                                        */
2076 /*             Argument                                                       */
2077 /* Returns:    Success or failure                                             */
2078 /*                                                                            */
2079 /* Description:                                                               */
2080 /*                                                                            */
2081 /*                                                                            */
2082 /******************************************************************************/
2083 static int
2084 ip2_ioctl ( PTTY tty, struct file *pFile, UINT cmd, ULONG arg )
2085 {
2086         wait_queue_t wait;
2087         i2ChanStrPtr pCh = DevTable[tty->index];
2088         i2eBordStrPtr pB;
2089         struct async_icount cprev, cnow;        /* kernel counter temps */
2090         struct serial_icounter_struct __user *p_cuser;
2091         int rc = 0;
2092         unsigned long flags;
2093         void __user *argp = (void __user *)arg;
2094
2095         if ( pCh == NULL )
2096                 return -ENODEV;
2097
2098         pB = pCh->pMyBord;
2099
2100         ip2trace (CHANN, ITRC_IOCTL, ITRC_ENTER, 2, cmd, arg );
2101
2102 #ifdef IP2DEBUG_IOCTL
2103         printk(KERN_DEBUG "IP2: ioctl cmd (%x), arg (%lx)\n", cmd, arg );
2104 #endif
2105
2106         switch(cmd) {
2107         case TIOCGSERIAL:
2108
2109                 ip2trace (CHANN, ITRC_IOCTL, 2, 1, rc );
2110
2111                 rc = get_serial_info(pCh, argp);
2112                 if (rc)
2113                         return rc;
2114                 break;
2115
2116         case TIOCSSERIAL:
2117
2118                 ip2trace (CHANN, ITRC_IOCTL, 3, 1, rc );
2119
2120                 rc = set_serial_info(pCh, argp);
2121                 if (rc)
2122                         return rc;
2123                 break;
2124
2125         case TCXONC:
2126                 rc = tty_check_change(tty);
2127                 if (rc)
2128                         return rc;
2129                 switch (arg) {
2130                 case TCOOFF:
2131                         //return  -ENOIOCTLCMD;
2132                         break;
2133                 case TCOON:
2134                         //return  -ENOIOCTLCMD;
2135                         break;
2136                 case TCIOFF:
2137                         if (STOP_CHAR(tty) != __DISABLED_CHAR) {
2138                                 i2QueueCommands( PTYPE_BYPASS, pCh, 100, 1,
2139                                                 CMD_XMIT_NOW(STOP_CHAR(tty)));
2140                         }
2141                         break;
2142                 case TCION:
2143                         if (START_CHAR(tty) != __DISABLED_CHAR) {
2144                                 i2QueueCommands( PTYPE_BYPASS, pCh, 100, 1,
2145                                                 CMD_XMIT_NOW(START_CHAR(tty)));
2146                         }
2147                         break;
2148                 default:
2149                         return -EINVAL;
2150                 }
2151                 return 0;
2152
2153         case TCSBRK:   /* SVID version: non-zero arg --> no break */
2154                 rc = tty_check_change(tty);
2155
2156                 ip2trace (CHANN, ITRC_IOCTL, 4, 1, rc );
2157
2158                 if (!rc) {
2159                         ip2_wait_until_sent(tty,0);
2160                         if (!arg) {
2161                                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_SEND_BRK(250));
2162                                 serviceOutgoingFifo( pCh->pMyBord );
2163                         }
2164                 }
2165                 break;
2166
2167         case TCSBRKP:  /* support for POSIX tcsendbreak() */
2168                 rc = tty_check_change(tty);
2169
2170                 ip2trace (CHANN, ITRC_IOCTL, 5, 1, rc );
2171
2172                 if (!rc) {
2173                         ip2_wait_until_sent(tty,0);
2174                         i2QueueCommands(PTYPE_INLINE, pCh, 100, 1,
2175                                 CMD_SEND_BRK(arg ? arg*100 : 250));
2176                         serviceOutgoingFifo ( pCh->pMyBord );   
2177                 }
2178                 break;
2179
2180         case TIOCGSOFTCAR:
2181
2182                 ip2trace (CHANN, ITRC_IOCTL, 6, 1, rc );
2183
2184                         rc = put_user(C_CLOCAL(tty) ? 1 : 0, (unsigned long __user *)argp);
2185                 if (rc) 
2186                         return rc;
2187         break;
2188
2189         case TIOCSSOFTCAR:
2190
2191                 ip2trace (CHANN, ITRC_IOCTL, 7, 1, rc );
2192
2193                 rc = get_user(arg,(unsigned long __user *) argp);
2194                 if (rc) 
2195                         return rc;
2196                 tty->termios->c_cflag = ((tty->termios->c_cflag & ~CLOCAL)
2197                                          | (arg ? CLOCAL : 0));
2198                 
2199                 break;
2200
2201         /*
2202          * Wait for any of the 4 modem inputs (DCD,RI,DSR,CTS) to change - mask
2203          * passed in arg for lines of interest (use |'ed TIOCM_RNG/DSR/CD/CTS
2204          * for masking). Caller should use TIOCGICOUNT to see which one it was
2205          */
2206         case TIOCMIWAIT:
2207                 WRITE_LOCK_IRQSAVE(&pB->read_fifo_spinlock, flags);
2208                 cprev = pCh->icount;     /* note the counters on entry */
2209                 WRITE_UNLOCK_IRQRESTORE(&pB->read_fifo_spinlock, flags);
2210                 i2QueueCommands(PTYPE_BYPASS, pCh, 100, 4, 
2211                                                 CMD_DCD_REP, CMD_CTS_REP, CMD_DSR_REP, CMD_RI_REP);
2212                 init_waitqueue_entry(&wait, current);
2213                 add_wait_queue(&pCh->delta_msr_wait, &wait);
2214                 set_current_state( TASK_INTERRUPTIBLE );
2215
2216                 serviceOutgoingFifo( pCh->pMyBord );
2217                 for(;;) {
2218                         ip2trace (CHANN, ITRC_IOCTL, 10, 0 );
2219
2220                         schedule();
2221
2222                         ip2trace (CHANN, ITRC_IOCTL, 11, 0 );
2223
2224                         /* see if a signal did it */
2225                         if (signal_pending(current)) {
2226                                 rc = -ERESTARTSYS;
2227                                 break;
2228                         }
2229                         WRITE_LOCK_IRQSAVE(&pB->read_fifo_spinlock, flags);
2230                         cnow = pCh->icount; /* atomic copy */
2231                         WRITE_UNLOCK_IRQRESTORE(&pB->read_fifo_spinlock, flags);
2232                         if (cnow.rng == cprev.rng && cnow.dsr == cprev.dsr &&
2233                                 cnow.dcd == cprev.dcd && cnow.cts == cprev.cts) {
2234                                 rc =  -EIO; /* no change => rc */
2235                                 break;
2236                         }
2237                         if (((arg & TIOCM_RNG) && (cnow.rng != cprev.rng)) ||
2238                             ((arg & TIOCM_DSR) && (cnow.dsr != cprev.dsr)) ||
2239                             ((arg & TIOCM_CD)  && (cnow.dcd != cprev.dcd)) ||
2240                             ((arg & TIOCM_CTS) && (cnow.cts != cprev.cts)) ) {
2241                                 rc =  0;
2242                                 break;
2243                         }
2244                         cprev = cnow;
2245                 }
2246                 set_current_state( TASK_RUNNING );
2247                 remove_wait_queue(&pCh->delta_msr_wait, &wait);
2248
2249                 i2QueueCommands(PTYPE_BYPASS, pCh, 100, 3, 
2250                                                  CMD_CTS_NREP, CMD_DSR_NREP, CMD_RI_NREP);
2251                 if ( ! (pCh->flags      & ASYNC_CHECK_CD)) {
2252                         i2QueueCommands(PTYPE_BYPASS, pCh, 100, 1, CMD_DCD_NREP);
2253                 }
2254                 serviceOutgoingFifo( pCh->pMyBord );
2255                 return rc;
2256                 break;
2257
2258         /*
2259          * Get counter of input serial line interrupts (DCD,RI,DSR,CTS)
2260          * Return: write counters to the user passed counter struct
2261          * NB: both 1->0 and 0->1 transitions are counted except for RI where
2262          * only 0->1 is counted. The controller is quite capable of counting
2263          * both, but this done to preserve compatibility with the standard
2264          * serial driver.
2265          */
2266         case TIOCGICOUNT:
2267                 ip2trace (CHANN, ITRC_IOCTL, 11, 1, rc );
2268
2269                 WRITE_LOCK_IRQSAVE(&pB->read_fifo_spinlock, flags);
2270                 cnow = pCh->icount;
2271                 WRITE_UNLOCK_IRQRESTORE(&pB->read_fifo_spinlock, flags);
2272                 p_cuser = argp;
2273                 rc = put_user(cnow.cts, &p_cuser->cts);
2274                 rc = put_user(cnow.dsr, &p_cuser->dsr);
2275                 rc = put_user(cnow.rng, &p_cuser->rng);
2276                 rc = put_user(cnow.dcd, &p_cuser->dcd);
2277                 rc = put_user(cnow.rx, &p_cuser->rx);
2278                 rc = put_user(cnow.tx, &p_cuser->tx);
2279                 rc = put_user(cnow.frame, &p_cuser->frame);
2280                 rc = put_user(cnow.overrun, &p_cuser->overrun);
2281                 rc = put_user(cnow.parity, &p_cuser->parity);
2282                 rc = put_user(cnow.brk, &p_cuser->brk);
2283                 rc = put_user(cnow.buf_overrun, &p_cuser->buf_overrun);
2284                 break;
2285
2286         /*
2287          * The rest are not supported by this driver. By returning -ENOIOCTLCMD they
2288          * will be passed to the line discipline for it to handle.
2289          */
2290         case TIOCSERCONFIG:
2291         case TIOCSERGWILD:
2292         case TIOCSERGETLSR:
2293         case TIOCSERSWILD:
2294         case TIOCSERGSTRUCT:
2295         case TIOCSERGETMULTI:
2296         case TIOCSERSETMULTI:
2297
2298         default:
2299                 ip2trace (CHANN, ITRC_IOCTL, 12, 0 );
2300
2301                 rc =  -ENOIOCTLCMD;
2302                 break;
2303         }
2304
2305         ip2trace (CHANN, ITRC_IOCTL, ITRC_RETURN, 0 );
2306
2307         return rc;
2308 }
2309
2310 /******************************************************************************/
2311 /* Function:   GetSerialInfo()                                                */
2312 /* Parameters: Pointer to channel structure                                   */
2313 /*             Pointer to old termios structure                               */
2314 /* Returns:    Nothing                                                        */
2315 /*                                                                            */
2316 /* Description:                                                               */
2317 /* This is to support the setserial command, and requires processing of the   */
2318 /* standard Linux serial structure.                                           */
2319 /******************************************************************************/
2320 static int
2321 get_serial_info ( i2ChanStrPtr pCh, struct serial_struct __user *retinfo )
2322 {
2323         struct serial_struct tmp;
2324
2325         memset ( &tmp, 0, sizeof(tmp) );
2326         tmp.type = pCh->pMyBord->channelBtypes.bid_value[(pCh->port_index & (IP2_PORTS_PER_BOARD-1))/16];
2327         if (BID_HAS_654(tmp.type)) {
2328                 tmp.type = PORT_16650;
2329         } else {
2330                 tmp.type = PORT_CIRRUS;
2331         }
2332         tmp.line = pCh->port_index;
2333         tmp.port = pCh->pMyBord->i2eBase;
2334         tmp.irq  = ip2config.irq[pCh->port_index/64];
2335         tmp.flags = pCh->flags;
2336         tmp.baud_base = pCh->BaudBase;
2337         tmp.close_delay = pCh->ClosingDelay;
2338         tmp.closing_wait = pCh->ClosingWaitTime;
2339         tmp.custom_divisor = pCh->BaudDivisor;
2340         return copy_to_user(retinfo,&tmp,sizeof(*retinfo));
2341 }
2342
2343 /******************************************************************************/
2344 /* Function:   SetSerialInfo()                                                */
2345 /* Parameters: Pointer to channel structure                                   */
2346 /*             Pointer to old termios structure                               */
2347 /* Returns:    Nothing                                                        */
2348 /*                                                                            */
2349 /* Description:                                                               */
2350 /* This function provides support for setserial, which uses the TIOCSSERIAL   */
2351 /* ioctl. Not all setserial parameters are relevant. If the user attempts to  */
2352 /* change the IRQ, address or type of the port the ioctl fails.               */
2353 /******************************************************************************/
2354 static int
2355 set_serial_info( i2ChanStrPtr pCh, struct serial_struct __user *new_info )
2356 {
2357         struct serial_struct ns;
2358         int   old_flags, old_baud_divisor;
2359
2360         if (copy_from_user(&ns, new_info, sizeof (ns)))
2361                 return -EFAULT;
2362
2363         /*
2364          * We don't allow setserial to change IRQ, board address, type or baud
2365          * base. Also line nunber as such is meaningless but we use it for our
2366          * array index so it is fixed also.
2367          */
2368         if ( (ns.irq        != ip2config.irq[pCh->port_index])
2369             || ((int) ns.port      != ((int) (pCh->pMyBord->i2eBase)))
2370             || (ns.baud_base != pCh->BaudBase)
2371             || (ns.line      != pCh->port_index) ) {
2372                 return -EINVAL;
2373         }
2374
2375         old_flags = pCh->flags;
2376         old_baud_divisor = pCh->BaudDivisor;
2377
2378         if ( !capable(CAP_SYS_ADMIN) ) {
2379                 if ( ( ns.close_delay != pCh->ClosingDelay ) ||
2380                     ( (ns.flags & ~ASYNC_USR_MASK) !=
2381                       (pCh->flags & ~ASYNC_USR_MASK) ) ) {
2382                         return -EPERM;
2383                 }
2384
2385                 pCh->flags = (pCh->flags & ~ASYNC_USR_MASK) |
2386                                (ns.flags & ASYNC_USR_MASK);
2387                 pCh->BaudDivisor = ns.custom_divisor;
2388         } else {
2389                 pCh->flags = (pCh->flags & ~ASYNC_FLAGS) |
2390                                (ns.flags & ASYNC_FLAGS);
2391                 pCh->BaudDivisor = ns.custom_divisor;
2392                 pCh->ClosingDelay = ns.close_delay * HZ/100;
2393                 pCh->ClosingWaitTime = ns.closing_wait * HZ/100;
2394         }
2395
2396         if ( ( (old_flags & ASYNC_SPD_MASK) != (pCh->flags & ASYNC_SPD_MASK) )
2397             || (old_baud_divisor != pCh->BaudDivisor) ) {
2398                 // Invalidate speed and reset parameters
2399                 set_params( pCh, NULL );
2400         }
2401
2402         return 0;
2403 }
2404
2405 /******************************************************************************/
2406 /* Function:   ip2_set_termios()                                              */
2407 /* Parameters: Pointer to tty structure                                       */
2408 /*             Pointer to old termios structure                               */
2409 /* Returns:    Nothing                                                        */
2410 /*                                                                            */
2411 /* Description:                                                               */
2412 /*                                                                            */
2413 /*                                                                            */
2414 /******************************************************************************/
2415 static void
2416 ip2_set_termios( PTTY tty, struct ktermios *old_termios )
2417 {
2418         i2ChanStrPtr pCh = (i2ChanStrPtr)tty->driver_data;
2419
2420 #ifdef IP2DEBUG_IOCTL
2421         printk (KERN_DEBUG "IP2: set termios %p\n", old_termios );
2422 #endif
2423
2424         set_params( pCh, old_termios );
2425 }
2426
2427 /******************************************************************************/
2428 /* Function:   ip2_set_line_discipline()                                      */
2429 /* Parameters: Pointer to tty structure                                       */
2430 /* Returns:    Nothing                                                        */
2431 /*                                                                            */
2432 /* Description:  Does nothing                                                 */
2433 /*                                                                            */
2434 /*                                                                            */
2435 /******************************************************************************/
2436 static void
2437 ip2_set_line_discipline ( PTTY tty )
2438 {
2439 #ifdef IP2DEBUG_IOCTL
2440         printk (KERN_DEBUG "IP2: set line discipline\n" );
2441 #endif
2442
2443         ip2trace (((i2ChanStrPtr)tty->driver_data)->port_index, ITRC_IOCTL, 16, 0 );
2444
2445 }
2446
2447 /******************************************************************************/
2448 /* Function:   SetLine Characteristics()                                      */
2449 /* Parameters: Pointer to channel structure                                   */
2450 /* Returns:    Nothing                                                        */
2451 /*                                                                            */
2452 /* Description:                                                               */
2453 /* This routine is called to update the channel structure with the new line   */
2454 /* characteristics, and send the appropriate commands to the board when they  */
2455 /* change.                                                                    */
2456 /******************************************************************************/
2457 static void
2458 set_params( i2ChanStrPtr pCh, struct ktermios *o_tios )
2459 {
2460         tcflag_t cflag, iflag, lflag;
2461         char stop_char, start_char;
2462         struct ktermios dummy;
2463
2464         lflag = pCh->pTTY->termios->c_lflag;
2465         cflag = pCh->pTTY->termios->c_cflag;
2466         iflag = pCh->pTTY->termios->c_iflag;
2467
2468         if (o_tios == NULL) {
2469                 dummy.c_lflag = ~lflag;
2470                 dummy.c_cflag = ~cflag;
2471                 dummy.c_iflag = ~iflag;
2472                 o_tios = &dummy;
2473         }
2474
2475         {
2476                 switch ( cflag & CBAUD ) {
2477                 case B0:
2478                         i2QueueCommands( PTYPE_BYPASS, pCh, 100, 2, CMD_RTSDN, CMD_DTRDN);
2479                         pCh->dataSetOut &= ~(I2_DTR | I2_RTS);
2480                         i2QueueCommands( PTYPE_INLINE, pCh, 100, 1, CMD_PAUSE(25));
2481                         pCh->pTTY->termios->c_cflag |= (CBAUD & o_tios->c_cflag);
2482                         goto service_it;
2483                         break;
2484                 case B38400:
2485                         /*
2486                          * This is the speed that is overloaded with all the other high
2487                          * speeds, depending upon the flag settings.
2488                          */
2489                         if ( ( pCh->flags & ASYNC_SPD_MASK ) == ASYNC_SPD_HI ) {
2490                                 pCh->speed = CBR_57600;
2491                         } else if ( (pCh->flags & ASYNC_SPD_MASK) == ASYNC_SPD_VHI ) {
2492                                 pCh->speed = CBR_115200;
2493                         } else if ( (pCh->flags & ASYNC_SPD_MASK) == ASYNC_SPD_CUST ) {
2494                                 pCh->speed = CBR_C1;
2495                         } else {
2496                                 pCh->speed = CBR_38400;
2497                         }
2498                         break;
2499                 case B50:      pCh->speed = CBR_50;      break;
2500                 case B75:      pCh->speed = CBR_75;      break;
2501                 case B110:     pCh->speed = CBR_110;     break;
2502                 case B134:     pCh->speed = CBR_134;     break;
2503                 case B150:     pCh->speed = CBR_150;     break;
2504                 case B200:     pCh->speed = CBR_200;     break;
2505                 case B300:     pCh->speed = CBR_300;     break;
2506                 case B600:     pCh->speed = CBR_600;     break;
2507                 case B1200:    pCh->speed = CBR_1200;    break;
2508                 case B1800:    pCh->speed = CBR_1800;    break;
2509                 case B2400:    pCh->speed = CBR_2400;    break;
2510                 case B4800:    pCh->speed = CBR_4800;    break;
2511                 case B9600:    pCh->speed = CBR_9600;    break;
2512                 case B19200:   pCh->speed = CBR_19200;   break;
2513                 case B57600:   pCh->speed = CBR_57600;   break;
2514                 case B115200:  pCh->speed = CBR_115200;  break;
2515                 case B153600:  pCh->speed = CBR_153600;  break;
2516                 case B230400:  pCh->speed = CBR_230400;  break;
2517                 case B307200:  pCh->speed = CBR_307200;  break;
2518                 case B460800:  pCh->speed = CBR_460800;  break;
2519                 case B921600:  pCh->speed = CBR_921600;  break;
2520                 default:       pCh->speed = CBR_9600;    break;
2521                 }
2522                 if ( pCh->speed == CBR_C1 ) {
2523                         // Process the custom speed parameters.
2524                         int bps = pCh->BaudBase / pCh->BaudDivisor;
2525                         if ( bps == 921600 ) {
2526                                 pCh->speed = CBR_921600;
2527                         } else {
2528                                 bps = bps/10;
2529                                 i2QueueCommands( PTYPE_INLINE, pCh, 100, 1, CMD_BAUD_DEF1(bps) );
2530                         }
2531                 }
2532                 i2QueueCommands( PTYPE_INLINE, pCh, 100, 1, CMD_SETBAUD(pCh->speed));
2533                 
2534                 i2QueueCommands ( PTYPE_INLINE, pCh, 100, 2, CMD_DTRUP, CMD_RTSUP);
2535                 pCh->dataSetOut |= (I2_DTR | I2_RTS);
2536         }
2537         if ( (CSTOPB & cflag) ^ (CSTOPB & o_tios->c_cflag)) 
2538         {
2539                 i2QueueCommands ( PTYPE_INLINE, pCh, 100, 1, 
2540                         CMD_SETSTOP( ( cflag & CSTOPB ) ? CST_2 : CST_1));
2541         }
2542         if (((PARENB|PARODD) & cflag) ^ ((PARENB|PARODD) & o_tios->c_cflag)) 
2543         {
2544                 i2QueueCommands ( PTYPE_INLINE, pCh, 100, 1,
2545                         CMD_SETPAR( 
2546                                 (cflag & PARENB ?  (cflag & PARODD ? CSP_OD : CSP_EV) : CSP_NP)
2547                         )
2548                 );
2549         }
2550         /* byte size and parity */
2551         if ( (CSIZE & cflag)^(CSIZE & o_tios->c_cflag)) 
2552         {
2553                 int datasize;
2554                 switch ( cflag & CSIZE ) {
2555                 case CS5: datasize = CSZ_5; break;
2556                 case CS6: datasize = CSZ_6; break;
2557                 case CS7: datasize = CSZ_7; break;
2558                 case CS8: datasize = CSZ_8; break;
2559                 default:  datasize = CSZ_5; break;      /* as per serial.c */
2560                 }
2561                 i2QueueCommands ( PTYPE_INLINE, pCh, 100, 1, CMD_SETBITS(datasize) );
2562         }
2563         /* Process CTS flow control flag setting */
2564         if ( (cflag & CRTSCTS) ) {
2565                 i2QueueCommands(PTYPE_INLINE, pCh, 100,
2566                                                 2, CMD_CTSFL_ENAB, CMD_RTSFL_ENAB);
2567         } else {
2568                 i2QueueCommands(PTYPE_INLINE, pCh, 100,
2569                                                 2, CMD_CTSFL_DSAB, CMD_RTSFL_DSAB);
2570         }
2571         //
2572         // Process XON/XOFF flow control flags settings
2573         //
2574         stop_char = STOP_CHAR(pCh->pTTY);
2575         start_char = START_CHAR(pCh->pTTY);
2576
2577         //////////// can't be \000
2578         if (stop_char == __DISABLED_CHAR ) 
2579         {
2580                 stop_char = ~__DISABLED_CHAR; 
2581         }
2582         if (start_char == __DISABLED_CHAR ) 
2583         {
2584                 start_char = ~__DISABLED_CHAR;
2585         }
2586         /////////////////////////////////
2587
2588         if ( o_tios->c_cc[VSTART] != start_char ) 
2589         {
2590                 i2QueueCommands(PTYPE_BYPASS, pCh, 100, 1, CMD_DEF_IXON(start_char));
2591                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_DEF_OXON(start_char));
2592         }
2593         if ( o_tios->c_cc[VSTOP] != stop_char ) 
2594         {
2595                  i2QueueCommands(PTYPE_BYPASS, pCh, 100, 1, CMD_DEF_IXOFF(stop_char));
2596                  i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_DEF_OXOFF(stop_char));
2597         }
2598         if (stop_char == __DISABLED_CHAR ) 
2599         {
2600                 stop_char = ~__DISABLED_CHAR;  //TEST123
2601                 goto no_xoff;
2602         }
2603         if ((iflag & (IXOFF))^(o_tios->c_iflag & (IXOFF))) 
2604         {
2605                 if ( iflag & IXOFF ) {  // Enable XOFF output flow control
2606                         i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_OXON_OPT(COX_XON));
2607                 } else {        // Disable XOFF output flow control
2608 no_xoff:
2609                         i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_OXON_OPT(COX_NONE));
2610                 }
2611         }
2612         if (start_char == __DISABLED_CHAR ) 
2613         {
2614                 goto no_xon;
2615         }
2616         if ((iflag & (IXON|IXANY)) ^ (o_tios->c_iflag & (IXON|IXANY))) 
2617         {
2618                 if ( iflag & IXON ) {
2619                         if ( iflag & IXANY ) { // Enable XON/XANY output flow control
2620                                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_IXON_OPT(CIX_XANY));
2621                         } else { // Enable XON output flow control
2622                                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_IXON_OPT(CIX_XON));
2623                         }
2624                 } else { // Disable XON output flow control
2625 no_xon:
2626                         i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_IXON_OPT(CIX_NONE));
2627                 }
2628         }
2629         if ( (iflag & ISTRIP) ^ ( o_tios->c_iflag & (ISTRIP)) ) 
2630         {
2631                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, 
2632                                 CMD_ISTRIP_OPT((iflag & ISTRIP ? 1 : 0)));
2633         }
2634         if ( (iflag & INPCK) ^ ( o_tios->c_iflag & (INPCK)) ) 
2635         {
2636                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, 
2637                                 CMD_PARCHK((iflag & INPCK) ? CPK_ENAB : CPK_DSAB));
2638         }
2639
2640         if ( (iflag & (IGNBRK|PARMRK|BRKINT|IGNPAR)) 
2641                         ^       ( o_tios->c_iflag & (IGNBRK|PARMRK|BRKINT|IGNPAR)) ) 
2642         {
2643                 char brkrpt = 0;
2644                 char parrpt = 0;
2645
2646                 if ( iflag & IGNBRK ) { /* Ignore breaks altogether */
2647                         /* Ignore breaks altogether */
2648                         i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_BRK_NREP);
2649                 } else {
2650                         if ( iflag & BRKINT ) {
2651                                 if ( iflag & PARMRK ) {
2652                                         brkrpt = 0x0a;  // exception an inline triple
2653                                 } else {
2654                                         brkrpt = 0x1a;  // exception and NULL
2655                                 }
2656                                 brkrpt |= 0x04; // flush input
2657                         } else {
2658                                 if ( iflag & PARMRK ) {
2659                                         brkrpt = 0x0b;  //POSIX triple \0377 \0 \0
2660                                 } else {
2661                                         brkrpt = 0x01;  // Null only
2662                                 }
2663                         }
2664                         i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_BRK_REP(brkrpt));
2665                 } 
2666
2667                 if (iflag & IGNPAR) {
2668                         parrpt = 0x20;
2669                                                                                                         /* would be 2 for not cirrus bug */
2670                                                                                                         /* would be 0x20 cept for cirrus bug */
2671                 } else {
2672                         if ( iflag & PARMRK ) {
2673                                 /*
2674                                  * Replace error characters with 3-byte sequence (\0377,\0,char)
2675                                  */
2676                                 parrpt = 0x04 ;
2677                                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_ISTRIP_OPT((char)0));
2678                         } else {
2679                                 parrpt = 0x03;
2680                         } 
2681                 }
2682                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_SET_ERROR(parrpt));
2683         }
2684         if (cflag & CLOCAL) {
2685                 // Status reporting fails for DCD if this is off
2686                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_DCD_NREP);
2687                 pCh->flags &= ~ASYNC_CHECK_CD;
2688         } else {
2689                 i2QueueCommands(PTYPE_INLINE, pCh, 100, 1, CMD_DCD_REP);
2690                 pCh->flags      |= ASYNC_CHECK_CD;
2691         }
2692
2693 service_it:
2694         i2DrainOutput( pCh, 100 );              
2695 }
2696
2697 /******************************************************************************/
2698 /* IPL Device Section                                                         */
2699 /******************************************************************************/
2700
2701 /******************************************************************************/
2702 /* Function:   ip2_ipl_read()                                                  */
2703 /* Parameters: Pointer to device inode                                        */
2704 /*             Pointer to file structure                                      */
2705 /*             Pointer to data                                                */
2706 /*             Number of bytes to read                                        */
2707 /* Returns:    Success or failure                                             */
2708 /*                                                                            */
2709 /* Description:   Ugly                                                        */
2710 /*                                                                            */
2711 /*                                                                            */
2712 /******************************************************************************/
2713
2714 static 
2715 ssize_t
2716 ip2_ipl_read(struct file *pFile, char __user *pData, size_t count, loff_t *off )
2717 {
2718         unsigned int minor = iminor(pFile->f_path.dentry->d_inode);
2719         int rc = 0;
2720
2721 #ifdef IP2DEBUG_IPL
2722         printk (KERN_DEBUG "IP2IPL: read %p, %d bytes\n", pData, count );
2723 #endif
2724
2725         switch( minor ) {
2726         case 0:     // IPL device
2727                 rc = -EINVAL;
2728                 break;
2729         case 1:     // Status dump
2730                 rc = -EINVAL;
2731                 break;
2732         case 2:     // Ping device
2733                 rc = -EINVAL;
2734                 break;
2735         case 3:     // Trace device
2736                 rc = DumpTraceBuffer ( pData, count );
2737                 break;
2738         case 4:     // Trace device
2739                 rc = DumpFifoBuffer ( pData, count );
2740                 break;
2741         default:
2742                 rc = -ENODEV;
2743                 break;
2744         }
2745         return rc;
2746 }
2747
2748 static int
2749 DumpFifoBuffer ( char __user *pData, int count )
2750 {
2751 #ifdef DEBUG_FIFO
2752         int rc;
2753         rc = copy_to_user(pData, DBGBuf, count);
2754
2755         printk(KERN_DEBUG "Last index %d\n", I );
2756
2757         return count;
2758 #endif  /* DEBUG_FIFO */
2759         return 0;
2760 }
2761
2762 static int
2763 DumpTraceBuffer ( char __user *pData, int count )
2764 {
2765 #ifdef IP2DEBUG_TRACE
2766         int rc;
2767         int dumpcount;
2768         int chunk;
2769         int *pIndex = (int __user *)pData;
2770
2771         if ( count < (sizeof(int) * 6) ) {
2772                 return -EIO;
2773         }
2774         rc = put_user(tracewrap, pIndex );
2775         rc = put_user(TRACEMAX, ++pIndex );
2776         rc = put_user(tracestrip, ++pIndex );
2777         rc = put_user(tracestuff, ++pIndex );
2778         pData += sizeof(int) * 6;
2779         count -= sizeof(int) * 6;
2780
2781         dumpcount = tracestuff - tracestrip;
2782         if ( dumpcount < 0 ) {
2783                 dumpcount += TRACEMAX;
2784         }
2785         if ( dumpcount > count ) {
2786                 dumpcount = count;
2787         }
2788         chunk = TRACEMAX - tracestrip;
2789         if ( dumpcount > chunk ) {
2790                 rc = copy_to_user(pData, &tracebuf[tracestrip],
2791                               chunk * sizeof(tracebuf[0]) );
2792                 pData += chunk * sizeof(tracebuf[0]);
2793                 tracestrip = 0;
2794                 chunk = dumpcount - chunk;
2795         } else {
2796                 chunk = dumpcount;
2797         }
2798         rc = copy_to_user(pData, &tracebuf[tracestrip],
2799                       chunk * sizeof(tracebuf[0]) );
2800         tracestrip += chunk;
2801         tracewrap = 0;
2802
2803         rc = put_user(tracestrip, ++pIndex );
2804         rc = put_user(tracestuff, ++pIndex );
2805
2806         return dumpcount;
2807 #else
2808         return 0;
2809 #endif
2810 }
2811
2812 /******************************************************************************/
2813 /* Function:   ip2_ipl_write()                                                 */
2814 /* Parameters:                                                                */
2815 /*             Pointer to file structure                                      */
2816 /*             Pointer to data                                                */
2817 /*             Number of bytes to write                                       */
2818 /* Returns:    Success or failure                                             */
2819 /*                                                                            */
2820 /* Description:                                                               */
2821 /*                                                                            */
2822 /*                                                                            */
2823 /******************************************************************************/
2824 static ssize_t
2825 ip2_ipl_write(struct file *pFile, const char __user *pData, size_t count, loff_t *off)
2826 {
2827 #ifdef IP2DEBUG_IPL
2828         printk (KERN_DEBUG "IP2IPL: write %p, %d bytes\n", pData, count );
2829 #endif
2830         return 0;
2831 }
2832
2833 /******************************************************************************/
2834 /* Function:   ip2_ipl_ioctl()                                                */
2835 /* Parameters: Pointer to device inode                                        */
2836 /*             Pointer to file structure                                      */
2837 /*             Command                                                        */
2838 /*             Argument                                                       */
2839 /* Returns:    Success or failure                                             */
2840 /*                                                                            */
2841 /* Description:                                                               */
2842 /*                                                                            */
2843 /*                                                                            */
2844 /******************************************************************************/
2845 static int
2846 ip2_ipl_ioctl ( struct inode *pInode, struct file *pFile, UINT cmd, ULONG arg )
2847 {
2848         unsigned int iplminor = iminor(pInode);
2849         int rc = 0;
2850         void __user *argp = (void __user *)arg;
2851         ULONG __user *pIndex = argp;
2852         i2eBordStrPtr pB = i2BoardPtrTable[iplminor / 4];
2853         i2ChanStrPtr pCh;
2854
2855 #ifdef IP2DEBUG_IPL
2856         printk (KERN_DEBUG "IP2IPL: ioctl cmd %d, arg %ld\n", cmd, arg );
2857 #endif
2858
2859         switch ( iplminor ) {
2860         case 0:     // IPL device
2861                 rc = -EINVAL;
2862                 break;
2863         case 1:     // Status dump
2864         case 5:
2865         case 9:
2866         case 13:
2867                 switch ( cmd ) {
2868                 case 64:        /* Driver - ip2stat */
2869                         rc = put_user(ip2_tty_driver->refcount, pIndex++ );
2870                         rc = put_user(irq_counter, pIndex++  );
2871                         rc = put_user(bh_counter, pIndex++  );
2872                         break;
2873
2874                 case 65:        /* Board  - ip2stat */
2875                         if ( pB ) {
2876                                 rc = copy_to_user(argp, pB, sizeof(i2eBordStr));
2877                                 rc = put_user(INB(pB->i2eStatus),
2878                                         (ULONG __user *)(arg + (ULONG)(&pB->i2eStatus) - (ULONG)pB ) );
2879                         } else {
2880                                 rc = -ENODEV;
2881                         }
2882                         break;
2883
2884                 default:
2885                         if (cmd < IP2_MAX_PORTS) {
2886                                 pCh = DevTable[cmd];
2887                                 if ( pCh )
2888                                 {
2889                                         rc = copy_to_user(argp, pCh, sizeof(i2ChanStr));
2890                                 } else {
2891                                         rc = -ENODEV;
2892                                 }
2893                         } else {
2894                                 rc = -EINVAL;
2895                         }
2896                 }
2897                 break;
2898
2899         case 2:     // Ping device
2900                 rc = -EINVAL;
2901                 break;
2902         case 3:     // Trace device
2903                 /*
2904                  * akpm: This used to write a whole bunch of function addresses
2905                  * to userspace, which generated lots of put_user() warnings.
2906                  * I killed it all.  Just return "success" and don't do
2907                  * anything.
2908                  */
2909                 if (cmd == 1)
2910                         rc = 0;
2911                 else
2912                         rc = -EINVAL;
2913                 break;
2914
2915         default:
2916                 rc = -ENODEV;
2917                 break;
2918         }
2919         return rc;
2920 }
2921
2922 /******************************************************************************/
2923 /* Function:   ip2_ipl_open()                                                 */
2924 /* Parameters: Pointer to device inode                                        */
2925 /*             Pointer to file structure                                      */
2926 /* Returns:    Success or failure                                             */
2927 /*                                                                            */
2928 /* Description:                                                               */
2929 /*                                                                            */
2930 /*                                                                            */
2931 /******************************************************************************/
2932 static int
2933 ip2_ipl_open( struct inode *pInode, struct file *pFile )
2934 {
2935         unsigned int iplminor = iminor(pInode);
2936         i2eBordStrPtr pB;
2937         i2ChanStrPtr  pCh;
2938
2939 #ifdef IP2DEBUG_IPL
2940         printk (KERN_DEBUG "IP2IPL: open\n" );
2941 #endif
2942
2943         switch(iplminor) {
2944         // These are the IPL devices
2945         case 0:
2946         case 4:
2947         case 8:
2948         case 12:
2949                 break;
2950
2951         // These are the status devices
2952         case 1:
2953         case 5:
2954         case 9:
2955         case 13:
2956                 break;
2957
2958         // These are the debug devices
2959         case 2:
2960         case 6:
2961         case 10:
2962         case 14:
2963                 pB = i2BoardPtrTable[iplminor / 4];
2964                 pCh = (i2ChanStrPtr) pB->i2eChannelPtr;
2965                 break;
2966
2967         // This is the trace device
2968         case 3:
2969                 break;
2970         }
2971         return 0;
2972 }
2973 /******************************************************************************/
2974 /* Function:   ip2_read_procmem                                               */
2975 /* Parameters:                                                                */
2976 /*                                                                            */
2977 /* Returns: Length of output                                                  */
2978 /*                                                                            */
2979 /* Description:                                                               */
2980 /*   Supplies some driver operating parameters                                */
2981 /*      Not real useful unless your debugging the fifo                                                    */
2982 /*                                                                            */
2983 /******************************************************************************/
2984
2985 #define LIMIT  (PAGE_SIZE - 120)
2986
2987 static int
2988 ip2_read_procmem(char *buf, char **start, off_t offset, int len)
2989 {
2990         i2eBordStrPtr  pB;
2991         i2ChanStrPtr  pCh;
2992         PTTY tty;
2993         int i;
2994
2995         len = 0;
2996
2997 #define FMTLINE "%3d: 0x%08x 0x%08x 0%011o 0%011o\n"
2998 #define FMTLIN2 "     0x%04x 0x%04x tx flow 0x%x\n"
2999 #define FMTLIN3 "     0x%04x 0x%04x rc flow\n"
3000
3001         len += sprintf(buf+len,"\n");
3002
3003         for( i = 0; i < IP2_MAX_BOARDS; ++i ) {
3004                 pB = i2BoardPtrTable[i];
3005                 if ( pB ) {
3006                         len += sprintf(buf+len,"board %d:\n",i);
3007                         len += sprintf(buf+len,"\tFifo rem: %d mty: %x outM %x\n",
3008                                 pB->i2eFifoRemains,pB->i2eWaitingForEmptyFifo,pB->i2eOutMailWaiting);
3009                 }
3010         }
3011
3012         len += sprintf(buf+len,"#: tty flags, port flags,     cflags,     iflags\n");
3013         for (i=0; i < IP2_MAX_PORTS; i++) {
3014                 if (len > LIMIT)
3015                         break;
3016                 pCh = DevTable[i];
3017                 if (pCh) {
3018                         tty = pCh->pTTY;
3019                         if (tty && tty->count) {
3020                                 len += sprintf(buf+len,FMTLINE,i,(int)tty->flags,pCh->flags,
3021                                                                         tty->termios->c_cflag,tty->termios->c_iflag);
3022
3023                                 len += sprintf(buf+len,FMTLIN2,
3024                                                 pCh->outfl.asof,pCh->outfl.room,pCh->channelNeeds);
3025                                 len += sprintf(buf+len,FMTLIN3,pCh->infl.asof,pCh->infl.room);
3026                         }
3027                 }
3028         }
3029         return len;
3030 }
3031
3032 /*
3033  * This is the handler for /proc/tty/driver/ip2
3034  *
3035  * This stretch of code has been largely plagerized from at least three
3036  * different sources including ip2mkdev.c and a couple of other drivers.
3037  * The bugs are all mine.  :-)  =mhw=
3038  */
3039 static int ip2_read_proc(char *page, char **start, off_t off,
3040                                 int count, int *eof, void *data)
3041 {
3042         int     i, j, box;
3043         int     len = 0;
3044         int     boxes = 0;
3045         int     ports = 0;
3046         int     tports = 0;
3047         off_t   begin = 0;
3048         i2eBordStrPtr  pB;
3049
3050         len += sprintf(page, "ip2info: 1.0 driver: %s\n", pcVersion );
3051         len += sprintf(page+len, "Driver: SMajor=%d CMajor=%d IMajor=%d MaxBoards=%d MaxBoxes=%d MaxPorts=%d\n",
3052                         IP2_TTY_MAJOR, IP2_CALLOUT_MAJOR, IP2_IPL_MAJOR,
3053                         IP2_MAX_BOARDS, ABS_MAX_BOXES, ABS_BIGGEST_BOX);
3054
3055         for( i = 0; i < IP2_MAX_BOARDS; ++i ) {
3056                 /* This need to be reset for a board by board count... */
3057                 boxes = 0;
3058                 pB = i2BoardPtrTable[i];
3059                 if( pB ) {
3060                         switch( pB->i2ePom.e.porID & ~POR_ID_RESERVED ) 
3061                         {
3062                         case POR_ID_FIIEX:
3063                                 len += sprintf( page+len, "Board %d: EX ports=", i );
3064                                 for( box = 0; box < ABS_MAX_BOXES; ++box )
3065                                 {
3066                                         ports = 0;
3067
3068                                         if( pB->i2eChannelMap[box] != 0 ) ++boxes;
3069                                         for( j = 0; j < ABS_BIGGEST_BOX; ++j ) 
3070                                         {
3071                                                 if( pB->i2eChannelMap[box] & 1<< j ) {
3072                                                         ++ports;
3073                                                 }
3074                                         }
3075                                         len += sprintf( page+len, "%d,", ports );
3076                                         tports += ports;
3077                                 }
3078
3079                                 --len;  /* Backup over that last comma */
3080
3081                                 len += sprintf( page+len, " boxes=%d width=%d", boxes, pB->i2eDataWidth16 ? 16 : 8 );
3082                                 break;
3083
3084                         case POR_ID_II_4:
3085                                 len += sprintf(page+len, "Board %d: ISA-4 ports=4 boxes=1", i );
3086                                 tports = ports = 4;
3087                                 break;
3088
3089                         case POR_ID_II_8:
3090                                 len += sprintf(page+len, "Board %d: ISA-8-std ports=8 boxes=1", i );
3091                                 tports = ports = 8;
3092                                 break;
3093
3094                         case POR_ID_II_8R:
3095                                 len += sprintf(page+len, "Board %d: ISA-8-RJ11 ports=8 boxes=1", i );
3096                                 tports = ports = 8;
3097                                 break;
3098
3099                         default:
3100                                 len += sprintf(page+len, "Board %d: unknown", i );
3101                                 /* Don't try and probe for minor numbers */
3102                                 tports = ports = 0;
3103                         }
3104
3105                 } else {
3106                         /* Don't try and probe for minor numbers */
3107                         len += sprintf(page+len, "Board %d: vacant", i );
3108                         tports = ports = 0;
3109                 }
3110
3111                 if( tports ) {
3112                         len += sprintf(page+len, " minors=" );
3113
3114                         for ( box = 0; box < ABS_MAX_BOXES; ++box )
3115                         {
3116                                 for ( j = 0; j < ABS_BIGGEST_BOX; ++j )
3117                                 {
3118                                         if ( pB->i2eChannelMap[box] & (1 << j) )
3119                                         {
3120                                                 len += sprintf (page+len,"%d,",
3121                                                         j + ABS_BIGGEST_BOX *
3122                                                         (box+i*ABS_MAX_BOXES));
3123                                         }
3124                                 }
3125                         }
3126
3127                         page[ len - 1 ] = '\n'; /* Overwrite that last comma */
3128                 } else {
3129                         len += sprintf (page+len,"\n" );
3130                 }
3131
3132                 if (len+begin > off+count)
3133                         break;
3134                 if (len+begin < off) {
3135                         begin += len;
3136                         len = 0;
3137                 }
3138         }
3139
3140         if (i >= IP2_MAX_BOARDS)
3141                 *eof = 1;
3142         if (off >= len+begin)
3143                 return 0;
3144
3145         *start = page + (off-begin);
3146         return ((count < begin+len-off) ? count : begin+len-off);
3147  }
3148  
3149 /******************************************************************************/
3150 /* Function:   ip2trace()                                                     */
3151 /* Parameters: Value to add to trace buffer                                   */
3152 /* Returns:    Nothing                                                        */
3153 /*                                                                            */
3154 /* Description:                                                               */
3155 /*                                                                            */
3156 /*                                                                            */
3157 /******************************************************************************/
3158 #ifdef IP2DEBUG_TRACE
3159 void
3160 ip2trace (unsigned short pn, unsigned char cat, unsigned char label, unsigned long codes, ...)
3161 {
3162         long flags;
3163         unsigned long *pCode = &codes;
3164         union ip2breadcrumb bc;
3165         i2ChanStrPtr  pCh;
3166
3167
3168         tracebuf[tracestuff++] = jiffies;
3169         if ( tracestuff == TRACEMAX ) {
3170                 tracestuff = 0;
3171         }
3172         if ( tracestuff == tracestrip ) {
3173                 if ( ++tracestrip == TRACEMAX ) {
3174                         tracestrip = 0;
3175                 }
3176                 ++tracewrap;
3177         }
3178
3179         bc.hdr.port  = 0xff & pn;
3180         bc.hdr.cat   = cat;
3181         bc.hdr.codes = (unsigned char)( codes & 0xff );
3182         bc.hdr.label = label;
3183         tracebuf[tracestuff++] = bc.value;
3184
3185         for (;;) {
3186                 if ( tracestuff == TRACEMAX ) {
3187                         tracestuff = 0;
3188                 }
3189                 if ( tracestuff == tracestrip ) {
3190                         if ( ++tracestrip == TRACEMAX ) {
3191                                 tracestrip = 0;
3192                         }
3193                         ++tracewrap;
3194                 }
3195
3196                 if ( !codes-- )
3197                         break;
3198
3199                 tracebuf[tracestuff++] = *++pCode;
3200         }
3201 }
3202 #endif
3203
3204
3205 MODULE_LICENSE("GPL");
3206
3207 static struct pci_device_id ip2main_pci_tbl[] __devinitdata = {
3208         { PCI_DEVICE(PCI_VENDOR_ID_COMPUTONE, PCI_DEVICE_ID_COMPUTONE_IP2EX) },
3209         { }
3210 };
3211
3212 MODULE_DEVICE_TABLE(pci, ip2main_pci_tbl);