dpti.c revision 1.7 1 1.7 thorpej /* $NetBSD: dpti.c,v 1.7 2002/09/30 21:11:45 thorpej Exp $ */
2 1.1 ad
3 1.1 ad /*-
4 1.1 ad * Copyright (c) 2001 The NetBSD Foundation, Inc.
5 1.1 ad * All rights reserved.
6 1.1 ad *
7 1.1 ad * This code is derived from software contributed to The NetBSD Foundation
8 1.1 ad * by Andrew Doran.
9 1.1 ad *
10 1.1 ad * Redistribution and use in source and binary forms, with or without
11 1.1 ad * modification, are permitted provided that the following conditions
12 1.1 ad * are met:
13 1.1 ad * 1. Redistributions of source code must retain the above copyright
14 1.1 ad * notice, this list of conditions and the following disclaimer.
15 1.1 ad * 2. Redistributions in binary form must reproduce the above copyright
16 1.1 ad * notice, this list of conditions and the following disclaimer in the
17 1.1 ad * documentation and/or other materials provided with the distribution.
18 1.1 ad * 3. All advertising materials mentioning features or use of this software
19 1.1 ad * must display the following acknowledgement:
20 1.1 ad * This product includes software developed by the NetBSD
21 1.1 ad * Foundation, Inc. and its contributors.
22 1.1 ad * 4. Neither the name of The NetBSD Foundation nor the names of its
23 1.1 ad * contributors may be used to endorse or promote products derived
24 1.1 ad * from this software without specific prior written permission.
25 1.1 ad *
26 1.1 ad * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
27 1.1 ad * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
28 1.1 ad * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
29 1.1 ad * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
30 1.1 ad * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
31 1.1 ad * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
32 1.1 ad * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
33 1.1 ad * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
34 1.1 ad * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
35 1.1 ad * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
36 1.1 ad * POSSIBILITY OF SUCH DAMAGE.
37 1.1 ad */
38 1.1 ad
39 1.1 ad /*
40 1.1 ad * Copyright (c) 1996-2000 Distributed Processing Technology Corporation
41 1.1 ad * Copyright (c) 2000 Adaptec Corporation
42 1.1 ad * All rights reserved.
43 1.1 ad *
44 1.1 ad * TERMS AND CONDITIONS OF USE
45 1.1 ad *
46 1.1 ad * Redistribution and use in source form, with or without modification, are
47 1.1 ad * permitted provided that redistributions of source code must retain the
48 1.1 ad * above copyright notice, this list of conditions and the following disclaimer.
49 1.1 ad *
50 1.1 ad * This software is provided `as is' by Adaptec and any express or implied
51 1.1 ad * warranties, including, but not limited to, the implied warranties of
52 1.1 ad * merchantability and fitness for a particular purpose, are disclaimed. In no
53 1.1 ad * event shall Adaptec be liable for any direct, indirect, incidental, special,
54 1.1 ad * exemplary or consequential damages (including, but not limited to,
55 1.1 ad * procurement of substitute goods or services; loss of use, data, or profits;
56 1.1 ad * or business interruptions) however caused and on any theory of liability,
57 1.1 ad * whether in contract, strict liability, or tort (including negligence or
58 1.1 ad * otherwise) arising in any way out of the use of this driver software, even
59 1.1 ad * if advised of the possibility of such damage.
60 1.1 ad */
61 1.1 ad
62 1.1 ad /*
63 1.1 ad * Adaptec/DPT I2O control interface.
64 1.1 ad */
65 1.3 lukem
66 1.3 lukem #include <sys/cdefs.h>
67 1.7 thorpej __KERNEL_RCSID(0, "$NetBSD: dpti.c,v 1.7 2002/09/30 21:11:45 thorpej Exp $");
68 1.1 ad
69 1.1 ad #include "opt_i2o.h"
70 1.1 ad
71 1.1 ad #include <sys/param.h>
72 1.1 ad #include <sys/systm.h>
73 1.1 ad #include <sys/kernel.h>
74 1.1 ad #include <sys/device.h>
75 1.1 ad #include <sys/queue.h>
76 1.1 ad #include <sys/proc.h>
77 1.1 ad #include <sys/endian.h>
78 1.1 ad #include <sys/malloc.h>
79 1.1 ad #include <sys/conf.h>
80 1.1 ad #include <sys/ioctl.h>
81 1.1 ad
82 1.2 ad #include <uvm/uvm_extern.h>
83 1.2 ad
84 1.1 ad #include <machine/bus.h>
85 1.2 ad #ifdef i386
86 1.2 ad #include <machine/pio.h>
87 1.2 ad #endif
88 1.1 ad
89 1.1 ad #include <dev/i2o/i2o.h>
90 1.1 ad #include <dev/i2o/i2odpt.h>
91 1.1 ad #include <dev/i2o/iopio.h>
92 1.1 ad #include <dev/i2o/iopvar.h>
93 1.1 ad #include <dev/i2o/dptivar.h>
94 1.1 ad
95 1.1 ad #ifdef I2ODEBUG
96 1.1 ad #define DPRINTF(x) printf x
97 1.1 ad #else
98 1.1 ad #define DPRINTF(x)
99 1.1 ad #endif
100 1.1 ad
101 1.1 ad static struct dpt_sig dpti_sig = {
102 1.2 ad { 'd', 'P', 't', 'S', 'i', 'G'},
103 1.2 ad SIG_VERSION,
104 1.2 ad #if defined(i386)
105 1.2 ad PROC_INTEL,
106 1.2 ad #elif defined(powerpc)
107 1.2 ad PROC_POWERPC,
108 1.2 ad #elif defined(alpha)
109 1.2 ad PROC_ALPHA,
110 1.4 thorpej #elif defined(__mips__)
111 1.2 ad PROC_MIPS,
112 1.2 ad #elif defined(sparc64)
113 1.2 ad PROC_ULTRASPARC,
114 1.2 ad #endif
115 1.2 ad #if defined(i386)
116 1.2 ad PROC_386 | PROC_486 | PROC_PENTIUM | PROC_SEXIUM,
117 1.2 ad #else
118 1.2 ad 0,
119 1.2 ad #endif
120 1.2 ad FT_HBADRVR,
121 1.2 ad 0,
122 1.2 ad OEM_DPT,
123 1.2 ad OS_FREE_BSD, /* XXX */
124 1.2 ad CAP_ABOVE16MB,
125 1.2 ad DEV_ALL,
126 1.1 ad ADF_ALL_SC5,
127 1.2 ad 0,
128 1.2 ad 0,
129 1.2 ad DPTI_VERSION,
130 1.2 ad DPTI_REVISION,
131 1.2 ad DPTI_SUBREVISION,
132 1.2 ad DPTI_MONTH,
133 1.2 ad DPTI_DAY,
134 1.2 ad DPTI_YEAR,
135 1.2 ad "" /* Will be filled later */
136 1.1 ad };
137 1.1 ad
138 1.1 ad void dpti_attach(struct device *, struct device *, void *);
139 1.1 ad int dpti_blinkled(struct dpti_softc *);
140 1.1 ad int dpti_ctlrinfo(struct dpti_softc *, u_long, caddr_t);
141 1.1 ad int dpti_match(struct device *, struct cfdata *, void *);
142 1.1 ad int dpti_passthrough(struct dpti_softc *, caddr_t, struct proc *);
143 1.1 ad int dpti_sysinfo(struct dpti_softc *, u_long, caddr_t);
144 1.1 ad
145 1.5 gehenna dev_type_open(dptiopen);
146 1.5 gehenna dev_type_ioctl(dptiioctl);
147 1.5 gehenna
148 1.5 gehenna const struct cdevsw dpti_cdevsw = {
149 1.5 gehenna dptiopen, nullclose, noread, nowrite, dptiioctl,
150 1.5 gehenna nostop, notty, nopoll, nommap,
151 1.5 gehenna };
152 1.1 ad
153 1.1 ad extern struct cfdriver dpti_cd;
154 1.1 ad
155 1.7 thorpej CFATTACH_DECL(dpti, sizeof(struct dpti_softc),
156 1.7 thorpej dpti_match, dpti_attach, NULL, NULL)
157 1.1 ad
158 1.1 ad int
159 1.1 ad dpti_match(struct device *parent, struct cfdata *match, void *aux)
160 1.1 ad {
161 1.1 ad struct iop_attach_args *ia;
162 1.1 ad struct iop_softc *iop;
163 1.1 ad
164 1.1 ad ia = aux;
165 1.1 ad iop = (struct iop_softc *)parent;
166 1.1 ad
167 1.1 ad if (ia->ia_class != I2O_CLASS_ANY || ia->ia_tid != I2O_TID_IOP)
168 1.1 ad return (0);
169 1.1 ad
170 1.1 ad if (le16toh(iop->sc_status.orgid) != I2O_ORG_DPT)
171 1.1 ad return (0);
172 1.1 ad
173 1.1 ad return (1);
174 1.1 ad }
175 1.1 ad
176 1.1 ad void
177 1.1 ad dpti_attach(struct device *parent, struct device *self, void *aux)
178 1.1 ad {
179 1.1 ad struct iop_softc *iop;
180 1.1 ad struct dpti_softc *sc;
181 1.1 ad struct {
182 1.1 ad struct i2o_param_op_results pr;
183 1.1 ad struct i2o_param_read_results prr;
184 1.1 ad struct i2o_dpt_param_exec_iop_buffers dib;
185 1.1 ad } __attribute__ ((__packed__)) param;
186 1.1 ad int rv;
187 1.1 ad
188 1.1 ad sc = (struct dpti_softc *)self;
189 1.1 ad iop = (struct iop_softc *)parent;
190 1.1 ad
191 1.1 ad /*
192 1.1 ad * Tell the world what we are. The description in the signature
193 1.1 ad * must be no more than 46 bytes long (see dptivar.h).
194 1.1 ad */
195 1.2 ad printf(": DPT/Adaptec RAID management interface\n");
196 1.1 ad sprintf(dpti_sig.dsDescription, "NetBSD %s I2O OSM", osrelease);
197 1.1 ad
198 1.1 ad rv = iop_field_get_all(iop, I2O_TID_IOP,
199 1.1 ad I2O_DPT_PARAM_EXEC_IOP_BUFFERS, ¶m,
200 1.1 ad sizeof(param), NULL);
201 1.1 ad if (rv != 0)
202 1.1 ad return;
203 1.1 ad
204 1.1 ad sc->sc_blinkled = le32toh(param.dib.serialoutputoff) + 8;
205 1.1 ad }
206 1.1 ad
207 1.1 ad int
208 1.1 ad dptiopen(dev_t dev, int flag, int mode, struct proc *p)
209 1.1 ad {
210 1.1 ad
211 1.1 ad if (securelevel > 1)
212 1.1 ad return (EPERM);
213 1.1 ad if (device_lookup(&dpti_cd, minor(dev)) == NULL)
214 1.1 ad return (ENXIO);
215 1.1 ad
216 1.1 ad return (0);
217 1.1 ad }
218 1.1 ad
219 1.1 ad int
220 1.1 ad dptiioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
221 1.1 ad {
222 1.1 ad struct iop_softc *iop;
223 1.1 ad struct dpti_softc *sc;
224 1.1 ad struct ioctl_pt *pt;
225 1.2 ad int i, size, rv;
226 1.1 ad
227 1.1 ad sc = device_lookup(&dpti_cd, minor(dev));
228 1.1 ad iop = (struct iop_softc *)sc->sc_dv.dv_parent;
229 1.1 ad
230 1.1 ad /*
231 1.1 ad * Currently, we only take ioctls passed down from the Linux
232 1.1 ad * emulation layer.
233 1.1 ad */
234 1.1 ad if (cmd == PTIOCLINUX) {
235 1.1 ad pt = (struct ioctl_pt *)data;
236 1.1 ad cmd = pt->com;
237 1.1 ad data = pt->data;
238 1.1 ad } else
239 1.1 ad return (ENOTTY);
240 1.1 ad
241 1.1 ad size = IOCPARM_LEN(cmd);
242 1.1 ad
243 1.1 ad switch (cmd & 0xffff) {
244 1.1 ad case DPT_SIGNATURE:
245 1.1 ad if (size > sizeof(dpti_sig))
246 1.1 ad size = sizeof(dpti_sig);
247 1.1 ad memcpy(data, &dpti_sig, size);
248 1.1 ad return (0);
249 1.1 ad
250 1.1 ad case DPT_CTRLINFO:
251 1.1 ad return (dpti_ctlrinfo(sc, cmd, data));
252 1.1 ad
253 1.1 ad case DPT_SYSINFO:
254 1.1 ad return (dpti_sysinfo(sc, cmd, data));
255 1.1 ad
256 1.1 ad case DPT_BLINKLED:
257 1.1 ad if ((i = dpti_blinkled(sc)) == -1)
258 1.1 ad i = 0;
259 1.1 ad
260 1.1 ad if (size == 0)
261 1.1 ad return (copyout(&i, *(caddr_t *)data, sizeof(i)));
262 1.1 ad
263 1.1 ad *(int *)data = i;
264 1.1 ad return (0);
265 1.1 ad
266 1.1 ad case DPT_TARGET_BUSY:
267 1.1 ad /*
268 1.1 ad * XXX This is here to stop linux_machdepioctl() from
269 1.1 ad * whining about an unknown ioctl. Really, it should be
270 1.1 ad * implemented.
271 1.1 ad */
272 1.1 ad return (EIO);
273 1.1 ad
274 1.1 ad case DPT_I2OUSRCMD:
275 1.2 ad if (sc->sc_nactive++ >= 2)
276 1.2 ad tsleep(&sc->sc_nactive, PRIBIO, "dptislp", 0);
277 1.2 ad
278 1.2 ad rv = dpti_passthrough(sc, data, p);
279 1.2 ad
280 1.2 ad sc->sc_nactive--;
281 1.2 ad wakeup_one(&sc->sc_nactive);
282 1.2 ad return (rv);
283 1.1 ad
284 1.1 ad case DPT_I2ORESETCMD:
285 1.1 ad printf("%s: I2ORESETCMD not implemented\n",
286 1.1 ad sc->sc_dv.dv_xname);
287 1.2 ad return (EOPNOTSUPP);
288 1.1 ad
289 1.1 ad case DPT_I2ORESCANCMD:
290 1.1 ad return (iop_reconfigure(iop, 0));
291 1.1 ad
292 1.1 ad default:
293 1.1 ad return (ENOTTY);
294 1.1 ad }
295 1.1 ad }
296 1.1 ad
297 1.1 ad int
298 1.1 ad dpti_blinkled(struct dpti_softc *sc)
299 1.1 ad {
300 1.1 ad struct iop_softc *iop;
301 1.1 ad u_int v;
302 1.1 ad
303 1.1 ad iop = (struct iop_softc *)sc->sc_dv.dv_parent;
304 1.1 ad
305 1.1 ad v = bus_space_read_1(iop->sc_iot, iop->sc_ioh, sc->sc_blinkled + 0);
306 1.1 ad if (v == 0xbc) {
307 1.1 ad v = bus_space_read_1(iop->sc_iot, iop->sc_ioh,
308 1.1 ad sc->sc_blinkled + 1);
309 1.1 ad return (v);
310 1.1 ad }
311 1.1 ad
312 1.1 ad return (-1);
313 1.1 ad }
314 1.1 ad
315 1.1 ad int
316 1.1 ad dpti_ctlrinfo(struct dpti_softc *sc, u_long cmd, caddr_t data)
317 1.1 ad {
318 1.2 ad struct dpt_ctlrinfo info;
319 1.1 ad struct iop_softc *iop;
320 1.1 ad int rv, i;
321 1.1 ad
322 1.1 ad iop = (struct iop_softc *)sc->sc_dv.dv_parent;
323 1.1 ad
324 1.2 ad memset(&info, 0, sizeof(info));
325 1.1 ad
326 1.2 ad info.length = sizeof(info) - sizeof(u_int16_t);
327 1.2 ad info.drvrHBAnum = sc->sc_dv.dv_unit;
328 1.2 ad info.baseAddr = iop->sc_memaddr;
329 1.1 ad if ((i = dpti_blinkled(sc)) == -1)
330 1.1 ad i = 0;
331 1.2 ad info.blinkState = i;
332 1.2 ad info.pciBusNum = iop->sc_pcibus;
333 1.2 ad info.pciDeviceNum = iop->sc_pcidev;
334 1.2 ad info.hbaFlags = FLG_OSD_PCI_VALID | FLG_OSD_DMA | FLG_OSD_I2O;
335 1.2 ad info.Interrupt = 10; /* XXX */
336 1.1 ad
337 1.1 ad if (IOCPARM_LEN(cmd) > sizeof(*data)) {
338 1.2 ad memcpy(data, &info, min(sizeof(info), IOCPARM_LEN(cmd)));
339 1.1 ad rv = 0;
340 1.1 ad } else
341 1.2 ad rv = copyout(&info, *(caddr_t *)data, sizeof(info));
342 1.1 ad
343 1.1 ad return (rv);
344 1.1 ad }
345 1.1 ad
346 1.1 ad int
347 1.1 ad dpti_sysinfo(struct dpti_softc *sc, u_long cmd, caddr_t data)
348 1.1 ad {
349 1.2 ad struct dpt_sysinfo info;
350 1.2 ad int rv;
351 1.2 ad #ifdef i386
352 1.2 ad int i, j;
353 1.2 ad #endif
354 1.2 ad
355 1.2 ad memset(&info, 0, sizeof(info));
356 1.2 ad
357 1.2 ad #ifdef i386
358 1.2 ad outb (0x70, 0x12);
359 1.2 ad i = inb(0x71);
360 1.2 ad j = i >> 4;
361 1.2 ad if (i == 0x0f) {
362 1.2 ad outb (0x70, 0x19);
363 1.2 ad j = inb (0x71);
364 1.2 ad }
365 1.2 ad info.drive0CMOS = j;
366 1.2 ad
367 1.2 ad j = i & 0x0f;
368 1.2 ad if (i == 0x0f) {
369 1.2 ad outb (0x70, 0x1a);
370 1.2 ad j = inb (0x71);
371 1.2 ad }
372 1.2 ad info.drive1CMOS = j;
373 1.2 ad info.processorFamily = dpti_sig.dsProcessorFamily;
374 1.2 ad
375 1.2 ad /*
376 1.2 ad * Get the conventional memory size from CMOS.
377 1.2 ad */
378 1.2 ad outb(0x70, 0x16);
379 1.2 ad j = inb(0x71);
380 1.2 ad j <<= 8;
381 1.2 ad outb(0x70, 0x15);
382 1.2 ad j |= inb(0x71);
383 1.2 ad info.conventionalMemSize = j;
384 1.2 ad
385 1.2 ad /*
386 1.2 ad * Get the extended memory size from CMOS.
387 1.2 ad */
388 1.2 ad outb(0x70, 0x31);
389 1.2 ad j = inb(0x71);
390 1.2 ad j <<= 8;
391 1.2 ad outb(0x70, 0x30);
392 1.2 ad j |= inb(0x71);
393 1.2 ad info.extendedMemSize = j;
394 1.2 ad
395 1.2 ad switch (cpu_class) {
396 1.2 ad case CPUCLASS_386:
397 1.2 ad info.processorType = PROC_386;
398 1.2 ad break;
399 1.2 ad case CPUCLASS_486:
400 1.2 ad info.processorType = PROC_486;
401 1.2 ad break;
402 1.2 ad case CPUCLASS_586:
403 1.2 ad info.processorType = PROC_PENTIUM;
404 1.2 ad break;
405 1.2 ad case CPUCLASS_686:
406 1.2 ad default:
407 1.2 ad info.processorType = PROC_SEXIUM;
408 1.2 ad break;
409 1.2 ad }
410 1.2 ad
411 1.2 ad info.flags = SI_CMOS_Valid | SI_BusTypeValid |
412 1.2 ad SI_MemorySizeValid | SI_NO_SmartROM;
413 1.2 ad #else
414 1.2 ad info.flags = SI_BusTypeValid | SI_NO_SmartROM;
415 1.2 ad #endif
416 1.2 ad
417 1.2 ad info.busType = SI_PCI_BUS;
418 1.1 ad
419 1.1 ad /*
420 1.2 ad * Copy out the info structure to the user.
421 1.1 ad */
422 1.2 ad if (IOCPARM_LEN(cmd) > sizeof(*data)) {
423 1.2 ad memcpy(data, &info, min(sizeof(info), IOCPARM_LEN(cmd)));
424 1.2 ad rv = 0;
425 1.2 ad } else
426 1.2 ad rv = copyout(&info, *(caddr_t *)data, sizeof(info));
427 1.2 ad
428 1.2 ad return (rv);
429 1.1 ad }
430 1.1 ad
431 1.1 ad int
432 1.1 ad dpti_passthrough(struct dpti_softc *sc, caddr_t data, struct proc *proc)
433 1.1 ad {
434 1.1 ad struct iop_softc *iop;
435 1.1 ad struct i2o_msg mh, *mf;
436 1.1 ad struct i2o_reply rh;
437 1.1 ad struct iop_msg *im;
438 1.1 ad struct dpti_ptbuf bufs[IOP_MAX_MSG_XFERS];
439 1.1 ad u_int32_t mbtmp[IOP_MAX_MSG_SIZE / sizeof(u_int32_t)];
440 1.1 ad u_int32_t rbtmp[IOP_MAX_MSG_SIZE / sizeof(u_int32_t)];
441 1.2 ad int rv, msgsize, repsize, sgoff, i, mapped, nbuf, nfrag, j, sz;
442 1.2 ad u_int32_t *p, *pmax, *pstart;
443 1.1 ad
444 1.1 ad iop = (struct iop_softc *)sc->sc_dv.dv_parent;
445 1.2 ad im = NULL;
446 1.1 ad
447 1.1 ad if ((rv = dpti_blinkled(sc)) != -1) {
448 1.1 ad if (rv != 0) {
449 1.1 ad printf("%s: adapter blinkled = 0x%02x\n",
450 1.1 ad sc->sc_dv.dv_xname, rv);
451 1.1 ad return (EIO);
452 1.1 ad }
453 1.1 ad }
454 1.1 ad
455 1.1 ad /*
456 1.1 ad * Copy in the message frame header and determine the size of the
457 1.1 ad * full message frame.
458 1.1 ad */
459 1.1 ad if ((rv = copyin(data, &mh, sizeof(mh))) != 0) {
460 1.1 ad DPRINTF(("%s: message copyin failed\n",
461 1.1 ad sc->sc_dv.dv_xname));
462 1.1 ad return (rv);
463 1.1 ad }
464 1.1 ad
465 1.1 ad msgsize = (mh.msgflags >> 14) & ~3;
466 1.1 ad if (msgsize < sizeof(mh) || msgsize >= IOP_MAX_MSG_SIZE) {
467 1.1 ad DPRINTF(("%s: bad message frame size\n",
468 1.1 ad sc->sc_dv.dv_xname));
469 1.1 ad return (EINVAL);
470 1.1 ad }
471 1.1 ad
472 1.1 ad /*
473 1.1 ad * Handle special commands.
474 1.1 ad */
475 1.1 ad switch (mh.msgfunc >> 24) {
476 1.1 ad case I2O_EXEC_IOP_RESET:
477 1.2 ad printf("%s: I2O_EXEC_IOP_RESET not implemented\n",
478 1.1 ad sc->sc_dv.dv_xname);
479 1.2 ad return (EOPNOTSUPP);
480 1.1 ad
481 1.1 ad case I2O_EXEC_OUTBOUND_INIT:
482 1.2 ad printf("%s: I2O_EXEC_OUTBOUND_INIT not implemented\n",
483 1.1 ad sc->sc_dv.dv_xname);
484 1.2 ad return (EOPNOTSUPP);
485 1.1 ad
486 1.1 ad case I2O_EXEC_SYS_TAB_SET:
487 1.2 ad printf("%s: I2O_EXEC_SYS_TAB_SET not implemented\n",
488 1.1 ad sc->sc_dv.dv_xname);
489 1.2 ad return (EOPNOTSUPP);
490 1.1 ad
491 1.1 ad case I2O_EXEC_STATUS_GET:
492 1.2 ad if ((rv = iop_status_get(iop, 0)) == 0)
493 1.2 ad rv = copyout(&iop->sc_status, data + msgsize,
494 1.2 ad sizeof(iop->sc_status));
495 1.1 ad return (rv);
496 1.1 ad }
497 1.1 ad
498 1.1 ad /*
499 1.1 ad * Copy in the full message frame.
500 1.1 ad */
501 1.1 ad if ((rv = copyin(data, mbtmp, msgsize)) != 0) {
502 1.1 ad DPRINTF(("%s: full message copyin failed\n",
503 1.1 ad sc->sc_dv.dv_xname));
504 1.1 ad return (rv);
505 1.1 ad }
506 1.1 ad
507 1.1 ad /*
508 1.1 ad * Determine the size of the reply frame, and copy it in.
509 1.1 ad */
510 1.1 ad if ((rv = copyin(data + msgsize, &rh, sizeof(rh))) != 0) {
511 1.1 ad DPRINTF(("%s: reply copyin failed\n",
512 1.1 ad sc->sc_dv.dv_xname));
513 1.1 ad return (rv);
514 1.1 ad }
515 1.1 ad
516 1.1 ad repsize = (rh.msgflags >> 14) & ~3;
517 1.1 ad if (repsize < sizeof(rh) || repsize >= IOP_MAX_MSG_SIZE) {
518 1.1 ad DPRINTF(("%s: bad reply header size\n",
519 1.1 ad sc->sc_dv.dv_xname));
520 1.1 ad return (EINVAL);
521 1.1 ad }
522 1.1 ad
523 1.1 ad if ((rv = copyin(data + msgsize, rbtmp, repsize)) != 0) {
524 1.1 ad DPRINTF(("%s: reply too large\n", sc->sc_dv.dv_xname));
525 1.1 ad return (rv);
526 1.1 ad }
527 1.1 ad
528 1.1 ad /*
529 1.1 ad * If the message has a scatter gather list, it must be comprised of
530 1.1 ad * simple elements. If any one transfer contains multiple segments,
531 1.1 ad * we allocate a temporary buffer for it; otherwise, the buffer will
532 1.2 ad * be mapped directly.
533 1.1 ad */
534 1.1 ad if ((sgoff = ((mh.msgflags >> 4) & 15)) != 0) {
535 1.1 ad if ((sgoff + 2) > (msgsize >> 2)) {
536 1.1 ad DPRINTF(("%s: invalid message size fields\n",
537 1.1 ad sc->sc_dv.dv_xname));
538 1.1 ad return (EINVAL);
539 1.1 ad }
540 1.2 ad
541 1.2 ad memset(bufs, 0, sizeof(bufs));
542 1.1 ad } else
543 1.1 ad nbuf = -1;
544 1.1 ad
545 1.2 ad rv = EINVAL;
546 1.2 ad
547 1.1 ad if (sgoff != 0) {
548 1.1 ad p = mbtmp + sgoff;
549 1.2 ad pmax = mbtmp + (msgsize >> 2) - 2;
550 1.1 ad
551 1.2 ad for (nbuf = 0; nbuf < IOP_MAX_MSG_XFERS; nbuf++, p += 2) {
552 1.2 ad if (p > pmax) {
553 1.1 ad DPRINTF(("%s: invalid SGL (1)\n",
554 1.1 ad sc->sc_dv.dv_xname));
555 1.2 ad goto bad;
556 1.1 ad }
557 1.1 ad
558 1.1 ad if ((p[0] & 0x30000000) != I2O_SGL_SIMPLE) {
559 1.1 ad DPRINTF(("%s: invalid SGL (2)\n",
560 1.1 ad sc->sc_dv.dv_xname));
561 1.2 ad goto bad;
562 1.1 ad }
563 1.1 ad
564 1.1 ad bufs[nbuf].db_out = (p[0] & I2O_SGL_DATA_OUT) != 0;
565 1.2 ad bufs[nbuf].db_ptr = NULL;
566 1.1 ad
567 1.1 ad if ((p[0] & I2O_SGL_END_BUFFER) != 0) {
568 1.1 ad if ((p[0] & 0x00ffffff) > IOP_MAX_XFER) {
569 1.1 ad DPRINTF(("%s: buffer too large\n",
570 1.1 ad sc->sc_dv.dv_xname));
571 1.2 ad goto bad;
572 1.1 ad }
573 1.1 ad
574 1.1 ad bufs[nbuf].db_ptr = (caddr_t)p[1];
575 1.1 ad bufs[nbuf].db_proc = proc;
576 1.1 ad bufs[nbuf].db_size = p[0] & 0x00ffffff;
577 1.1 ad
578 1.1 ad if ((p[0] & I2O_SGL_END) != 0)
579 1.1 ad break;
580 1.1 ad
581 1.1 ad continue;
582 1.1 ad }
583 1.1 ad
584 1.2 ad /*
585 1.2 ad * The buffer has multiple segments. Determine the
586 1.2 ad * total size.
587 1.2 ad */
588 1.2 ad nfrag = 0;
589 1.2 ad sz = 0;
590 1.2 ad for (pstart = p; p <= pmax; p += 2) {
591 1.2 ad if (nfrag == DPTI_MAX_SEGS) {
592 1.2 ad DPRINTF(("%s: too many segments\n",
593 1.2 ad sc->sc_dv.dv_xname));
594 1.2 ad goto bad;
595 1.2 ad }
596 1.2 ad
597 1.2 ad bufs[nbuf].db_frags[nfrag].iov_len =
598 1.2 ad p[0] & 0x00ffffff;
599 1.2 ad bufs[nbuf].db_frags[nfrag].iov_base =
600 1.2 ad (void *)p[1];
601 1.2 ad
602 1.2 ad sz += p[0] & 0x00ffffff;
603 1.2 ad nfrag++;
604 1.2 ad
605 1.2 ad if ((p[0] & I2O_SGL_END) != 0) {
606 1.2 ad if ((p[0] & I2O_SGL_END_BUFFER) == 0) {
607 1.2 ad DPRINTF((
608 1.2 ad "%s: invalid SGL (3)\n",
609 1.2 ad sc->sc_dv.dv_xname));
610 1.2 ad goto bad;
611 1.2 ad }
612 1.2 ad break;
613 1.2 ad }
614 1.2 ad if ((p[0] & I2O_SGL_END_BUFFER) != 0)
615 1.2 ad break;
616 1.2 ad }
617 1.2 ad bufs[nbuf].db_nfrag = nfrag;
618 1.2 ad
619 1.2 ad if (p > pmax) {
620 1.2 ad DPRINTF(("%s: invalid SGL (4)\n",
621 1.2 ad sc->sc_dv.dv_xname));
622 1.2 ad goto bad;
623 1.2 ad }
624 1.2 ad
625 1.2 ad if (sz > IOP_MAX_XFER) {
626 1.2 ad DPRINTF(("%s: buffer too large\n",
627 1.2 ad sc->sc_dv.dv_xname));
628 1.2 ad goto bad;
629 1.2 ad }
630 1.2 ad
631 1.2 ad bufs[nbuf].db_size = sz;
632 1.2 ad bufs[nbuf].db_ptr = malloc(sz, M_DEVBUF, M_WAITOK);
633 1.2 ad if (bufs[nbuf].db_ptr == NULL) {
634 1.2 ad DPRINTF(("%s: allocation failure\n",
635 1.2 ad sc->sc_dv.dv_xname));
636 1.2 ad rv = ENOMEM;
637 1.2 ad goto bad;
638 1.2 ad }
639 1.2 ad
640 1.2 ad for (i = 0, sz = 0; i < bufs[nbuf].db_nfrag; i++) {
641 1.2 ad rv = copyin(bufs[nbuf].db_frags[i].iov_base,
642 1.2 ad bufs[nbuf].db_ptr + sz,
643 1.2 ad bufs[nbuf].db_frags[i].iov_len);
644 1.2 ad if (rv != 0) {
645 1.2 ad DPRINTF(("%s: frag copyin\n",
646 1.2 ad sc->sc_dv.dv_xname));
647 1.2 ad goto bad;
648 1.2 ad }
649 1.2 ad sz += bufs[nbuf].db_frags[i].iov_len;
650 1.2 ad }
651 1.2 ad
652 1.2 ad if ((p[0] & I2O_SGL_END) != 0)
653 1.2 ad break;
654 1.1 ad }
655 1.1 ad
656 1.1 ad if (nbuf == IOP_MAX_MSG_XFERS) {
657 1.1 ad DPRINTF(("%s: too many transfers\n",
658 1.1 ad sc->sc_dv.dv_xname));
659 1.2 ad goto bad;
660 1.1 ad }
661 1.1 ad }
662 1.1 ad
663 1.1 ad /*
664 1.1 ad * Allocate a wrapper, and adjust the message header fields to
665 1.1 ad * indicate that no scatter-gather list is currently present.
666 1.1 ad */
667 1.2 ad mapped = 0;
668 1.2 ad
669 1.1 ad im = iop_msg_alloc(iop, IM_WAIT | IM_NOSTATUS);
670 1.1 ad im->im_rb = (struct i2o_reply *)rbtmp;
671 1.1 ad mf = (struct i2o_msg *)mbtmp;
672 1.1 ad mf->msgictx = IOP_ICTX;
673 1.1 ad mf->msgtctx = im->im_tctx;
674 1.1 ad
675 1.1 ad if (sgoff != 0)
676 1.1 ad mf->msgflags = (mf->msgflags & 0xff0f) | (sgoff << 16);
677 1.1 ad
678 1.1 ad /*
679 1.1 ad * Map the data transfer(s).
680 1.1 ad */
681 1.1 ad for (i = 0; i <= nbuf; i++) {
682 1.1 ad rv = iop_msg_map(iop, im, mbtmp, bufs[i].db_ptr,
683 1.1 ad bufs[i].db_size, bufs[i].db_out, bufs[i].db_proc);
684 1.1 ad if (rv != 0) {
685 1.2 ad DPRINTF(("%s: msg_map failed, rv = %d\n",
686 1.2 ad sc->sc_dv.dv_xname, rv));
687 1.1 ad goto bad;
688 1.1 ad }
689 1.1 ad mapped = 1;
690 1.1 ad }
691 1.1 ad
692 1.1 ad /*
693 1.1 ad * Start the command and sleep until it completes.
694 1.1 ad */
695 1.1 ad if ((rv = iop_msg_post(iop, im, mbtmp, 5*60*1000)) != 0)
696 1.1 ad goto bad;
697 1.1 ad
698 1.1 ad /*
699 1.1 ad * Copy out the reply frame.
700 1.1 ad */
701 1.1 ad if ((rv = copyout(rbtmp, data + msgsize, repsize)) != 0)
702 1.1 ad DPRINTF(("%s: reply copyout() failed\n",
703 1.1 ad sc->sc_dv.dv_xname));
704 1.1 ad
705 1.1 ad bad:
706 1.2 ad /*
707 1.2 ad * Free resources and return to the caller.
708 1.2 ad */
709 1.2 ad if (im != NULL) {
710 1.2 ad if (mapped)
711 1.2 ad iop_msg_unmap(iop, im);
712 1.2 ad iop_msg_free(iop, im);
713 1.2 ad }
714 1.2 ad
715 1.2 ad for (i = 0; i <= nbuf; i++) {
716 1.2 ad if (bufs[i].db_proc != NULL)
717 1.2 ad continue;
718 1.2 ad
719 1.2 ad if (!bufs[i].db_out && rv == 0) {
720 1.2 ad for (j = 0, sz = 0; j < bufs[i].db_nfrag; j++) {
721 1.2 ad rv = copyout(bufs[i].db_ptr + sz,
722 1.2 ad bufs[i].db_frags[j].iov_base,
723 1.2 ad bufs[i].db_frags[j].iov_len);
724 1.2 ad if (rv != 0)
725 1.2 ad break;
726 1.2 ad sz += bufs[i].db_frags[j].iov_len;
727 1.2 ad }
728 1.2 ad }
729 1.1 ad
730 1.2 ad if (bufs[i].db_ptr != NULL)
731 1.2 ad free(bufs[i].db_ptr, M_DEVBUF);
732 1.2 ad }
733 1.1 ad
734 1.1 ad return (rv);
735 1.1 ad }
736