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