ip2main.c
上传用户:lgb322
上传日期:2013-02-24
资源大小:30529k
文件大小:114k
源码类别:

嵌入式Linux

开发平台:

Unix_Linux

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