Merge branch 'master'
[linux-2.6] / drivers / char / rio / rioctrl.c
1 /*
2 ** -----------------------------------------------------------------------------
3 **
4 **  Perle Specialix driver for Linux
5 **  Ported from existing RIO Driver for SCO sources.
6  *
7  *  (C) 1990 - 2000 Specialix International Ltd., Byfleet, Surrey, UK.
8  *
9  *      This program is free software; you can redistribute it and/or modify
10  *      it under the terms of the GNU General Public License as published by
11  *      the Free Software Foundation; either version 2 of the License, or
12  *      (at your option) any later version.
13  *
14  *      This program is distributed in the hope that it will be useful,
15  *      but WITHOUT ANY WARRANTY; without even the implied warranty of
16  *      MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
17  *      GNU General Public License for more details.
18  *
19  *      You should have received a copy of the GNU General Public License
20  *      along with this program; if not, write to the Free Software
21  *      Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 **
23 **      Module          : rioctrl.c
24 **      SID             : 1.3
25 **      Last Modified   : 11/6/98 10:33:42
26 **      Retrieved       : 11/6/98 10:33:49
27 **
28 **  ident @(#)rioctrl.c 1.3
29 **
30 ** -----------------------------------------------------------------------------
31 */
32 #ifdef SCCS_LABELS
33 static char *_rioctrl_c_sccs_ = "@(#)rioctrl.c  1.3";
34 #endif
35
36
37 #include <linux/module.h>
38 #include <linux/slab.h>
39 #include <linux/errno.h>
40 #include <asm/io.h>
41 #include <asm/system.h>
42 #include <asm/string.h>
43 #include <asm/semaphore.h>
44 #include <asm/uaccess.h>
45
46 #include <linux/termios.h>
47 #include <linux/serial.h>
48
49 #include <linux/generic_serial.h>
50
51
52 #include "linux_compat.h"
53 #include "rio_linux.h"
54 #include "pkt.h"
55 #include "daemon.h"
56 #include "rio.h"
57 #include "riospace.h"
58 #include "cmdpkt.h"
59 #include "map.h"
60 #include "rup.h"
61 #include "port.h"
62 #include "riodrvr.h"
63 #include "rioinfo.h"
64 #include "func.h"
65 #include "errors.h"
66 #include "pci.h"
67
68 #include "parmmap.h"
69 #include "unixrup.h"
70 #include "board.h"
71 #include "host.h"
72 #include "phb.h"
73 #include "link.h"
74 #include "cmdblk.h"
75 #include "route.h"
76 #include "cirrus.h"
77 #include "rioioctl.h"
78
79
80 static struct LpbReq LpbReq;
81 static struct RupReq RupReq;
82 static struct PortReq PortReq;
83 static struct HostReq HostReq;
84 static struct HostDpRam HostDpRam;
85 static struct DebugCtrl DebugCtrl;
86 static struct Map MapEnt;
87 static struct PortSetup PortSetup;
88 static struct DownLoad DownLoad;
89 static struct SendPack SendPack;
90 /* static struct StreamInfo     StreamInfo; */
91 /* static char modemtable[RIO_PORTS]; */
92 static struct SpecialRupCmd SpecialRupCmd;
93 static struct PortParams PortParams;
94 static struct portStats portStats;
95
96 static struct SubCmdStruct {
97         ushort Host;
98         ushort Rup;
99         ushort Port;
100         ushort Addr;
101 } SubCmd;
102
103 struct PortTty {
104         uint port;
105         struct ttystatics Tty;
106 };
107
108 static struct PortTty PortTty;
109 typedef struct ttystatics TERMIO;
110
111 /*
112 ** This table is used when the config.rio downloads bin code to the
113 ** driver. We index the table using the product code, 0-F, and call
114 ** the function pointed to by the entry, passing the information
115 ** about the boot.
116 ** The RIOBootCodeUNKNOWN entry is there to politely tell the calling
117 ** process to bog off.
118 */
119 static int
120  (*RIOBootTable[MAX_PRODUCT]) (struct rio_info *, struct DownLoad *) = {
121                                         /* 0 */ RIOBootCodeHOST,
122                                         /* Host Card */
123                                         /* 1 */ RIOBootCodeRTA,
124                                         /* RTA */
125 };
126
127 #define drv_makedev(maj, min) ((((uint) maj & 0xff) << 8) | ((uint) min & 0xff))
128
129 int riocontrol(p, dev, cmd, arg, su)
130 struct rio_info *p;
131 dev_t dev;
132 int cmd;
133 caddr_t arg;
134 int su;
135 {
136         uint Host;              /* leave me unsigned! */
137         uint port;              /* and me! */
138         struct Host *HostP;
139         ushort loop;
140         int Entry;
141         struct Port *PortP;
142         struct PKT *PacketP;
143         int retval = 0;
144         unsigned long flags;
145
146         func_enter();
147
148         /* Confuse the compiler to think that we've initialized these */
149         Host = 0;
150         PortP = NULL;
151
152         rio_dprintk(RIO_DEBUG_CTRL, "control ioctl cmd: 0x%x arg: %p\n", cmd, arg);
153
154         switch (cmd) {
155                 /*
156                  ** RIO_SET_TIMER
157                  **
158                  ** Change the value of the host card interrupt timer.
159                  ** If the host card number is -1 then all host cards are changed
160                  ** otherwise just the specified host card will be changed.
161                  */
162         case RIO_SET_TIMER:
163                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_SET_TIMER to %ldms\n", (unsigned long)arg);
164                 {
165                         int host, value;
166                         host = ((unsigned long) arg >> 16) & 0x0000FFFF;
167                         value = (unsigned long) arg & 0x0000ffff;
168                         if (host == -1) {
169                                 for (host = 0; host < p->RIONumHosts; host++) {
170                                         if (p->RIOHosts[host].Flags == RC_RUNNING) {
171                                                 writew(value, &p->RIOHosts[host].ParmMapP->timer);
172                                         }
173                                 }
174                         } else if (host >= p->RIONumHosts) {
175                                 return -EINVAL;
176                         } else {
177                                 if (p->RIOHosts[host].Flags == RC_RUNNING) {
178                                         writew(value, &p->RIOHosts[host].ParmMapP->timer);
179                                 }
180                         }
181                 }
182                 return 0;
183
184         case RIO_FOAD_RTA:
185                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_FOAD_RTA\n");
186                 return RIOCommandRta(p, (unsigned long)arg, RIOFoadRta);
187
188         case RIO_ZOMBIE_RTA:
189                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_ZOMBIE_RTA\n");
190                 return RIOCommandRta(p, (unsigned long)arg, RIOZombieRta);
191
192         case RIO_IDENTIFY_RTA:
193                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_IDENTIFY_RTA\n");
194                 return RIOIdentifyRta(p, arg);
195
196         case RIO_KILL_NEIGHBOUR:
197                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_KILL_NEIGHBOUR\n");
198                 return RIOKillNeighbour(p, arg);
199
200         case SPECIAL_RUP_CMD:
201                 {
202                         struct CmdBlk *CmdBlkP;
203
204                         rio_dprintk(RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD\n");
205                         if (copy_from_user(&SpecialRupCmd, arg, sizeof(SpecialRupCmd))) {
206                                 rio_dprintk(RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD copy failed\n");
207                                 p->RIOError.Error = COPYIN_FAILED;
208                                 return -EFAULT;
209                         }
210                         CmdBlkP = RIOGetCmdBlk();
211                         if (!CmdBlkP) {
212                                 rio_dprintk(RIO_DEBUG_CTRL, "SPECIAL_RUP_CMD GetCmdBlk failed\n");
213                                 return -ENXIO;
214                         }
215                         CmdBlkP->Packet = SpecialRupCmd.Packet;
216                         if (SpecialRupCmd.Host >= p->RIONumHosts)
217                                 SpecialRupCmd.Host = 0;
218                         rio_dprintk(RIO_DEBUG_CTRL, "Queue special rup command for host %d rup %d\n", SpecialRupCmd.Host, SpecialRupCmd.RupNum);
219                         if (RIOQueueCmdBlk(&p->RIOHosts[SpecialRupCmd.Host], SpecialRupCmd.RupNum, CmdBlkP) == RIO_FAIL) {
220                                 printk(KERN_WARNING "rio: FAILED TO QUEUE SPECIAL RUP COMMAND\n");
221                         }
222                         return 0;
223                 }
224
225         case RIO_DEBUG_MEM:
226                 return -EPERM;
227
228         case RIO_ALL_MODEM:
229                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_ALL_MODEM\n");
230                 p->RIOError.Error = IOCTL_COMMAND_UNKNOWN;
231                 return -EINVAL;
232
233         case RIO_GET_TABLE:
234                 /*
235                  ** Read the routing table from the device driver to user space
236                  */
237                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_TABLE\n");
238
239                 if ((retval = RIOApel(p)) != 0)
240                         return retval;
241
242                 if (copy_to_user(arg, p->RIOConnectTable, TOTAL_MAP_ENTRIES * sizeof(struct Map))) {
243                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_TABLE copy failed\n");
244                         p->RIOError.Error = COPYOUT_FAILED;
245                         return -EFAULT;
246                 }
247
248                 {
249                         int entry;
250                         rio_dprintk(RIO_DEBUG_CTRL, "*****\nMAP ENTRIES\n");
251                         for (entry = 0; entry < TOTAL_MAP_ENTRIES; entry++) {
252                                 if ((p->RIOConnectTable[entry].ID == 0) && (p->RIOConnectTable[entry].HostUniqueNum == 0) && (p->RIOConnectTable[entry].RtaUniqueNum == 0))
253                                         continue;
254
255                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.HostUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].HostUniqueNum);
256                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.RtaUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].RtaUniqueNum);
257                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.ID = 0x%x\n", entry, p->RIOConnectTable[entry].ID);
258                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.ID2 = 0x%x\n", entry, p->RIOConnectTable[entry].ID2);
259                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Flags = 0x%x\n", entry, (int) p->RIOConnectTable[entry].Flags);
260                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.SysPort = 0x%x\n", entry, (int) p->RIOConnectTable[entry].SysPort);
261                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[0].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[0].Unit);
262                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[0].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[0].Link);
263                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[1].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[1].Unit);
264                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[1].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[1].Link);
265                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[2].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[2].Unit);
266                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[2].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[2].Link);
267                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[3].Unit = %x\n", entry, p->RIOConnectTable[entry].Topology[3].Unit);
268                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Top[4].Link = %x\n", entry, p->RIOConnectTable[entry].Topology[3].Link);
269                                 rio_dprintk(RIO_DEBUG_CTRL, "Map entry %d.Name = %s\n", entry, p->RIOConnectTable[entry].Name);
270                         }
271                         rio_dprintk(RIO_DEBUG_CTRL, "*****\nEND MAP ENTRIES\n");
272                 }
273                 p->RIOQuickCheck = NOT_CHANGED; /* a table has been gotten */
274                 return 0;
275
276         case RIO_PUT_TABLE:
277                 /*
278                  ** Write the routing table to the device driver from user space
279                  */
280                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_TABLE\n");
281
282                 if (!su) {
283                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_TABLE !Root\n");
284                         p->RIOError.Error = NOT_SUPER_USER;
285                         return -EPERM;
286                 }
287                 if (copy_from_user(&p->RIOConnectTable[0], arg, TOTAL_MAP_ENTRIES * sizeof(struct Map))) {
288                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_TABLE copy failed\n");
289                         p->RIOError.Error = COPYIN_FAILED;
290                         return -EFAULT;
291                 }
292 /*
293 ***********************************
294                                 {
295                                         int entry;
296                                         rio_dprint(RIO_DEBUG_CTRL,  ("*****\nMAP ENTRIES\n") );
297                                         for ( entry=0; entry<TOTAL_MAP_ENTRIES; entry++ )
298                                         {
299                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.HostUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].HostUniqueNum ) );
300                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.RtaUniqueNum = 0x%x\n", entry, p->RIOConnectTable[entry].RtaUniqueNum ) );
301                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.ID = 0x%x\n", entry, p->RIOConnectTable[entry].ID ) );
302                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.ID2 = 0x%x\n", entry, p->RIOConnectTable[entry].ID2 ) );
303                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Flags = 0x%x\n", entry, p->RIOConnectTable[entry].Flags ) );
304                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.SysPort = 0x%x\n", entry, p->RIOConnectTable[entry].SysPort ) );
305                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Top[0].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[0].Unit ) );
306                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Top[0].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[0].Link ) );
307                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Top[1].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[1].Unit ) );
308                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Top[1].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[1].Link ) );
309                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Top[2].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[2].Unit ) );
310                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Top[2].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[2].Link ) );
311                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Top[3].Unit = %b\n", entry, p->RIOConnectTable[entry].Topology[3].Unit ) );
312                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Top[4].Link = %b\n", entry, p->RIOConnectTable[entry].Topology[3].Link ) );
313                                                 rio_dprint(RIO_DEBUG_CTRL,  ("Map entry %d.Name = %s\n", entry, p->RIOConnectTable[entry].Name ) );
314                                         }
315                                         rio_dprint(RIO_DEBUG_CTRL,  ("*****\nEND MAP ENTRIES\n") );
316                                 }
317 ***********************************
318 */
319                 return RIONewTable(p);
320
321         case RIO_GET_BINDINGS:
322                 /*
323                  ** Send bindings table, containing unique numbers of RTAs owned
324                  ** by this system to user space
325                  */
326                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_BINDINGS\n");
327
328                 if (!su) {
329                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_BINDINGS !Root\n");
330                         p->RIOError.Error = NOT_SUPER_USER;
331                         return -EPERM;
332                 }
333                 if (copy_to_user(arg, p->RIOBindTab, (sizeof(ulong) * MAX_RTA_BINDINGS))) {
334                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_BINDINGS copy failed\n");
335                         p->RIOError.Error = COPYOUT_FAILED;
336                         return -EFAULT;
337                 }
338                 return 0;
339
340         case RIO_PUT_BINDINGS:
341                 /*
342                  ** Receive a bindings table, containing unique numbers of RTAs owned
343                  ** by this system
344                  */
345                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_BINDINGS\n");
346
347                 if (!su) {
348                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_BINDINGS !Root\n");
349                         p->RIOError.Error = NOT_SUPER_USER;
350                         return -EPERM;
351                 }
352                 if (copy_from_user(&p->RIOBindTab[0], arg, (sizeof(ulong) * MAX_RTA_BINDINGS))) {
353                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_PUT_BINDINGS copy failed\n");
354                         p->RIOError.Error = COPYIN_FAILED;
355                         return -EFAULT;
356                 }
357                 return 0;
358
359         case RIO_BIND_RTA:
360                 {
361                         int EmptySlot = -1;
362                         /*
363                          ** Bind this RTA to host, so that it will be booted by
364                          ** host in 'boot owned RTAs' mode.
365                          */
366                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_BIND_RTA\n");
367
368                         if (!su) {
369                                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_BIND_RTA !Root\n");
370                                 p->RIOError.Error = NOT_SUPER_USER;
371                                 return -EPERM;
372                         }
373                         for (Entry = 0; Entry < MAX_RTA_BINDINGS; Entry++) {
374                                 if ((EmptySlot == -1) && (p->RIOBindTab[Entry] == 0L))
375                                         EmptySlot = Entry;
376                                 else if (p->RIOBindTab[Entry] == (long)arg) {
377                                         /*
378                                          ** Already exists - delete
379                                          */
380                                         p->RIOBindTab[Entry] = 0L;
381                                         rio_dprintk(RIO_DEBUG_CTRL, "Removing Rta %ld from p->RIOBindTab\n", (unsigned long)arg);
382                                         return 0;
383                                 }
384                         }
385                         /*
386                          ** Dosen't exist - add
387                          */
388                         if (EmptySlot != -1) {
389                                 p->RIOBindTab[EmptySlot] = (unsigned long)arg;
390                                 rio_dprintk(RIO_DEBUG_CTRL, "Adding Rta %lx to p->RIOBindTab\n", (unsigned long) arg);
391                         } else {
392                                 rio_dprintk(RIO_DEBUG_CTRL, "p->RIOBindTab full! - Rta %lx not added\n", (unsigned long) arg);
393                                 return -ENOMEM;
394                         }
395                         return 0;
396                 }
397
398         case RIO_RESUME:
399                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_RESUME\n");
400                 port = (unsigned long) arg;
401                 if ((port < 0) || (port > 511)) {
402                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_RESUME: Bad port number %d\n", port);
403                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
404                         return -EINVAL;
405                 }
406                 PortP = p->RIOPortp[port];
407                 if (!PortP->Mapped) {
408                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_RESUME: Port %d not mapped\n", port);
409                         p->RIOError.Error = PORT_NOT_MAPPED_INTO_SYSTEM;
410                         return -EINVAL;
411                 }
412                 if (!(PortP->State & (RIO_LOPEN | RIO_MOPEN))) {
413                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_RESUME: Port %d not open\n", port);
414                         return -EINVAL;
415                 }
416
417                 rio_spin_lock_irqsave(&PortP->portSem, flags);
418                 if (RIOPreemptiveCmd(p, (p->RIOPortp[port]), RESUME) == RIO_FAIL) {
419                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_RESUME failed\n");
420                         rio_spin_unlock_irqrestore(&PortP->portSem, flags);
421                         return -EBUSY;
422                 } else {
423                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_RESUME: Port %d resumed\n", port);
424                         PortP->State |= RIO_BUSY;
425                 }
426                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
427                 return retval;
428
429         case RIO_ASSIGN_RTA:
430                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_ASSIGN_RTA\n");
431                 if (!su) {
432                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_ASSIGN_RTA !Root\n");
433                         p->RIOError.Error = NOT_SUPER_USER;
434                         return -EPERM;
435                 }
436                 if (copy_from_user(&MapEnt, arg, sizeof(MapEnt))) {
437                         rio_dprintk(RIO_DEBUG_CTRL, "Copy from user space failed\n");
438                         p->RIOError.Error = COPYIN_FAILED;
439                         return -EFAULT;
440                 }
441                 return RIOAssignRta(p, &MapEnt);
442
443         case RIO_CHANGE_NAME:
444                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_CHANGE_NAME\n");
445                 if (!su) {
446                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_CHANGE_NAME !Root\n");
447                         p->RIOError.Error = NOT_SUPER_USER;
448                         return -EPERM;
449                 }
450                 if (copy_from_user(&MapEnt, arg, sizeof(MapEnt))) {
451                         rio_dprintk(RIO_DEBUG_CTRL, "Copy from user space failed\n");
452                         p->RIOError.Error = COPYIN_FAILED;
453                         return -EFAULT;
454                 }
455                 return RIOChangeName(p, &MapEnt);
456
457         case RIO_DELETE_RTA:
458                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_DELETE_RTA\n");
459                 if (!su) {
460                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_DELETE_RTA !Root\n");
461                         p->RIOError.Error = NOT_SUPER_USER;
462                         return -EPERM;
463                 }
464                 if (copy_from_user(&MapEnt, arg, sizeof(MapEnt))) {
465                         rio_dprintk(RIO_DEBUG_CTRL, "Copy from data space failed\n");
466                         p->RIOError.Error = COPYIN_FAILED;
467                         return -EFAULT;
468                 }
469                 return RIODeleteRta(p, &MapEnt);
470
471         case RIO_QUICK_CHECK:
472                 if (copy_to_user(arg, &p->RIORtaDisCons, sizeof(unsigned int))) {
473                         p->RIOError.Error = COPYOUT_FAILED;
474                         return -EFAULT;
475                 }
476                 return 0;
477
478         case RIO_LAST_ERROR:
479                 if (copy_to_user(arg, &p->RIOError, sizeof(struct Error)))
480                         return -EFAULT;
481                 return 0;
482
483         case RIO_GET_LOG:
484                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_LOG\n");
485                 return -EINVAL;
486
487         case RIO_GET_MODTYPE:
488                 if (copy_from_user(&port, arg, sizeof(unsigned int))) {
489                         p->RIOError.Error = COPYIN_FAILED;
490                         return -EFAULT;
491                 }
492                 rio_dprintk(RIO_DEBUG_CTRL, "Get module type for port %d\n", port);
493                 if (port < 0 || port > 511) {
494                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_MODTYPE: Bad port number %d\n", port);
495                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
496                         return -EINVAL;
497                 }
498                 PortP = (p->RIOPortp[port]);
499                 if (!PortP->Mapped) {
500                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_MODTYPE: Port %d not mapped\n", port);
501                         p->RIOError.Error = PORT_NOT_MAPPED_INTO_SYSTEM;
502                         return -EINVAL;
503                 }
504                 /*
505                  ** Return module type of port
506                  */
507                 port = PortP->HostP->UnixRups[PortP->RupNum].ModTypes;
508                 if (copy_to_user(arg, &port, sizeof(unsigned int))) {
509                         p->RIOError.Error = COPYOUT_FAILED;
510                         return -EFAULT;
511                 }
512                 return (0);
513         case RIO_BLOCK_OPENS:
514                 rio_dprintk(RIO_DEBUG_CTRL, "Opens block until booted\n");
515                 for (Entry = 0; Entry < RIO_PORTS; Entry++) {
516                         rio_spin_lock_irqsave(&PortP->portSem, flags);
517                         p->RIOPortp[Entry]->WaitUntilBooted = 1;
518                         rio_spin_unlock_irqrestore(&PortP->portSem, flags);
519                 }
520                 return 0;
521
522         case RIO_SETUP_PORTS:
523                 rio_dprintk(RIO_DEBUG_CTRL, "Setup ports\n");
524                 if (copy_from_user(&PortSetup, arg, sizeof(PortSetup))) {
525                         p->RIOError.Error = COPYIN_FAILED;
526                         rio_dprintk(RIO_DEBUG_CTRL, "EFAULT");
527                         return -EFAULT;
528                 }
529                 if (PortSetup.From > PortSetup.To || PortSetup.To >= RIO_PORTS) {
530                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
531                         rio_dprintk(RIO_DEBUG_CTRL, "ENXIO");
532                         return -ENXIO;
533                 }
534                 if (PortSetup.XpCps > p->RIOConf.MaxXpCps || PortSetup.XpCps < p->RIOConf.MinXpCps) {
535                         p->RIOError.Error = XPRINT_CPS_OUT_OF_RANGE;
536                         rio_dprintk(RIO_DEBUG_CTRL, "EINVAL");
537                         return -EINVAL;
538                 }
539                 if (!p->RIOPortp) {
540                         printk(KERN_ERR "rio: No p->RIOPortp array!\n");
541                         rio_dprintk(RIO_DEBUG_CTRL, "No p->RIOPortp array!\n");
542                         return -EIO;
543                 }
544                 rio_dprintk(RIO_DEBUG_CTRL, "entering loop (%d %d)!\n", PortSetup.From, PortSetup.To);
545                 for (loop = PortSetup.From; loop <= PortSetup.To; loop++) {
546                         rio_dprintk(RIO_DEBUG_CTRL, "in loop (%d)!\n", loop);
547                 }
548                 rio_dprintk(RIO_DEBUG_CTRL, "after loop (%d)!\n", loop);
549                 rio_dprintk(RIO_DEBUG_CTRL, "Retval:%x\n", retval);
550                 return retval;
551
552         case RIO_GET_PORT_SETUP:
553                 rio_dprintk(RIO_DEBUG_CTRL, "Get port setup\n");
554                 if (copy_from_user(&PortSetup, arg, sizeof(PortSetup))) {
555                         p->RIOError.Error = COPYIN_FAILED;
556                         return -EFAULT;
557                 }
558                 if (PortSetup.From >= RIO_PORTS) {
559                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
560                         return -ENXIO;
561                 }
562
563                 port = PortSetup.To = PortSetup.From;
564                 PortSetup.IxAny = (p->RIOPortp[port]->Config & RIO_IXANY) ? 1 : 0;
565                 PortSetup.IxOn = (p->RIOPortp[port]->Config & RIO_IXON) ? 1 : 0;
566                 PortSetup.Drain = (p->RIOPortp[port]->Config & RIO_WAITDRAIN) ? 1 : 0;
567                 PortSetup.Store = p->RIOPortp[port]->Store;
568                 PortSetup.Lock = p->RIOPortp[port]->Lock;
569                 PortSetup.XpCps = p->RIOPortp[port]->Xprint.XpCps;
570                 memcpy(PortSetup.XpOn, p->RIOPortp[port]->Xprint.XpOn, MAX_XP_CTRL_LEN);
571                 memcpy(PortSetup.XpOff, p->RIOPortp[port]->Xprint.XpOff, MAX_XP_CTRL_LEN);
572                 PortSetup.XpOn[MAX_XP_CTRL_LEN - 1] = '\0';
573                 PortSetup.XpOff[MAX_XP_CTRL_LEN - 1] = '\0';
574
575                 if (copy_to_user(arg, &PortSetup, sizeof(PortSetup))) {
576                         p->RIOError.Error = COPYOUT_FAILED;
577                         return -EFAULT;
578                 }
579                 return retval;
580
581         case RIO_GET_PORT_PARAMS:
582                 rio_dprintk(RIO_DEBUG_CTRL, "Get port params\n");
583                 if (copy_from_user(&PortParams, arg, sizeof(struct PortParams))) {
584                         p->RIOError.Error = COPYIN_FAILED;
585                         return -EFAULT;
586                 }
587                 if (PortParams.Port >= RIO_PORTS) {
588                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
589                         return -ENXIO;
590                 }
591                 PortP = (p->RIOPortp[PortParams.Port]);
592                 PortParams.Config = PortP->Config;
593                 PortParams.State = PortP->State;
594                 rio_dprintk(RIO_DEBUG_CTRL, "Port %d\n", PortParams.Port);
595
596                 if (copy_to_user(arg, &PortParams, sizeof(struct PortParams))) {
597                         p->RIOError.Error = COPYOUT_FAILED;
598                         return -EFAULT;
599                 }
600                 return retval;
601
602         case RIO_GET_PORT_TTY:
603                 rio_dprintk(RIO_DEBUG_CTRL, "Get port tty\n");
604                 if (copy_from_user(&PortTty, arg, sizeof(struct PortTty))) {
605                         p->RIOError.Error = COPYIN_FAILED;
606                         return -EFAULT;
607                 }
608                 if (PortTty.port >= RIO_PORTS) {
609                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
610                         return -ENXIO;
611                 }
612
613                 rio_dprintk(RIO_DEBUG_CTRL, "Port %d\n", PortTty.port);
614                 PortP = (p->RIOPortp[PortTty.port]);
615                 if (copy_to_user(arg, &PortTty, sizeof(struct PortTty))) {
616                         p->RIOError.Error = COPYOUT_FAILED;
617                         return -EFAULT;
618                 }
619                 return retval;
620
621         case RIO_SET_PORT_TTY:
622                 if (copy_from_user(&PortTty, arg, sizeof(struct PortTty))) {
623                         p->RIOError.Error = COPYIN_FAILED;
624                         return -EFAULT;
625                 }
626                 rio_dprintk(RIO_DEBUG_CTRL, "Set port %d tty\n", PortTty.port);
627                 if (PortTty.port >= (ushort) RIO_PORTS) {
628                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
629                         return -ENXIO;
630                 }
631                 PortP = (p->RIOPortp[PortTty.port]);
632                 RIOParam(PortP, CONFIG, PortP->State & RIO_MODEM, OK_TO_SLEEP);
633                 return retval;
634
635         case RIO_SET_PORT_PARAMS:
636                 rio_dprintk(RIO_DEBUG_CTRL, "Set port params\n");
637                 if (copy_from_user(&PortParams, arg, sizeof(PortParams))) {
638                         p->RIOError.Error = COPYIN_FAILED;
639                         return -EFAULT;
640                 }
641                 if (PortParams.Port >= (ushort) RIO_PORTS) {
642                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
643                         return -ENXIO;
644                 }
645                 PortP = (p->RIOPortp[PortParams.Port]);
646                 rio_spin_lock_irqsave(&PortP->portSem, flags);
647                 PortP->Config = PortParams.Config;
648                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
649                 return retval;
650
651         case RIO_GET_PORT_STATS:
652                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_GET_PORT_STATS\n");
653                 if (copy_from_user(&portStats, arg, sizeof(struct portStats))) {
654                         p->RIOError.Error = COPYIN_FAILED;
655                         return -EFAULT;
656                 }
657                 if (portStats.port >= RIO_PORTS) {
658                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
659                         return -ENXIO;
660                 }
661                 PortP = (p->RIOPortp[portStats.port]);
662                 portStats.gather = PortP->statsGather;
663                 portStats.txchars = PortP->txchars;
664                 portStats.rxchars = PortP->rxchars;
665                 portStats.opens = PortP->opens;
666                 portStats.closes = PortP->closes;
667                 portStats.ioctls = PortP->ioctls;
668                 if (copy_to_user(arg, &portStats, sizeof(struct portStats))) {
669                         p->RIOError.Error = COPYOUT_FAILED;
670                         return -EFAULT;
671                 }
672                 return retval;
673
674         case RIO_RESET_PORT_STATS:
675                 port = (unsigned long) arg;
676                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_RESET_PORT_STATS\n");
677                 if (port >= RIO_PORTS) {
678                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
679                         return -ENXIO;
680                 }
681                 PortP = (p->RIOPortp[port]);
682                 rio_spin_lock_irqsave(&PortP->portSem, flags);
683                 PortP->txchars = 0;
684                 PortP->rxchars = 0;
685                 PortP->opens = 0;
686                 PortP->closes = 0;
687                 PortP->ioctls = 0;
688                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
689                 return retval;
690
691         case RIO_GATHER_PORT_STATS:
692                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_GATHER_PORT_STATS\n");
693                 if (copy_from_user(&portStats, arg, sizeof(struct portStats))) {
694                         p->RIOError.Error = COPYIN_FAILED;
695                         return -EFAULT;
696                 }
697                 if (portStats.port >= RIO_PORTS) {
698                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
699                         return -ENXIO;
700                 }
701                 PortP = (p->RIOPortp[portStats.port]);
702                 rio_spin_lock_irqsave(&PortP->portSem, flags);
703                 PortP->statsGather = portStats.gather;
704                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
705                 return retval;
706
707         case RIO_READ_CONFIG:
708                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_READ_CONFIG\n");
709                 if (copy_to_user(arg, &p->RIOConf, sizeof(struct Conf))) {
710                         p->RIOError.Error = COPYOUT_FAILED;
711                         return -EFAULT;
712                 }
713                 return retval;
714
715         case RIO_SET_CONFIG:
716                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_SET_CONFIG\n");
717                 if (!su) {
718                         p->RIOError.Error = NOT_SUPER_USER;
719                         return -EPERM;
720                 }
721                 if (copy_from_user(&p->RIOConf, arg, sizeof(struct Conf))) {
722                         p->RIOError.Error = COPYIN_FAILED;
723                         return -EFAULT;
724                 }
725                 /*
726                  ** move a few value around
727                  */
728                 for (Host = 0; Host < p->RIONumHosts; Host++)
729                         if ((p->RIOHosts[Host].Flags & RUN_STATE) == RC_RUNNING)
730                                 writew(p->RIOConf.Timer, &p->RIOHosts[Host].ParmMapP->timer);
731                 return retval;
732
733         case RIO_START_POLLER:
734                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_START_POLLER\n");
735                 return -EINVAL;
736
737         case RIO_STOP_POLLER:
738                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_STOP_POLLER\n");
739                 if (!su) {
740                         p->RIOError.Error = NOT_SUPER_USER;
741                         return -EPERM;
742                 }
743                 p->RIOPolling = NOT_POLLING;
744                 return retval;
745
746         case RIO_SETDEBUG:
747         case RIO_GETDEBUG:
748                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_SETDEBUG/RIO_GETDEBUG\n");
749                 if (copy_from_user(&DebugCtrl, arg, sizeof(DebugCtrl))) {
750                         p->RIOError.Error = COPYIN_FAILED;
751                         return -EFAULT;
752                 }
753                 if (DebugCtrl.SysPort == NO_PORT) {
754                         if (cmd == RIO_SETDEBUG) {
755                                 if (!su) {
756                                         p->RIOError.Error = NOT_SUPER_USER;
757                                         return -EPERM;
758                                 }
759                                 p->rio_debug = DebugCtrl.Debug;
760                                 p->RIODebugWait = DebugCtrl.Wait;
761                                 rio_dprintk(RIO_DEBUG_CTRL, "Set global debug to 0x%x set wait to 0x%x\n", p->rio_debug, p->RIODebugWait);
762                         } else {
763                                 rio_dprintk(RIO_DEBUG_CTRL, "Get global debug 0x%x wait 0x%x\n", p->rio_debug, p->RIODebugWait);
764                                 DebugCtrl.Debug = p->rio_debug;
765                                 DebugCtrl.Wait = p->RIODebugWait;
766                                 if (copy_to_user(arg, &DebugCtrl, sizeof(DebugCtrl))) {
767                                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_SET/GET DEBUG: bad port number %d\n", DebugCtrl.SysPort);
768                                         p->RIOError.Error = COPYOUT_FAILED;
769                                         return -EFAULT;
770                                 }
771                         }
772                 } else if (DebugCtrl.SysPort >= RIO_PORTS && DebugCtrl.SysPort != NO_PORT) {
773                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_SET/GET DEBUG: bad port number %d\n", DebugCtrl.SysPort);
774                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
775                         return -ENXIO;
776                 } else if (cmd == RIO_SETDEBUG) {
777                         if (!su) {
778                                 p->RIOError.Error = NOT_SUPER_USER;
779                                 return -EPERM;
780                         }
781                         rio_spin_lock_irqsave(&PortP->portSem, flags);
782                         p->RIOPortp[DebugCtrl.SysPort]->Debug = DebugCtrl.Debug;
783                         rio_spin_unlock_irqrestore(&PortP->portSem, flags);
784                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_SETDEBUG 0x%x\n", p->RIOPortp[DebugCtrl.SysPort]->Debug);
785                 } else {
786                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_GETDEBUG 0x%x\n", p->RIOPortp[DebugCtrl.SysPort]->Debug);
787                         DebugCtrl.Debug = p->RIOPortp[DebugCtrl.SysPort]->Debug;
788                         if (copy_to_user(arg, &DebugCtrl, sizeof(DebugCtrl))) {
789                                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_GETDEBUG: Bad copy to user space\n");
790                                 p->RIOError.Error = COPYOUT_FAILED;
791                                 return -EFAULT;
792                         }
793                 }
794                 return retval;
795
796         case RIO_VERSID:
797                 /*
798                  ** Enquire about the release and version.
799                  ** We return MAX_VERSION_LEN bytes, being a
800                  ** textual null terminated string.
801                  */
802                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_VERSID\n");
803                 if (copy_to_user(arg, RIOVersid(), sizeof(struct rioVersion))) {
804                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_VERSID: Bad copy to user space (host=%d)\n", Host);
805                         p->RIOError.Error = COPYOUT_FAILED;
806                         return -EFAULT;
807                 }
808                 return retval;
809
810         case RIO_NUM_HOSTS:
811                 /*
812                  ** Enquire as to the number of hosts located
813                  ** at init time.
814                  */
815                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_NUM_HOSTS\n");
816                 if (copy_to_user(arg, &p->RIONumHosts, sizeof(p->RIONumHosts))) {
817                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_NUM_HOSTS: Bad copy to user space\n");
818                         p->RIOError.Error = COPYOUT_FAILED;
819                         return -EFAULT;
820                 }
821                 return retval;
822
823         case RIO_HOST_FOAD:
824                 /*
825                  ** Kill host. This may not be in the final version...
826                  */
827                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_FOAD %ld\n", (unsigned long) arg);
828                 if (!su) {
829                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_FOAD: Not super user\n");
830                         p->RIOError.Error = NOT_SUPER_USER;
831                         return -EPERM;
832                 }
833                 p->RIOHalted = 1;
834                 p->RIOSystemUp = 0;
835
836                 for (Host = 0; Host < p->RIONumHosts; Host++) {
837                         (void) RIOBoardTest(p->RIOHosts[Host].PaddrP, p->RIOHosts[Host].Caddr, p->RIOHosts[Host].Type, p->RIOHosts[Host].Slot);
838                         memset(&p->RIOHosts[Host].Flags, 0, ((char *) &p->RIOHosts[Host].____end_marker____) - ((char *) &p->RIOHosts[Host].Flags));
839                         p->RIOHosts[Host].Flags = RC_WAITING;
840                 }
841                 RIOFoadWakeup(p);
842                 p->RIONumBootPkts = 0;
843                 p->RIOBooting = 0;
844                 printk("HEEEEELP!\n");
845
846                 for (loop = 0; loop < RIO_PORTS; loop++) {
847                         spin_lock_init(&p->RIOPortp[loop]->portSem);
848                         p->RIOPortp[loop]->InUse = NOT_INUSE;
849                 }
850
851                 p->RIOSystemUp = 0;
852                 return retval;
853
854         case RIO_DOWNLOAD:
855                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_DOWNLOAD\n");
856                 if (!su) {
857                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_DOWNLOAD: Not super user\n");
858                         p->RIOError.Error = NOT_SUPER_USER;
859                         return -EPERM;
860                 }
861                 if (copy_from_user(&DownLoad, arg, sizeof(DownLoad))) {
862                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_DOWNLOAD: Copy in from user space failed\n");
863                         p->RIOError.Error = COPYIN_FAILED;
864                         return -EFAULT;
865                 }
866                 rio_dprintk(RIO_DEBUG_CTRL, "Copied in download code for product code 0x%x\n", DownLoad.ProductCode);
867
868                 /*
869                  ** It is important that the product code is an unsigned object!
870                  */
871                 if (DownLoad.ProductCode > MAX_PRODUCT) {
872                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_DOWNLOAD: Bad product code %d passed\n", DownLoad.ProductCode);
873                         p->RIOError.Error = NO_SUCH_PRODUCT;
874                         return -ENXIO;
875                 }
876                 /*
877                  ** do something!
878                  */
879                 retval = (*(RIOBootTable[DownLoad.ProductCode])) (p, &DownLoad);
880                 /* <-- Panic */
881                 p->RIOHalted = 0;
882                 /*
883                  ** and go back, content with a job well completed.
884                  */
885                 return retval;
886
887         case RIO_PARMS:
888                 {
889                         unsigned int host;
890
891                         if (copy_from_user(&host, arg, sizeof(host))) {
892                                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ: Copy in from user space failed\n");
893                                 p->RIOError.Error = COPYIN_FAILED;
894                                 return -EFAULT;
895                         }
896                         /*
897                          ** Fetch the parmmap
898                          */
899                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_PARMS\n");
900                         if (copy_to_user(arg, p->RIOHosts[host].ParmMapP, sizeof(PARM_MAP))) {
901                                 p->RIOError.Error = COPYOUT_FAILED;
902                                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_PARMS: Copy out to user space failed\n");
903                                 return -EFAULT;
904                         }
905                 }
906                 return retval;
907
908         case RIO_HOST_REQ:
909                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ\n");
910                 if (copy_from_user(&HostReq, arg, sizeof(HostReq))) {
911                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ: Copy in from user space failed\n");
912                         p->RIOError.Error = COPYIN_FAILED;
913                         return -EFAULT;
914                 }
915                 if (HostReq.HostNum >= p->RIONumHosts) {
916                         p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
917                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ: Illegal host number %d\n", HostReq.HostNum);
918                         return -ENXIO;
919                 }
920                 rio_dprintk(RIO_DEBUG_CTRL, "Request for host %d\n", HostReq.HostNum);
921
922                 if (copy_to_user(HostReq.HostP, &p->RIOHosts[HostReq.HostNum], sizeof(struct Host))) {
923                         p->RIOError.Error = COPYOUT_FAILED;
924                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_REQ: Bad copy to user space\n");
925                         return -EFAULT;
926                 }
927                 return retval;
928
929         case RIO_HOST_DPRAM:
930                 rio_dprintk(RIO_DEBUG_CTRL, "Request for DPRAM\n");
931                 if (copy_from_user(&HostDpRam, arg, sizeof(HostDpRam))) {
932                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_DPRAM: Copy in from user space failed\n");
933                         p->RIOError.Error = COPYIN_FAILED;
934                         return -EFAULT;
935                 }
936                 if (HostDpRam.HostNum >= p->RIONumHosts) {
937                         p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
938                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_DPRAM: Illegal host number %d\n", HostDpRam.HostNum);
939                         return -ENXIO;
940                 }
941                 rio_dprintk(RIO_DEBUG_CTRL, "Request for host %d\n", HostDpRam.HostNum);
942
943                 if (p->RIOHosts[HostDpRam.HostNum].Type == RIO_PCI) {
944                         int off;
945                         /* It's hardware like this that really gets on my tits. */
946                         static unsigned char copy[sizeof(struct DpRam)];
947                         for (off = 0; off < sizeof(struct DpRam); off++)
948                                 copy[off] = readb(&p->RIOHosts[HostDpRam.HostNum].Caddr[off]);
949                         if (copy_to_user(HostDpRam.DpRamP, copy, sizeof(struct DpRam))) {
950                                 p->RIOError.Error = COPYOUT_FAILED;
951                                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_DPRAM: Bad copy to user space\n");
952                                 return -EFAULT;
953                         }
954                 } else if (copy_to_user(HostDpRam.DpRamP, p->RIOHosts[HostDpRam.HostNum].Caddr, sizeof(struct DpRam))) {
955                         p->RIOError.Error = COPYOUT_FAILED;
956                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_DPRAM: Bad copy to user space\n");
957                         return -EFAULT;
958                 }
959                 return retval;
960
961         case RIO_SET_BUSY:
962                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_SET_BUSY\n");
963                 if ((unsigned long) arg > 511) {
964                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_SET_BUSY: Bad port number %ld\n", (unsigned long) arg);
965                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
966                         return -EINVAL;
967                 }
968                 rio_spin_lock_irqsave(&PortP->portSem, flags);
969                 p->RIOPortp[(unsigned long) arg]->State |= RIO_BUSY;
970                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
971                 return retval;
972
973         case RIO_HOST_PORT:
974                 /*
975                  ** The daemon want port information
976                  ** (probably for debug reasons)
977                  */
978                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_PORT\n");
979                 if (copy_from_user(&PortReq, arg, sizeof(PortReq))) {
980                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_PORT: Copy in from user space failed\n");
981                         p->RIOError.Error = COPYIN_FAILED;
982                         return -EFAULT;
983                 }
984
985                 if (PortReq.SysPort >= RIO_PORTS) {     /* SysPort is unsigned */
986                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_PORT: Illegal port number %d\n", PortReq.SysPort);
987                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
988                         return -ENXIO;
989                 }
990                 rio_dprintk(RIO_DEBUG_CTRL, "Request for port %d\n", PortReq.SysPort);
991                 if (copy_to_user(PortReq.PortP, p->RIOPortp[PortReq.SysPort], sizeof(struct Port))) {
992                         p->RIOError.Error = COPYOUT_FAILED;
993                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_PORT: Bad copy to user space\n");
994                         return -EFAULT;
995                 }
996                 return retval;
997
998         case RIO_HOST_RUP:
999                 /*
1000                  ** The daemon want rup information
1001                  ** (probably for debug reasons)
1002                  */
1003                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_RUP\n");
1004                 if (copy_from_user(&RupReq, arg, sizeof(RupReq))) {
1005                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_RUP: Copy in from user space failed\n");
1006                         p->RIOError.Error = COPYIN_FAILED;
1007                         return -EFAULT;
1008                 }
1009                 if (RupReq.HostNum >= p->RIONumHosts) { /* host is unsigned */
1010                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_RUP: Illegal host number %d\n", RupReq.HostNum);
1011                         p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
1012                         return -ENXIO;
1013                 }
1014                 if (RupReq.RupNum >= MAX_RUP + LINKS_PER_UNIT) {        /* eek! */
1015                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_RUP: Illegal rup number %d\n", RupReq.RupNum);
1016                         p->RIOError.Error = RUP_NUMBER_OUT_OF_RANGE;
1017                         return -EINVAL;
1018                 }
1019                 HostP = &p->RIOHosts[RupReq.HostNum];
1020
1021                 if ((HostP->Flags & RUN_STATE) != RC_RUNNING) {
1022                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_RUP: Host %d not running\n", RupReq.HostNum);
1023                         p->RIOError.Error = HOST_NOT_RUNNING;
1024                         return -EIO;
1025                 }
1026                 rio_dprintk(RIO_DEBUG_CTRL, "Request for rup %d from host %d\n", RupReq.RupNum, RupReq.HostNum);
1027
1028                 if (copy_to_user(HostP->UnixRups[RupReq.RupNum].RupP, RupReq.RupP, sizeof(struct RUP))) {
1029                         p->RIOError.Error = COPYOUT_FAILED;
1030                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_RUP: Bad copy to user space\n");
1031                         return -EFAULT;
1032                 }
1033                 return retval;
1034
1035         case RIO_HOST_LPB:
1036                 /*
1037                  ** The daemon want lpb information
1038                  ** (probably for debug reasons)
1039                  */
1040                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB\n");
1041                 if (copy_from_user(&LpbReq, arg, sizeof(LpbReq))) {
1042                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB: Bad copy from user space\n");
1043                         p->RIOError.Error = COPYIN_FAILED;
1044                         return -EFAULT;
1045                 }
1046                 if (LpbReq.Host >= p->RIONumHosts) {    /* host is unsigned */
1047                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB: Illegal host number %d\n", LpbReq.Host);
1048                         p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
1049                         return -ENXIO;
1050                 }
1051                 if (LpbReq.Link >= LINKS_PER_UNIT) {    /* eek! */
1052                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB: Illegal link number %d\n", LpbReq.Link);
1053                         p->RIOError.Error = LINK_NUMBER_OUT_OF_RANGE;
1054                         return -EINVAL;
1055                 }
1056                 HostP = &p->RIOHosts[LpbReq.Host];
1057
1058                 if ((HostP->Flags & RUN_STATE) != RC_RUNNING) {
1059                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB: Host %d not running\n", LpbReq.Host);
1060                         p->RIOError.Error = HOST_NOT_RUNNING;
1061                         return -EIO;
1062                 }
1063                 rio_dprintk(RIO_DEBUG_CTRL, "Request for lpb %d from host %d\n", LpbReq.Link, LpbReq.Host);
1064
1065                 if (copy_to_user(LpbReq.LpbP, &HostP->LinkStrP[LpbReq.Link], sizeof(struct LPB))) {
1066                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_HOST_LPB: Bad copy to user space\n");
1067                         p->RIOError.Error = COPYOUT_FAILED;
1068                         return -EFAULT;
1069                 }
1070                 return retval;
1071
1072                 /*
1073                  ** Here 3 IOCTL's that allow us to change the way in which
1074                  ** rio logs errors. send them just to syslog or send them
1075                  ** to both syslog and console or send them to just the console.
1076                  **
1077                  ** See RioStrBuf() in util.c for the other half.
1078                  */
1079         case RIO_SYSLOG_ONLY:
1080                 p->RIOPrintLogState = PRINT_TO_LOG;     /* Just syslog */
1081                 return 0;
1082
1083         case RIO_SYSLOG_CONS:
1084                 p->RIOPrintLogState = PRINT_TO_LOG_CONS;        /* syslog and console */
1085                 return 0;
1086
1087         case RIO_CONS_ONLY:
1088                 p->RIOPrintLogState = PRINT_TO_CONS;    /* Just console */
1089                 return 0;
1090
1091         case RIO_SIGNALS_ON:
1092                 if (p->RIOSignalProcess) {
1093                         p->RIOError.Error = SIGNALS_ALREADY_SET;
1094                         return -EBUSY;
1095                 }
1096                 /* FIXME: PID tracking */
1097                 p->RIOSignalProcess = current->pid;
1098                 p->RIOPrintDisabled = DONT_PRINT;
1099                 return retval;
1100
1101         case RIO_SIGNALS_OFF:
1102                 if (p->RIOSignalProcess != current->pid) {
1103                         p->RIOError.Error = NOT_RECEIVING_PROCESS;
1104                         return -EPERM;
1105                 }
1106                 rio_dprintk(RIO_DEBUG_CTRL, "Clear signal process to zero\n");
1107                 p->RIOSignalProcess = 0;
1108                 return retval;
1109
1110         case RIO_SET_BYTE_MODE:
1111                 for (Host = 0; Host < p->RIONumHosts; Host++)
1112                         if (p->RIOHosts[Host].Type == RIO_AT)
1113                                 p->RIOHosts[Host].Mode &= ~WORD_OPERATION;
1114                 return retval;
1115
1116         case RIO_SET_WORD_MODE:
1117                 for (Host = 0; Host < p->RIONumHosts; Host++)
1118                         if (p->RIOHosts[Host].Type == RIO_AT)
1119                                 p->RIOHosts[Host].Mode |= WORD_OPERATION;
1120                 return retval;
1121
1122         case RIO_SET_FAST_BUS:
1123                 for (Host = 0; Host < p->RIONumHosts; Host++)
1124                         if (p->RIOHosts[Host].Type == RIO_AT)
1125                                 p->RIOHosts[Host].Mode |= FAST_AT_BUS;
1126                 return retval;
1127
1128         case RIO_SET_SLOW_BUS:
1129                 for (Host = 0; Host < p->RIONumHosts; Host++)
1130                         if (p->RIOHosts[Host].Type == RIO_AT)
1131                                 p->RIOHosts[Host].Mode &= ~FAST_AT_BUS;
1132                 return retval;
1133
1134         case RIO_MAP_B50_TO_50:
1135         case RIO_MAP_B50_TO_57600:
1136         case RIO_MAP_B110_TO_110:
1137         case RIO_MAP_B110_TO_115200:
1138                 rio_dprintk(RIO_DEBUG_CTRL, "Baud rate mapping\n");
1139                 port = (unsigned long) arg;
1140                 if (port < 0 || port > 511) {
1141                         rio_dprintk(RIO_DEBUG_CTRL, "Baud rate mapping: Bad port number %d\n", port);
1142                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
1143                         return -EINVAL;
1144                 }
1145                 rio_spin_lock_irqsave(&PortP->portSem, flags);
1146                 switch (cmd) {
1147                 case RIO_MAP_B50_TO_50:
1148                         p->RIOPortp[port]->Config |= RIO_MAP_50_TO_50;
1149                         break;
1150                 case RIO_MAP_B50_TO_57600:
1151                         p->RIOPortp[port]->Config &= ~RIO_MAP_50_TO_50;
1152                         break;
1153                 case RIO_MAP_B110_TO_110:
1154                         p->RIOPortp[port]->Config |= RIO_MAP_110_TO_110;
1155                         break;
1156                 case RIO_MAP_B110_TO_115200:
1157                         p->RIOPortp[port]->Config &= ~RIO_MAP_110_TO_110;
1158                         break;
1159                 }
1160                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
1161                 return retval;
1162
1163         case RIO_STREAM_INFO:
1164                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_STREAM_INFO\n");
1165                 return -EINVAL;
1166
1167         case RIO_SEND_PACKET:
1168                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_SEND_PACKET\n");
1169                 if (copy_from_user(&SendPack, arg, sizeof(SendPack))) {
1170                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_SEND_PACKET: Bad copy from user space\n");
1171                         p->RIOError.Error = COPYIN_FAILED;
1172                         return -EFAULT;
1173                 }
1174                 if (SendPack.PortNum >= 128) {
1175                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
1176                         return -ENXIO;
1177                 }
1178
1179                 PortP = p->RIOPortp[SendPack.PortNum];
1180                 rio_spin_lock_irqsave(&PortP->portSem, flags);
1181
1182                 if (!can_add_transmit(&PacketP, PortP)) {
1183                         p->RIOError.Error = UNIT_IS_IN_USE;
1184                         rio_spin_unlock_irqrestore(&PortP->portSem, flags);
1185                         return -ENOSPC;
1186                 }
1187
1188                 for (loop = 0; loop < (ushort) (SendPack.Len & 127); loop++)
1189                         writeb(SendPack.Data[loop], &PacketP->data[loop]);
1190
1191                 writeb(SendPack.Len, &PacketP->len);
1192
1193                 add_transmit(PortP);
1194                 /*
1195                  ** Count characters transmitted for port statistics reporting
1196                  */
1197                 if (PortP->statsGather)
1198                         PortP->txchars += (SendPack.Len & 127);
1199                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
1200                 return retval;
1201
1202         case RIO_NO_MESG:
1203                 if (su)
1204                         p->RIONoMessage = 1;
1205                 return su ? 0 : -EPERM;
1206
1207         case RIO_MESG:
1208                 if (su)
1209                         p->RIONoMessage = 0;
1210                 return su ? 0 : -EPERM;
1211
1212         case RIO_WHAT_MESG:
1213                 if (copy_to_user(arg, &p->RIONoMessage, sizeof(p->RIONoMessage))) {
1214                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_WHAT_MESG: Bad copy to user space\n");
1215                         p->RIOError.Error = COPYOUT_FAILED;
1216                         return -EFAULT;
1217                 }
1218                 return 0;
1219
1220         case RIO_MEM_DUMP:
1221                 if (copy_from_user(&SubCmd, arg, sizeof(struct SubCmdStruct))) {
1222                         p->RIOError.Error = COPYIN_FAILED;
1223                         return -EFAULT;
1224                 }
1225                 rio_dprintk(RIO_DEBUG_CTRL, "RIO_MEM_DUMP host %d rup %d addr %x\n", SubCmd.Host, SubCmd.Rup, SubCmd.Addr);
1226
1227                 if (SubCmd.Rup >= MAX_RUP + LINKS_PER_UNIT) {
1228                         p->RIOError.Error = RUP_NUMBER_OUT_OF_RANGE;
1229                         return -EINVAL;
1230                 }
1231
1232                 if (SubCmd.Host >= p->RIONumHosts) {
1233                         p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
1234                         return -EINVAL;
1235                 }
1236
1237                 port = p->RIOHosts[SubCmd.Host].UnixRups[SubCmd.Rup].BaseSysPort;
1238
1239                 PortP = p->RIOPortp[port];
1240
1241                 rio_spin_lock_irqsave(&PortP->portSem, flags);
1242
1243                 if (RIOPreemptiveCmd(p, PortP, MEMDUMP) == RIO_FAIL) {
1244                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_MEM_DUMP failed\n");
1245                         rio_spin_unlock_irqrestore(&PortP->portSem, flags);
1246                         return -EBUSY;
1247                 } else
1248                         PortP->State |= RIO_BUSY;
1249
1250                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
1251                 if (copy_to_user(arg, p->RIOMemDump, MEMDUMP_SIZE)) {
1252                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_MEM_DUMP copy failed\n");
1253                         p->RIOError.Error = COPYOUT_FAILED;
1254                         return -EFAULT;
1255                 }
1256                 return 0;
1257
1258         case RIO_TICK:
1259                 if ((unsigned long) arg >= p->RIONumHosts)
1260                         return -EINVAL;
1261                 rio_dprintk(RIO_DEBUG_CTRL, "Set interrupt for host %ld\n", (unsigned long) arg);
1262                 writeb(0xFF, &p->RIOHosts[(unsigned long) arg].SetInt);
1263                 return 0;
1264
1265         case RIO_TOCK:
1266                 if ((unsigned long) arg >= p->RIONumHosts)
1267                         return -EINVAL;
1268                 rio_dprintk(RIO_DEBUG_CTRL, "Clear interrupt for host %ld\n", (unsigned long) arg);
1269                 writeb(0xFF, &p->RIOHosts[(unsigned long) arg].ResetInt);
1270                 return 0;
1271
1272         case RIO_READ_CHECK:
1273                 /* Check reads for pkts with data[0] the same */
1274                 p->RIOReadCheck = !p->RIOReadCheck;
1275                 if (copy_to_user(arg, &p->RIOReadCheck, sizeof(unsigned int))) {
1276                         p->RIOError.Error = COPYOUT_FAILED;
1277                         return -EFAULT;
1278                 }
1279                 return 0;
1280
1281         case RIO_READ_REGISTER:
1282                 if (copy_from_user(&SubCmd, arg, sizeof(struct SubCmdStruct))) {
1283                         p->RIOError.Error = COPYIN_FAILED;
1284                         return -EFAULT;
1285                 }
1286                 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);
1287
1288                 if (SubCmd.Port > 511) {
1289                         rio_dprintk(RIO_DEBUG_CTRL, "Baud rate mapping: Bad port number %d\n", SubCmd.Port);
1290                         p->RIOError.Error = PORT_NUMBER_OUT_OF_RANGE;
1291                         return -EINVAL;
1292                 }
1293
1294                 if (SubCmd.Rup >= MAX_RUP + LINKS_PER_UNIT) {
1295                         p->RIOError.Error = RUP_NUMBER_OUT_OF_RANGE;
1296                         return -EINVAL;
1297                 }
1298
1299                 if (SubCmd.Host >= p->RIONumHosts) {
1300                         p->RIOError.Error = HOST_NUMBER_OUT_OF_RANGE;
1301                         return -EINVAL;
1302                 }
1303
1304                 port = p->RIOHosts[SubCmd.Host].UnixRups[SubCmd.Rup].BaseSysPort + SubCmd.Port;
1305                 PortP = p->RIOPortp[port];
1306
1307                 rio_spin_lock_irqsave(&PortP->portSem, flags);
1308
1309                 if (RIOPreemptiveCmd(p, PortP, READ_REGISTER) == RIO_FAIL) {
1310                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_READ_REGISTER failed\n");
1311                         rio_spin_unlock_irqrestore(&PortP->portSem, flags);
1312                         return -EBUSY;
1313                 } else
1314                         PortP->State |= RIO_BUSY;
1315
1316                 rio_spin_unlock_irqrestore(&PortP->portSem, flags);
1317                 if (copy_to_user(arg, &p->CdRegister, sizeof(unsigned int))) {
1318                         rio_dprintk(RIO_DEBUG_CTRL, "RIO_READ_REGISTER copy failed\n");
1319                         p->RIOError.Error = COPYOUT_FAILED;
1320                         return -EFAULT;
1321                 }
1322                 return 0;
1323                 /*
1324                  ** rio_make_dev: given port number (0-511) ORed with port type
1325                  ** (RIO_DEV_DIRECT, RIO_DEV_MODEM, RIO_DEV_XPRINT) return dev_t
1326                  ** value to pass to mknod to create the correct device node.
1327                  */
1328         case RIO_MAKE_DEV:
1329                 {
1330                         unsigned int port = (unsigned long) arg & RIO_MODEM_MASK;
1331                         unsigned int ret;
1332
1333                         switch ((unsigned long) arg & RIO_DEV_MASK) {
1334                         case RIO_DEV_DIRECT:
1335                                 ret = drv_makedev(MAJOR(dev), port);
1336                                 rio_dprintk(RIO_DEBUG_CTRL, "Makedev direct 0x%x is 0x%x\n", port, ret);
1337                                 return ret;
1338                         case RIO_DEV_MODEM:
1339                                 ret = drv_makedev(MAJOR(dev), (port | RIO_MODEM_BIT));
1340                                 rio_dprintk(RIO_DEBUG_CTRL, "Makedev modem 0x%x is 0x%x\n", port, ret);
1341                                 return ret;
1342                         case RIO_DEV_XPRINT:
1343                                 ret = drv_makedev(MAJOR(dev), port);
1344                                 rio_dprintk(RIO_DEBUG_CTRL, "Makedev printer 0x%x is 0x%x\n", port, ret);
1345                                 return ret;
1346                         }
1347                         rio_dprintk(RIO_DEBUG_CTRL, "MAKE Device is called\n");
1348                         return -EINVAL;
1349                 }
1350                 /*
1351                  ** rio_minor: given a dev_t from a stat() call, return
1352                  ** the port number (0-511) ORed with the port type
1353                  ** ( RIO_DEV_DIRECT, RIO_DEV_MODEM, RIO_DEV_XPRINT )
1354                  */
1355         case RIO_MINOR:
1356                 {
1357                         dev_t dv;
1358                         int mino;
1359                         unsigned long ret;
1360
1361                         dv = (dev_t) ((unsigned long) arg);
1362                         mino = RIO_UNMODEM(dv);
1363
1364                         if (RIO_ISMODEM(dv)) {
1365                                 rio_dprintk(RIO_DEBUG_CTRL, "Minor for device 0x%x: modem %d\n", dv, mino);
1366                                 ret = mino | RIO_DEV_MODEM;
1367                         } else {
1368                                 rio_dprintk(RIO_DEBUG_CTRL, "Minor for device 0x%x: direct %d\n", dv, mino);
1369                                 ret = mino | RIO_DEV_DIRECT;
1370                         }
1371                         return ret;
1372                 }
1373         }
1374         rio_dprintk(RIO_DEBUG_CTRL, "INVALID DAEMON IOCTL 0x%x\n", cmd);
1375         p->RIOError.Error = IOCTL_COMMAND_UNKNOWN;
1376
1377         func_exit();
1378         return -EINVAL;
1379 }
1380
1381 /*
1382 ** Pre-emptive commands go on RUPs and are only one byte long.
1383 */
1384 int RIOPreemptiveCmd(struct rio_info *p, struct Port *PortP, u8 Cmd)
1385 {
1386         struct CmdBlk *CmdBlkP;
1387         struct PktCmd_M *PktCmdP;
1388         int Ret;
1389         ushort rup;
1390         int port;
1391
1392         if (PortP->State & RIO_DELETED) {
1393                 rio_dprintk(RIO_DEBUG_CTRL, "Preemptive command to deleted RTA ignored\n");
1394                 return RIO_FAIL;
1395         }
1396
1397         if (((int) ((char) PortP->InUse) == -1) || !(CmdBlkP = RIOGetCmdBlk())) {
1398                 rio_dprintk(RIO_DEBUG_CTRL, "Cannot allocate command block for command %d on port %d\n", Cmd, PortP->PortNum);
1399                 return RIO_FAIL;
1400         }
1401
1402         rio_dprintk(RIO_DEBUG_CTRL, "Command blk %p - InUse now %d\n", CmdBlkP, PortP->InUse);
1403
1404         PktCmdP = (struct PktCmd_M *) &CmdBlkP->Packet.data[0];
1405
1406         CmdBlkP->Packet.src_unit = 0;
1407         if (PortP->SecondBlock)
1408                 rup = PortP->ID2;
1409         else
1410                 rup = PortP->RupNum;
1411         CmdBlkP->Packet.dest_unit = rup;
1412         CmdBlkP->Packet.src_port = COMMAND_RUP;
1413         CmdBlkP->Packet.dest_port = COMMAND_RUP;
1414         CmdBlkP->Packet.len = PKT_CMD_BIT | 2;
1415         CmdBlkP->PostFuncP = RIOUnUse;
1416         CmdBlkP->PostArg = (unsigned long) PortP;
1417         PktCmdP->Command = Cmd;
1418         port = PortP->HostPort % (ushort) PORTS_PER_RTA;
1419         /*
1420          ** Index ports 8-15 for 2nd block of 16 port RTA.
1421          */
1422         if (PortP->SecondBlock)
1423                 port += (ushort) PORTS_PER_RTA;
1424         PktCmdP->PhbNum = port;
1425
1426         switch (Cmd) {
1427         case MEMDUMP:
1428                 rio_dprintk(RIO_DEBUG_CTRL, "Queue MEMDUMP command blk %p (addr 0x%x)\n", CmdBlkP, (int) SubCmd.Addr);
1429                 PktCmdP->SubCommand = MEMDUMP;
1430                 PktCmdP->SubAddr = SubCmd.Addr;
1431                 break;
1432         case FCLOSE:
1433                 rio_dprintk(RIO_DEBUG_CTRL, "Queue FCLOSE command blk %p\n", CmdBlkP);
1434                 break;
1435         case READ_REGISTER:
1436                 rio_dprintk(RIO_DEBUG_CTRL, "Queue READ_REGISTER (0x%x) command blk %p\n", (int) SubCmd.Addr, CmdBlkP);
1437                 PktCmdP->SubCommand = READ_REGISTER;
1438                 PktCmdP->SubAddr = SubCmd.Addr;
1439                 break;
1440         case RESUME:
1441                 rio_dprintk(RIO_DEBUG_CTRL, "Queue RESUME command blk %p\n", CmdBlkP);
1442                 break;
1443         case RFLUSH:
1444                 rio_dprintk(RIO_DEBUG_CTRL, "Queue RFLUSH command blk %p\n", CmdBlkP);
1445                 CmdBlkP->PostFuncP = RIORFlushEnable;
1446                 break;
1447         case SUSPEND:
1448                 rio_dprintk(RIO_DEBUG_CTRL, "Queue SUSPEND command blk %p\n", CmdBlkP);
1449                 break;
1450
1451         case MGET:
1452                 rio_dprintk(RIO_DEBUG_CTRL, "Queue MGET command blk %p\n", CmdBlkP);
1453                 break;
1454
1455         case MSET:
1456         case MBIC:
1457         case MBIS:
1458                 CmdBlkP->Packet.data[4] = (char) PortP->ModemLines;
1459                 rio_dprintk(RIO_DEBUG_CTRL, "Queue MSET/MBIC/MBIS command blk %p\n", CmdBlkP);
1460                 break;
1461
1462         case WFLUSH:
1463                 /*
1464                  ** If we have queued up the maximum number of Write flushes
1465                  ** allowed then we should not bother sending any more to the
1466                  ** RTA.
1467                  */
1468                 if ((int) ((char) PortP->WflushFlag) == (int) -1) {
1469                         rio_dprintk(RIO_DEBUG_CTRL, "Trashed WFLUSH, WflushFlag about to wrap!");
1470                         RIOFreeCmdBlk(CmdBlkP);
1471                         return (RIO_FAIL);
1472                 } else {
1473                         rio_dprintk(RIO_DEBUG_CTRL, "Queue WFLUSH command blk %p\n", CmdBlkP);
1474                         CmdBlkP->PostFuncP = RIOWFlushMark;
1475                 }
1476                 break;
1477         }
1478
1479         PortP->InUse++;
1480
1481         Ret = RIOQueueCmdBlk(PortP->HostP, rup, CmdBlkP);
1482
1483         return Ret;
1484 }