| /* |
| ** ----------------------------------------------------------------------------- |
| ** |
| ** Perle Specialix driver for Linux |
| ** Ported from existing RIO Driver for SCO sources. |
| * |
| * (C) 1990 - 2000 Specialix International Ltd., Byfleet, Surrey, UK. |
| * |
| * This program is free software; you can redistribute it and/or modify |
| * it under the terms of the GNU General Public License as published by |
| * the Free Software Foundation; either version 2 of the License, or |
| * (at your option) any later version. |
| * |
| * This program is distributed in the hope that it will be useful, |
| * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| * GNU General Public License for more details. |
| * |
| * You should have received a copy of the GNU General Public License |
| * along with this program; if not, write to the Free Software |
| * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. |
| ** |
| ** Module : rioctrl.c |
| ** SID : 1.3 |
| ** Last Modified : 11/6/98 10:33:42 |
| ** Retrieved : 11/6/98 10:33:49 |
| ** |
| ** ident @(#)rioctrl.c 1.3 |
| ** |
| ** ----------------------------------------------------------------------------- |
| */ |
| #ifdef SCCS_LABELS |
| static char *_rioctrl_c_sccs_ = "@(#)rioctrl.c 1.3"; |
| #endif |
| |
| |
| #include <linux/module.h> |
| #include <linux/slab.h> |
| #include <linux/errno.h> |
| #include <asm/io.h> |
| #include <asm/system.h> |
| #include <asm/string.h> |
| #include <asm/semaphore.h> |
| #include <asm/uaccess.h> |
| |
| #include <linux/termios.h> |
| #include <linux/serial.h> |
| |
| #include <linux/generic_serial.h> |
| |
| |
| #include "linux_compat.h" |
| #include "rio_linux.h" |
| #include "typdef.h" |
| #include "pkt.h" |
| #include "daemon.h" |
| #include "rio.h" |
| #include "riospace.h" |
| #include "top.h" |
| #include "cmdpkt.h" |
| #include "map.h" |
| #include "riotypes.h" |
| #include "rup.h" |
| #include "port.h" |
| #include "riodrvr.h" |
| #include "rioinfo.h" |
| #include "func.h" |
| #include "errors.h" |
| #include "pci.h" |
| |
| #include "parmmap.h" |
| #include "unixrup.h" |
| #include "board.h" |
| #include "host.h" |
| #include "error.h" |
| #include "phb.h" |
| #include "link.h" |
| #include "cmdblk.h" |
| #include "route.h" |
| #include "control.h" |
| #include "cirrus.h" |
| #include "rioioctl.h" |
| |
| |
| static struct LpbReq LpbReq; |
| static struct RupReq RupReq; |
| static struct PortReq PortReq; |
| static struct HostReq HostReq; |
| static struct HostDpRam HostDpRam; |
| static struct DebugCtrl DebugCtrl; |
| static struct Map MapEnt; |
| static struct PortSetup PortSetup; |
| static struct DownLoad DownLoad; |
| static struct SendPack SendPack; |
| /* static struct StreamInfo StreamInfo; */ |
| /* static char modemtable[RIO_PORTS]; */ |
| static struct SpecialRupCmd SpecialRupCmd; |
| static struct PortParams PortParams; |
| static struct portStats portStats; |
| |
| static struct SubCmdStruct { |
| ushort Host; |
| ushort Rup; |
| ushort Port; |
| ushort Addr; |
| } SubCmd; |
| |
| struct PortTty { |
| uint port; |
| struct ttystatics Tty; |
| }; |
| |
| static struct PortTty PortTty; |
| typedef struct ttystatics TERMIO; |
| |
| /* |
| ** This table is used when the config.rio downloads bin code to the |
| ** driver. We index the table using the product code, 0-F, and call |
| ** the function pointed to by the entry, passing the information |
| ** about the boot. |
| ** The RIOBootCodeUNKNOWN entry is there to politely tell the calling |
| ** process to bog off. |
| */ |
| static int |
| (*RIOBootTable[MAX_PRODUCT]) (struct rio_info *, struct DownLoad *) = { |
| /* 0 */ RIOBootCodeHOST, |
| /* Host Card */ |
| /* 1 */ RIOBootCodeRTA, |
| /* RTA */ |
| }; |
| |
| #define drv_makedev(maj, min) ((((uint) maj & 0xff) << 8) | ((uint) min & 0xff)) |
| |
| int copyin(int arg, caddr_t dp, int siz) |
| { |
| 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; |
| } |
| |
| static int copyout(caddr_t dp, int arg, int siz) |
| { |
| 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; |
| } |
| |
| int riocontrol(p, dev, cmd, arg, su) |
| struct rio_info *p; |
| dev_t dev; |
| int cmd; |
| caddr_t arg; |
| int su; |
| { |
| uint Host; /* leave me unsigned! */ |
| uint port; /* and me! */ |
| struct Host *HostP; |
| ushort loop; |
| int Entry; |
| struct Port *PortP; |
| PKT *PacketP; |
| int retval = 0; |
| unsigned long flags; |
| |
| func_enter(); |
| |
| /* Confuse the compiler to think that we've initialized these */ |
| Host = 0; |
| PortP = NULL; |
| |
| 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); |
| } |
| } |
| } |
| return 0; |
| |
| case RIO_IDENTIFY_DRIVER: |
| /* |
| ** 15.10.1998 ARG - ESIL 0760 part fix |
| ** Added driver ident string output. |
| ** |
| #ifndef __THIS_RELEASE__ |
| #warning Driver Version string not defined ! |
| #endif |
| cprintf("%s %s %s %s\n", |
| RIO_DRV_STR, |
| __THIS_RELEASE__, |
| __DATE__, __TIME__ ); |
| |
| return 0; |
| |
| case RIO_DISPLAY_HOST_CFG: |
| ** |
| ** 15.10.1998 ARG - ESIL 0760 part fix |
| ** Added driver host card ident string output. |
| ** |
| ** Note that the only types currently supported |
| ** are ISA and PCI. Also this driver does not |
| ** (yet) distinguish between the Old PCI card |
| ** and the Jet PCI card. In fact I think this |
| ** driver only supports JET PCI ! |
| ** |
| |
| for (Host = 0; Host < p->RIONumHosts; Host++) |
| { |
| HostP = &(p->RIOHosts[Host]); |
| |
| switch ( HostP->Type ) |
| { |
| case RIO_AT : |
| strcpy( host_type, RIO_AT_HOST_STR ); |
| break; |
| |
| case RIO_PCI : |
| strcpy( host_type, RIO_PCI_HOST_STR ); |
| break; |
| |
| default : |
| strcpy( host_type, "Unknown" ); |
| break; |
| } |
| |
| cprintf( |
| "RIO Host %d - Type:%s Addr:%X IRQ:%d\n", |
| Host, host_type, |
| (uint)HostP->PaddrP, |
| (int)HostP->Ivec - 32 ); |
| } |
| return 0; |
| ** |
| */ |
| |
| case RIO_FOAD_RTA: |
| rio_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: |
| #ifdef DEBUG_MEM_SUPPORT |
| RIO_DEBUG_CTRL, if (su) |
| return rio_RIODebugMemory(RIO_DEBUG_CTRL, arg); |
| else |
| #endif |
| return -EPERM; |
| |
| case RIO_ALL_MODEM: |
| rio_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"); |
| |
| 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; |
| |
| 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; |
| } |
| /* |
| *********************************** |
| { |
| int entry; |
| rio_dprint(RIO_DEBUG_CTRL, ("*****\nMAP ENTRIES\n") ); |
| for ( entry=0; entry<TOTAL_MAP_ENTRIES; entry++ ) |
| { |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.HostUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].HostUniqueNum ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.RtaUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].RtaUniqueNum ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.ID = 0x%x\n", entry, p->RIOConnectTable[entry].ID ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.ID2 = 0x%x\n", entry, p->RIOConnectTable[entry].ID2 ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Flags = 0x%x\n", entry, p->RIOConnectTable[entry].Flags ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.SysPort = 0x%x\n", entry, p->RIOConnectTable[entry].SysPort ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[0].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[0].Unit ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[0].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[0].Link ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[1].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[1].Unit ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[1].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[1].Link ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[2].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[2].Unit ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[2].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[2].Link ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[3].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[3].Unit ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Top[4].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[3].Link ) ); |
| rio_dprint(RIO_DEBUG_CTRL, ("Map entry %d.Name = %s\n", entry, p->RIOConnectTable[entry].Name ) ); |
| } |
| rio_dprint(RIO_DEBUG_CTRL, ("*****\nEND MAP ENTRIES\n") ); |
| } |
| *********************************** |
| */ |
| return RIONewTable(p); |
| |
| case RIO_GET_BINDINGS: |
| /* |
| ** Send bindings table, containing unique numbers of RTAs owned |
| ** by this system to user space |
| */ |
| rio_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; |
| /* |
| ** 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; |
| } |
| } |
| /* |
| ** 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; |
| #else |
| return -EINVAL; |
| #endif |
| |
| case RIO_GET_MODTYPE: |
| if (copyin((int) arg, (caddr_t) & port, sizeof(uint)) == COPYFAIL) { |
| p->RIOError.Error = COPYIN_FAILED; |
| return -EFAULT; |
| } |
| rio_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; |
| } |
| |
| 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; |
| #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 0 |
| rio_spin_lock_irqsave(&PortP->portSem, flags); |
| PortP->TtyP->tm.c_iflag = PortTty.Tty.tm.c_iflag; |
| PortP->TtyP->tm.c_oflag = PortTty.Tty.tm.c_oflag; |
| PortP->TtyP->tm.c_cflag = PortTty.Tty.tm.c_cflag; |
| PortP->TtyP->tm.c_lflag = PortTty.Tty.tm.c_lflag; |
| rio_spin_unlock_irqrestore(&PortP->portSem, flags); |
| #endif |
| |
| RIOParam(PortP, CONFIG, PortP->State & RIO_MODEM, OK_TO_SLEEP); |
| return retval; |
| |
| case RIO_SET_PORT_PARAMS: |
| rio_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; |
| } |
| #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; |
| } |
| 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; |
| } |
| 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; |
| |
| /* |
| ** !!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!!! |
| ** !! 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); |
| #endif |
| } |
| RIOFoadWakeup(p); |
| p->RIONumBootPkts = 0; |
| p->RIOBooting = 0; |
| |
| #ifdef RINGBUFFER_SUPPORT |
| for (loop = 0; loop < RIO_PORTS; loop++) |
| if (p->RIOPortp[loop]->TxRingBuffer) |
| sysfree((void *) p->RIOPortp[loop]->TxRingBuffer, RIOBufferSize); |
| #endif |
| #if 0 |
| bzero((caddr_t) & p->RIOPortp[0], RIO_PORTS * sizeof(struct Port)); |
| #else |
| printk("HEEEEELP!\n"); |
| #endif |
| |
| for (loop = 0; loop < RIO_PORTS; loop++) { |
| #if 0 |
| p->RIOPortp[loop]->TtyP = &p->channel[loop]; |
| #endif |
| |
| 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; |
| |
| 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); |
| p->RIOError.Error = IOCTL_COMMAND_UNKNOWN; |
| |
| 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; |
| struct Port *PortP; |
| uchar Cmd; |
| { |
| struct CmdBlk *CmdBlkP; |
| struct PktCmd_M *PktCmdP; |
| int Ret; |
| ushort rup; |
| int port; |
| |
| #ifdef CHECK |
| CheckPortP(PortP); |
| #endif |
| |
| if (PortP->State & RIO_DELETED) { |
| rio_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); |
| return RIO_FAIL; |
| } |
| |
| 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]; |
| |
| CmdBlkP->Packet.src_unit = 0; |
| if (PortP->SecondBlock) |
| rup = PortP->ID2; |
| else |
| rup = PortP->RupNum; |
| CmdBlkP->Packet.dest_unit = rup; |
| CmdBlkP->Packet.src_port = COMMAND_RUP; |
| CmdBlkP->Packet.dest_port = COMMAND_RUP; |
| CmdBlkP->Packet.len = PKT_CMD_BIT | 2; |
| CmdBlkP->PostFuncP = RIOUnUse; |
| CmdBlkP->PostArg = (int) PortP; |
| PktCmdP->Command = Cmd; |
| port = PortP->HostPort % (ushort) PORTS_PER_RTA; |
| /* |
| ** Index ports 8-15 for 2nd block of 16 port RTA. |
| */ |
| if (PortP->SecondBlock) |
| port += (ushort) PORTS_PER_RTA; |
| PktCmdP->PhbNum = port; |
| |
| switch (Cmd) { |
| case MEMDUMP: |
| rio_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); |
| |
| return Ret; |
| } |