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