patch-2.3.99-pre7 linux/drivers/char/rio/rioctrl.c
Next file: linux/drivers/char/rio/riodrvr.h
Previous file: linux/drivers/char/rio/riocmd.c
Back to the patch index
Back to the overall index
- Lines: 1899
- Date:
Wed May 10 16:56:44 2000
- Orig file:
v2.3.99-pre6/linux/drivers/char/rio/rioctrl.c
- Orig date:
Wed Dec 31 16:00:00 1969
diff -u --recursive --new-file v2.3.99-pre6/linux/drivers/char/rio/rioctrl.c linux/drivers/char/rio/rioctrl.c
@@ -0,0 +1,1898 @@
+/*
+** -----------------------------------------------------------------------------
+**
+** Perle Specialix driver for Linux
+** Ported from existing RIO Driver for SCO sources.
+ *
+ * (C) 1990 - 2000 Specialix International Ltd., Byfleet, Surrey, UK.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License as published by
+ * the Free Software Foundation; either version 2 of the License, or
+ * (at your option) any later version.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
+**
+** Module : rioctrl.c
+** SID : 1.3
+** Last Modified : 11/6/98 10:33:42
+** Retrieved : 11/6/98 10:33:49
+**
+** ident @(#)rioctrl.c 1.3
+**
+** -----------------------------------------------------------------------------
+*/
+#ifdef SCCS_LABELS
+static char *_rioctrl_c_sccs_ = "@(#)rioctrl.c 1.3";
+#endif
+
+
+#define __NO_VERSION__
+#include <linux/module.h>
+#include <linux/malloc.h>
+#include <linux/errno.h>
+#include <asm/io.h>
+#include <asm/system.h>
+#include <asm/string.h>
+#include <asm/semaphore.h>
+#include <asm/uaccess.h>
+
+#include <linux/termios.h>
+#include <linux/serial.h>
+
+#include <linux/compatmac.h>
+#include <linux/generic_serial.h>
+
+
+#include "linux_compat.h"
+#include "rio_linux.h"
+#include "typdef.h"
+#include "pkt.h"
+#include "daemon.h"
+#include "rio.h"
+#include "riospace.h"
+#include "top.h"
+#include "cmdpkt.h"
+#include "map.h"
+#include "riotypes.h"
+#include "rup.h"
+#include "port.h"
+#include "riodrvr.h"
+#include "rioinfo.h"
+#include "func.h"
+#include "errors.h"
+#include "pci.h"
+
+#include "parmmap.h"
+#include "unixrup.h"
+#include "board.h"
+#include "host.h"
+#include "error.h"
+#include "phb.h"
+#include "link.h"
+#include "cmdblk.h"
+#include "route.h"
+#include "control.h"
+#include "cirrus.h"
+#include "rioioctl.h"
+
+
+static struct LpbReq LpbReq;
+static struct RupReq RupReq;
+static struct PortReq PortReq;
+static struct HostReq HostReq;
+static struct HostDpRam HostDpRam;
+static struct DebugCtrl DebugCtrl;
+static struct Map MapEnt;
+static struct PortSetup PortSetup;
+static struct DownLoad DownLoad;
+static struct SendPack SendPack;
+/* static struct StreamInfo StreamInfo; */
+/* static char modemtable[RIO_PORTS]; */
+static struct SpecialRupCmd SpecialRupCmd;
+static struct PortParams PortParams;
+static struct portStats portStats;
+
+static struct SubCmdStruct {
+ ushort Host;
+ ushort Rup;
+ ushort Port;
+ ushort Addr;
+} SubCmd;
+
+struct PortTty {
+ uint port;
+ struct ttystatics Tty;
+};
+
+static struct PortTty PortTty;
+typedef struct ttystatics TERMIO;
+
+/*
+** This table is used when the config.rio downloads bin code to the
+** driver. We index the table using the product code, 0-F, and call
+** the function pointed to by the entry, passing the information
+** about the boot.
+** The RIOBootCodeUNKNOWN entry is there to politely tell the calling
+** process to bog off.
+*/
+static int
+(*RIOBootTable[MAX_PRODUCT])(struct rio_info *, struct DownLoad *) =
+{
+/* 0 */ RIOBootCodeHOST, /* Host Card */
+/* 1 */ RIOBootCodeRTA, /* RTA */
+};
+
+#define drv_makedev(maj, min) ((((uint) maj & 0xff) << 8) | ((uint) min & 0xff))
+
+#ifdef linux
+int copyin (int arg, caddr_t dp, int siz)
+{
+ int rv;
+
+ rio_dprint (RIO_DEBUG_CTRL, ("Copying %d bytes from user %p to %p.\n", siz, (void *) arg, dp));
+ rv = copy_from_user (dp, (void *)arg, siz);
+ if (rv < 0) return COPYFAIL;
+ else return rv;
+}
+
+
+int copyout (caddr_t dp, int arg, int siz)
+{
+ int rv;
+
+ rio_dprint (RIO_DEBUG_CTRL, ("Copying %d bytes to user %p from %p.\n", siz, (void *) arg, dp));
+ rv = copy_to_user ((void *)arg, dp, siz);
+ if (rv < 0) return COPYFAIL;
+ else return rv;
+}
+
+#else
+
+int
+copyin(arg, dp, siz)
+int arg;
+caddr_t dp;
+int siz;
+{
+ if (rbounds ((unsigned long) arg) >= siz) {
+ bcopy ( arg, dp, siz );
+ return OK;
+ } else
+ return ( COPYFAIL );
+}
+
+int
+copyout (dp, arg, siz)
+caddr_t dp;
+int arg;
+int siz;
+{
+ if (wbounds ((unsigned long) arg) >= siz ) {
+ bcopy ( dp, arg, siz );
+ return OK;
+ } else
+ return ( COPYFAIL );
+}
+#endif
+
+int
+riocontrol(p, dev, cmd, arg, su)
+struct rio_info * p;
+dev_t dev;
+int cmd;
+caddr_t arg;
+int su;
+{
+ uint Host; /* leave me unsigned! */
+ uint port; /* and me! */
+ struct Host *HostP;
+ ushort loop;
+ int Entry;
+ struct Port *PortP;
+ PKT *PacketP;
+ int retval = 0;
+ unsigned long flags;
+
+ /* Confuse teh compiler to think that we've initialized these */
+ Host=0;
+ PortP = NULL;
+
+ rio_dprint(RIO_DEBUG_CTRL, ("control ioctl cmd: 0x%x arg: 0x%x\n", cmd, (int)arg));
+
+ switch (cmd) {
+ /*
+ ** RIO_SET_TIMER
+ **
+ ** Change the value of the host card interrupt timer.
+ ** If the host card number is -1 then all host cards are changed
+ ** otherwise just the specified host card will be changed.
+ */
+ case RIO_SET_TIMER:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SET_TIMER to %dms\n", (uint)arg));
+ {
+ int host, value;
+ host = (uint)arg >> 16;
+ value = (uint)arg & 0x0000ffff;
+ if (host == -1) {
+ for (host = 0; host < p->RIONumHosts; host++) {
+ if (p->RIOHosts[host].Flags == RC_RUNNING) {
+ WWORD(p->RIOHosts[host].ParmMapP->timer , value);
+ }
+ }
+ } else if (host >= p->RIONumHosts) {
+ return EINVAL;
+ } else {
+ if ( p->RIOHosts[host].Flags == RC_RUNNING ) {
+ WWORD(p->RIOHosts[host].ParmMapP->timer , value);
+ }
+ }
+ }
+ return 0;
+
+ case RIO_IDENTIFY_DRIVER:
+ /*
+ ** 15.10.1998 ARG - ESIL 0760 part fix
+ ** Added driver ident string output.
+ **
+#ifndef __THIS_RELEASE__
+#warning Driver Version string not defined !
+#endif
+ cprintf("%s %s %s %s\n",
+ RIO_DRV_STR,
+ __THIS_RELEASE__,
+ __DATE__, __TIME__ );
+
+ return 0;
+
+ case RIO_DISPLAY_HOST_CFG:
+ **
+ ** 15.10.1998 ARG - ESIL 0760 part fix
+ ** Added driver host card ident string output.
+ **
+ ** Note that the only types currently supported
+ ** are ISA and PCI. Also this driver does not
+ ** (yet) distinguish between the Old PCI card
+ ** and the Jet PCI card. In fact I think this
+ ** driver only supports JET PCI !
+ **
+
+ for (Host = 0; Host < p->RIONumHosts; Host++)
+ {
+ HostP = &(p->RIOHosts[Host]);
+
+ switch ( HostP->Type )
+ {
+ case RIO_AT :
+ strcpy( host_type, RIO_AT_HOST_STR );
+ break;
+
+ case RIO_PCI :
+ strcpy( host_type, RIO_PCI_HOST_STR );
+ break;
+
+ default :
+ strcpy( host_type, "Unknown" );
+ break;
+ }
+
+ cprintf(
+ "RIO Host %d - Type:%s Addr:%X IRQ:%d\n",
+ Host, host_type,
+ (uint)HostP->PaddrP,
+ (int)HostP->Ivec - 32 );
+ }
+ return 0;
+ **
+ */
+
+ case RIO_FOAD_RTA:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_FOAD_RTA\n"));
+ return RIOCommandRta(p, (uint)arg, RIOFoadRta);
+
+ case RIO_ZOMBIE_RTA:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_ZOMBIE_RTA\n"));
+ return RIOCommandRta(p, (uint)arg, RIOZombieRta);
+
+ case RIO_IDENTIFY_RTA:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_IDENTIFY_RTA\n"));
+ return RIOIdentifyRta(p, arg);
+
+ case RIO_KILL_NEIGHBOUR:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_KILL_NEIGHBOUR\n"));
+ return RIOKillNeighbour(p, arg);
+
+ case SPECIAL_RUP_CMD:
+ {
+ struct CmdBlk *CmdBlkP;
+
+ rio_dprint(RIO_DEBUG_CTRL, ("SPECIAL_RUP_CMD\n"));
+ if (copyin((int)arg, (caddr_t)&SpecialRupCmd,
+ sizeof(SpecialRupCmd)) == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("SPECIAL_RUP_CMD copy failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ CmdBlkP = RIOGetCmdBlk();
+ if ( !CmdBlkP ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("SPECIAL_RUP_CMD GetCmdBlk failed\n"));
+ return ENXIO;
+ }
+ CmdBlkP->Packet = SpecialRupCmd.Packet;
+ if ( SpecialRupCmd.Host >= p->RIONumHosts )
+ SpecialRupCmd.Host = 0;
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue special rup command for host %d rup %d\n",
+ SpecialRupCmd.Host, SpecialRupCmd.RupNum));
+ if (RIOQueueCmdBlk(&p->RIOHosts[SpecialRupCmd.Host],
+ SpecialRupCmd.RupNum, CmdBlkP) == RIO_FAIL) {
+ cprintf("FAILED TO QUEUE SPECIAL RUP COMMAND\n");
+ }
+ return 0;
+ }
+
+ case RIO_DEBUG_MEM:
+#ifdef DEBUG_MEM_SUPPORT
+RIO_DEBUG_CTRL, if (su)
+ return rio_RIODebugMemory(RIO_DEBUG_CTRL, arg);
+ else
+#endif
+ return EPERM;
+
+ case RIO_ALL_MODEM:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_ALL_MODEM\n"));
+ p->RIOError.Error = IOCTL_COMMAND_UNKNOWN;
+ return EINVAL;
+
+ case RIO_GET_TABLE:
+ /*
+ ** Read the routing table from the device driver to user space
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_TABLE\n"));
+
+ if ((retval = RIOApel(p)) != 0)
+ return retval;
+
+ if (copyout((caddr_t)p->RIOConnectTable, (int)arg,
+ TOTAL_MAP_ENTRIES*sizeof(struct Map)) == COPYFAIL) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_TABLE copy failed\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+
+ {
+ int entry;
+ rio_dprint(RIO_DEBUG_CTRL, ("*****\nMAP ENTRIES\n") );
+ for ( entry=0; entry<TOTAL_MAP_ENTRIES; entry++ )
+ {
+ if ((p->RIOConnectTable[entry].ID == 0) &&
+ (p->RIOConnectTable[entry].HostUniqueNum == 0) &&
+ (p->RIOConnectTable[entry].RtaUniqueNum == 0)) continue;
+
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.HostUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].HostUniqueNum ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.RtaUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].RtaUniqueNum ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.ID = 0x%x\n", entry, p->RIOConnectTable[entry].ID ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.ID2 = 0x%x\n", entry, p->RIOConnectTable[entry].ID2 ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Flags = 0x%x\n", entry, (int)p->RIOConnectTable[entry].Flags ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.SysPort = 0x%x\n", entry, (int)p->RIOConnectTable[entry].SysPort ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[0].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[0].Unit ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[0].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[0].Link ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[1].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[1].Unit ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[1].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[1].Link ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[2].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[2].Unit ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[2].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[2].Link ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[3].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[3].Unit ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[4].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[3].Link ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Name = %s\n", entry, p->RIOConnectTable[entry].Name ) );
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("*****\nEND MAP ENTRIES\n") );
+ }
+ p->RIOQuickCheck = NOT_CHANGED; /* a table has been gotten */
+ return 0;
+
+ case RIO_PUT_TABLE:
+ /*
+ ** Write the routing table to the device driver from user space
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_PUT_TABLE\n"));
+
+ if ( !su ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_PUT_TABLE !Root\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ if ( copyin((int)arg, (caddr_t)&p->RIOConnectTable[0],
+ TOTAL_MAP_ENTRIES*sizeof(struct Map) ) == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_PUT_TABLE copy failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+/*
+***********************************
+ {
+ int entry;
+ rio_dprint(RIO_DEBUG_CTRL, ("*****\nMAP ENTRIES\n") );
+ for ( entry=0; entry<TOTAL_MAP_ENTRIES; entry++ )
+ {
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.HostUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].HostUniqueNum ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.RtaUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].RtaUniqueNum ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.ID = 0x%x\n", entry, p->RIOConnectTable[entry].ID ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.ID2 = 0x%x\n", entry, p->RIOConnectTable[entry].ID2 ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Flags = 0x%x\n", entry, p->RIOConnectTable[entry].Flags ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.SysPort = 0x%x\n", entry, p->RIOConnectTable[entry].SysPort ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[0].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[0].Unit ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[0].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[0].Link ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[1].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[1].Unit ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[1].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[1].Link ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[2].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[2].Unit ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[2].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[2].Link ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[3].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[3].Unit ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[4].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[3].Link ) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Name = %s\n", entry, p->RIOConnectTable[entry].Name ) );
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("*****\nEND MAP ENTRIES\n") );
+ }
+***********************************
+*/
+ return RIONewTable(p);
+
+ case RIO_GET_BINDINGS :
+ /*
+ ** Send bindings table, containing unique numbers of RTAs owned
+ ** by this system to user space
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_BINDINGS\n"));
+
+ if ( !su )
+ {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_BINDINGS !Root\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ if (copyout((caddr_t) p->RIOBindTab, (int)arg,
+ (sizeof(ulong) * MAX_RTA_BINDINGS)) == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_BINDINGS copy failed\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return 0;
+
+ case RIO_PUT_BINDINGS :
+ /*
+ ** Receive a bindings table, containing unique numbers of RTAs owned
+ ** by this system
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_PUT_BINDINGS\n"));
+
+ if ( !su )
+ {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_PUT_BINDINGS !Root\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ if (copyin((int)arg, (caddr_t)&p->RIOBindTab[0],
+ (sizeof(ulong) * MAX_RTA_BINDINGS))==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_PUT_BINDINGS copy failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ return 0;
+
+ case RIO_BIND_RTA :
+ {
+ int EmptySlot = -1;
+ /*
+ ** Bind this RTA to host, so that it will be booted by
+ ** host in 'boot owned RTAs' mode.
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_BIND_RTA\n"));
+
+ if ( !su ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_BIND_RTA !Root\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ for (Entry = 0; Entry < MAX_RTA_BINDINGS; Entry++) {
+ if ((EmptySlot == -1) && (p->RIOBindTab[Entry] == 0L))
+ EmptySlot = Entry;
+ else if (p->RIOBindTab[Entry] == (int) arg) {
+ /*
+ ** Already exists - delete
+ */
+ p->RIOBindTab[Entry] = 0L;
+ rio_dprint(RIO_DEBUG_CTRL, ("Removing Rta %x from p->RIOBindTab\n",
+ (int) arg));
+ return 0;
+ }
+ }
+ /*
+ ** Dosen't exist - add
+ */
+ if (EmptySlot != -1) {
+ p->RIOBindTab[EmptySlot] = (int) arg;
+ rio_dprint(RIO_DEBUG_CTRL, ("Adding Rta %x to p->RIOBindTab\n",
+ (int) arg));
+ }
+ else {
+ rio_dprint(RIO_DEBUG_CTRL, ("p->RIOBindTab full! - Rta %x not added\n",
+ (int) arg));
+ return 1;
+ }
+ return 0;
+ }
+
+ case RIO_RESUME :
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_RESUME\n"));
+ port = (uint) arg;
+ if ((port < 0) || (port > 511)) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_RESUME: Bad port number %d\n", port));
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+ PortP = p->RIOPortp[port];
+ if (!PortP->Mapped) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_RESUME: Port %d not mapped\n", port));
+ p->RIOError.Error = PORT_NOT_MAPPED_INTO_SYSTEM;
+ return EINVAL;
+ }
+ if (!(PortP->State & (RIO_LOPEN | RIO_MOPEN))) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_RESUME: Port %d not open\n", port));
+ return EINVAL;
+ }
+
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ if (RIOPreemptiveCmd(p, (p->RIOPortp[port]), RESUME) ==
+ RIO_FAIL) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_RESUME failed\n"));
+ rio_spin_unlock_irqrestore(&PortP->portSem, flags);
+ return EBUSY;
+ }
+ else {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_RESUME: Port %d resumed\n", port));
+ PortP->State |= RIO_BUSY;
+ }
+ rio_spin_unlock_irqrestore(&PortP->portSem, flags);
+ return retval;
+
+ case RIO_ASSIGN_RTA:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_ASSIGN_RTA\n"));
+ if ( !su ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_ASSIGN_RTA !Root\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ if (copyin((int)arg, (caddr_t)&MapEnt, sizeof(MapEnt))
+ == COPYFAIL) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Copy from user space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ return RIOAssignRta(p, &MapEnt);
+
+ case RIO_CHANGE_NAME:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_CHANGE_NAME\n"));
+ if ( !su ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_CHANGE_NAME !Root\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ if (copyin((int)arg, (caddr_t)&MapEnt, sizeof(MapEnt))
+ == COPYFAIL) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Copy from user space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ return RIOChangeName(p, &MapEnt);
+
+ case RIO_DELETE_RTA:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_DELETE_RTA\n"));
+ if ( !su ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_DELETE_RTA !Root\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ if (copyin((int)arg, (caddr_t)&MapEnt, sizeof(MapEnt))
+ == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Copy from data space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ return RIODeleteRta(p, &MapEnt);
+
+ case RIO_QUICK_CHECK:
+ /*
+ ** 09.12.1998 ARG - ESIL 0776 part fix
+ ** A customer was using this to get the RTAs
+ ** connect/disconnect status.
+ ** RIOConCon() had been botched use RIOHalted
+ ** to keep track of RTA connections and
+ ** disconnections. That has been changed and
+ ** RIORtaDisCons in the rio_info struct now
+ ** does the job. So we need to return the value
+ ** of RIORtaCons instead of RIOHalted.
+ **
+ if (copyout((caddr_t)&p->RIOHalted,(int)arg,
+ sizeof(uint))==COPYFAIL) {
+ **
+ */
+
+ if (copyout((caddr_t)&p->RIORtaDisCons,(int)arg,
+ sizeof(uint))==COPYFAIL) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return 0;
+
+ case RIO_LAST_ERROR:
+ if (copyout((caddr_t)&p->RIOError, (int)arg,
+ sizeof(struct Error)) ==COPYFAIL )
+ return EFAULT;
+ return 0;
+
+ case RIO_GET_LOG:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_LOG\n"));
+#ifdef LOGGING
+ RIOGetLog(arg);
+ return 0;
+#else
+ return EINVAL;
+#endif
+
+ case RIO_GET_MODTYPE:
+ if ( copyin( (int)arg, (caddr_t)&port,
+ sizeof(uint)) == COPYFAIL )
+ {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Get module type for port %d\n", port));
+ if ( port < 0 || port > 511 )
+ {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_MODTYPE: Bad port number %d\n", port));
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+ PortP = (p->RIOPortp[port]);
+ if (!PortP->Mapped)
+ {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_MODTYPE: Port %d not mapped\n", port));
+ p->RIOError.Error = PORT_NOT_MAPPED_INTO_SYSTEM;
+ return EINVAL;
+ }
+ /*
+ ** Return module type of port
+ */
+ port = PortP->HostP->UnixRups[PortP->RupNum].ModTypes;
+ if (copyout((caddr_t)&port, (int)arg,
+ sizeof(uint)) == COPYFAIL) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return(0);
+ /*
+ ** 02.03.1999 ARG - ESIL 0820 fix
+ ** We are no longer using "Boot Mode", so these ioctls
+ ** are not required :
+ **
+ case RIO_GET_BOOT_MODE :
+ rio_dprint(RIO_DEBUG_CTRL, ("Get boot mode - %x\n", p->RIOBootMode));
+ **
+ ** Return boot state of system - BOOT_ALL, BOOT_OWN or BOOT_NONE
+ **
+ if (copyout((caddr_t)&p->RIOBootMode, (int)arg,
+ sizeof(p->RIOBootMode)) == COPYFAIL) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return(0);
+
+ case RIO_SET_BOOT_MODE :
+ p->RIOBootMode = (uint) arg;
+ rio_dprint(RIO_DEBUG_CTRL, ("Set boot mode to 0x%x\n", p->RIOBootMode));
+ return(0);
+ **
+ ** End ESIL 0820 fix
+ */
+
+ case RIO_BLOCK_OPENS:
+ rio_dprint(RIO_DEBUG_CTRL, ("Opens block until booted\n"));
+ for ( Entry=0; Entry < RIO_PORTS; Entry++ ) {
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ p->RIOPortp[Entry]->WaitUntilBooted = 1;
+ rio_spin_unlock_irqrestore(&PortP->portSem, flags);
+ }
+ return 0;
+
+ case RIO_SETUP_PORTS:
+ rio_dprint(RIO_DEBUG_CTRL, ("Setup ports\n"));
+ if (copyin((int)arg, (caddr_t)&PortSetup, sizeof(PortSetup))
+ == COPYFAIL ) {
+ p->RIOError.Error = COPYIN_FAILED;
+ rio_dprint(RIO_DEBUG_CTRL, ("EFAULT"));
+ return EFAULT;
+ }
+ if ( PortSetup.From > PortSetup.To ||
+ PortSetup.To >= RIO_PORTS ) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ rio_dprint(RIO_DEBUG_CTRL, ("ENXIO"));
+ return ENXIO;
+ }
+ if ( PortSetup.XpCps > p->RIOConf.MaxXpCps ||
+ PortSetup.XpCps < p->RIOConf.MinXpCps ) {
+ p->RIOError.Error = XPRINT_CPS_OUT_OF_RANGE;
+ rio_dprint(RIO_DEBUG_CTRL, ("EINVAL"));
+ return EINVAL;
+ }
+ if ( !p->RIOPortp ) {
+ cprintf("No p->RIOPortp array!\n");
+ rio_dprint(RIO_DEBUG_CTRL, ("No p->RIOPortp array!\n"));
+ return EIO;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("entering loop (%d %d)!\n", PortSetup.From, PortSetup.To));
+ for (loop=PortSetup.From; loop<=PortSetup.To; loop++) {
+ rio_dprint(RIO_DEBUG_CTRL, ("in loop (%d)!\n", loop));
+#if 0
+ PortP = p->RIOPortp[loop];
+ if ( !PortP->TtyP )
+ PortP->TtyP = &p->channel[loop];
+
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ if ( PortSetup.IxAny )
+ PortP->Config |= RIO_IXANY;
+ else
+ PortP->Config &= ~RIO_IXANY;
+ if ( PortSetup.IxOn )
+ PortP->Config |= RIO_IXON;
+ else
+ PortP->Config &= ~RIO_IXON;
+
+ /*
+ ** If the port needs to wait for all a processes output
+ ** to drain before closing then this flag will be set.
+ */
+ if (PortSetup.Drain) {
+ PortP->Config |= RIO_WAITDRAIN;
+ } else {
+ PortP->Config &= ~RIO_WAITDRAIN;
+ }
+ /*
+ ** Store setings if locking or unlocking port or if the
+ ** port is not locked, when setting the store option.
+ */
+ if (PortP->Mapped &&
+ ((PortSetup.Lock && !PortP->Lock) ||
+ (!PortP->Lock &&
+ (PortSetup.Store && !PortP->Store)))) {
+ PortP->StoredTty.iflag = PortP->TtyP->tm.c_iflag;
+ PortP->StoredTty.oflag = PortP->TtyP->tm.c_oflag;
+ PortP->StoredTty.cflag = PortP->TtyP->tm.c_cflag;
+ PortP->StoredTty.lflag = PortP->TtyP->tm.c_lflag;
+ PortP->StoredTty.line = PortP->TtyP->tm.c_line;
+ bcopy(PortP->TtyP->tm.c_cc, PortP->StoredTty.cc,
+ NCC + 5);
+ }
+ PortP->Lock = PortSetup.Lock;
+ PortP->Store = PortSetup.Store;
+ PortP->Xprint.XpCps = PortSetup.XpCps;
+ bcopy(PortSetup.XpOn,PortP->Xprint.XpOn,MAX_XP_CTRL_LEN);
+ bcopy(PortSetup.XpOff,PortP->Xprint.XpOff,MAX_XP_CTRL_LEN);
+ PortP->Xprint.XpOn[MAX_XP_CTRL_LEN-1] = '\0';
+ PortP->Xprint.XpOff[MAX_XP_CTRL_LEN-1] = '\0';
+ PortP->Xprint.XpLen = RIOStrlen(PortP->Xprint.XpOn)+
+ RIOStrlen(PortP->Xprint.XpOff);
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+#endif
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("after loop (%d)!\n", loop));
+ rio_dprint(RIO_DEBUG_CTRL, ("Retval:%x\n", retval ) );
+ return retval;
+
+ case RIO_GET_PORT_SETUP :
+ rio_dprint(RIO_DEBUG_CTRL, ("Get port setup\n"));
+ if (copyin((int)arg, (caddr_t)&PortSetup, sizeof(PortSetup))
+ == COPYFAIL ) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if ( PortSetup.From >= RIO_PORTS ) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+
+ port = PortSetup.To = PortSetup.From;
+ PortSetup.IxAny = (p->RIOPortp[port]->Config & RIO_IXANY) ?
+ 1 : 0;
+ PortSetup.IxOn = (p->RIOPortp[port]->Config & RIO_IXON) ?
+ 1 : 0;
+ PortSetup.Drain = (p->RIOPortp[port]->Config & RIO_WAITDRAIN) ?
+ 1 : 0;
+ PortSetup.Store = p->RIOPortp[port]->Store;
+ PortSetup.Lock = p->RIOPortp[port]->Lock;
+ PortSetup.XpCps = p->RIOPortp[port]->Xprint.XpCps;
+ bcopy(p->RIOPortp[port]->Xprint.XpOn, PortSetup.XpOn,
+ MAX_XP_CTRL_LEN);
+ bcopy(p->RIOPortp[port]->Xprint.XpOff, PortSetup.XpOff,
+ MAX_XP_CTRL_LEN);
+ PortSetup.XpOn[MAX_XP_CTRL_LEN-1] = '\0';
+ PortSetup.XpOff[MAX_XP_CTRL_LEN-1] = '\0';
+
+ if ( copyout((caddr_t)&PortSetup,(int)arg,sizeof(PortSetup))
+ ==COPYFAIL ) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_GET_PORT_PARAMS :
+ rio_dprint(RIO_DEBUG_CTRL, ("Get port params\n"));
+ if (copyin( (int)arg, (caddr_t)&PortParams,
+ sizeof(struct PortParams)) == COPYFAIL) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if (PortParams.Port >= RIO_PORTS) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ PortP = (p->RIOPortp[PortParams.Port]);
+ PortParams.Config = PortP->Config;
+ PortParams.State = PortP->State;
+ rio_dprint(RIO_DEBUG_CTRL, ("Port %d\n", PortParams.Port));
+
+ if (copyout((caddr_t)&PortParams, (int)arg,
+ sizeof(struct PortParams)) == COPYFAIL ) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_GET_PORT_TTY :
+ rio_dprint(RIO_DEBUG_CTRL, ("Get port tty\n"));
+ if (copyin((int)arg, (caddr_t)&PortTty, sizeof(struct PortTty))
+ == COPYFAIL) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if ( PortTty.port >= RIO_PORTS ) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+
+ rio_dprint(RIO_DEBUG_CTRL, ("Port %d\n", PortTty.port));
+ PortP = (p->RIOPortp[PortTty.port]);
+#if 0
+ PortTty.Tty.tm.c_iflag = PortP->TtyP->tm.c_iflag;
+ PortTty.Tty.tm.c_oflag = PortP->TtyP->tm.c_oflag;
+ PortTty.Tty.tm.c_cflag = PortP->TtyP->tm.c_cflag;
+ PortTty.Tty.tm.c_lflag = PortP->TtyP->tm.c_lflag;
+#endif
+ if (copyout((caddr_t)&PortTty, (int)arg,
+ sizeof(struct PortTty)) == COPYFAIL) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_SET_PORT_TTY :
+ if (copyin((int)arg, (caddr_t)&PortTty,
+ sizeof(struct PortTty)) == COPYFAIL) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Set port %d tty\n", PortTty.port));
+ if (PortTty.port >= (ushort) RIO_PORTS) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ PortP = (p->RIOPortp[PortTty.port]);
+#if 0
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ PortP->TtyP->tm.c_iflag = PortTty.Tty.tm.c_iflag;
+ PortP->TtyP->tm.c_oflag = PortTty.Tty.tm.c_oflag;
+ PortP->TtyP->tm.c_cflag = PortTty.Tty.tm.c_cflag;
+ PortP->TtyP->tm.c_lflag = PortTty.Tty.tm.c_lflag;
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+#endif
+
+ RIOParam(PortP, CONFIG, PortP->State & RIO_MODEM, OK_TO_SLEEP);
+ return retval;
+
+ case RIO_SET_PORT_PARAMS :
+ rio_dprint(RIO_DEBUG_CTRL, ("Set port params\n"));
+ if ( copyin((int)arg, (caddr_t)&PortParams, sizeof(PortParams))
+ == COPYFAIL ) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if (PortParams.Port >= (ushort) RIO_PORTS) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ PortP = (p->RIOPortp[PortParams.Port]);
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ PortP->Config = PortParams.Config;
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ return retval;
+
+ case RIO_GET_PORT_STATS :
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GET_PORT_STATS\n"));
+ if ( copyin((int)arg, (caddr_t)&portStats,
+ sizeof(struct portStats)) == COPYFAIL ) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if ( portStats.port >= RIO_PORTS ) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ PortP = (p->RIOPortp[portStats.port]);
+ portStats.gather = PortP->statsGather;
+ portStats.txchars = PortP->txchars;
+ portStats.rxchars = PortP->rxchars;
+ portStats.opens = PortP->opens;
+ portStats.closes = PortP->closes;
+ portStats.ioctls = PortP->ioctls;
+ if ( copyout((caddr_t)&portStats, (int)arg,
+ sizeof(struct portStats)) == COPYFAIL ) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_RESET_PORT_STATS :
+ port = (uint) arg;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_RESET_PORT_STATS\n"));
+ if ( port >= RIO_PORTS ) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ PortP = (p->RIOPortp[port]);
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ PortP->txchars = 0;
+ PortP->rxchars = 0;
+ PortP->opens = 0;
+ PortP->closes = 0;
+ PortP->ioctls = 0;
+ rio_spin_unlock_irqrestore(&PortP->portSem, flags);
+ return retval;
+
+ case RIO_GATHER_PORT_STATS :
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GATHER_PORT_STATS\n"));
+ if ( copyin( (int)arg, (caddr_t)&portStats,
+ sizeof(struct portStats)) == COPYFAIL ) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if ( portStats.port >= RIO_PORTS ) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ PortP = (p->RIOPortp[portStats.port]);
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ PortP->statsGather = portStats.gather;
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ return retval;
+
+#ifdef DEBUG_SUPPORTED
+ case RIO_READ_LEVELS:
+ {
+ int num;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_READ_LEVELS\n"));
+ for ( num=0; RIODbInf[num].Flag; num++ ) ;
+ rio_dprint(RIO_DEBUG_CTRL, ("%d levels to copy\n",num));
+ if (copyout((caddr_t)RIODbInf,(int)arg,
+ sizeof(struct DbInf)*(num+1))==COPYFAIL) {
+ rio_dprint(RIO_DEBUG_CTRL, ("ReadLevels Copy failed\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("%d levels to copied\n",num));
+ return retval;
+ }
+#endif
+
+ case RIO_READ_CONFIG:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_READ_CONFIG\n"));
+ if (copyout((caddr_t)&p->RIOConf, (int)arg,
+ sizeof(struct Conf)) ==COPYFAIL ) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_SET_CONFIG:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SET_CONFIG\n"));
+ if ( !su ) {
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ if ( copyin((int)arg, (caddr_t)&p->RIOConf, sizeof(struct Conf) )
+ ==COPYFAIL ) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ /*
+ ** move a few value around
+ */
+ for (Host=0; Host < p->RIONumHosts; Host++)
+ if ( (p->RIOHosts[Host].Flags & RUN_STATE) == RC_RUNNING )
+ WWORD(p->RIOHosts[Host].ParmMapP->timer ,
+ p->RIOConf.Timer);
+ return retval;
+
+ case RIO_START_POLLER:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_START_POLLER\n"));
+ return EINVAL;
+
+ case RIO_STOP_POLLER:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_STOP_POLLER\n"));
+ if ( !su ) {
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ p->RIOPolling = NOT_POLLING;
+ return retval;
+
+ case RIO_SETDEBUG:
+ case RIO_GETDEBUG:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SETDEBUG/RIO_GETDEBUG\n"));
+ if ( copyin( (int)arg, (caddr_t)&DebugCtrl, sizeof(DebugCtrl) )
+ ==COPYFAIL ) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if ( DebugCtrl.SysPort == NO_PORT ) {
+ if ( cmd == RIO_SETDEBUG ) {
+ if ( !su ) {
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ p->rio_debug = DebugCtrl.Debug;
+ p->RIODebugWait = DebugCtrl.Wait;
+ rio_dprint(RIO_DEBUG_CTRL, ("Set global debug to 0x%x set wait to 0x%x\n",
+ p->rio_debug,p->RIODebugWait));
+ }
+ else {
+ rio_dprint(RIO_DEBUG_CTRL, ("Get global debug 0x%x wait 0x%x\n",
+ p->rio_debug,p->RIODebugWait));
+ DebugCtrl.Debug = p->rio_debug;
+ DebugCtrl.Wait = p->RIODebugWait;
+ if ( copyout((caddr_t)&DebugCtrl,(int)arg,
+ sizeof(DebugCtrl)) == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SET/GET DEBUG: bad port number %d\n",
+ DebugCtrl.SysPort));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ }
+ }
+ else if ( DebugCtrl.SysPort >= RIO_PORTS &&
+ DebugCtrl.SysPort != NO_PORT ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SET/GET DEBUG: bad port number %d\n",
+ DebugCtrl.SysPort));
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ else if ( cmd == RIO_SETDEBUG ) {
+ if ( !su ) {
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ p->RIOPortp[DebugCtrl.SysPort]->Debug = DebugCtrl.Debug;
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SETDEBUG 0x%x\n",
+ p->RIOPortp[DebugCtrl.SysPort]->Debug));
+ }
+ else {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GETDEBUG 0x%x\n",
+ p->RIOPortp[DebugCtrl.SysPort]->Debug));
+ DebugCtrl.Debug = p->RIOPortp[DebugCtrl.SysPort]->Debug;
+ if ( copyout((caddr_t)&DebugCtrl,(int)arg,
+ sizeof(DebugCtrl))==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_GETDEBUG: Bad copy to user space\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ }
+ return retval;
+
+ case RIO_VERSID:
+ /*
+ ** Enquire about the release and version.
+ ** We return MAX_VERSION_LEN bytes, being a
+ ** textual null terminated string.
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_VERSID\n") );
+ if ( copyout( (caddr_t)RIOVersid(),
+ (int)arg,
+ sizeof(struct rioVersion) ) == COPYFAIL )
+ {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_VERSID: Bad copy to user space (host=%d)\n",Host) );
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+
+ /*
+ ** !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
+ ** !! commented out previous 'RIO_VERSID' functionality !!
+ ** !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
+ **
+ case RIO_VERSID:
+ **
+ ** Enquire about the release and version.
+ ** We return MAX_VERSION_LEN bytes, being a textual null
+ ** terminated string.
+ **
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_VERSID\n"));
+ if (copyout((caddr_t)RIOVersid(),
+ (int)arg, MAX_VERSION_LEN ) == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_VERSID: Bad copy to user space\n",Host));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+ **
+ ** !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
+ */
+
+ case RIO_NUM_HOSTS:
+ /*
+ ** Enquire as to the number of hosts located
+ ** at init time.
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_NUM_HOSTS\n"));
+ if (copyout((caddr_t)&p->RIONumHosts, (int)arg,
+ sizeof(p->RIONumHosts) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_NUM_HOSTS: Bad copy to user space\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_HOST_FOAD:
+ /*
+ ** Kill host. This may not be in the final version...
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_FOAD %d\n", (int)arg));
+ if ( !su ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_FOAD: Not super user\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ p->RIOHalted = 1;
+ p->RIOSystemUp = 0;
+
+ for ( Host=0; Host<p->RIONumHosts; Host++ ) {
+ (void)RIOBoardTest( p->RIOHosts[Host].PaddrP,
+ p->RIOHosts[Host].Caddr, p->RIOHosts[Host].Type,
+ p->RIOHosts[Host].Slot );
+ bzero( (caddr_t)&p->RIOHosts[Host].Flags,
+ ((int)&p->RIOHosts[Host].____end_marker____) -
+ ((int)&p->RIOHosts[Host].Flags) );
+ p->RIOHosts[Host].Flags = RC_WAITING;
+#if 0
+ RIOSetupDataStructs(p);
+#endif
+ }
+ RIOFoadWakeup(p);
+ p->RIONumBootPkts = 0;
+ p->RIOBooting = 0;
+
+#ifdef RINGBUFFER_SUPPORT
+ for( loop=0; loop<RIO_PORTS; loop++ )
+ if ( p->RIOPortp[loop]->TxRingBuffer )
+ sysfree((void *)p->RIOPortp[loop]->TxRingBuffer,
+ RIOBufferSize );
+#endif
+#if 0
+ bzero((caddr_t)&p->RIOPortp[0],RIO_PORTS*sizeof(struct Port));
+#else
+ printk ("HEEEEELP!\n");
+#endif
+
+ for( loop=0; loop<RIO_PORTS; loop++ ) {
+#if 0
+ p->RIOPortp[loop]->TtyP = &p->channel[loop];
+#endif
+
+ p->RIOPortp[loop]->portSem = SPIN_LOCK_UNLOCKED;
+ p->RIOPortp[loop]->InUse = NOT_INUSE;
+ }
+
+ p->RIOSystemUp = 0;
+ return retval;
+
+ case RIO_DOWNLOAD:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_DOWNLOAD\n"));
+ if ( !su ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_DOWNLOAD: Not super user\n"));
+ p->RIOError.Error = NOT_SUPER_USER;
+ return EPERM;
+ }
+ if ( copyin((int)arg, (caddr_t)&DownLoad,
+ sizeof(DownLoad) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_DOWNLOAD: Copy in from user space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Copied in download code for product code 0x%x\n",
+ DownLoad.ProductCode ) );
+
+ /*
+ ** It is important that the product code is an unsigned object!
+ */
+ if ( DownLoad.ProductCode > MAX_PRODUCT ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_DOWNLOAD: Bad product code %d passed\n",
+ DownLoad.ProductCode));
+ p->RIOError.Error = NO_SUCH_PRODUCT;
+ return ENXIO;
+ }
+ /*
+ ** do something!
+ */
+ retval = (*(RIOBootTable[DownLoad.ProductCode]))(p, &DownLoad);
+ /* <-- Panic */
+ p->RIOHalted = 0;
+ /*
+ ** and go back, content with a job well completed.
+ */
+ return retval;
+
+ case RIO_PARMS:
+ {
+ uint host;
+
+ if (copyin((int)arg, (caddr_t)&host,
+ sizeof(host) ) == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, (
+ "RIO_HOST_REQ: Copy in from user space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ /*
+ ** Fetch the parmmap
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_PARMS\n"));
+ if ( copyout( (caddr_t)p->RIOHosts[host].ParmMapP,
+ (int)arg, sizeof(PARM_MAP) )==COPYFAIL ) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_PARMS: Copy out to user space failed\n"));
+ return EFAULT;
+ }
+ }
+ return retval;
+
+ case RIO_HOST_REQ:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_REQ\n"));
+ if (copyin((int)arg, (caddr_t)&HostReq,
+ sizeof(HostReq) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_REQ: Copy in from user space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if ( HostReq.HostNum >= p->RIONumHosts ) {
+ p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_REQ: Illegal host number %d\n",
+ HostReq.HostNum));
+ return ENXIO;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Request for host %d\n", HostReq.HostNum));
+
+ if (copyout((caddr_t)&p->RIOHosts[HostReq.HostNum],
+ (int)HostReq.HostP,sizeof(struct Host) ) == COPYFAIL) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_REQ: Bad copy to user space\n"));
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_HOST_DPRAM:
+ rio_dprint(RIO_DEBUG_CTRL, ("Request for DPRAM\n"));
+ if ( copyin( (int)arg, (caddr_t)&HostDpRam,
+ sizeof(HostDpRam) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_DPRAM: Copy in from user space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if ( HostDpRam.HostNum >= p->RIONumHosts ) {
+ p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_DPRAM: Illegal host number %d\n",
+ HostDpRam.HostNum));
+ return ENXIO;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Request for host %d\n", HostDpRam.HostNum));
+
+ if (p->RIOHosts[HostDpRam.HostNum].Type == RIO_PCI) {
+ int off;
+ /* It's hardware like this that really gets on my tits. */
+ static unsigned char copy[sizeof(struct DpRam)];
+ for ( off=0; off<sizeof(struct DpRam); off++ )
+ copy[off] = p->RIOHosts[HostDpRam.HostNum].Caddr[off];
+ if ( copyout( (caddr_t)copy, (int)HostDpRam.DpRamP,
+ sizeof(struct DpRam) ) == COPYFAIL ) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_DPRAM: Bad copy to user space\n"));
+ return EFAULT;
+ }
+ }
+ else if (copyout((caddr_t)p->RIOHosts[HostDpRam.HostNum].Caddr,
+ (int)HostDpRam.DpRamP,
+ sizeof(struct DpRam) ) == COPYFAIL ) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_DPRAM: Bad copy to user space\n"));
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_SET_BUSY:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SET_BUSY\n"));
+ if ( (int)arg < 0 || (int)arg > 511 ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SET_BUSY: Bad port number %d\n",(int)arg));
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ p->RIOPortp[(int)arg]->State |= RIO_BUSY;
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ return retval;
+
+ case RIO_HOST_PORT:
+ /*
+ ** The daemon want port information
+ ** (probably for debug reasons)
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_PORT\n"));
+ if ( copyin((int)arg, (caddr_t)&PortReq,
+ sizeof(PortReq) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_PORT: Copy in from user space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+
+ if (PortReq.SysPort >= RIO_PORTS) { /* SysPort is unsigned */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_PORT: Illegal port number %d\n",
+ PortReq.SysPort));
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Request for port %d\n", PortReq.SysPort));
+ if (copyout((caddr_t)p->RIOPortp[PortReq.SysPort],
+ (int)PortReq.PortP,
+ sizeof(struct Port) ) == COPYFAIL) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_PORT: Bad copy to user space\n"));
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_HOST_RUP:
+ /*
+ ** The daemon want rup information
+ ** (probably for debug reasons)
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_RUP\n"));
+ if (copyin((int)arg, (caddr_t)&RupReq,
+ sizeof(RupReq) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_RUP: Copy in from user space failed\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if (RupReq.HostNum >= p->RIONumHosts) { /* host is unsigned */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_RUP: Illegal host number %d\n",
+ RupReq.HostNum));
+ p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ if ( RupReq.RupNum >= MAX_RUP+LINKS_PER_UNIT ) { /* eek! */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_RUP: Illegal rup number %d\n",
+ RupReq.RupNum));
+ p->RIOError.Error = RUP_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+ HostP = &p->RIOHosts[RupReq.HostNum];
+
+ if ((HostP->Flags & RUN_STATE) != RC_RUNNING) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_RUP: Host %d not running\n",
+ RupReq.HostNum));
+ p->RIOError.Error = HOST_NOT_RUNNING;
+ return EIO;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Request for rup %d from host %d\n",
+ RupReq.RupNum,RupReq.HostNum));
+
+ if (copyout((caddr_t)HostP->UnixRups[RupReq.RupNum].RupP,
+ (int)RupReq.RupP,sizeof(struct RUP) ) == COPYFAIL) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_RUP: Bad copy to user space\n"));
+ return EFAULT;
+ }
+ return retval;
+
+ case RIO_HOST_LPB:
+ /*
+ ** The daemon want lpb information
+ ** (probably for debug reasons)
+ */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_LPB\n"));
+ if (copyin((int)arg, (caddr_t)&LpbReq,
+ sizeof(LpbReq) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_LPB: Bad copy from user space\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if (LpbReq.Host >= p->RIONumHosts) { /* host is unsigned */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_LPB: Illegal host number %d\n",
+ LpbReq.Host));
+ p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+ if ( LpbReq.Link >= LINKS_PER_UNIT ) { /* eek! */
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_LPB: Illegal link number %d\n",
+ LpbReq.Link));
+ p->RIOError.Error = LINK_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+ HostP = &p->RIOHosts[LpbReq.Host];
+
+ if ( (HostP->Flags & RUN_STATE) != RC_RUNNING ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_LPB: Host %d not running\n",
+ LpbReq.Host));
+ p->RIOError.Error = HOST_NOT_RUNNING;
+ return EIO;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Request for lpb %d from host %d\n",
+ LpbReq.Link, LpbReq.Host));
+
+ if (copyout((caddr_t)&HostP->LinkStrP[LpbReq.Link],
+ (int)LpbReq.LpbP,sizeof(struct LPB) ) == COPYFAIL) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_HOST_LPB: Bad copy to user space\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return retval;
+
+ /*
+ ** Here 3 IOCTL's that allow us to change the way in which
+ ** rio logs errors. send them just to syslog or send them
+ ** to both syslog and console or send them to just the console.
+ **
+ ** See RioStrBuf() in util.c for the other half.
+ */
+ case RIO_SYSLOG_ONLY:
+ p->RIOPrintLogState = PRINT_TO_LOG; /* Just syslog */
+ return 0;
+
+ case RIO_SYSLOG_CONS:
+ p->RIOPrintLogState = PRINT_TO_LOG_CONS;/* syslog and console */
+ return 0;
+
+ case RIO_CONS_ONLY:
+ p->RIOPrintLogState = PRINT_TO_CONS; /* Just console */
+ return 0;
+
+ case RIO_SIGNALS_ON:
+ if ( p->RIOSignalProcess ) {
+ p->RIOError.Error = SIGNALS_ALREADY_SET;
+ return EBUSY;
+ }
+ p->RIOSignalProcess = getpid();
+ p->RIOPrintDisabled = DONT_PRINT;
+ return retval;
+
+ case RIO_SIGNALS_OFF:
+ if ( p->RIOSignalProcess != getpid() ) {
+ p->RIOError.Error = NOT_RECEIVING_PROCESS;
+ return EPERM;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("Clear signal process to zero\n"));
+ p->RIOSignalProcess = 0;
+ return retval;
+
+ case RIO_SET_BYTE_MODE:
+ for ( Host=0; Host<p->RIONumHosts; Host++ )
+ if ( p->RIOHosts[Host].Type == RIO_AT )
+ p->RIOHosts[Host].Mode &= ~WORD_OPERATION;
+ return retval;
+
+ case RIO_SET_WORD_MODE:
+ for ( Host=0; Host<p->RIONumHosts; Host++ )
+ if ( p->RIOHosts[Host].Type == RIO_AT )
+ p->RIOHosts[Host].Mode |= WORD_OPERATION;
+ return retval;
+
+ case RIO_SET_FAST_BUS:
+ for ( Host=0; Host<p->RIONumHosts; Host++ )
+ if ( p->RIOHosts[Host].Type == RIO_AT )
+ p->RIOHosts[Host].Mode |= FAST_AT_BUS;
+ return retval;
+
+ case RIO_SET_SLOW_BUS:
+ for ( Host=0; Host<p->RIONumHosts; Host++ )
+ if ( p->RIOHosts[Host].Type == RIO_AT )
+ p->RIOHosts[Host].Mode &= ~FAST_AT_BUS;
+ return retval;
+
+ case RIO_MAP_B50_TO_50:
+ case RIO_MAP_B50_TO_57600:
+ case RIO_MAP_B110_TO_110:
+ case RIO_MAP_B110_TO_115200:
+ rio_dprint(RIO_DEBUG_CTRL, ("Baud rate mapping\n"));
+ port = (uint) arg;
+ if ( port < 0 || port > 511 ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Baud rate mapping: Bad port number %d\n", port));
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+ switch( cmd )
+ {
+ case RIO_MAP_B50_TO_50 :
+ p->RIOPortp[port]->Config |= RIO_MAP_50_TO_50;
+ break;
+ case RIO_MAP_B50_TO_57600 :
+ p->RIOPortp[port]->Config &= ~RIO_MAP_50_TO_50;
+ break;
+ case RIO_MAP_B110_TO_110 :
+ p->RIOPortp[port]->Config |= RIO_MAP_110_TO_110;
+ break;
+ case RIO_MAP_B110_TO_115200 :
+ p->RIOPortp[port]->Config &= ~RIO_MAP_110_TO_110;
+ break;
+ }
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ return retval;
+
+ case RIO_STREAM_INFO:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_STREAM_INFO\n"));
+ return EINVAL;
+
+ case RIO_SEND_PACKET:
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SEND_PACKET\n"));
+ if ( copyin( (int)arg, (caddr_t)&SendPack,
+ sizeof(SendPack) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_SEND_PACKET: Bad copy from user space\n"));
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ if ( SendPack.PortNum >= 128 ) {
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return ENXIO;
+ }
+
+ PortP = p->RIOPortp[SendPack.PortNum];
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+
+ if ( !can_add_transmit(&PacketP,PortP) ) {
+ p->RIOError.Error = UNIT_IS_IN_USE;
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ return ENOSPC;
+ }
+
+ for ( loop=0; loop<(ushort)(SendPack.Len & 127); loop++ )
+ WBYTE(PacketP->data[loop], SendPack.Data[loop] );
+
+ WBYTE(PacketP->len, SendPack.Len);
+
+ add_transmit( PortP );
+ /*
+ ** Count characters transmitted for port statistics reporting
+ */
+ if (PortP->statsGather)
+ PortP->txchars += (SendPack.Len & 127);
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ return retval;
+
+ case RIO_NO_MESG:
+ if ( su )
+ p->RIONoMessage = 1;
+ return su ? 0 : EPERM;
+
+ case RIO_MESG:
+ if ( su )
+ p->RIONoMessage = 0;
+ return su ? 0 : EPERM;
+
+ case RIO_WHAT_MESG:
+ if ( copyout( (caddr_t)&p->RIONoMessage, (int)arg,
+ sizeof(p->RIONoMessage) )==COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_WHAT_MESG: Bad copy to user space\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return 0;
+
+ case RIO_MEM_DUMP :
+ if (copyin((int)arg, (caddr_t)&SubCmd,
+ sizeof(struct SubCmdStruct)) == COPYFAIL) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_MEM_DUMP host %d rup %d addr %x\n",
+ SubCmd.Host, SubCmd.Rup, SubCmd.Addr));
+
+ if (SubCmd.Rup >= MAX_RUP+LINKS_PER_UNIT ) {
+ p->RIOError.Error = RUP_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+
+ if (SubCmd.Host >= p->RIONumHosts ) {
+ p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+
+ port = p->RIOHosts[SubCmd.Host].
+ UnixRups[SubCmd.Rup].BaseSysPort;
+
+ PortP = p->RIOPortp[port];
+
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+
+ if ( RIOPreemptiveCmd(p, PortP, MEMDUMP ) == RIO_FAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_MEM_DUMP failed\n"));
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ return EBUSY;
+ }
+ else
+ PortP->State |= RIO_BUSY;
+
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ if ( copyout( (caddr_t)p->RIOMemDump, (int)arg,
+ MEMDUMP_SIZE) == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_MEM_DUMP copy failed\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return 0;
+
+ case RIO_TICK:
+ if ((int)arg < 0 || (int)arg >= p->RIONumHosts)
+ return EINVAL;
+ rio_dprint(RIO_DEBUG_CTRL, ("Set interrupt for host %d\n", (int)arg ));
+ WBYTE(p->RIOHosts[(int)arg].SetInt , 0xff);
+ return 0;
+
+ case RIO_TOCK:
+ if ((int)arg < 0 || (int)arg >= p->RIONumHosts)
+ return EINVAL;
+ rio_dprint(RIO_DEBUG_CTRL, ("Clear interrupt for host %d\n", (int)arg ));
+ WBYTE((p->RIOHosts[(int)arg].ResetInt) , 0xff);
+ return 0;
+
+ case RIO_READ_CHECK:
+ /* Check reads for pkts with data[0] the same */
+ p->RIOReadCheck = !p->RIOReadCheck;
+ if (copyout((caddr_t)&p->RIOReadCheck,(int)arg,
+ sizeof(uint))== COPYFAIL) {
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return 0;
+
+ case RIO_READ_REGISTER :
+ if (copyin((int)arg, (caddr_t)&SubCmd,
+ sizeof(struct SubCmdStruct)) == COPYFAIL) {
+ p->RIOError.Error = COPYIN_FAILED;
+ return EFAULT;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_READ_REGISTER host %d rup %d port %d reg %x\n",
+ SubCmd.Host, SubCmd.Rup, SubCmd.Port, SubCmd.Addr));
+
+ if (SubCmd.Port > 511) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Baud rate mapping: Bad port number %d\n",
+ SubCmd.Port));
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+
+ if (SubCmd.Rup >= MAX_RUP+LINKS_PER_UNIT ) {
+ p->RIOError.Error = RUP_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+
+ if (SubCmd.Host >= p->RIONumHosts ) {
+ p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
+ return EINVAL;
+ }
+
+ port = p->RIOHosts[SubCmd.Host].
+ UnixRups[SubCmd.Rup].BaseSysPort + SubCmd.Port;
+ PortP = p->RIOPortp[port];
+
+ rio_spin_lock_irqsave(&PortP->portSem, flags);
+
+ if (RIOPreemptiveCmd(p, PortP, READ_REGISTER) == RIO_FAIL) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_READ_REGISTER failed\n"));
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ return EBUSY;
+ }
+ else
+ PortP->State |= RIO_BUSY;
+
+ rio_spin_unlock_irqrestore( &PortP->portSem , flags);
+ if (copyout((caddr_t)&p->CdRegister, (int)arg,
+ sizeof(uint)) == COPYFAIL ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("RIO_READ_REGISTER copy failed\n"));
+ p->RIOError.Error = COPYOUT_FAILED;
+ return EFAULT;
+ }
+ return 0;
+ /*
+ ** rio_make_dev: given port number (0-511) ORed with port type
+ ** (RIO_DEV_DIRECT, RIO_DEV_MODEM, RIO_DEV_XPRINT) return dev_t
+ ** value to pass to mknod to create the correct device node.
+ */
+ case RIO_MAKE_DEV:
+ {
+ uint port = (uint)arg & RIO_MODEM_MASK;
+
+ switch ( (uint)arg & RIO_DEV_MASK ) {
+ case RIO_DEV_DIRECT:
+ arg = (caddr_t)drv_makedev(major(dev), port);
+ rio_dprint(RIO_DEBUG_CTRL, ("Makedev direct 0x%x is 0x%x\n",port, (int)arg ));
+ return (int)arg;
+ case RIO_DEV_MODEM:
+ arg = (caddr_t)drv_makedev(major(dev), (port|RIO_MODEM_BIT) );
+ rio_dprint(RIO_DEBUG_CTRL, ("Makedev modem 0x%x is 0x%x\n",port, (int)arg ));
+ return (int)arg;
+ case RIO_DEV_XPRINT:
+ arg = (caddr_t)drv_makedev(major(dev), port);
+ rio_dprint(RIO_DEBUG_CTRL, ("Makedev printer 0x%x is 0x%x\n",port, (int)arg ));
+ return (int)arg;
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("MAKE Device is called\n"));
+ return EINVAL;
+ }
+ /*
+ ** rio_minor: given a dev_t from a stat() call, return
+ ** the port number (0-511) ORed with the port type
+ ** ( RIO_DEV_DIRECT, RIO_DEV_MODEM, RIO_DEV_XPRINT )
+ */
+ case RIO_MINOR:
+ {
+ dev_t dv;
+ int mino;
+
+ dv = (dev_t)((int)arg);
+ mino = RIO_UNMODEM(dv);
+
+ if ( RIO_ISMODEM(dv) ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Minor for device 0x%x: modem %d\n", dv, mino));
+ arg = (caddr_t)(mino | RIO_DEV_MODEM);
+ }
+ else {
+ rio_dprint(RIO_DEBUG_CTRL, ("Minor for device 0x%x: direct %d\n", dv, mino));
+ arg = (caddr_t)(mino | RIO_DEV_DIRECT);
+ }
+ return (int)arg;
+ }
+ }
+ rio_dprint(RIO_DEBUG_CTRL, ("INVALID DAEMON IOCTL 0x%x\n",cmd));
+ p->RIOError.Error = IOCTL_COMMAND_UNKNOWN;
+ return EINVAL;
+}
+
+/*
+** Pre-emptive commands go on RUPs and are only one byte long.
+*/
+int
+RIOPreemptiveCmd(p, PortP, Cmd)
+struct rio_info * p;
+struct Port *PortP;
+uchar Cmd;
+{
+ struct CmdBlk *CmdBlkP;
+ struct PktCmd_M *PktCmdP;
+ int Ret;
+ ushort rup;
+ int port;
+
+#ifdef CHECK
+ CheckPortP( PortP );
+#endif
+
+ if ( PortP->State & RIO_DELETED ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Preemptive command to deleted RTA ignored\n"));
+ return RIO_FAIL;
+ }
+
+ if (((int)((char)PortP->InUse) == -1) || ! (CmdBlkP = RIOGetCmdBlk()) ) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Cannot allocate command block for command %d on port %d\n",
+ Cmd, PortP->PortNum));
+ return RIO_FAIL;
+ }
+
+ rio_dprint(RIO_DEBUG_CTRL, ("Command blk 0x%x - InUse now %d\n",
+ (int)CmdBlkP,PortP->InUse));
+
+ PktCmdP = (struct PktCmd_M *)&CmdBlkP->Packet.data[0];
+
+ CmdBlkP->Packet.src_unit = 0;
+ if (PortP->SecondBlock)
+ rup = PortP->ID2;
+ else
+ rup = PortP->RupNum;
+ CmdBlkP->Packet.dest_unit = rup;
+ CmdBlkP->Packet.src_port = COMMAND_RUP;
+ CmdBlkP->Packet.dest_port = COMMAND_RUP;
+ CmdBlkP->Packet.len = PKT_CMD_BIT | 2;
+ CmdBlkP->PostFuncP = RIOUnUse;
+ CmdBlkP->PostArg = (int)PortP;
+ PktCmdP->Command = Cmd;
+ port = PortP->HostPort % (ushort)PORTS_PER_RTA;
+ /*
+ ** Index ports 8-15 for 2nd block of 16 port RTA.
+ */
+ if (PortP->SecondBlock)
+ port += (ushort) PORTS_PER_RTA;
+ PktCmdP->PhbNum = port;
+
+ switch ( Cmd ) {
+ case MEMDUMP:
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue MEMDUMP command blk 0x%x (addr 0x%x)\n",
+ (int)CmdBlkP, (int)SubCmd.Addr));
+ PktCmdP->SubCommand = MEMDUMP;
+ PktCmdP->SubAddr = SubCmd.Addr;
+ break;
+ case FCLOSE:
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue FCLOSE command blk 0x%x\n",(int)CmdBlkP));
+ break;
+ case READ_REGISTER:
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue READ_REGISTER (0x%x) command blk 0x%x\n",
+ (int)SubCmd.Addr, (int)CmdBlkP));
+ PktCmdP->SubCommand = READ_REGISTER;
+ PktCmdP->SubAddr = SubCmd.Addr;
+ break;
+ case RESUME:
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue RESUME command blk 0x%x\n",(int)CmdBlkP));
+ break;
+ case RFLUSH:
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue RFLUSH command blk 0x%x\n",(int)CmdBlkP));
+ CmdBlkP->PostFuncP = RIORFlushEnable;
+ break;
+ case SUSPEND:
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue SUSPEND command blk 0x%x\n",(int)CmdBlkP));
+ break;
+
+ case MGET :
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue MGET command blk 0x%x\n", (int)CmdBlkP));
+ break;
+
+ case MSET :
+ case MBIC :
+ case MBIS :
+ CmdBlkP->Packet.data[4] = (char) PortP->ModemLines;
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue MSET/MBIC/MBIS command blk 0x%x\n", (int)CmdBlkP));
+ break;
+
+ case WFLUSH:
+ /*
+ ** If we have queued up the maximum number of Write flushes
+ ** allowed then we should not bother sending any more to the
+ ** RTA.
+ */
+ if ((int)((char)PortP->WflushFlag) == (int)-1) {
+ rio_dprint(RIO_DEBUG_CTRL, ("Trashed WFLUSH, WflushFlag about to wrap!"));
+ RIOFreeCmdBlk(CmdBlkP);
+ return(RIO_FAIL);
+ } else {
+ rio_dprint(RIO_DEBUG_CTRL, ("Queue WFLUSH command blk 0x%x\n",
+ (int)CmdBlkP));
+ CmdBlkP->PostFuncP = RIOWFlushMark;
+ }
+ break;
+ }
+
+ PortP->InUse++;
+
+ Ret = RIOQueueCmdBlk( PortP->HostP, rup, CmdBlkP );
+
+ return Ret;
+}
FUNET's LINUX-ADM group, linux-adm@nic.funet.fi
TCL-scripts by Sam Shen (who was at: slshen@lbl.gov)