|
|
@@ -82,16 +82,16 @@ static char *_rioctrl_c_sccs_ = "@(#)rioctrl.c 1.3";
|
|
|
#include "rioioctl.h"
|
|
|
|
|
|
|
|
|
-static struct LpbReq LpbReq;
|
|
|
-static struct RupReq RupReq;
|
|
|
-static struct PortReq PortReq;
|
|
|
-static struct HostReq HostReq;
|
|
|
+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 Map MapEnt;
|
|
|
static struct PortSetup PortSetup;
|
|
|
-static struct DownLoad DownLoad;
|
|
|
-static struct SendPack SendPack;
|
|
|
+static struct DownLoad DownLoad;
|
|
|
+static struct SendPack SendPack;
|
|
|
/* static struct StreamInfo StreamInfo; */
|
|
|
/* static char modemtable[RIO_PORTS]; */
|
|
|
static struct SpecialRupCmd SpecialRupCmd;
|
|
|
@@ -99,18 +99,18 @@ static struct PortParams PortParams;
|
|
|
static struct portStats portStats;
|
|
|
|
|
|
static struct SubCmdStruct {
|
|
|
- ushort Host;
|
|
|
- ushort Rup;
|
|
|
- ushort Port;
|
|
|
- ushort Addr;
|
|
|
+ ushort Host;
|
|
|
+ ushort Rup;
|
|
|
+ ushort Port;
|
|
|
+ ushort Addr;
|
|
|
} SubCmd;
|
|
|
|
|
|
struct PortTty {
|
|
|
- uint port;
|
|
|
- struct ttystatics Tty;
|
|
|
+ uint port;
|
|
|
+ struct ttystatics Tty;
|
|
|
};
|
|
|
|
|
|
-static struct PortTty PortTty;
|
|
|
+static struct PortTty PortTty;
|
|
|
typedef struct ttystatics TERMIO;
|
|
|
|
|
|
/*
|
|
|
@@ -121,267 +121,264 @@ typedef struct ttystatics TERMIO;
|
|
|
** 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 */
|
|
|
+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))
|
|
|
|
|
|
-int copyin (int arg, caddr_t dp, int siz)
|
|
|
+int copyin(int arg, caddr_t dp, int siz)
|
|
|
{
|
|
|
- int rv;
|
|
|
+ int rv;
|
|
|
|
|
|
- rio_dprintk (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) return COPYFAIL;
|
|
|
- else return rv;
|
|
|
+ rio_dprintk(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)
|
|
|
+ return COPYFAIL;
|
|
|
+ else
|
|
|
+ return rv;
|
|
|
}
|
|
|
|
|
|
-static int copyout (caddr_t dp, int arg, int siz)
|
|
|
+static int copyout(caddr_t dp, int arg, int siz)
|
|
|
{
|
|
|
- int rv;
|
|
|
+ int rv;
|
|
|
|
|
|
- rio_dprintk (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) return COPYFAIL;
|
|
|
- else return rv;
|
|
|
+ rio_dprintk(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)
|
|
|
+ return COPYFAIL;
|
|
|
+ else
|
|
|
+ return rv;
|
|
|
}
|
|
|
|
|
|
-int
|
|
|
-riocontrol(p, dev, cmd, arg, su)
|
|
|
-struct rio_info * p;
|
|
|
-dev_t dev;
|
|
|
-int cmd;
|
|
|
-caddr_t arg;
|
|
|
-int su;
|
|
|
+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;
|
|
|
+ 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;
|
|
|
-
|
|
|
- func_enter ();
|
|
|
-
|
|
|
+
|
|
|
+ func_enter();
|
|
|
+
|
|
|
/* Confuse the compiler to think that we've initialized these */
|
|
|
- Host=0;
|
|
|
+ Host = 0;
|
|
|
PortP = NULL;
|
|
|
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "control ioctl cmd: 0x%x arg: 0x%x\n", cmd, (int)arg);
|
|
|
+ rio_dprintk(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_dprintk (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);
|
|
|
+ ** 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_dprintk(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);
|
|
|
}
|
|
|
}
|
|
|
- }
|
|
|
- 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;
|
|
|
+ } else if (host >= p->RIONumHosts) {
|
|
|
+ return -EINVAL;
|
|
|
+ } else {
|
|
|
+ if (p->RIOHosts[host].Flags == RC_RUNNING) {
|
|
|
+ WWORD(p->RIOHosts[host].ParmMapP->timer, value);
|
|
|
}
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return 0;
|
|
|
|
|
|
- cprintf(
|
|
|
- "RIO Host %d - Type:%s Addr:%X IRQ:%d\n",
|
|
|
- Host, host_type,
|
|
|
- (uint)HostP->PaddrP,
|
|
|
- (int)HostP->Ivec - 32 );
|
|
|
+ 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_dprintk(RIO_DEBUG_CTRL, "RIO_FOAD_RTA\n");
|
|
|
+ return RIOCommandRta(p, (uint) arg, RIOFoadRta);
|
|
|
+
|
|
|
+ case RIO_ZOMBIE_RTA:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_ZOMBIE_RTA\n");
|
|
|
+ return RIOCommandRta(p, (uint) arg, RIOZombieRta);
|
|
|
+
|
|
|
+ case RIO_IDENTIFY_RTA:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_IDENTIFY_RTA\n");
|
|
|
+ return RIOIdentifyRta(p, arg);
|
|
|
+
|
|
|
+ case RIO_KILL_NEIGHBOUR:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_KILL_NEIGHBOUR\n");
|
|
|
+ return RIOKillNeighbour(p, arg);
|
|
|
+
|
|
|
+ case SPECIAL_RUP_CMD:
|
|
|
+ {
|
|
|
+ struct CmdBlk *CmdBlkP;
|
|
|
+
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD\n");
|
|
|
+ if (copyin((int) arg, (caddr_t) & SpecialRupCmd, sizeof(SpecialRupCmd)) == COPYFAIL) {
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD copy failed\n");
|
|
|
+ p->RIOError.Error = COPYIN_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ CmdBlkP = RIOGetCmdBlk();
|
|
|
+ if (!CmdBlkP) {
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD GetCmdBlk failed\n");
|
|
|
+ return -ENXIO;
|
|
|
+ }
|
|
|
+ CmdBlkP->Packet = SpecialRupCmd.Packet;
|
|
|
+ if (SpecialRupCmd.Host >= p->RIONumHosts)
|
|
|
+ SpecialRupCmd.Host = 0;
|
|
|
+ rio_dprintk(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_FOAD_RTA:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_FOAD_RTA\n");
|
|
|
- return RIOCommandRta(p, (uint)arg, RIOFoadRta);
|
|
|
-
|
|
|
- case RIO_ZOMBIE_RTA:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_ZOMBIE_RTA\n");
|
|
|
- return RIOCommandRta(p, (uint)arg, RIOZombieRta);
|
|
|
-
|
|
|
- case RIO_IDENTIFY_RTA:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_IDENTIFY_RTA\n");
|
|
|
- return RIOIdentifyRta(p, arg);
|
|
|
-
|
|
|
- case RIO_KILL_NEIGHBOUR:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_KILL_NEIGHBOUR\n");
|
|
|
- return RIOKillNeighbour(p, arg);
|
|
|
-
|
|
|
- case SPECIAL_RUP_CMD:
|
|
|
- {
|
|
|
- struct CmdBlk *CmdBlkP;
|
|
|
-
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD\n");
|
|
|
- if (copyin((int)arg, (caddr_t)&SpecialRupCmd,
|
|
|
- sizeof(SpecialRupCmd)) == COPYFAIL ) {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD copy failed\n");
|
|
|
- p->RIOError.Error = COPYIN_FAILED;
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- CmdBlkP = RIOGetCmdBlk();
|
|
|
- if ( !CmdBlkP ) {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD GetCmdBlk failed\n");
|
|
|
- return -ENXIO;
|
|
|
- }
|
|
|
- CmdBlkP->Packet = SpecialRupCmd.Packet;
|
|
|
- if ( SpecialRupCmd.Host >= p->RIONumHosts )
|
|
|
- SpecialRupCmd.Host = 0;
|
|
|
- rio_dprintk (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:
|
|
|
+ case RIO_DEBUG_MEM:
|
|
|
#ifdef DEBUG_MEM_SUPPORT
|
|
|
-RIO_DEBUG_CTRL, if (su)
|
|
|
- return rio_RIODebugMemory(RIO_DEBUG_CTRL, arg);
|
|
|
- else
|
|
|
+ RIO_DEBUG_CTRL, if (su)
|
|
|
+ return rio_RIODebugMemory(RIO_DEBUG_CTRL, arg);
|
|
|
+ else
|
|
|
#endif
|
|
|
- return -EPERM;
|
|
|
-
|
|
|
- case RIO_ALL_MODEM:
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_GET_TABLE\n");
|
|
|
+ return -EPERM;
|
|
|
|
|
|
- if ((retval = RIOApel(p)) != 0)
|
|
|
- return retval;
|
|
|
+ case RIO_ALL_MODEM:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_ALL_MODEM\n");
|
|
|
+ p->RIOError.Error = IOCTL_COMMAND_UNKNOWN;
|
|
|
+ return -EINVAL;
|
|
|
|
|
|
- if (copyout((caddr_t)p->RIOConnectTable, (int)arg,
|
|
|
- TOTAL_MAP_ENTRIES*sizeof(struct Map)) == COPYFAIL) {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_GET_TABLE copy failed\n");
|
|
|
- p->RIOError.Error = COPYOUT_FAILED;
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
+ case RIO_GET_TABLE:
|
|
|
+ /*
|
|
|
+ ** Read the routing table from the device driver to user space
|
|
|
+ */
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_GET_TABLE copy failed\n");
|
|
|
+ p->RIOError.Error = COPYOUT_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+
|
|
|
+ {
|
|
|
+ int entry;
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "Map entry %d.HostUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].HostUniqueNum);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.RtaUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].RtaUniqueNum);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.ID = 0x%x\n", entry, p->RIOConnectTable[entry].ID);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.ID2 = 0x%x\n", entry, p->RIOConnectTable[entry].ID2);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Flags = 0x%x\n", entry, (int) p->RIOConnectTable[entry].Flags);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.SysPort = 0x%x\n", entry, (int) p->RIOConnectTable[entry].SysPort);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[0].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[0].Unit);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[0].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[0].Link);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[1].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[1].Unit);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[1].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[1].Link);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[2].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[2].Unit);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[2].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[2].Link);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[3].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[3].Unit);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[4].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[3].Link);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Name = %s\n", entry, p->RIOConnectTable[entry].Name);
|
|
|
+ }
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "*****\nEND MAP ENTRIES\n");
|
|
|
+ }
|
|
|
+ p->RIOQuickCheck = NOT_CHANGED; /* a table has been gotten */
|
|
|
+ return 0;
|
|
|
|
|
|
- {
|
|
|
- int entry;
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Map entry %d.HostUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].HostUniqueNum );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.RtaUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].RtaUniqueNum );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.ID = 0x%x\n", entry, p->RIOConnectTable[entry].ID );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.ID2 = 0x%x\n", entry, p->RIOConnectTable[entry].ID2 );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Flags = 0x%x\n", entry, (int)p->RIOConnectTable[entry].Flags );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.SysPort = 0x%x\n", entry, (int)p->RIOConnectTable[entry].SysPort );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Top[0].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[0].Unit );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Top[0].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[0].Link );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Top[1].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[1].Unit );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Top[1].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[1].Link );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Top[2].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[2].Unit );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Top[2].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[2].Link );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Top[3].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[3].Unit );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Top[4].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[3].Link );
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Map entry %d.Name = %s\n", entry, p->RIOConnectTable[entry].Name );
|
|
|
- }
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_PUT_TABLE\n");
|
|
|
-
|
|
|
- if ( !su ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_PUT_TABLE copy failed\n");
|
|
|
- p->RIOError.Error = COPYIN_FAILED;
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
+ case RIO_PUT_TABLE:
|
|
|
+ /*
|
|
|
+ ** Write the routing table to the device driver from user space
|
|
|
+ */
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_TABLE\n");
|
|
|
+
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_TABLE copy failed\n");
|
|
|
+ p->RIOError.Error = COPYIN_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
/*
|
|
|
***********************************
|
|
|
{
|
|
|
@@ -409,1353 +406,1244 @@ RIO_DEBUG_CTRL, if (su)
|
|
|
}
|
|
|
***********************************
|
|
|
*/
|
|
|
- return RIONewTable(p);
|
|
|
-
|
|
|
- case RIO_GET_BINDINGS :
|
|
|
- /*
|
|
|
- ** Send bindings table, containing unique numbers of RTAs owned
|
|
|
- ** by this system to user space
|
|
|
- */
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_GET_BINDINGS\n");
|
|
|
+ return RIONewTable(p);
|
|
|
|
|
|
- if ( !su )
|
|
|
- {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_GET_BINDINGS copy failed\n");
|
|
|
- p->RIOError.Error = COPYOUT_FAILED;
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- return 0;
|
|
|
-
|
|
|
- case RIO_PUT_BINDINGS :
|
|
|
+ case RIO_GET_BINDINGS:
|
|
|
+ /*
|
|
|
+ ** Send bindings table, containing unique numbers of RTAs owned
|
|
|
+ ** by this system to user space
|
|
|
+ */
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_BINDINGS\n");
|
|
|
+
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_BINDINGS\n");
|
|
|
+
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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_dprintk(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;
|
|
|
/*
|
|
|
- ** Receive a bindings table, containing unique numbers of RTAs owned
|
|
|
- ** by this system
|
|
|
- */
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_PUT_BINDINGS\n");
|
|
|
-
|
|
|
- if ( !su )
|
|
|
- {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_BIND_RTA\n");
|
|
|
-
|
|
|
- if ( !su ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Removing Rta %x from p->RIOBindTab\n",
|
|
|
- (int) arg);
|
|
|
- return 0;
|
|
|
- }
|
|
|
- }
|
|
|
+ ** Bind this RTA to host, so that it will be booted by
|
|
|
+ ** host in 'boot owned RTAs' mode.
|
|
|
+ */
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_BIND_RTA\n");
|
|
|
+
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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) {
|
|
|
/*
|
|
|
- ** Dosen't exist - add
|
|
|
- */
|
|
|
- if (EmptySlot != -1) {
|
|
|
- p->RIOBindTab[EmptySlot] = (int) arg;
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Adding Rta %x to p->RIOBindTab\n",
|
|
|
- (int) arg);
|
|
|
- }
|
|
|
- else {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "p->RIOBindTab full! - Rta %x not added\n",
|
|
|
- (int) arg);
|
|
|
- return -ENOMEM;
|
|
|
- }
|
|
|
+ ** Already exists - delete
|
|
|
+ */
|
|
|
+ p->RIOBindTab[Entry] = 0L;
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Removing Rta %x from p->RIOBindTab\n", (int) arg);
|
|
|
return 0;
|
|
|
}
|
|
|
-
|
|
|
- case RIO_RESUME :
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_RESUME\n");
|
|
|
- port = (uint) arg;
|
|
|
- if ((port < 0) || (port > 511)) {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_RESUME failed\n");
|
|
|
- rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
|
- return -EBUSY;
|
|
|
- }
|
|
|
- else {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_ASSIGN_RTA\n");
|
|
|
- if ( !su ) {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_CHANGE_NAME\n");
|
|
|
- if ( !su ) {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_DELETE_RTA\n");
|
|
|
- if ( !su ) {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_GET_LOG\n");
|
|
|
+ }
|
|
|
+ /*
|
|
|
+ ** Dosen't exist - add
|
|
|
+ */
|
|
|
+ if (EmptySlot != -1) {
|
|
|
+ p->RIOBindTab[EmptySlot] = (int) arg;
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Adding Rta %x to p->RIOBindTab\n", (int) arg);
|
|
|
+ } else {
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "p->RIOBindTab full! - Rta %x not added\n", (int) arg);
|
|
|
+ return -ENOMEM;
|
|
|
+ }
|
|
|
+ return 0;
|
|
|
+ }
|
|
|
+
|
|
|
+ case RIO_RESUME:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_RESUME\n");
|
|
|
+ port = (uint) arg;
|
|
|
+ if ((port < 0) || (port > 511)) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_RESUME failed\n");
|
|
|
+ rio_spin_unlock_irqrestore(&PortP->portSem, flags);
|
|
|
+ return -EBUSY;
|
|
|
+ } else {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_ASSIGN_RTA\n");
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_CHANGE_NAME\n");
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_DELETE_RTA\n");
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_GET_LOG\n");
|
|
|
#ifdef LOGGING
|
|
|
- RIOGetLog(arg);
|
|
|
- return 0;
|
|
|
+ RIOGetLog(arg);
|
|
|
+ return 0;
|
|
|
#else
|
|
|
- return -EINVAL;
|
|
|
+ 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_dprintk (RIO_DEBUG_CTRL, "Get module type for port %d\n", port);
|
|
|
- if ( port < 0 || port > 511 )
|
|
|
- {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Setup ports\n");
|
|
|
- if (copyin((int)arg, (caddr_t)&PortSetup, sizeof(PortSetup))
|
|
|
- == COPYFAIL ) {
|
|
|
- p->RIOError.Error = COPYIN_FAILED;
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "EFAULT");
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- if ( PortSetup.From > PortSetup.To ||
|
|
|
- PortSetup.To >= RIO_PORTS ) {
|
|
|
- p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "EINVAL");
|
|
|
- return -EINVAL;
|
|
|
- }
|
|
|
- if ( !p->RIOPortp ) {
|
|
|
- cprintf("No p->RIOPortp array!\n");
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "No p->RIOPortp array!\n");
|
|
|
- return -EIO;
|
|
|
- }
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "entering loop (%d %d)!\n", PortSetup.From, PortSetup.To);
|
|
|
- for (loop=PortSetup.From; loop<=PortSetup.To; loop++) {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "in loop (%d)!\n", loop);
|
|
|
+ case RIO_GET_MODTYPE:
|
|
|
+ if (copyin((int) arg, (caddr_t) & port, sizeof(uint)) == COPYFAIL) {
|
|
|
+ p->RIOError.Error = COPYIN_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Get module type for port %d\n", port);
|
|
|
+ if (port < 0 || port > 511) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "Setup ports\n");
|
|
|
+ if (copyin((int) arg, (caddr_t) & PortSetup, sizeof(PortSetup))
|
|
|
+ == COPYFAIL) {
|
|
|
+ p->RIOError.Error = COPYIN_FAILED;
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "EFAULT");
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ if (PortSetup.From > PortSetup.To || PortSetup.To >= RIO_PORTS) {
|
|
|
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "EINVAL");
|
|
|
+ return -EINVAL;
|
|
|
+ }
|
|
|
+ if (!p->RIOPortp) {
|
|
|
+ cprintf("No p->RIOPortp array!\n");
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "No p->RIOPortp array!\n");
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "entering loop (%d %d)!\n", PortSetup.From, PortSetup.To);
|
|
|
+ for (loop = PortSetup.From; loop <= PortSetup.To; loop++) {
|
|
|
+ rio_dprintk(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 settings 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_dprintk (RIO_DEBUG_CTRL, "after loop (%d)!\n", loop);
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Retval:%x\n", retval);
|
|
|
- return retval;
|
|
|
-
|
|
|
- case RIO_GET_PORT_SETUP :
|
|
|
- rio_dprintk (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;
|
|
|
- }
|
|
|
+ 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;
|
|
|
|
|
|
- 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_dprintk (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_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Port %d\n", PortTty.port);
|
|
|
- PortP = (p->RIOPortp[PortTty.port]);
|
|
|
+ /*
|
|
|
+ ** 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 settings 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_dprintk(RIO_DEBUG_CTRL, "after loop (%d)!\n", loop);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Retval:%x\n", retval);
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ case RIO_GET_PORT_SETUP:
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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;
|
|
|
+ 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_dprintk (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 (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_dprintk(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);
|
|
|
+ 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_dprintk (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_dprintk (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_dprintk (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_dprintk (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;
|
|
|
+ RIOParam(PortP, CONFIG, PortP->State & RIO_MODEM, OK_TO_SLEEP);
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ case RIO_SET_PORT_PARAMS:
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk (RIO_DEBUG_CTRL, "RIO_READ_LEVELS\n");
|
|
|
- for ( num=0; RIODbInf[num].Flag; num++ ) ;
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "%d levels to copy\n",num);
|
|
|
- if (copyout((caddr_t)RIODbInf,(int)arg,
|
|
|
- sizeof(struct DbInf)*(num+1))==COPYFAIL) {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "ReadLevels Copy failed\n");
|
|
|
- p->RIOError.Error = COPYOUT_FAILED;
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "%d levels to copied\n",num);
|
|
|
- return retval;
|
|
|
- }
|
|
|
+ case RIO_READ_LEVELS:
|
|
|
+ {
|
|
|
+ int num;
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_READ_LEVELS\n");
|
|
|
+ for (num = 0; RIODbInf[num].Flag; num++);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "%d levels to copy\n", num);
|
|
|
+ if (copyout((caddr_t) RIODbInf, (int) arg, sizeof(struct DbInf) * (num + 1)) == COPYFAIL) {
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "ReadLevels Copy failed\n");
|
|
|
+ p->RIOError.Error = COPYOUT_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "%d levels to copied\n", num);
|
|
|
+ return retval;
|
|
|
+ }
|
|
|
#endif
|
|
|
|
|
|
- case RIO_READ_CONFIG:
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_SET_CONFIG\n");
|
|
|
- if ( !su ) {
|
|
|
- p->RIOError.Error = NOT_SUPER_USER;
|
|
|
- return -EPERM;
|
|
|
+ case RIO_READ_CONFIG:
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_START_POLLER\n");
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ case RIO_STOP_POLLER:
|
|
|
+ rio_dprintk(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_dprintk(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;
|
|
|
}
|
|
|
- if ( copyin((int)arg, (caddr_t)&p->RIOConf, sizeof(struct Conf) )
|
|
|
- ==COPYFAIL ) {
|
|
|
- p->RIOError.Error = COPYIN_FAILED;
|
|
|
- return -EFAULT;
|
|
|
+ p->rio_debug = DebugCtrl.Debug;
|
|
|
+ p->RIODebugWait = DebugCtrl.Wait;
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Set global debug to 0x%x set wait to 0x%x\n", p->rio_debug, p->RIODebugWait);
|
|
|
+ } else {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_SET/GET DEBUG: bad port number %d\n", DebugCtrl.SysPort);
|
|
|
+ p->RIOError.Error = COPYOUT_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_dprintk (RIO_DEBUG_CTRL, "RIO_START_POLLER\n");
|
|
|
- return -EINVAL;
|
|
|
+ }
|
|
|
+ } else if (DebugCtrl.SysPort >= RIO_PORTS && DebugCtrl.SysPort != NO_PORT) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_SETDEBUG 0x%x\n", p->RIOPortp[DebugCtrl.SysPort]->Debug);
|
|
|
+ } else {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_GETDEBUG: Bad copy to user space\n");
|
|
|
+ p->RIOError.Error = COPYOUT_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return retval;
|
|
|
|
|
|
- case RIO_STOP_POLLER:
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Set global debug to 0x%x set wait to 0x%x\n",
|
|
|
- p->rio_debug,p->RIODebugWait);
|
|
|
- }
|
|
|
- else {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_SETDEBUG 0x%x\n",
|
|
|
- p->RIOPortp[DebugCtrl.SysPort]->Debug);
|
|
|
- }
|
|
|
- else {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_VERSID\n");
|
|
|
- if ( copyout( (caddr_t)RIOVersid(),
|
|
|
- (int)arg,
|
|
|
- sizeof(struct rioVersion) ) == COPYFAIL )
|
|
|
- {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_VERSID: Bad copy to user space (host=%d)\n", Host);
|
|
|
- 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_dprintk(RIO_DEBUG_CTRL, "RIO_VERSID\n");
|
|
|
+ if (copyout((caddr_t) RIOVersid(), (int) arg, sizeof(struct rioVersion)) == COPYFAIL) {
|
|
|
+ rio_dprintk(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_dprintk (RIO_DEBUG_CTRL, "RIO_NUM_HOSTS\n");
|
|
|
- if (copyout((caddr_t)&p->RIONumHosts, (int)arg,
|
|
|
- sizeof(p->RIONumHosts) )==COPYFAIL ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_FOAD %d\n", (int)arg);
|
|
|
- if ( !su ) {
|
|
|
- rio_dprintk (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;
|
|
|
+ /*
|
|
|
+ ** !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!
|
|
|
+ ** !! 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_dprintk(RIO_DEBUG_CTRL, "RIO_NUM_HOSTS\n");
|
|
|
+ if (copyout((caddr_t) & p->RIONumHosts, (int) arg, sizeof(p->RIONumHosts)) == COPYFAIL) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_FOAD %d\n", (int) arg);
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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);
|
|
|
+ RIOSetupDataStructs(p);
|
|
|
#endif
|
|
|
- }
|
|
|
- RIOFoadWakeup(p);
|
|
|
- p->RIONumBootPkts = 0;
|
|
|
- p->RIOBooting = 0;
|
|
|
+ }
|
|
|
+ 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 );
|
|
|
+ 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));
|
|
|
+ bzero((caddr_t) & p->RIOPortp[0], RIO_PORTS * sizeof(struct Port));
|
|
|
#else
|
|
|
- printk ("HEEEEELP!\n");
|
|
|
+ printk("HEEEEELP!\n");
|
|
|
#endif
|
|
|
|
|
|
- for( loop=0; loop<RIO_PORTS; loop++ ) {
|
|
|
+ for (loop = 0; loop < RIO_PORTS; loop++) {
|
|
|
#if 0
|
|
|
- p->RIOPortp[loop]->TtyP = &p->channel[loop];
|
|
|
+ p->RIOPortp[loop]->TtyP = &p->channel[loop];
|
|
|
#endif
|
|
|
-
|
|
|
- spin_lock_init(&p->RIOPortp[loop]->portSem);
|
|
|
- p->RIOPortp[loop]->InUse = NOT_INUSE;
|
|
|
- }
|
|
|
-
|
|
|
- p->RIOSystemUp = 0;
|
|
|
- return retval;
|
|
|
-
|
|
|
- case RIO_DOWNLOAD:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_DOWNLOAD\n");
|
|
|
- if ( !su ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_DOWNLOAD: Copy in from user space failed\n");
|
|
|
- p->RIOError.Error = COPYIN_FAILED;
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL,
|
|
|
- "RIO_HOST_REQ: Copy in from user space failed\n");
|
|
|
- p->RIOError.Error = COPYIN_FAILED;
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- /*
|
|
|
- ** Fetch the parmmap
|
|
|
- */
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_PARMS: Copy out to user space failed\n");
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- }
|
|
|
- return retval;
|
|
|
-
|
|
|
- case RIO_HOST_REQ:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_REQ\n");
|
|
|
- if (copyin((int)arg, (caddr_t)&HostReq,
|
|
|
- sizeof(HostReq) )==COPYFAIL ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_REQ: Illegal host number %d\n",
|
|
|
- HostReq.HostNum);
|
|
|
- return -ENXIO;
|
|
|
- }
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_REQ: Bad copy to user space\n");
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- return retval;
|
|
|
-
|
|
|
- case RIO_HOST_DPRAM:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Request for DPRAM\n");
|
|
|
- if ( copyin( (int)arg, (caddr_t)&HostDpRam,
|
|
|
- sizeof(HostDpRam) )==COPYFAIL ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_DPRAM: Illegal host number %d\n",
|
|
|
- HostDpRam.HostNum);
|
|
|
- return -ENXIO;
|
|
|
- }
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_DPRAM: Bad copy to user space\n");
|
|
|
- return -EFAULT;
|
|
|
- }
|
|
|
- return retval;
|
|
|
-
|
|
|
- case RIO_SET_BUSY:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_SET_BUSY\n");
|
|
|
- if ( (int)arg < 0 || (int)arg > 511 ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_PORT\n");
|
|
|
- if ( copyin((int)arg, (caddr_t)&PortReq,
|
|
|
- sizeof(PortReq) )==COPYFAIL ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_PORT: Illegal port number %d\n",
|
|
|
- PortReq.SysPort);
|
|
|
- p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
|
|
|
- return -ENXIO;
|
|
|
- }
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_RUP\n");
|
|
|
- if (copyin((int)arg, (caddr_t)&RupReq,
|
|
|
- sizeof(RupReq) )==COPYFAIL ) {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_RUP: Host %d not running\n",
|
|
|
- RupReq.HostNum);
|
|
|
- p->RIOError.Error = HOST_NOT_RUNNING;
|
|
|
- return -EIO;
|
|
|
- }
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_LPB\n");
|
|
|
- if (copyin((int)arg, (caddr_t)&LpbReq,
|
|
|
- sizeof(LpbReq) )==COPYFAIL ) {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_HOST_LPB: Host %d not running\n",
|
|
|
- LpbReq.Host );
|
|
|
- p->RIOError.Error = HOST_NOT_RUNNING;
|
|
|
- return -EIO;
|
|
|
- }
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Baud rate mapping\n");
|
|
|
- port = (uint) arg;
|
|
|
- if ( port < 0 || port > 511 ) {
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "RIO_STREAM_INFO\n");
|
|
|
- return -EINVAL;
|
|
|
+ spin_lock_init(&p->RIOPortp[loop]->portSem);
|
|
|
+ p->RIOPortp[loop]->InUse = NOT_INUSE;
|
|
|
+ }
|
|
|
+
|
|
|
+ p->RIOSystemUp = 0;
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ case RIO_DOWNLOAD:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_DOWNLOAD\n");
|
|
|
+ if (!su) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_DOWNLOAD: Copy in from user space failed\n");
|
|
|
+ p->RIOError.Error = COPYIN_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Copied in download code for product code 0x%x\n", DownLoad.ProductCode);
|
|
|
|
|
|
- case RIO_SEND_PACKET:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "RIO_SEND_PACKET\n");
|
|
|
- if ( copyin( (int)arg, (caddr_t)&SendPack,
|
|
|
- sizeof(SendPack) )==COPYFAIL ) {
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Makedev printer 0x%x is 0x%x\n",port, (int)arg);
|
|
|
- return (int)arg;
|
|
|
- }
|
|
|
- rio_dprintk (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);
|
|
|
+ /*
|
|
|
+ ** It is important that the product code is an unsigned object!
|
|
|
+ */
|
|
|
+ if (DownLoad.ProductCode > MAX_PRODUCT) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ: Copy in from user space failed\n");
|
|
|
+ p->RIOError.Error = COPYIN_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ /*
|
|
|
+ ** Fetch the parmmap
|
|
|
+ */
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_PARMS: Copy out to user space failed\n");
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ }
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ case RIO_HOST_REQ:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ\n");
|
|
|
+ if (copyin((int) arg, (caddr_t) & HostReq, sizeof(HostReq)) == COPYFAIL) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ: Illegal host number %d\n", HostReq.HostNum);
|
|
|
+ return -ENXIO;
|
|
|
+ }
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ: Bad copy to user space\n");
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ case RIO_HOST_DPRAM:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Request for DPRAM\n");
|
|
|
+ if (copyin((int) arg, (caddr_t) & HostDpRam, sizeof(HostDpRam)) == COPYFAIL) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_DPRAM: Illegal host number %d\n", HostDpRam.HostNum);
|
|
|
+ return -ENXIO;
|
|
|
+ }
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_DPRAM: Bad copy to user space\n");
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ return retval;
|
|
|
+
|
|
|
+ case RIO_SET_BUSY:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_SET_BUSY\n");
|
|
|
+ if ((int) arg < 0 || (int) arg > 511) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_PORT\n");
|
|
|
+ if (copyin((int) arg, (caddr_t) & PortReq, sizeof(PortReq)) == COPYFAIL) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_PORT: Illegal port number %d\n", PortReq.SysPort);
|
|
|
+ p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
|
|
|
+ return -ENXIO;
|
|
|
+ }
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_RUP\n");
|
|
|
+ if (copyin((int) arg, (caddr_t) & RupReq, sizeof(RupReq)) == COPYFAIL) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_RUP: Host %d not running\n", RupReq.HostNum);
|
|
|
+ p->RIOError.Error = HOST_NOT_RUNNING;
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB\n");
|
|
|
+ if (copyin((int) arg, (caddr_t) & LpbReq, sizeof(LpbReq)) == COPYFAIL) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB: Host %d not running\n", LpbReq.Host);
|
|
|
+ p->RIOError.Error = HOST_NOT_RUNNING;
|
|
|
+ return -EIO;
|
|
|
+ }
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB: Bad copy to user space\n");
|
|
|
+ p->RIOError.Error = COPYOUT_FAILED;
|
|
|
+ return -EFAULT;
|
|
|
+ }
|
|
|
+ return retval;
|
|
|
|
|
|
- if ( RIO_ISMODEM(dv) ) {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Minor for device 0x%x: modem %d\n", dv, mino);
|
|
|
- arg = (caddr_t)(mino | RIO_DEV_MODEM);
|
|
|
- }
|
|
|
- else {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Minor for device 0x%x: direct %d\n", dv, mino);
|
|
|
- arg = (caddr_t)(mino | RIO_DEV_DIRECT);
|
|
|
- }
|
|
|
- return (int)arg;
|
|
|
- }
|
|
|
+ /*
|
|
|
+ ** 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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "Baud rate mapping\n");
|
|
|
+ port = (uint) arg;
|
|
|
+ if (port < 0 || port > 511) {
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "RIO_STREAM_INFO\n");
|
|
|
+ return -EINVAL;
|
|
|
+
|
|
|
+ case RIO_SEND_PACKET:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "RIO_SEND_PACKET\n");
|
|
|
+ if (copyin((int) arg, (caddr_t) & SendPack, sizeof(SendPack)) == COPYFAIL) {
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "Makedev printer 0x%x is 0x%x\n", port, (int) arg);
|
|
|
+ return (int) arg;
|
|
|
+ }
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "Minor for device 0x%x: modem %d\n", dv, mino);
|
|
|
+ arg = (caddr_t) (mino | RIO_DEV_MODEM);
|
|
|
+ } else {
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Minor for device 0x%x: direct %d\n", dv, mino);
|
|
|
+ arg = (caddr_t) (mino | RIO_DEV_DIRECT);
|
|
|
+ }
|
|
|
+ return (int) arg;
|
|
|
+ }
|
|
|
}
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "INVALID DAEMON IOCTL 0x%x\n",cmd);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "INVALID DAEMON IOCTL 0x%x\n", cmd);
|
|
|
p->RIOError.Error = IOCTL_COMMAND_UNKNOWN;
|
|
|
|
|
|
- func_exit ();
|
|
|
+ func_exit();
|
|
|
return -EINVAL;
|
|
|
}
|
|
|
|
|
|
/*
|
|
|
** Pre-emptive commands go on RUPs and are only one byte long.
|
|
|
*/
|
|
|
-int
|
|
|
-RIOPreemptiveCmd(p, PortP, Cmd)
|
|
|
-struct rio_info * p;
|
|
|
+int RIOPreemptiveCmd(p, PortP, Cmd)
|
|
|
+struct rio_info *p;
|
|
|
struct Port *PortP;
|
|
|
uchar Cmd;
|
|
|
{
|
|
|
@@ -1766,104 +1654,99 @@ uchar Cmd;
|
|
|
int port;
|
|
|
|
|
|
#ifdef CHECK
|
|
|
- CheckPortP( PortP );
|
|
|
+ CheckPortP(PortP);
|
|
|
#endif
|
|
|
|
|
|
- if ( PortP->State & RIO_DELETED ) {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Preemptive command to deleted RTA ignored\n");
|
|
|
+ if (PortP->State & RIO_DELETED) {
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Preemptive command to deleted RTA ignored\n");
|
|
|
return RIO_FAIL;
|
|
|
}
|
|
|
|
|
|
- if (((int)((char)PortP->InUse) == -1) || ! (CmdBlkP = RIOGetCmdBlk()) ) {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Cannot allocate command block for command %d on port %d\n",
|
|
|
- Cmd, PortP->PortNum);
|
|
|
+ if (((int) ((char) PortP->InUse) == -1) || !(CmdBlkP = RIOGetCmdBlk())) {
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Cannot allocate command block for command %d on port %d\n", Cmd, PortP->PortNum);
|
|
|
return RIO_FAIL;
|
|
|
}
|
|
|
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Command blk 0x%x - InUse now %d\n",
|
|
|
- (int)CmdBlkP,PortP->InUse);
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Command blk 0x%x - InUse now %d\n", (int) CmdBlkP, PortP->InUse);
|
|
|
|
|
|
- PktCmdP = (struct PktCmd_M *)&CmdBlkP->Packet.data[0];
|
|
|
+ PktCmdP = (struct PktCmd_M *) &CmdBlkP->Packet.data[0];
|
|
|
|
|
|
- CmdBlkP->Packet.src_unit = 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.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;
|
|
|
+ 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.
|
|
|
- */
|
|
|
+ ** 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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Queue FCLOSE command blk 0x%x\n",(int)CmdBlkP);
|
|
|
- break;
|
|
|
- case READ_REGISTER:
|
|
|
- rio_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Queue RESUME command blk 0x%x\n",(int)CmdBlkP);
|
|
|
- break;
|
|
|
- case RFLUSH:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Queue RFLUSH command blk 0x%x\n",(int)CmdBlkP);
|
|
|
- CmdBlkP->PostFuncP = RIORFlushEnable;
|
|
|
- break;
|
|
|
- case SUSPEND:
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Queue SUSPEND command blk 0x%x\n",(int)CmdBlkP);
|
|
|
- break;
|
|
|
-
|
|
|
- case MGET :
|
|
|
- rio_dprintk (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_dprintk (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_dprintk (RIO_DEBUG_CTRL, "Trashed WFLUSH, WflushFlag about to wrap!");
|
|
|
- RIOFreeCmdBlk(CmdBlkP);
|
|
|
- return(RIO_FAIL);
|
|
|
- } else {
|
|
|
- rio_dprintk (RIO_DEBUG_CTRL, "Queue WFLUSH command blk 0x%x\n",
|
|
|
- (int)CmdBlkP);
|
|
|
- CmdBlkP->PostFuncP = RIOWFlushMark;
|
|
|
- }
|
|
|
- break;
|
|
|
+ PktCmdP->PhbNum = port;
|
|
|
+
|
|
|
+ switch (Cmd) {
|
|
|
+ case MEMDUMP:
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "Queue FCLOSE command blk 0x%x\n", (int) CmdBlkP);
|
|
|
+ break;
|
|
|
+ case READ_REGISTER:
|
|
|
+ rio_dprintk(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_dprintk(RIO_DEBUG_CTRL, "Queue RESUME command blk 0x%x\n", (int) CmdBlkP);
|
|
|
+ break;
|
|
|
+ case RFLUSH:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Queue RFLUSH command blk 0x%x\n", (int) CmdBlkP);
|
|
|
+ CmdBlkP->PostFuncP = RIORFlushEnable;
|
|
|
+ break;
|
|
|
+ case SUSPEND:
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Queue SUSPEND command blk 0x%x\n", (int) CmdBlkP);
|
|
|
+ break;
|
|
|
+
|
|
|
+ case MGET:
|
|
|
+ rio_dprintk(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_dprintk(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_dprintk(RIO_DEBUG_CTRL, "Trashed WFLUSH, WflushFlag about to wrap!");
|
|
|
+ RIOFreeCmdBlk(CmdBlkP);
|
|
|
+ return (RIO_FAIL);
|
|
|
+ } else {
|
|
|
+ rio_dprintk(RIO_DEBUG_CTRL, "Queue WFLUSH command blk 0x%x\n", (int) CmdBlkP);
|
|
|
+ CmdBlkP->PostFuncP = RIOWFlushMark;
|
|
|
+ }
|
|
|
+ break;
|
|
|
}
|
|
|
|
|
|
PortP->InUse++;
|
|
|
|
|
|
- Ret = RIOQueueCmdBlk( PortP->HostP, rup, CmdBlkP );
|
|
|
+ Ret = RIOQueueCmdBlk(PortP->HostP, rup, CmdBlkP);
|
|
|
|
|
|
return Ret;
|
|
|
}
|