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

嵌入式Linux

开发平台:

Unix_Linux

  1. /*
  2. ** -----------------------------------------------------------------------------
  3. **
  4. **  Perle Specialix driver for Linux
  5. **  Ported from existing RIO Driver for SCO sources.
  6.  *
  7.  *  (C) 1990 - 2000 Specialix International Ltd., Byfleet, Surrey, UK.
  8.  *
  9.  *      This program is free software; you can redistribute it and/or modify
  10.  *      it under the terms of the GNU General Public License as published by
  11.  *      the Free Software Foundation; either version 2 of the License, or
  12.  *      (at your option) any later version.
  13.  *
  14.  *      This program is distributed in the hope that it will be useful,
  15.  *      but WITHOUT ANY WARRANTY; without even the implied warranty of
  16.  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17.  *      GNU General Public License for more details.
  18.  *
  19.  *      You should have received a copy of the GNU General Public License
  20.  *      along with this program; if not, write to the Free Software
  21.  *      Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  22. **
  23. ** Module : riointr.c
  24. ** SID : 1.2
  25. ** Last Modified : 11/6/98 10:33:44
  26. ** Retrieved : 11/6/98 10:33:49
  27. **
  28. **  ident @(#)riointr.c 1.2
  29. **
  30. ** -----------------------------------------------------------------------------
  31. */
  32. #ifdef SCCS_LABELS
  33. static char *_riointr_c_sccs_ = "@(#)riointr.c 1.2";
  34. #endif
  35. #define __NO_VERSION__
  36. #include <linux/module.h>
  37. #include <linux/slab.h>
  38. #include <linux/errno.h>
  39. #include <linux/tty.h>
  40. #include <asm/io.h>
  41. #include <asm/system.h>
  42. #include <asm/string.h>
  43. #include <asm/semaphore.h>
  44. #include <asm/uaccess.h>
  45. #include <linux/termios.h>
  46. #include <linux/serial.h>
  47. #include <linux/compatmac.h>
  48. #include <linux/generic_serial.h>
  49. #include <linux/delay.h>
  50. #include "linux_compat.h"
  51. #include "rio_linux.h"
  52. #include "typdef.h"
  53. #include "pkt.h"
  54. #include "daemon.h"
  55. #include "rio.h"
  56. #include "riospace.h"
  57. #include "top.h"
  58. #include "cmdpkt.h"
  59. #include "map.h"
  60. #include "riotypes.h"
  61. #include "rup.h"
  62. #include "port.h"
  63. #include "riodrvr.h"
  64. #include "rioinfo.h"
  65. #include "func.h"
  66. #include "errors.h"
  67. #include "pci.h"
  68. #include "parmmap.h"
  69. #include "unixrup.h"
  70. #include "board.h"
  71. #include "host.h"
  72. #include "error.h"
  73. #include "phb.h"
  74. #include "link.h"
  75. #include "cmdblk.h"
  76. #include "route.h"
  77. #include "control.h"
  78. #include "cirrus.h"
  79. #include "rioioctl.h"
  80. /*
  81. ** riopoll is called every clock tick. Once the /dev/rio device has been
  82. ** opened, and polldistributed( ) has been called, this routine is called
  83. ** every clock tick *by every cpu*. The 'interesting' piece of code that
  84. ** manipulates 'RIONumCpus' and 'RIOCpuCountdown' is used to fair-share
  85. ** the work between the CPUs. If there are 'N' cpus, then each poll time
  86. ** we increment a counter, modulo 'N-1'. When this counter is 0, we call
  87. ** the interrupt handler. This has the effect that polls are serviced
  88. ** by processor 'N', 'N-1', 'N-2', ... '0', round and round. Neat.
  89. */
  90. void
  91. riopoll(p)
  92. struct rio_info * p;
  93. {
  94. int   host;
  95. /*
  96. ** Here's the deal. We try to fair share as much as possible amongst
  97. ** all the processors that are available. Since each processor 
  98. ** should generate HZ ticks per second and since we only need HZ ticks
  99. ** in total for proper operation we simply attempt to cycle round each
  100. ** processor in turn, using RIOCpuCountdown to decide whether to call
  101. ** the interrupt routine. ( In fact the count zeroes when it reaches
  102. ** one less than the total number of processors - so e.g. on a two
  103. ** processor system RIOService will get called 2*HZ times per second. )
  104. ** this_cpu (cur_cpu()) tells us the number of the current processor
  105. ** as follows:
  106. **
  107. ** 0 - default CPU
  108. ** 1 - first extra CPU
  109. ** 2 - second extra CPU
  110. ** etc.
  111. */
  112. /*
  113. ** okay, we've got a cpu that hasn't had a go recently 
  114. ** - lets check to see what needs doing.
  115. */
  116. for ( host=0; host<p->RIONumHosts; host++ ) {
  117. struct Host *HostP = &p->RIOHosts[host];
  118. rio_spin_lock( &HostP->HostLock );
  119. if ( ( (HostP->Flags & RUN_STATE) != RC_RUNNING ) ||
  120.      HostP->InIntr ) {
  121. rio_spin_unlock (&HostP->HostLock); 
  122. continue;
  123. }
  124. if ( RWORD( HostP->ParmMapP->rup_intr ) ||
  125.  RWORD( HostP->ParmMapP->rx_intr  ) ||
  126.  RWORD( HostP->ParmMapP->tx_intr  ) ) {
  127. HostP->InIntr = 1;
  128. #ifdef FUTURE_RELEASE
  129. if( HostP->Type == RIO_EISA )
  130. INBZ( HostP->Slot, EISA_INTERRUPT_RESET );
  131. else
  132. #endif
  133. WBYTE( HostP->ResetInt , 0xff );
  134. rio_spin_lock(&HostP->HostLock); 
  135. p->_RIO_Polled++;
  136. RIOServiceHost(p, HostP, 'p' );
  137. rio_spin_lock( &HostP->HostLock); 
  138. HostP->InIntr = 0;
  139. rio_spin_unlock (&HostP->HostLock);
  140. }
  141. }
  142. rio_spin_unlock (&p->RIOIntrSem); 
  143. }
  144. char *firstchars (char *p, int nch)
  145. {
  146.   static char buf[2][128];
  147.   static int t=0;
  148.   t = ! t;
  149.   memcpy (buf[t], p, nch);
  150.   buf[t][nch] = 0;
  151.   return buf[t];
  152. }
  153. #define INCR( P, I ) ((P) = (((P)+(I)) & p->RIOBufferMask))
  154. /* Enable and start the transmission of packets */
  155. void
  156. RIOTxEnable(en)
  157. char * en;
  158. {
  159.   struct Port * PortP;
  160.   struct rio_info *p;
  161.   struct tty_struct* tty;
  162.   int c;
  163.   struct PKT * PacketP;
  164.   unsigned long flags;
  165.   PortP = (struct Port *)en; 
  166.   p = (struct rio_info *)PortP->p;
  167.   tty = PortP->gs.tty;
  168.   rio_dprintk (RIO_DEBUG_INTR, "tx port %d: %d chars queued.n", 
  169.       PortP->PortNum, PortP->gs.xmit_cnt);
  170.   if (!PortP->gs.xmit_cnt) return;
  171.   
  172.   /* This routine is an order of magnitude simpler than the specialix
  173.      version. One of the disadvantages is that this version will send
  174.      an incomplete packet (usually 64 bytes instead of 72) once for
  175.      every 4k worth of data. Let's just say that this won't influence
  176.      performance significantly..... */
  177.   rio_spin_lock_irqsave(&PortP->portSem, flags);
  178.   while (can_add_transmit( &PacketP, PortP )) {
  179.     c = PortP->gs.xmit_cnt;
  180.     if (c > PKT_MAX_DATA_LEN) c = PKT_MAX_DATA_LEN;
  181.     /* Don't copy past the end of the source buffer */
  182.     if (c > SERIAL_XMIT_SIZE - PortP->gs.xmit_tail) 
  183.       c = SERIAL_XMIT_SIZE - PortP->gs.xmit_tail;
  184.     { int t;
  185.     t = (c > 10)?10:c;
  186.     
  187.     rio_dprintk (RIO_DEBUG_INTR, "rio: tx port %d: copying %d chars: %s - %sn", 
  188.  PortP->PortNum, c, 
  189.  firstchars (PortP->gs.xmit_buf + PortP->gs.xmit_tail      , t),
  190.  firstchars (PortP->gs.xmit_buf + PortP->gs.xmit_tail + c-t, t));
  191.     }
  192.     /* If for one reason or another, we can't copy more data, 
  193.        we're done! */
  194.     if (c == 0) break;
  195.     rio_memcpy_toio (PortP->HostP->Caddr, (caddr_t)PacketP->data, 
  196.  PortP->gs.xmit_buf + PortP->gs.xmit_tail, c);
  197.     /*    udelay (1); */
  198.     writeb (c, &(PacketP->len));
  199.     if (!( PortP->State & RIO_DELETED ) ) {
  200.       add_transmit ( PortP );
  201.       /*
  202.       ** Count chars tx'd for port statistics reporting
  203.       */
  204.       if ( PortP->statsGather )
  205. PortP->txchars += c;
  206.     }
  207.     PortP->gs.xmit_tail = (PortP->gs.xmit_tail + c) & (SERIAL_XMIT_SIZE-1);
  208.     PortP->gs.xmit_cnt -= c;
  209.   }
  210.   rio_spin_unlock_irqrestore(&PortP->portSem, flags);
  211.   if (PortP->gs.xmit_cnt <= (PortP->gs.wakeup_chars + 2*PKT_MAX_DATA_LEN)) {
  212.     rio_dprintk (RIO_DEBUG_INTR, "Waking up.... ldisc:%d (%d/%d)....",
  213.  (int)(PortP->gs.tty->flags & (1 << TTY_DO_WRITE_WAKEUP)),
  214.  PortP->gs.wakeup_chars, PortP->gs.xmit_cnt); 
  215.     if ((PortP->gs.tty->flags & (1 << TTY_DO_WRITE_WAKEUP)) &&
  216. PortP->gs.tty->ldisc.write_wakeup)
  217.       (PortP->gs.tty->ldisc.write_wakeup)(PortP->gs.tty);
  218.     rio_dprintk (RIO_DEBUG_INTR, "(%d/%d)n",
  219. PortP->gs.wakeup_chars, PortP->gs.xmit_cnt); 
  220.     wake_up_interruptible(&PortP->gs.tty->write_wait);
  221.   }
  222. }
  223. /*
  224. ** When a real-life interrupt comes in here, we try to find out
  225. ** which host card it belongs to, and then service only that host
  226. ** Notice the cunning way that, once we've found a candidate, we
  227. ** continue just in case we are sharing interrupts.
  228. */
  229. void
  230. riointr(p)
  231. struct rio_info * p;
  232. {
  233. int host;
  234. for ( host=0; host<p->RIONumHosts; host++ ) {
  235. struct Host *HostP = &p->RIOHosts[host];
  236. rio_dprintk (RIO_DEBUG_INTR,  "riointr() doing host %d type %dn", host, HostP->Type);
  237. switch( HostP->Type ) {
  238. case RIO_AT:
  239. case RIO_MCA:
  240. case RIO_PCI:
  241.    rio_spin_lock(&HostP->HostLock);
  242. WBYTE(HostP->ResetInt , 0xff);
  243. if ( !HostP->InIntr ) {
  244. HostP->InIntr = 1;
  245. rio_spin_unlock (&HostP->HostLock);
  246. p->_RIO_Interrupted++;
  247. RIOServiceHost(p, HostP, 'i');
  248. rio_spin_lock(&HostP->HostLock);
  249. HostP->InIntr = 0;
  250. }
  251. rio_spin_unlock(&HostP->HostLock); 
  252. break;
  253. #ifdef FUTURE_RELEASE
  254. case RIO_EISA:
  255. if ( ivec == HostP->Ivec )
  256. {
  257. OldSpl = LOCKB( &HostP->HostLock );
  258. INBZ( HostP->Slot, EISA_INTERRUPT_RESET );
  259. if ( !HostP->InIntr )
  260. {
  261. HostP->InIntr = 1;
  262. UNLOCKB( &HostP->HostLock, OldSpl );
  263. if ( this_cpu < RIO_CPU_LIMIT )
  264. {
  265. int intrSpl = LOCKB( &RIOIntrLock );
  266. UNLOCKB( &RIOIntrLock, intrSpl );
  267. }
  268. p->_RIO_Interrupted++;
  269. RIOServiceHost( HostP, 'i' );
  270. OldSpl = LOCKB( &HostP->HostLock );
  271. HostP->InIntr = 0;
  272. }
  273. UNLOCKB( &HostP->HostLock, OldSpl );
  274. done++;
  275. }
  276. break;
  277. #endif
  278. }
  279. HostP->IntSrvDone++;
  280. }
  281. #ifdef FUTURE_RELEASE
  282. if ( !done )
  283. {
  284. cmn_err( CE_WARN, "RIO: Interrupt received with vector 0x%xn", ivec );
  285. cmn_err( CE_CONT, "  Valid vectors are:n");
  286. for ( host=0; host<RIONumHosts; host++ )
  287. {
  288. switch( RIOHosts[host].Type )
  289. {
  290. case RIO_AT:
  291. case RIO_MCA:
  292. case RIO_EISA:
  293. cmn_err( CE_CONT, "0x%x ", RIOHosts[host].Ivec );
  294. break;
  295. case RIO_PCI:
  296. cmn_err( CE_CONT, "0x%x ", get_intr_arg( RIOHosts[host].PciDevInfo.busnum, IDIST_PCI_IRQ( RIOHosts[host].PciDevInfo.slotnum, RIOHosts[host].PciDevInfo.funcnum ) ));
  297. break;
  298. }
  299. }
  300. cmn_err( CE_CONT, "n" );
  301. }
  302. #endif
  303. }
  304. /*
  305. ** RIO Host Service routine. Does all the work traditionally associated with an
  306. ** interrupt.
  307. */
  308. static int RupIntr;
  309. static int RxIntr;
  310. static int TxIntr;
  311. void
  312. RIOServiceHost(p, HostP, From)
  313. struct rio_info * p;
  314. struct Host *HostP;
  315. int From; 
  316. {
  317.   rio_spin_lock (&HostP->HostLock);
  318.   if ( (HostP->Flags & RUN_STATE) != RC_RUNNING ) { 
  319.     static int t =0;
  320.     rio_spin_unlock (&HostP->HostLock); 
  321.     if ((t++ % 200) == 0)
  322.       rio_dprintk (RIO_DEBUG_INTR, "Interrupt but host not running. flags=%x.n", (int)HostP->Flags);
  323.     return;
  324.   }
  325.   rio_spin_unlock (&HostP->HostLock); 
  326.   if ( RWORD( HostP->ParmMapP->rup_intr ) ) {
  327.     WWORD( HostP->ParmMapP->rup_intr , 0 );
  328.     p->RIORupCount++;
  329.     RupIntr++;
  330.     rio_dprintk (RIO_DEBUG_INTR, "rio: RUP interrupt on host %dn", HostP-p->RIOHosts);
  331.     RIOPollHostCommands(p, HostP );
  332.   }
  333.   if ( RWORD( HostP->ParmMapP->rx_intr ) ) {
  334.     int port;
  335.     WWORD( HostP->ParmMapP->rx_intr , 0 );
  336.     p->RIORxCount++;
  337.     RxIntr++;
  338.     rio_dprintk (RIO_DEBUG_INTR, "rio: RX interrupt on host %dn", HostP-p->RIOHosts);
  339.     /*
  340.     ** Loop through every port. If the port is mapped into
  341.     ** the system ( i.e. has /dev/ttyXXXX associated ) then it is
  342.     ** worth checking. If the port isn't open, grab any packets
  343.     ** hanging on its receive queue and stuff them on the free
  344.     ** list; check for commands on the way.
  345.     */
  346.     for ( port=p->RIOFirstPortsBooted; 
  347.   port<p->RIOLastPortsBooted+PORTS_PER_RTA; port++ ) {
  348.       struct Port *PortP = p->RIOPortp[port];
  349.       struct tty_struct *ttyP;
  350.       struct PKT *PacketP;
  351.       /*
  352.       ** not mapped in - most of the RIOPortp[] information
  353.       ** has not been set up!
  354.       ** Optimise: ports come in bundles of eight.
  355.       */
  356.       if ( !PortP->Mapped ) {
  357. port += 7;
  358. continue; /* with the next port */
  359.       }
  360.       /*
  361.       ** If the host board isn't THIS host board, check the next one.
  362.       ** optimise: ports come in bundles of eight.
  363.       */
  364.       if ( PortP->HostP != HostP ) {
  365. port += 7;
  366. continue;
  367.       }
  368.       /*
  369.       ** Let us see - is the port open? If not, then don't service it.
  370.       */
  371.       if ( !( PortP->PortState & PORT_ISOPEN ) ) {
  372. continue;
  373.       }
  374.       /*
  375.       ** find corresponding tty structure. The process of mapping
  376.       ** the ports puts these here.
  377.       */
  378.       ttyP = PortP->gs.tty;
  379.       /*
  380.       ** Lock the port before we begin working on it.
  381.       */
  382.       rio_spin_lock(&PortP->portSem);
  383.       /*
  384.       ** Process received data if there is any.
  385.       */
  386.       if ( can_remove_receive( &PacketP, PortP ) )
  387. RIOReceive(p, PortP);
  388.       /*
  389.       ** If there is no data left to be read from the port, and
  390.       ** it's handshake bit is set, then we must clear the handshake,
  391.       ** so that that downstream RTA is re-enabled.
  392.       */
  393.       if ( !can_remove_receive( &PacketP, PortP ) && 
  394.    ( RWORD( PortP->PhbP->handshake )==PHB_HANDSHAKE_SET ) ) {
  395. /*
  396. ** MAGIC! ( Basically, handshake the RX buffer, so that
  397. ** the RTAs upstream can be re-enabled. )
  398. */
  399. rio_dprintk (RIO_DEBUG_INTR, "Set RX handshake bitn");
  400. WWORD( PortP->PhbP->handshake, 
  401.        PHB_HANDSHAKE_SET|PHB_HANDSHAKE_RESET );
  402.       }
  403.       rio_spin_unlock(&PortP->portSem);
  404.     }
  405.   }
  406.   if ( RWORD( HostP->ParmMapP->tx_intr ) ) {
  407.     int port;
  408.     WWORD( HostP->ParmMapP->tx_intr , 0);
  409.     p->RIOTxCount++;
  410.     TxIntr++;
  411.     rio_dprintk (RIO_DEBUG_INTR, "rio: TX interrupt on host %dn", HostP-p->RIOHosts);
  412.     /*
  413.     ** Loop through every port.
  414.     ** If the port is mapped into the system ( i.e. has /dev/ttyXXXX
  415.     ** associated ) then it is worth checking.
  416.     */
  417.     for ( port=p->RIOFirstPortsBooted; 
  418.   port<p->RIOLastPortsBooted+PORTS_PER_RTA; port++ ) {
  419.       struct Port *PortP = p->RIOPortp[port];
  420.       struct tty_struct *ttyP;
  421.       struct PKT *PacketP;
  422.       /*
  423.       ** not mapped in - most of the RIOPortp[] information
  424.       ** has not been set up!
  425.       */
  426.       if ( !PortP->Mapped ) {
  427. port += 7;
  428. continue; /* with the next port */
  429.       }
  430.       /*
  431.       ** If the host board isn't running, then its data structures
  432.       ** are no use to us - continue quietly.
  433.       */
  434.       if ( PortP->HostP != HostP ) {
  435. port += 7;
  436. continue; /* with the next port */
  437.       }
  438.       /*
  439.       ** Let us see - is the port open? If not, then don't service it.
  440.       */
  441.       if ( !( PortP->PortState & PORT_ISOPEN ) ) {
  442. continue;
  443.       }
  444.       rio_dprintk (RIO_DEBUG_INTR, "rio: Looking into port %d.n", port);
  445.       /*
  446.       ** Lock the port before we begin working on it.
  447.       */
  448.       rio_spin_lock(&PortP->portSem);
  449.       /*
  450.       ** If we can't add anything to the transmit queue, then
  451.       ** we need do none of this processing.
  452.       */
  453.       if ( !can_add_transmit( &PacketP, PortP ) ) {
  454. rio_dprintk (RIO_DEBUG_INTR, "Can't add to port, so skipping.n");
  455. rio_spin_unlock(&PortP->portSem);
  456. continue;
  457.       }
  458.       /*
  459.       ** find corresponding tty structure. The process of mapping
  460.       ** the ports puts these here.
  461.       */
  462.       ttyP = PortP->gs.tty;
  463.       /* If ttyP is NULL, the port is getting closed. Forget about it. */
  464.       if (!ttyP) {
  465. rio_dprintk (RIO_DEBUG_INTR, "no tty, so skipping.n");
  466. rio_spin_unlock(&PortP->portSem);
  467. continue;
  468.       }
  469.       /*
  470.       ** If there is more room available we start up the transmit
  471.       ** data process again. This can be direct I/O, if the cookmode
  472.       ** is set to COOK_RAW or COOK_MEDIUM, or will be a call to the
  473.       ** riotproc( T_OUTPUT ) if we are in COOK_WELL mode, to fetch
  474.       ** characters via the line discipline. We must always call
  475.       ** the line discipline,
  476.       ** so that user input characters can be echoed correctly.
  477.       **
  478.       ** ++++ Update +++++
  479.       ** With the advent of double buffering, we now see if
  480.       ** TxBufferOut-In is non-zero. If so, then we copy a packet
  481.       ** to the output place, and set it going. If this empties
  482.       ** the buffer, then we must issue a wakeup( ) on OUT.
  483.       ** If it frees space in the buffer then we must issue
  484.       ** a wakeup( ) on IN.
  485.       **
  486.       ** ++++ Extra! Extra! If PortP->WflushFlag is set, then we
  487.       ** have to send a WFLUSH command down the PHB, to mark the
  488.       ** end point of a WFLUSH. We also need to clear out any
  489.       ** data from the double buffer! ( note that WflushFlag is a
  490.       ** *count* of the number of WFLUSH commands outstanding! )
  491.       **
  492.       ** ++++ And there's more!
  493.       ** If an RTA is powered off, then on again, and rebooted,
  494.       ** whilst it has ports open, then we need to re-open the ports.
  495.       ** ( reasonable enough ). We can't do this when we spot the
  496.       ** re-boot, in interrupt time, because the queue is probably
  497.       ** full. So, when we come in here, we need to test if any
  498.       ** ports are in this condition, and re-open the port before
  499.       ** we try to send any more data to it. Now, the re-booted
  500.       ** RTA will be discarding packets from the PHB until it
  501.       ** receives this open packet, but don't worry tooo much
  502.       ** about that. The one thing that is interesting is the
  503.       ** combination of this effect and the WFLUSH effect!
  504.       */
  505.       /* For now don't handle RTA reboots. -- REW. 
  506.  Reenabled. Otherwise RTA reboots didn't work. Duh. -- REW */
  507.       if ( PortP->MagicFlags ) {
  508. #if 1
  509. if ( PortP->MagicFlags & MAGIC_REBOOT ) {
  510.   /*
  511.   ** well, the RTA has been rebooted, and there is room
  512.   ** on its queue to add the open packet that is required.
  513.   **
  514.   ** The messy part of this line is trying to decide if
  515.   ** we need to call the Param function as a tty or as
  516.   ** a modem.
  517.   ** DONT USE CLOCAL AS A TEST FOR THIS!
  518.   **
  519.   ** If we can't param the port, then move on to the
  520.   ** next port.
  521.   */
  522.   PortP->InUse = NOT_INUSE;
  523.   rio_spin_unlock(&PortP->portSem);
  524.   if ( RIOParam(PortP, OPEN, ((PortP->Cor2Copy & 
  525.        (COR2_RTSFLOW|COR2_CTSFLOW ) )== 
  526.       (COR2_RTSFLOW|COR2_CTSFLOW ) ) ? 
  527. TRUE : FALSE, DONT_SLEEP ) == RIO_FAIL ) {
  528.     continue; /* with next port */
  529.   }
  530.   rio_spin_lock(&PortP->portSem);
  531.   PortP->MagicFlags &= ~MAGIC_REBOOT;
  532. }
  533. #endif
  534. /*
  535. ** As mentioned above, this is a tacky hack to cope
  536. ** with WFLUSH
  537. */
  538. if ( PortP->WflushFlag ) {
  539.   rio_dprintk (RIO_DEBUG_INTR, "Want to WFLUSH mark this portn");
  540.   if ( PortP->InUse )
  541.     rio_dprintk (RIO_DEBUG_INTR, "FAILS - PORT IS IN USEn");
  542. }
  543. while ( PortP->WflushFlag &&
  544. can_add_transmit( &PacketP, PortP ) && 
  545. ( PortP->InUse == NOT_INUSE ) ) {
  546.   int p;
  547.   struct PktCmd *PktCmdP;
  548.   rio_dprintk (RIO_DEBUG_INTR, "Add WFLUSH marker to data queuen");
  549.   /*
  550.   ** make it look just like a WFLUSH command
  551.   */
  552.   PktCmdP = ( struct PktCmd * )&PacketP->data[0];
  553.   WBYTE( PktCmdP->Command , WFLUSH );
  554.   p =  PortP->HostPort % ( ushort )PORTS_PER_RTA;
  555.   /*
  556.   ** If second block of ports for 16 port RTA, add 8
  557.   ** to index 8-15.
  558.   */
  559.   if ( PortP->SecondBlock )
  560.     p += PORTS_PER_RTA;
  561.   WBYTE( PktCmdP->PhbNum, p );
  562.   /*
  563.   ** to make debuggery easier
  564.   */
  565.   WBYTE( PacketP->data[ 2], 'W'  );
  566.   WBYTE( PacketP->data[ 3], 'F'  );
  567.   WBYTE( PacketP->data[ 4], 'L'  );
  568.   WBYTE( PacketP->data[ 5], 'U'  );
  569.   WBYTE( PacketP->data[ 6], 'S'  );
  570.   WBYTE( PacketP->data[ 7], 'H'  );
  571.   WBYTE( PacketP->data[ 8], ' '  );
  572.   WBYTE( PacketP->data[ 9], '0'+PortP->WflushFlag );
  573.   WBYTE( PacketP->data[10], ' '  );
  574.   WBYTE( PacketP->data[11], ' '  );
  575.   WBYTE( PacketP->data[12], '' );
  576.   /*
  577.   ** its two bytes long!
  578.   */
  579.   WBYTE( PacketP->len , PKT_CMD_BIT | 2 );
  580.   /*
  581.   ** queue it!
  582.   */
  583.   if ( !( PortP->State & RIO_DELETED ) ) {
  584.     add_transmit( PortP );
  585.     /*
  586.     ** Count chars tx'd for port statistics reporting
  587.     */
  588.     if ( PortP->statsGather )
  589.       PortP->txchars += 2;
  590.   }
  591.   if ( --( PortP->WflushFlag ) == 0 ) {
  592.     PortP->MagicFlags &= ~MAGIC_FLUSH;
  593.   }
  594.   rio_dprintk (RIO_DEBUG_INTR, "Wflush count now stands at %dn", 
  595.  PortP->WflushFlag);
  596. }
  597. if ( PortP->MagicFlags & MORE_OUTPUT_EYGOR ) {
  598.   if ( PortP->MagicFlags & MAGIC_FLUSH ) {
  599.     PortP->MagicFlags |= MORE_OUTPUT_EYGOR;
  600.   }
  601.   else {
  602.     if ( !can_add_transmit( &PacketP, PortP ) ) {
  603.       rio_spin_unlock(&PortP->portSem);
  604.       continue;
  605.     }
  606.     rio_spin_unlock(&PortP->portSem);
  607.     RIOTxEnable((char *)PortP);
  608.     rio_spin_lock(&PortP->portSem);
  609.     PortP->MagicFlags &= ~MORE_OUTPUT_EYGOR;
  610.   }
  611. }
  612.       }
  613.       /*
  614.       ** If we can't add anything to the transmit queue, then
  615.       ** we need do none of the remaining processing.
  616.       */
  617.       if (!can_add_transmit( &PacketP, PortP ) ) {
  618. rio_spin_unlock(&PortP->portSem);
  619. continue;
  620.       }
  621.       rio_spin_unlock(&PortP->portSem);
  622.       RIOTxEnable((char *)PortP);
  623.     }
  624.   }
  625. }
  626. /*
  627. ** Routine for handling received data for clist drivers.
  628. ** NB: Called with the tty locked. The spl from the lockb( ) is passed.
  629. ** we return the ttySpl level that we re-locked at.
  630. */
  631. void
  632. RIOReceive(p, PortP)
  633. struct rio_info * p;
  634. struct Port * PortP;
  635. {
  636.   struct tty_struct *TtyP;
  637.   register ushort transCount;
  638.   struct PKT *PacketP;
  639.   register uint DataCnt;
  640.   uchar * ptr;
  641.   int copied =0;
  642.   static int intCount, RxIntCnt;
  643.   /*
  644.   ** The receive data process is to remove packets from the
  645.   ** PHB until there aren't any more or the current cblock
  646.   ** is full. When this occurs, there will be some left over
  647.   ** data in the packet, that we must do something with.
  648.   ** As we haven't unhooked the packet from the read list
  649.   ** yet, we can just leave the packet there, having first
  650.   ** made a note of how far we got. This means that we need
  651.   ** a pointer per port saying where we start taking the
  652.   ** data from - this will normally be zero, but when we
  653.   ** run out of space it will be set to the offset of the
  654.   ** next byte to copy from the packet data area. The packet
  655.   ** length field is decremented by the number of bytes that
  656.   ** we succesfully removed from the packet. When this reaches
  657.   ** zero, we reset the offset pointer to be zero, and free
  658.   ** the packet from the front of the queue.
  659.   */
  660.   intCount++;
  661.   TtyP = PortP->gs.tty;
  662.   if (!TtyP) {
  663.     rio_dprintk (RIO_DEBUG_INTR, "RIOReceive: tty is null. n");
  664.     return;
  665.   }
  666.   if (PortP->State & RIO_THROTTLE_RX) {
  667.     rio_dprintk (RIO_DEBUG_INTR, "RIOReceive: Throttled. Can't handle more input.n");
  668.     return;
  669.   }
  670.   if ( PortP->State & RIO_DELETED )
  671.     {
  672.       while ( can_remove_receive( &PacketP, PortP ) )
  673. {
  674.   remove_receive( PortP );
  675.   put_free_end( PortP->HostP, PacketP );
  676. }
  677.     }
  678.   else
  679.     {
  680.       /*
  681.       ** loop, just so long as:
  682.       **   i ) there's some data ( i.e. can_remove_receive )
  683.       **  ii ) we haven't been blocked
  684.       ** iii ) there's somewhere to put the data
  685.       **  iv ) we haven't outstayed our welcome
  686.       */
  687.       transCount = 1;
  688.       while ( can_remove_receive(&PacketP, PortP)
  689.       && transCount)
  690. {
  691. #ifdef STATS
  692.   PortP->Stat.RxIntCnt++;
  693. #endif /* STATS */
  694.   RxIntCnt++;
  695.   /*
  696.   ** check that it is not a command!
  697.   */
  698.   if ( PacketP->len & PKT_CMD_BIT ) {
  699.     rio_dprintk (RIO_DEBUG_INTR, "RIO: unexpected command packet received on PHBn");
  700.     /*     rio_dprint(RIO_DEBUG_INTR, (" sysport   = %dn", p->RIOPortp->PortNum)); */
  701.     rio_dprintk (RIO_DEBUG_INTR, " dest_unit = %dn", PacketP->dest_unit);
  702.     rio_dprintk (RIO_DEBUG_INTR, " dest_port = %dn", PacketP->dest_port);
  703.     rio_dprintk (RIO_DEBUG_INTR, " src_unit  = %dn", PacketP->src_unit);
  704.     rio_dprintk (RIO_DEBUG_INTR, " src_port  = %dn", PacketP->src_port);
  705.     rio_dprintk (RIO_DEBUG_INTR, " len    = %dn", PacketP->len);
  706.     rio_dprintk (RIO_DEBUG_INTR, " control   = %dn", PacketP->control);
  707.     rio_dprintk (RIO_DEBUG_INTR, " csum    = %dn", PacketP->csum);
  708.     rio_dprintk (RIO_DEBUG_INTR, "  data bytes: ");
  709.     for ( DataCnt=0; DataCnt<PKT_MAX_DATA_LEN; DataCnt++ )
  710.       rio_dprintk (RIO_DEBUG_INTR, "%dn", PacketP->data[DataCnt]);
  711.     remove_receive( PortP );
  712.     put_free_end( PortP->HostP, PacketP );
  713.     continue; /* with next packet */
  714.   }
  715.   /*
  716.   ** How many characters can we move 'upstream' ?
  717.   **
  718.   ** Determine the minimum of the amount of data
  719.   ** available and the amount of space in which to
  720.   ** put it.
  721.   **
  722.   ** 1. Get the packet length by masking 'len'
  723.   ** for only the length bits.
  724.   ** 2. Available space is [buffer size] - [space used]
  725.   **
  726.   ** Transfer count is the minimum of packet length
  727.   ** and available space.
  728.   */
  729.   transCount = min_t(unsigned int, PacketP->len & PKT_LEN_MASK,
  730.    TTY_FLIPBUF_SIZE - TtyP->flip.count);
  731.   rio_dprintk (RIO_DEBUG_REC,  "port %d: Copy %d bytesn", 
  732.       PortP->PortNum, transCount);
  733.   /*
  734.   ** To use the following 'kkprintfs' for debugging - change the '#undef'
  735.   ** to '#define', (this is the only place ___DEBUG_IT___ occurs in the
  736.   ** driver).
  737.   */
  738. #undef ___DEBUG_IT___
  739. #ifdef ___DEBUG_IT___
  740.   kkprintf("I:%d R:%d P:%d Q:%d C:%d F:%x ",
  741.    intCount,
  742.    RxIntCnt,
  743.    PortP->PortNum,
  744.    TtyP->rxqueue.count,
  745.    transCount,
  746.    TtyP->flags );
  747. #endif
  748.   ptr = (uchar *) PacketP->data + PortP->RxDataStart;
  749.   rio_memcpy_fromio (TtyP->flip.char_buf_ptr, ptr, transCount);
  750.   memset(TtyP->flip.flag_buf_ptr, TTY_NORMAL, transCount);
  751. #ifdef STATS
  752.   /*
  753.   ** keep a count for statistical purposes
  754.   */
  755.   PortP->Stat.RxCharCnt += transCount;
  756. #endif
  757.   PortP->RxDataStart += transCount;
  758.   PacketP->len -= transCount;
  759.   copied += transCount;
  760.   TtyP->flip.count += transCount;
  761.   TtyP->flip.char_buf_ptr += transCount;
  762.   TtyP->flip.flag_buf_ptr += transCount;
  763. #ifdef ___DEBUG_IT___
  764.   kkprintf("T:%d L:%dn", DataCnt, PacketP->len );
  765. #endif
  766.   if ( PacketP->len == 0 )
  767.     {
  768. /*
  769. ** If we have emptied the packet, then we can
  770. ** free it, and reset the start pointer for
  771. ** the next packet.
  772. */
  773.       remove_receive( PortP );
  774.       put_free_end( PortP->HostP, PacketP );
  775.       PortP->RxDataStart = 0;
  776. #ifdef STATS
  777. /*
  778. ** more lies ( oops, I mean statistics )
  779. */
  780.       PortP->Stat.RxPktCnt++;
  781. #endif /* STATS */
  782.     }
  783. }
  784.     }
  785.   if (copied) {
  786.     rio_dprintk (RIO_DEBUG_REC, "port %d: pushing tty flip buffer: %d total bytes copied.n", PortP->PortNum, copied);
  787.     tty_flip_buffer_push (TtyP);
  788.   }
  789.   return;
  790. }
  791. #ifdef FUTURE_RELEASE
  792. /*
  793. ** The proc routine called by the line discipline to do the work for it.
  794. ** The proc routine works hand in hand with the interrupt routine.
  795. */
  796. int
  797. riotproc(p, tp, cmd, port)
  798. struct rio_info * p;
  799. register struct ttystatics *tp;
  800. int cmd;
  801. int port;
  802. {
  803. register struct Port *PortP;
  804. int SysPort;
  805. struct PKT *PacketP;
  806. SysPort = port; /* Believe me, it works. */
  807. if ( SysPort < 0 || SysPort >= RIO_PORTS ) {
  808. rio_dprintk (RIO_DEBUG_INTR, "Illegal port %d derived from TTY in riotproc()n",SysPort);
  809. return 0;
  810. }
  811. PortP = p->RIOPortp[SysPort];
  812. if ((uint)PortP->PhbP < (uint)PortP->Caddr || 
  813. (uint)PortP->PhbP >= (uint)PortP->Caddr+SIXTY_FOUR_K ) {
  814. rio_dprintk (RIO_DEBUG_INTR, "RIO: NULL or BAD PhbP on sys port %d in proc routinen",
  815. SysPort);
  816. rio_dprintk (RIO_DEBUG_INTR, "  PortP = 0x%xn",PortP);
  817. rio_dprintk (RIO_DEBUG_INTR, "  PortP->PhbP = 0x%xn",PortP->PhbP);
  818. rio_dprintk (RIO_DEBUG_INTR, "  PortP->Caddr = 0x%xn",PortP->PhbP);
  819. rio_dprintk (RIO_DEBUG_INTR, "  PortP->HostPort = 0x%xn",PortP->HostPort);
  820. return 0;
  821. }
  822. switch(cmd) {
  823. case T_WFLUSH:
  824. rio_dprintk (RIO_DEBUG_INTR, "T_WFLUSHn");
  825. /*
  826. ** Because of the spooky way the RIO works, we don't need
  827. ** to issue a flush command on any of the SET*F commands,
  828. ** as that causes trouble with getty and login, which issue
  829. ** these commands to incur a READ flush, and rely on the fact
  830. ** that the line discipline does a wait for drain for them.
  831. ** As the rio doesn't wait for drain, the write flush would
  832. ** destroy the Password: prompt. This isn't very friendly, so
  833. ** here we only issue a WFLUSH command if we are in the interrupt
  834. ** routine, or we aren't executing a SET*F command.
  835. */
  836. if ( PortP->HostP->InIntr || !PortP->FlushCmdBodge ) {
  837. /*
  838. ** form a wflush packet - 1 byte long, no data
  839. */
  840. if ( PortP->State & RIO_DELETED ) {
  841. rio_dprintk (RIO_DEBUG_INTR, "WFLUSH on deleted RTAn");
  842. }
  843. else {
  844. if ( RIOPreemptiveCmd(p, PortP, WFLUSH ) == RIO_FAIL ) {
  845. rio_dprintk (RIO_DEBUG_INTR, "T_WFLUSH Command failedn");
  846. }
  847. else
  848. rio_dprintk (RIO_DEBUG_INTR, "T_WFLUSH Commandn");
  849. }
  850. /*
  851. ** WFLUSH operation - flush the data!
  852. */
  853. PortP->TxBufferIn = PortP->TxBufferOut = 0;
  854. }
  855. else {
  856. rio_dprintk (RIO_DEBUG_INTR, "T_WFLUSH Command ignoredn");
  857. }
  858. /*
  859. ** sort out the line discipline
  860. */
  861. if (PortP->CookMode == COOK_WELL)
  862. goto start;
  863. break;
  864. case T_RESUME:
  865. rio_dprintk (RIO_DEBUG_INTR, "T_RESUMEn");
  866. /*
  867. ** send pre-emptive resume packet
  868. */
  869. if ( PortP->State & RIO_DELETED ) {
  870. rio_dprintk (RIO_DEBUG_INTR, "RESUME on deleted RTAn");
  871. }
  872. else {
  873. if ( RIOPreemptiveCmd(p, PortP, RESUME ) == RIO_FAIL ) {
  874. rio_dprintk (RIO_DEBUG_INTR, "T_RESUME Command failedn");
  875. }
  876. }
  877. /*
  878. ** and re-start the sender software!
  879. */
  880. if (PortP->CookMode == COOK_WELL)
  881. goto start;
  882. break;
  883. case T_TIME:
  884. rio_dprintk (RIO_DEBUG_INTR, "T_TIMEn");
  885. /*
  886. ** T_TIME is called when xDLY is set in oflags and
  887. ** the line discipline timeout has expired. It's
  888. ** function in life is to clear the TIMEOUT flag
  889. ** and to re-start output to the port.
  890. */
  891. /*
  892. ** Fall through and re-start output
  893. */
  894. case T_OUTPUT:
  895. start:
  896. if ( PortP->MagicFlags & MAGIC_FLUSH ) {
  897. PortP->MagicFlags |= MORE_OUTPUT_EYGOR;
  898. return 0;
  899. }
  900. RIOTxEnable((char *)PortP);
  901. PortP->MagicFlags &= ~MORE_OUTPUT_EYGOR;
  902. /*rio_dprint(RIO_DEBUG_INTR, PortP,DBG_PROC,"T_OUTPUT finishedn");*/
  903. break;
  904. case T_SUSPEND:
  905. rio_dprintk (RIO_DEBUG_INTR, "T_SUSPENDn");
  906. /*
  907. ** send a suspend pre-emptive packet.
  908. */
  909. if ( PortP->State & RIO_DELETED ) {
  910. rio_dprintk (RIO_DEBUG_INTR, "SUSPEND deleted RTAn");
  911. }
  912. else {
  913. if ( RIOPreemptiveCmd(p, PortP, SUSPEND ) == RIO_FAIL ) {
  914. rio_dprintk (RIO_DEBUG_INTR, "T_SUSPEND Command failedn");
  915. }
  916. }
  917. /*
  918. ** done!
  919. */
  920. break;
  921. case T_BLOCK:
  922. rio_dprintk (RIO_DEBUG_INTR, "T_BLOCKn");
  923. break;
  924. case T_RFLUSH:
  925. rio_dprintk (RIO_DEBUG_INTR, "T_RFLUSHn");
  926. if ( PortP->State & RIO_DELETED ) {
  927. rio_dprintk (RIO_DEBUG_INTR, "RFLUSH on deleted RTAn");
  928. PortP->RxDataStart = 0;
  929. }
  930. else {
  931. if ( RIOPreemptiveCmd( p, PortP, RFLUSH ) == RIO_FAIL ) {
  932. rio_dprintk (RIO_DEBUG_INTR, "T_RFLUSH Command failedn");
  933. return 0;
  934. }
  935. PortP->RxDataStart = 0;
  936. while ( can_remove_receive(&PacketP, PortP) ) {
  937. remove_receive(PortP);
  938. ShowPacket(DBG_PROC, PacketP );
  939. put_free_end(PortP->HostP, PacketP );
  940. }
  941. if ( PortP->PhbP->handshake == PHB_HANDSHAKE_SET ) {
  942. /*
  943. ** MAGIC!
  944. */
  945. rio_dprintk (RIO_DEBUG_INTR, "Set receive handshake bitn");
  946. PortP->PhbP->handshake |= PHB_HANDSHAKE_RESET;
  947. }
  948. }
  949. break;
  950. /* FALLTHROUGH */
  951. case T_UNBLOCK:
  952. rio_dprintk (RIO_DEBUG_INTR, "T_UNBLOCKn");
  953. /*
  954. ** If there is any data to receive set a timeout to service it.
  955. */
  956. RIOReceive(p, PortP);
  957. break;
  958. case T_BREAK:
  959. rio_dprintk (RIO_DEBUG_INTR, "T_BREAKn");
  960. /*
  961. ** Send a break command. For Sys V
  962. ** this is a timed break, so we
  963. ** send a SBREAK[time] packet
  964. */
  965. /*
  966. ** Build a BREAK command
  967. */
  968. if ( PortP->State & RIO_DELETED ) {
  969. rio_dprintk (RIO_DEBUG_INTR, "BREAK on deleted RTAn");
  970. }
  971. else {
  972. if (RIOShortCommand(PortP,SBREAK,2,
  973. p->RIOConf.BreakInterval)==RIO_FAIL) {
  974.     rio_dprintk (RIO_DEBUG_INTR, "SBREAK RIOShortCommand failedn");
  975. }
  976. }
  977. /*
  978. ** done!
  979. */
  980. break;
  981. case T_INPUT:
  982. rio_dprintk (RIO_DEBUG_INTR, "Proc T_INPUT called - I don't know what to do!n");
  983. break;
  984. case T_PARM:
  985. rio_dprintk (RIO_DEBUG_INTR, "Proc T_PARM called - I don't know what to do!n");
  986. break;
  987. case T_SWTCH:
  988. rio_dprintk (RIO_DEBUG_INTR, "Proc T_SWTCH called - I don't know what to do!n");
  989. break;
  990. default:
  991. rio_dprintk (RIO_DEBUG_INTR, "Proc UNKNOWN command %dn",cmd);
  992. }
  993. /*
  994. ** T_OUTPUT returns without passing through this point!
  995. */
  996. /*rio_dprint(RIO_DEBUG_INTR, PortP,DBG_PROC,"riotproc donen");*/
  997. return(0);
  998. }
  999. #endif