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