1 /*- 2 * Copyright (c) 2006 IronPort Systems 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer. 10 * 2. Redistributions in binary form must reproduce the above copyright 11 * notice, this list of conditions and the following disclaimer in the 12 * documentation and/or other materials provided with the distribution. 13 * 14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 17 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 24 * SUCH DAMAGE. 25 */ 26 27 #include <sys/cdefs.h> 28 __FBSDID("$FreeBSD$"); 29 30 #include "opt_mfi.h" 31 32 #include <sys/param.h> 33 #include <sys/systm.h> 34 #include <sys/malloc.h> 35 #include <sys/kernel.h> 36 #include <sys/poll.h> 37 #include <sys/selinfo.h> 38 #include <sys/bus.h> 39 #include <sys/conf.h> 40 #include <sys/eventhandler.h> 41 #include <sys/rman.h> 42 #include <sys/bus_dma.h> 43 #include <sys/bio.h> 44 #include <sys/ioccom.h> 45 #include <sys/uio.h> 46 #include <sys/proc.h> 47 48 #include <machine/bus.h> 49 #include <machine/resource.h> 50 51 #include <dev/mfi/mfireg.h> 52 #include <dev/mfi/mfi_ioctl.h> 53 #include <dev/mfi/mfivar.h> 54 55 static int mfi_alloc_commands(struct mfi_softc *); 56 static void mfi_release_command(struct mfi_command *cm); 57 static int mfi_comms_init(struct mfi_softc *); 58 static int mfi_polled_command(struct mfi_softc *, struct mfi_command *); 59 static int mfi_wait_command(struct mfi_softc *, struct mfi_command *); 60 static int mfi_get_controller_info(struct mfi_softc *); 61 static int mfi_get_log_state(struct mfi_softc *, 62 struct mfi_evt_log_state **); 63 #ifdef NOTYET 64 static int mfi_get_entry(struct mfi_softc *, int); 65 #endif 66 static int mfi_dcmd_command(struct mfi_softc *, struct mfi_command **, 67 uint32_t, void **, size_t); 68 static void mfi_data_cb(void *, bus_dma_segment_t *, int, int); 69 static void mfi_startup(void *arg); 70 static void mfi_intr(void *arg); 71 static void mfi_enable_intr(struct mfi_softc *sc); 72 static void mfi_ldprobe(struct mfi_softc *sc); 73 static int mfi_aen_register(struct mfi_softc *sc, int seq, int locale); 74 static void mfi_aen_complete(struct mfi_command *); 75 static int mfi_aen_setup(struct mfi_softc *, uint32_t); 76 static int mfi_add_ld(struct mfi_softc *sc, int); 77 static void mfi_add_ld_complete(struct mfi_command *); 78 static struct mfi_command * mfi_bio_command(struct mfi_softc *); 79 static void mfi_bio_complete(struct mfi_command *); 80 static int mfi_mapcmd(struct mfi_softc *, struct mfi_command *); 81 static int mfi_send_frame(struct mfi_softc *, struct mfi_command *); 82 static void mfi_complete(struct mfi_softc *, struct mfi_command *); 83 static int mfi_abort(struct mfi_softc *, struct mfi_command *); 84 static int mfi_linux_ioctl_int(struct cdev *, u_long, caddr_t, int, d_thread_t *); 85 86 /* Management interface */ 87 static d_open_t mfi_open; 88 static d_close_t mfi_close; 89 static d_ioctl_t mfi_ioctl; 90 static d_poll_t mfi_poll; 91 92 static struct cdevsw mfi_cdevsw = { 93 .d_version = D_VERSION, 94 .d_flags = 0, 95 .d_open = mfi_open, 96 .d_close = mfi_close, 97 .d_ioctl = mfi_ioctl, 98 .d_poll = mfi_poll, 99 .d_name = "mfi", 100 }; 101 102 MALLOC_DEFINE(M_MFIBUF, "mfibuf", "Buffers for the MFI driver"); 103 104 #define MFI_INQ_LENGTH SHORT_INQUIRY_LENGTH 105 106 static int 107 mfi_transition_firmware(struct mfi_softc *sc) 108 { 109 int32_t fw_state, cur_state; 110 int max_wait, i; 111 112 fw_state = MFI_READ4(sc, MFI_OMSG0) & MFI_FWSTATE_MASK; 113 while (fw_state != MFI_FWSTATE_READY) { 114 if (bootverbose) 115 device_printf(sc->mfi_dev, "Waiting for firmware to " 116 "become ready\n"); 117 cur_state = fw_state; 118 switch (fw_state) { 119 case MFI_FWSTATE_FAULT: 120 device_printf(sc->mfi_dev, "Firmware fault\n"); 121 return (ENXIO); 122 case MFI_FWSTATE_WAIT_HANDSHAKE: 123 MFI_WRITE4(sc, MFI_IDB, MFI_FWINIT_CLEAR_HANDSHAKE); 124 max_wait = 2; 125 break; 126 case MFI_FWSTATE_OPERATIONAL: 127 MFI_WRITE4(sc, MFI_IDB, MFI_FWINIT_READY); 128 max_wait = 10; 129 break; 130 case MFI_FWSTATE_UNDEFINED: 131 case MFI_FWSTATE_BB_INIT: 132 max_wait = 2; 133 break; 134 case MFI_FWSTATE_FW_INIT: 135 case MFI_FWSTATE_DEVICE_SCAN: 136 case MFI_FWSTATE_FLUSH_CACHE: 137 max_wait = 20; 138 break; 139 default: 140 device_printf(sc->mfi_dev,"Unknown firmware state %d\n", 141 fw_state); 142 return (ENXIO); 143 } 144 for (i = 0; i < (max_wait * 10); i++) { 145 fw_state = MFI_READ4(sc, MFI_OMSG0) & MFI_FWSTATE_MASK; 146 if (fw_state == cur_state) 147 DELAY(100000); 148 else 149 break; 150 } 151 if (fw_state == cur_state) { 152 device_printf(sc->mfi_dev, "firmware stuck in state " 153 "%#x\n", fw_state); 154 return (ENXIO); 155 } 156 } 157 return (0); 158 } 159 160 static void 161 mfi_addr32_cb(void *arg, bus_dma_segment_t *segs, int nsegs, int error) 162 { 163 uint32_t *addr; 164 165 addr = arg; 166 *addr = segs[0].ds_addr; 167 } 168 169 int 170 mfi_attach(struct mfi_softc *sc) 171 { 172 uint32_t status; 173 int error, commsz, framessz, sensesz; 174 int frames, unit; 175 176 mtx_init(&sc->mfi_io_lock, "MFI I/O lock", NULL, MTX_DEF); 177 TAILQ_INIT(&sc->mfi_ld_tqh); 178 TAILQ_INIT(&sc->mfi_aen_pids); 179 180 mfi_initq_free(sc); 181 mfi_initq_ready(sc); 182 mfi_initq_busy(sc); 183 mfi_initq_bio(sc); 184 185 /* Before we get too far, see if the firmware is working */ 186 if ((error = mfi_transition_firmware(sc)) != 0) { 187 device_printf(sc->mfi_dev, "Firmware not in READY state, " 188 "error %d\n", error); 189 return (ENXIO); 190 } 191 192 /* 193 * Get information needed for sizing the contiguous memory for the 194 * frame pool. Size down the sgl parameter since we know that 195 * we will never need more than what's required for MAXPHYS. 196 * It would be nice if these constants were available at runtime 197 * instead of compile time. 198 */ 199 status = MFI_READ4(sc, MFI_OMSG0); 200 sc->mfi_max_fw_cmds = status & MFI_FWSTATE_MAXCMD_MASK; 201 sc->mfi_max_fw_sgl = (status & MFI_FWSTATE_MAXSGL_MASK) >> 16; 202 sc->mfi_total_sgl = min(sc->mfi_max_fw_sgl, ((MAXPHYS / PAGE_SIZE) +1)); 203 204 /* 205 * Create the dma tag for data buffers. Used both for block I/O 206 * and for various internal data queries. 207 */ 208 if (bus_dma_tag_create( sc->mfi_parent_dmat, /* parent */ 209 1, 0, /* algnmnt, boundary */ 210 BUS_SPACE_MAXADDR, /* lowaddr */ 211 BUS_SPACE_MAXADDR, /* highaddr */ 212 NULL, NULL, /* filter, filterarg */ 213 BUS_SPACE_MAXSIZE_32BIT,/* maxsize */ 214 sc->mfi_total_sgl, /* nsegments */ 215 BUS_SPACE_MAXSIZE_32BIT,/* maxsegsize */ 216 BUS_DMA_ALLOCNOW, /* flags */ 217 busdma_lock_mutex, /* lockfunc */ 218 &sc->mfi_io_lock, /* lockfuncarg */ 219 &sc->mfi_buffer_dmat)) { 220 device_printf(sc->mfi_dev, "Cannot allocate buffer DMA tag\n"); 221 return (ENOMEM); 222 } 223 224 /* 225 * Allocate DMA memory for the comms queues. Keep it under 4GB for 226 * efficiency. The mfi_hwcomms struct includes space for 1 reply queue 227 * entry, so the calculated size here will be will be 1 more than 228 * mfi_max_fw_cmds. This is apparently a requirement of the hardware. 229 */ 230 commsz = (sizeof(uint32_t) * sc->mfi_max_fw_cmds) + 231 sizeof(struct mfi_hwcomms); 232 if (bus_dma_tag_create( sc->mfi_parent_dmat, /* parent */ 233 1, 0, /* algnmnt, boundary */ 234 BUS_SPACE_MAXADDR_32BIT,/* lowaddr */ 235 BUS_SPACE_MAXADDR, /* highaddr */ 236 NULL, NULL, /* filter, filterarg */ 237 commsz, /* maxsize */ 238 1, /* msegments */ 239 commsz, /* maxsegsize */ 240 0, /* flags */ 241 NULL, NULL, /* lockfunc, lockarg */ 242 &sc->mfi_comms_dmat)) { 243 device_printf(sc->mfi_dev, "Cannot allocate comms DMA tag\n"); 244 return (ENOMEM); 245 } 246 if (bus_dmamem_alloc(sc->mfi_comms_dmat, (void **)&sc->mfi_comms, 247 BUS_DMA_NOWAIT, &sc->mfi_comms_dmamap)) { 248 device_printf(sc->mfi_dev, "Cannot allocate comms memory\n"); 249 return (ENOMEM); 250 } 251 bzero(sc->mfi_comms, commsz); 252 bus_dmamap_load(sc->mfi_comms_dmat, sc->mfi_comms_dmamap, 253 sc->mfi_comms, commsz, mfi_addr32_cb, &sc->mfi_comms_busaddr, 0); 254 255 /* 256 * Allocate DMA memory for the command frames. Keep them in the 257 * lower 4GB for efficiency. Calculate the size of the frames at 258 * the same time; the frame is 64 bytes plus space for the SG lists. 259 * The assumption here is that the SG list will start at the second 260 * 64 byte segment of the frame and not use the unused bytes in the 261 * frame. While this might seem wasteful, apparently the frames must 262 * be 64 byte aligned, so any savings would be negated by the extra 263 * alignment padding. 264 */ 265 if (sizeof(bus_addr_t) == 8) { 266 sc->mfi_sgsize = sizeof(struct mfi_sg64); 267 sc->mfi_flags |= MFI_FLAGS_SG64; 268 } else { 269 sc->mfi_sgsize = sizeof(struct mfi_sg32); 270 } 271 frames = (sc->mfi_sgsize * sc->mfi_total_sgl + MFI_FRAME_SIZE - 1) / 272 MFI_FRAME_SIZE + 1; 273 sc->mfi_frame_size = frames * MFI_FRAME_SIZE; 274 framessz = sc->mfi_frame_size * sc->mfi_max_fw_cmds; 275 if (bus_dma_tag_create( sc->mfi_parent_dmat, /* parent */ 276 64, 0, /* algnmnt, boundary */ 277 BUS_SPACE_MAXADDR_32BIT,/* lowaddr */ 278 BUS_SPACE_MAXADDR, /* highaddr */ 279 NULL, NULL, /* filter, filterarg */ 280 framessz, /* maxsize */ 281 1, /* nsegments */ 282 framessz, /* maxsegsize */ 283 0, /* flags */ 284 NULL, NULL, /* lockfunc, lockarg */ 285 &sc->mfi_frames_dmat)) { 286 device_printf(sc->mfi_dev, "Cannot allocate frame DMA tag\n"); 287 return (ENOMEM); 288 } 289 if (bus_dmamem_alloc(sc->mfi_frames_dmat, (void **)&sc->mfi_frames, 290 BUS_DMA_NOWAIT, &sc->mfi_frames_dmamap)) { 291 device_printf(sc->mfi_dev, "Cannot allocate frames memory\n"); 292 return (ENOMEM); 293 } 294 bzero(sc->mfi_frames, framessz); 295 bus_dmamap_load(sc->mfi_frames_dmat, sc->mfi_frames_dmamap, 296 sc->mfi_frames, framessz, mfi_addr32_cb, &sc->mfi_frames_busaddr,0); 297 298 /* 299 * Allocate DMA memory for the frame sense data. Keep them in the 300 * lower 4GB for efficiency 301 */ 302 sensesz = sc->mfi_max_fw_cmds * MFI_SENSE_LEN; 303 if (bus_dma_tag_create( sc->mfi_parent_dmat, /* parent */ 304 4, 0, /* algnmnt, boundary */ 305 BUS_SPACE_MAXADDR_32BIT,/* lowaddr */ 306 BUS_SPACE_MAXADDR, /* highaddr */ 307 NULL, NULL, /* filter, filterarg */ 308 sensesz, /* maxsize */ 309 1, /* nsegments */ 310 sensesz, /* maxsegsize */ 311 0, /* flags */ 312 NULL, NULL, /* lockfunc, lockarg */ 313 &sc->mfi_sense_dmat)) { 314 device_printf(sc->mfi_dev, "Cannot allocate sense DMA tag\n"); 315 return (ENOMEM); 316 } 317 if (bus_dmamem_alloc(sc->mfi_sense_dmat, (void **)&sc->mfi_sense, 318 BUS_DMA_NOWAIT, &sc->mfi_sense_dmamap)) { 319 device_printf(sc->mfi_dev, "Cannot allocate sense memory\n"); 320 return (ENOMEM); 321 } 322 bus_dmamap_load(sc->mfi_sense_dmat, sc->mfi_sense_dmamap, 323 sc->mfi_sense, sensesz, mfi_addr32_cb, &sc->mfi_sense_busaddr, 0); 324 325 if ((error = mfi_alloc_commands(sc)) != 0) 326 return (error); 327 328 if ((error = mfi_comms_init(sc)) != 0) 329 return (error); 330 331 if ((error = mfi_get_controller_info(sc)) != 0) 332 return (error); 333 334 if ((error = mfi_aen_setup(sc, 0), 0) != 0) 335 return (error); 336 337 /* 338 * Set up the interrupt handler. XXX This should happen in 339 * mfi_pci.c 340 */ 341 sc->mfi_irq_rid = 0; 342 if ((sc->mfi_irq = bus_alloc_resource_any(sc->mfi_dev, SYS_RES_IRQ, 343 &sc->mfi_irq_rid, RF_SHAREABLE | RF_ACTIVE)) == NULL) { 344 device_printf(sc->mfi_dev, "Cannot allocate interrupt\n"); 345 return (EINVAL); 346 } 347 if (bus_setup_intr(sc->mfi_dev, sc->mfi_irq, INTR_MPSAFE|INTR_TYPE_BIO, 348 mfi_intr, sc, &sc->mfi_intr)) { 349 device_printf(sc->mfi_dev, "Cannot set up interrupt\n"); 350 return (EINVAL); 351 } 352 353 /* Register a config hook to probe the bus for arrays */ 354 sc->mfi_ich.ich_func = mfi_startup; 355 sc->mfi_ich.ich_arg = sc; 356 if (config_intrhook_establish(&sc->mfi_ich) != 0) { 357 device_printf(sc->mfi_dev, "Cannot establish configuration " 358 "hook\n"); 359 return (EINVAL); 360 } 361 362 /* 363 * Register a shutdown handler. 364 */ 365 if ((sc->mfi_eh = EVENTHANDLER_REGISTER(shutdown_final, mfi_shutdown, 366 sc, SHUTDOWN_PRI_DEFAULT)) == NULL) { 367 device_printf(sc->mfi_dev, "Warning: shutdown event " 368 "registration failed\n"); 369 } 370 371 /* 372 * Create the control device for doing management 373 */ 374 unit = device_get_unit(sc->mfi_dev); 375 sc->mfi_cdev = make_dev(&mfi_cdevsw, unit, UID_ROOT, GID_OPERATOR, 376 0640, "mfi%d", unit); 377 if (unit == 0) 378 make_dev_alias(sc->mfi_cdev, "megaraid_sas_ioctl_node"); 379 if (sc->mfi_cdev != NULL) 380 sc->mfi_cdev->si_drv1 = sc; 381 382 return (0); 383 } 384 385 static int 386 mfi_alloc_commands(struct mfi_softc *sc) 387 { 388 struct mfi_command *cm; 389 int i, ncmds; 390 391 /* 392 * XXX Should we allocate all the commands up front, or allocate on 393 * demand later like 'aac' does? 394 */ 395 ncmds = sc->mfi_max_fw_cmds; 396 sc->mfi_commands = malloc(sizeof(struct mfi_command) * ncmds, M_MFIBUF, 397 M_WAITOK | M_ZERO); 398 399 for (i = 0; i < ncmds; i++) { 400 cm = &sc->mfi_commands[i]; 401 cm->cm_frame = (union mfi_frame *)((uintptr_t)sc->mfi_frames + 402 sc->mfi_frame_size * i); 403 cm->cm_frame_busaddr = sc->mfi_frames_busaddr + 404 sc->mfi_frame_size * i; 405 cm->cm_frame->header.context = i; 406 cm->cm_sense = &sc->mfi_sense[i]; 407 cm->cm_sense_busaddr= sc->mfi_sense_busaddr + MFI_SENSE_LEN * i; 408 cm->cm_sc = sc; 409 if (bus_dmamap_create(sc->mfi_buffer_dmat, 0, 410 &cm->cm_dmamap) == 0) 411 mfi_release_command(cm); 412 else 413 break; 414 sc->mfi_total_cmds++; 415 } 416 417 return (0); 418 } 419 420 static void 421 mfi_release_command(struct mfi_command *cm) 422 { 423 uint32_t *hdr_data; 424 425 /* 426 * Zero out the important fields of the frame, but make sure the 427 * context field is preserved 428 */ 429 hdr_data = (uint32_t *)cm->cm_frame; 430 hdr_data[0] = 0; 431 hdr_data[1] = 0; 432 433 cm->cm_extra_frames = 0; 434 cm->cm_flags = 0; 435 cm->cm_complete = NULL; 436 cm->cm_private = NULL; 437 cm->cm_sg = 0; 438 cm->cm_total_frame_size = 0; 439 mfi_enqueue_free(cm); 440 } 441 442 static int 443 mfi_dcmd_command(struct mfi_softc *sc, struct mfi_command **cmp, uint32_t opcode, 444 void **bufp, size_t bufsize) 445 { 446 struct mfi_command *cm; 447 struct mfi_dcmd_frame *dcmd; 448 void *buf = NULL; 449 450 mtx_assert(&sc->mfi_io_lock, MA_OWNED); 451 452 cm = mfi_dequeue_free(sc); 453 if (cm == NULL) 454 return (EBUSY); 455 456 if ((bufsize > 0) && (bufp != NULL)) { 457 if (*bufp == NULL) { 458 buf = malloc(bufsize, M_MFIBUF, M_NOWAIT|M_ZERO); 459 if (buf == NULL) { 460 mfi_release_command(cm); 461 return (ENOMEM); 462 } 463 *bufp = buf; 464 } else { 465 buf = *bufp; 466 } 467 } 468 469 dcmd = &cm->cm_frame->dcmd; 470 bzero(dcmd->mbox, MFI_MBOX_SIZE); 471 dcmd->header.cmd = MFI_CMD_DCMD; 472 dcmd->header.timeout = 0; 473 dcmd->header.flags = 0; 474 dcmd->header.data_len = bufsize; 475 dcmd->opcode = opcode; 476 cm->cm_sg = &dcmd->sgl; 477 cm->cm_total_frame_size = MFI_DCMD_FRAME_SIZE; 478 cm->cm_flags = 0; 479 cm->cm_data = buf; 480 cm->cm_private = buf; 481 cm->cm_len = bufsize; 482 483 *cmp = cm; 484 if ((bufp != NULL) && (*bufp == NULL) && (buf != NULL)) 485 *bufp = buf; 486 return (0); 487 } 488 489 static int 490 mfi_comms_init(struct mfi_softc *sc) 491 { 492 struct mfi_command *cm; 493 struct mfi_init_frame *init; 494 struct mfi_init_qinfo *qinfo; 495 int error; 496 497 if ((cm = mfi_dequeue_free(sc)) == NULL) 498 return (EBUSY); 499 500 /* 501 * Abuse the SG list area of the frame to hold the init_qinfo 502 * object; 503 */ 504 init = &cm->cm_frame->init; 505 qinfo = (struct mfi_init_qinfo *)((uintptr_t)init + MFI_FRAME_SIZE); 506 507 bzero(qinfo, sizeof(struct mfi_init_qinfo)); 508 qinfo->rq_entries = sc->mfi_max_fw_cmds + 1; 509 qinfo->rq_addr_lo = sc->mfi_comms_busaddr + 510 offsetof(struct mfi_hwcomms, hw_reply_q); 511 qinfo->pi_addr_lo = sc->mfi_comms_busaddr + 512 offsetof(struct mfi_hwcomms, hw_pi); 513 qinfo->ci_addr_lo = sc->mfi_comms_busaddr + 514 offsetof(struct mfi_hwcomms, hw_ci); 515 516 init->header.cmd = MFI_CMD_INIT; 517 init->header.data_len = sizeof(struct mfi_init_qinfo); 518 init->qinfo_new_addr_lo = cm->cm_frame_busaddr + MFI_FRAME_SIZE; 519 520 if ((error = mfi_polled_command(sc, cm)) != 0) { 521 device_printf(sc->mfi_dev, "failed to send init command\n"); 522 return (error); 523 } 524 mfi_release_command(cm); 525 526 return (0); 527 } 528 529 static int 530 mfi_get_controller_info(struct mfi_softc *sc) 531 { 532 struct mfi_command *cm = NULL; 533 struct mfi_ctrl_info *ci = NULL; 534 uint32_t max_sectors_1, max_sectors_2; 535 int error; 536 537 mtx_lock(&sc->mfi_io_lock); 538 error = mfi_dcmd_command(sc, &cm, MFI_DCMD_CTRL_GETINFO, 539 (void **)&ci, sizeof(*ci)); 540 if (error) 541 goto out; 542 cm->cm_flags = MFI_CMD_DATAIN | MFI_CMD_POLLED; 543 544 if ((error = mfi_mapcmd(sc, cm)) != 0) { 545 device_printf(sc->mfi_dev, "Controller info buffer map failed\n"); 546 free(ci, M_MFIBUF); 547 mfi_release_command(cm); 548 return (error); 549 } 550 551 /* It's ok if this fails, just use default info instead */ 552 if ((error = mfi_polled_command(sc, cm)) != 0) { 553 device_printf(sc->mfi_dev, "Failed to get controller info\n"); 554 sc->mfi_max_io = (sc->mfi_total_sgl - 1) * PAGE_SIZE / 555 MFI_SECTOR_LEN; 556 error = 0; 557 goto out; 558 } 559 560 bus_dmamap_sync(sc->mfi_buffer_dmat, cm->cm_dmamap, 561 BUS_DMASYNC_POSTREAD); 562 bus_dmamap_unload(sc->mfi_buffer_dmat, cm->cm_dmamap); 563 564 max_sectors_1 = (1 << ci->stripe_sz_ops.min) * ci->max_strips_per_io; 565 max_sectors_2 = ci->max_request_size; 566 sc->mfi_max_io = min(max_sectors_1, max_sectors_2); 567 568 out: 569 if (ci) 570 free(ci, M_MFIBUF); 571 if (cm) 572 mfi_release_command(cm); 573 mtx_unlock(&sc->mfi_io_lock); 574 return (error); 575 } 576 577 static int 578 mfi_get_log_state(struct mfi_softc *sc, struct mfi_evt_log_state **log_state) 579 { 580 struct mfi_command *cm = NULL; 581 int error; 582 583 mtx_lock(&sc->mfi_io_lock); 584 error = mfi_dcmd_command(sc, &cm, MFI_DCMD_CTRL_EVENT_GETINFO, 585 (void **)log_state, sizeof(**log_state)); 586 if (error) 587 goto out; 588 cm->cm_flags = MFI_CMD_DATAIN | MFI_CMD_POLLED; 589 590 if ((error = mfi_mapcmd(sc, cm)) != 0) { 591 device_printf(sc->mfi_dev, "Log state buffer map failed\n"); 592 goto out; 593 } 594 595 if ((error = mfi_polled_command(sc, cm)) != 0) { 596 device_printf(sc->mfi_dev, "Failed to get log state\n"); 597 goto out; 598 } 599 600 bus_dmamap_sync(sc->mfi_buffer_dmat, cm->cm_dmamap, 601 BUS_DMASYNC_POSTREAD); 602 bus_dmamap_unload(sc->mfi_buffer_dmat, cm->cm_dmamap); 603 604 out: 605 if (cm) 606 mfi_release_command(cm); 607 mtx_unlock(&sc->mfi_io_lock); 608 609 return (error); 610 } 611 612 static int 613 mfi_aen_setup(struct mfi_softc *sc, uint32_t seq_start) 614 { 615 struct mfi_evt_log_state *log_state = NULL; 616 union mfi_evt class_locale; 617 int error = 0; 618 uint32_t seq; 619 620 class_locale.members.reserved = 0; 621 class_locale.members.locale = MFI_EVT_LOCALE_ALL; 622 class_locale.members.class = MFI_EVT_CLASS_DEBUG; 623 624 if (seq_start == 0) { 625 error = mfi_get_log_state(sc, &log_state); 626 if (error) { 627 if (log_state) 628 free(log_state, M_MFIBUF); 629 return (error); 630 } 631 /* 632 * Don't run them yet since we can't parse them. 633 * We can indirectly get the contents from 634 * the AEN mechanism via setting it lower then 635 * current. The firmware will iterate through them. 636 */ 637 #ifdef NOTYET 638 for (seq = log_state->shutdown_seq_num; 639 seq <= log_state->newest_seq_num; seq++) { 640 mfi_get_entry(sc, seq); 641 } 642 #endif 643 644 seq = log_state->shutdown_seq_num + 1; 645 } else 646 seq = seq_start; 647 mfi_aen_register(sc, seq, class_locale.word); 648 free(log_state, M_MFIBUF); 649 650 return 0; 651 } 652 653 static int 654 mfi_polled_command(struct mfi_softc *sc, struct mfi_command *cm) 655 { 656 struct mfi_frame_header *hdr; 657 int tm = MFI_POLL_TIMEOUT_SECS * 1000000; 658 659 hdr = &cm->cm_frame->header; 660 hdr->cmd_status = 0xff; 661 hdr->flags |= MFI_FRAME_DONT_POST_IN_REPLY_QUEUE; 662 663 mfi_send_frame(sc, cm); 664 665 while (hdr->cmd_status == 0xff) { 666 DELAY(1000); 667 tm -= 1000; 668 if (tm <= 0) 669 break; 670 } 671 672 if (hdr->cmd_status == 0xff) { 673 device_printf(sc->mfi_dev, "Frame %p timed out\n", hdr); 674 return (ETIMEDOUT); 675 } 676 677 return (0); 678 } 679 680 static int 681 mfi_wait_command(struct mfi_softc *sc, struct mfi_command *cm) 682 { 683 684 mtx_assert(&sc->mfi_io_lock, MA_OWNED); 685 cm->cm_complete = NULL; 686 687 mfi_enqueue_ready(cm); 688 mfi_startio(sc); 689 return (msleep(cm, &sc->mfi_io_lock, PRIBIO, "mfiwait", 0)); 690 } 691 692 void 693 mfi_free(struct mfi_softc *sc) 694 { 695 struct mfi_command *cm; 696 int i; 697 698 if (sc->mfi_cdev != NULL) 699 destroy_dev(sc->mfi_cdev); 700 701 if (sc->mfi_total_cmds != 0) { 702 for (i = 0; i < sc->mfi_total_cmds; i++) { 703 cm = &sc->mfi_commands[i]; 704 bus_dmamap_destroy(sc->mfi_buffer_dmat, cm->cm_dmamap); 705 } 706 free(sc->mfi_commands, M_MFIBUF); 707 } 708 709 if (sc->mfi_intr) 710 bus_teardown_intr(sc->mfi_dev, sc->mfi_irq, sc->mfi_intr); 711 if (sc->mfi_irq != NULL) 712 bus_release_resource(sc->mfi_dev, SYS_RES_IRQ, sc->mfi_irq_rid, 713 sc->mfi_irq); 714 715 if (sc->mfi_sense_busaddr != 0) 716 bus_dmamap_unload(sc->mfi_sense_dmat, sc->mfi_sense_dmamap); 717 if (sc->mfi_sense != NULL) 718 bus_dmamem_free(sc->mfi_sense_dmat, sc->mfi_sense, 719 sc->mfi_sense_dmamap); 720 if (sc->mfi_sense_dmat != NULL) 721 bus_dma_tag_destroy(sc->mfi_sense_dmat); 722 723 if (sc->mfi_frames_busaddr != 0) 724 bus_dmamap_unload(sc->mfi_frames_dmat, sc->mfi_frames_dmamap); 725 if (sc->mfi_frames != NULL) 726 bus_dmamem_free(sc->mfi_frames_dmat, sc->mfi_frames, 727 sc->mfi_frames_dmamap); 728 if (sc->mfi_frames_dmat != NULL) 729 bus_dma_tag_destroy(sc->mfi_frames_dmat); 730 731 if (sc->mfi_comms_busaddr != 0) 732 bus_dmamap_unload(sc->mfi_comms_dmat, sc->mfi_comms_dmamap); 733 if (sc->mfi_comms != NULL) 734 bus_dmamem_free(sc->mfi_comms_dmat, sc->mfi_comms, 735 sc->mfi_comms_dmamap); 736 if (sc->mfi_comms_dmat != NULL) 737 bus_dma_tag_destroy(sc->mfi_comms_dmat); 738 739 if (sc->mfi_buffer_dmat != NULL) 740 bus_dma_tag_destroy(sc->mfi_buffer_dmat); 741 if (sc->mfi_parent_dmat != NULL) 742 bus_dma_tag_destroy(sc->mfi_parent_dmat); 743 744 if (mtx_initialized(&sc->mfi_io_lock)) 745 mtx_destroy(&sc->mfi_io_lock); 746 747 return; 748 } 749 750 static void 751 mfi_startup(void *arg) 752 { 753 struct mfi_softc *sc; 754 755 sc = (struct mfi_softc *)arg; 756 757 config_intrhook_disestablish(&sc->mfi_ich); 758 759 mfi_enable_intr(sc); 760 mfi_ldprobe(sc); 761 } 762 763 static void 764 mfi_intr(void *arg) 765 { 766 struct mfi_softc *sc; 767 struct mfi_command *cm; 768 uint32_t status, pi, ci, context; 769 770 sc = (struct mfi_softc *)arg; 771 772 status = MFI_READ4(sc, MFI_OSTS); 773 if ((status & MFI_OSTS_INTR_VALID) == 0) 774 return; 775 MFI_WRITE4(sc, MFI_OSTS, status); 776 777 pi = sc->mfi_comms->hw_pi; 778 ci = sc->mfi_comms->hw_ci; 779 mtx_lock(&sc->mfi_io_lock); 780 while (ci != pi) { 781 context = sc->mfi_comms->hw_reply_q[ci]; 782 sc->mfi_comms->hw_reply_q[ci] = 0xffffffff; 783 if (context == 0xffffffff) { 784 device_printf(sc->mfi_dev, "mfi_intr: invalid context " 785 "pi= %d ci= %d\n", pi, ci); 786 } else { 787 cm = &sc->mfi_commands[context]; 788 mfi_remove_busy(cm); 789 mfi_complete(sc, cm); 790 } 791 ci++; 792 if (ci == (sc->mfi_max_fw_cmds + 1)) { 793 ci = 0; 794 } 795 } 796 mtx_unlock(&sc->mfi_io_lock); 797 798 sc->mfi_comms->hw_ci = ci; 799 800 return; 801 } 802 803 int 804 mfi_shutdown(struct mfi_softc *sc) 805 { 806 struct mfi_dcmd_frame *dcmd; 807 struct mfi_command *cm; 808 int error; 809 810 mtx_lock(&sc->mfi_io_lock); 811 error = mfi_dcmd_command(sc, &cm, MFI_DCMD_CTRL_SHUTDOWN, NULL, 0); 812 mtx_unlock(&sc->mfi_io_lock); 813 if (error) 814 return (error); 815 816 if (sc->mfi_aen_cm != NULL) 817 mfi_abort(sc, sc->mfi_aen_cm); 818 819 dcmd = &cm->cm_frame->dcmd; 820 dcmd->header.flags = MFI_FRAME_DIR_NONE; 821 822 if ((error = mfi_polled_command(sc, cm)) != 0) { 823 device_printf(sc->mfi_dev, "Failed to shutdown controller\n"); 824 } 825 826 mfi_release_command(cm); 827 return (error); 828 } 829 830 static void 831 mfi_enable_intr(struct mfi_softc *sc) 832 { 833 834 MFI_WRITE4(sc, MFI_OMSK, 0x01); 835 } 836 837 static void 838 mfi_ldprobe(struct mfi_softc *sc) 839 { 840 struct mfi_frame_header *hdr; 841 struct mfi_command *cm = NULL; 842 struct mfi_ld_list *list = NULL; 843 int error, i; 844 845 mtx_lock(&sc->mfi_io_lock); 846 error = mfi_dcmd_command(sc, &cm, MFI_DCMD_LD_GET_LIST, 847 (void **)&list, sizeof(*list)); 848 if (error) 849 goto out; 850 851 cm->cm_flags = MFI_CMD_DATAIN; 852 if (mfi_wait_command(sc, cm) != 0) { 853 device_printf(sc->mfi_dev, "Failed to get device listing\n"); 854 goto out; 855 } 856 857 hdr = &cm->cm_frame->header; 858 if (hdr->cmd_status != MFI_STAT_OK) { 859 device_printf(sc->mfi_dev, "MFI_DCMD_LD_GET_LIST failed %x\n", 860 hdr->cmd_status); 861 goto out; 862 } 863 864 for (i = 0; i < list->ld_count; i++) 865 mfi_add_ld(sc, list->ld_list[i].ld.target_id); 866 out: 867 if (list) 868 free(list, M_MFIBUF); 869 if (cm) 870 mfi_release_command(cm); 871 mtx_unlock(&sc->mfi_io_lock); 872 return; 873 } 874 875 #ifdef NOTYET 876 static void 877 mfi_decode_log(struct mfi_softc *sc, struct mfi_log_detail *detail) 878 { 879 switch (detail->arg_type) { 880 default: 881 device_printf(sc->mfi_dev, "%d - Log entry type %d\n", 882 detail->seq, 883 detail->arg_type 884 ); 885 break; 886 } 887 } 888 #endif 889 890 static void 891 mfi_decode_evt(struct mfi_softc *sc, struct mfi_evt_detail *detail) 892 { 893 switch (detail->arg_type) { 894 case MR_EVT_ARGS_NONE: 895 device_printf(sc->mfi_dev, "%d - %s\n", 896 detail->seq, 897 detail->description 898 ); 899 break; 900 case MR_EVT_ARGS_CDB_SENSE: 901 device_printf(sc->mfi_dev, "%d - PD %02d(e%d/s%d) CDB %*D" 902 "Sense %*D\n: %s\n", 903 detail->seq, 904 detail->args.cdb_sense.pd.device_id, 905 detail->args.cdb_sense.pd.enclosure_index, 906 detail->args.cdb_sense.pd.slot_number, 907 detail->args.cdb_sense.cdb_len, 908 detail->args.cdb_sense.cdb, 909 ":", 910 detail->args.cdb_sense.sense_len, 911 detail->args.cdb_sense.sense, 912 ":", 913 detail->description 914 ); 915 break; 916 case MR_EVT_ARGS_LD: 917 device_printf(sc->mfi_dev, "%d - VD %02d/%d " 918 "event: %s\n", 919 detail->seq, 920 detail->args.ld.ld_index, 921 detail->args.ld.target_id, 922 detail->description 923 ); 924 break; 925 case MR_EVT_ARGS_LD_COUNT: 926 device_printf(sc->mfi_dev, "%d - VD %02d/%d " 927 "count %lld: %s\n", 928 detail->seq, 929 detail->args.ld_count.ld.ld_index, 930 detail->args.ld_count.ld.target_id, 931 (long long)detail->args.ld_count.count, 932 detail->description 933 ); 934 break; 935 case MR_EVT_ARGS_LD_LBA: 936 device_printf(sc->mfi_dev, "%d - VD %02d/%d " 937 "lba %lld: %s\n", 938 detail->seq, 939 detail->args.ld_lba.ld.ld_index, 940 detail->args.ld_lba.ld.target_id, 941 (long long)detail->args.ld_lba.lba, 942 detail->description 943 ); 944 break; 945 case MR_EVT_ARGS_LD_OWNER: 946 device_printf(sc->mfi_dev, "%d - VD %02d/%d " 947 "owner changed: prior %d, new %d: %s\n", 948 detail->seq, 949 detail->args.ld_owner.ld.ld_index, 950 detail->args.ld_owner.ld.target_id, 951 detail->args.ld_owner.pre_owner, 952 detail->args.ld_owner.new_owner, 953 detail->description 954 ); 955 break; 956 case MR_EVT_ARGS_LD_LBA_PD_LBA: 957 device_printf(sc->mfi_dev, "%d - VD %02d/%d " 958 "lba %lld, physical drive PD %02d(e%d/s%d) lba %lld: %s\n", 959 detail->seq, 960 detail->args.ld_lba_pd_lba.ld.ld_index, 961 detail->args.ld_lba_pd_lba.ld.target_id, 962 (long long)detail->args.ld_lba_pd_lba.ld_lba, 963 detail->args.ld_lba_pd_lba.pd.device_id, 964 detail->args.ld_lba_pd_lba.pd.enclosure_index, 965 detail->args.ld_lba_pd_lba.pd.slot_number, 966 (long long)detail->args.ld_lba_pd_lba.pd_lba, 967 detail->description 968 ); 969 break; 970 case MR_EVT_ARGS_LD_PROG: 971 device_printf(sc->mfi_dev, "%d - VD %02d/%d " 972 "progress %d%% in %ds: %s\n", 973 detail->seq, 974 detail->args.ld_prog.ld.ld_index, 975 detail->args.ld_prog.ld.target_id, 976 detail->args.ld_prog.prog.progress/655, 977 detail->args.ld_prog.prog.elapsed_seconds, 978 detail->description 979 ); 980 break; 981 case MR_EVT_ARGS_LD_STATE: 982 device_printf(sc->mfi_dev, "%d - VD %02d/%d " 983 "state prior %d new %d: %s\n", 984 detail->seq, 985 detail->args.ld_state.ld.ld_index, 986 detail->args.ld_state.ld.target_id, 987 detail->args.ld_state.prev_state, 988 detail->args.ld_state.new_state, 989 detail->description 990 ); 991 break; 992 case MR_EVT_ARGS_LD_STRIP: 993 device_printf(sc->mfi_dev, "%d - VD %02d/%d " 994 "strip %lld: %s\n", 995 detail->seq, 996 detail->args.ld_strip.ld.ld_index, 997 detail->args.ld_strip.ld.target_id, 998 (long long)detail->args.ld_strip.strip, 999 detail->description 1000 ); 1001 break; 1002 case MR_EVT_ARGS_PD: 1003 device_printf(sc->mfi_dev, "%d - PD %02d(e%d/s%d) " 1004 "event: %s\n", 1005 detail->seq, 1006 detail->args.pd.device_id, 1007 detail->args.pd.enclosure_index, 1008 detail->args.pd.slot_number, 1009 detail->description 1010 ); 1011 break; 1012 case MR_EVT_ARGS_PD_ERR: 1013 device_printf(sc->mfi_dev, "%d - PD %02d(e%d/s%d) " 1014 "err %d: %s\n", 1015 detail->seq, 1016 detail->args.pd_err.pd.device_id, 1017 detail->args.pd_err.pd.enclosure_index, 1018 detail->args.pd_err.pd.slot_number, 1019 detail->args.pd_err.err, 1020 detail->description 1021 ); 1022 break; 1023 case MR_EVT_ARGS_PD_LBA: 1024 device_printf(sc->mfi_dev, "%d - PD %02d(e%d/s%d) " 1025 "lba %lld: %s\n", 1026 detail->seq, 1027 detail->args.pd_lba.pd.device_id, 1028 detail->args.pd_lba.pd.enclosure_index, 1029 detail->args.pd_lba.pd.slot_number, 1030 (long long)detail->args.pd_lba.lba, 1031 detail->description 1032 ); 1033 break; 1034 case MR_EVT_ARGS_PD_LBA_LD: 1035 device_printf(sc->mfi_dev, "%d - PD %02d(e%d/s%d) " 1036 "lba %lld VD %02d/%d: %s\n", 1037 detail->seq, 1038 detail->args.pd_lba_ld.pd.device_id, 1039 detail->args.pd_lba_ld.pd.enclosure_index, 1040 detail->args.pd_lba_ld.pd.slot_number, 1041 (long long)detail->args.pd_lba.lba, 1042 detail->args.pd_lba_ld.ld.ld_index, 1043 detail->args.pd_lba_ld.ld.target_id, 1044 detail->description 1045 ); 1046 break; 1047 case MR_EVT_ARGS_PD_PROG: 1048 device_printf(sc->mfi_dev, "%d - PD %02d(e%d/s%d) " 1049 "progress %d%% seconds %ds: %s\n", 1050 detail->seq, 1051 detail->args.pd_prog.pd.device_id, 1052 detail->args.pd_prog.pd.enclosure_index, 1053 detail->args.pd_prog.pd.slot_number, 1054 detail->args.pd_prog.prog.progress/655, 1055 detail->args.pd_prog.prog.elapsed_seconds, 1056 detail->description 1057 ); 1058 break; 1059 case MR_EVT_ARGS_PD_STATE: 1060 device_printf(sc->mfi_dev, "%d - PD %02d(e%d/s%d) " 1061 "state prior %d new %d: %s\n", 1062 detail->seq, 1063 detail->args.pd_prog.pd.device_id, 1064 detail->args.pd_prog.pd.enclosure_index, 1065 detail->args.pd_prog.pd.slot_number, 1066 detail->args.pd_state.prev_state, 1067 detail->args.pd_state.new_state, 1068 detail->description 1069 ); 1070 break; 1071 case MR_EVT_ARGS_PCI: 1072 device_printf(sc->mfi_dev, "%d - PCI 0x04%x 0x04%x " 1073 "0x04%x 0x04%x: %s\n", 1074 detail->seq, 1075 detail->args.pci.venderId, 1076 detail->args.pci.deviceId, 1077 detail->args.pci.subVenderId, 1078 detail->args.pci.subDeviceId, 1079 detail->description 1080 ); 1081 break; 1082 case MR_EVT_ARGS_RATE: 1083 device_printf(sc->mfi_dev, "%d - Rebuild rate %d: %s\n", 1084 detail->seq, 1085 detail->args.rate, 1086 detail->description 1087 ); 1088 break; 1089 case MR_EVT_ARGS_TIME: 1090 device_printf(sc->mfi_dev, "%d - Adapter ticks %d " 1091 "elapsed %ds: %s\n", 1092 detail->seq, 1093 detail->args.time.rtc, 1094 detail->args.time.elapsedSeconds, 1095 detail->description 1096 ); 1097 break; 1098 case MR_EVT_ARGS_ECC: 1099 device_printf(sc->mfi_dev, "%d - Adapter ECC %x,%x: %s: %s\n", 1100 detail->seq, 1101 detail->args.ecc.ecar, 1102 detail->args.ecc.elog, 1103 detail->args.ecc.str, 1104 detail->description 1105 ); 1106 break; 1107 default: 1108 device_printf(sc->mfi_dev, "%d - Type %d: %s\n", 1109 detail->seq, 1110 detail->arg_type, detail->description 1111 ); 1112 } 1113 } 1114 1115 static int 1116 mfi_aen_register(struct mfi_softc *sc, int seq, int locale) 1117 { 1118 struct mfi_command *cm; 1119 struct mfi_dcmd_frame *dcmd; 1120 union mfi_evt current_aen, prior_aen; 1121 struct mfi_evt_detail *ed = NULL; 1122 int error; 1123 1124 current_aen.word = locale; 1125 if (sc->mfi_aen_cm != NULL) { 1126 prior_aen.word = 1127 ((uint32_t *)&sc->mfi_aen_cm->cm_frame->dcmd.mbox)[1]; 1128 if (prior_aen.members.class <= current_aen.members.class && 1129 !((prior_aen.members.locale & current_aen.members.locale) 1130 ^current_aen.members.locale)) { 1131 return (0); 1132 } else { 1133 prior_aen.members.locale |= current_aen.members.locale; 1134 if (prior_aen.members.class 1135 < current_aen.members.class) 1136 current_aen.members.class = 1137 prior_aen.members.class; 1138 mfi_abort(sc, sc->mfi_aen_cm); 1139 } 1140 } 1141 1142 mtx_lock(&sc->mfi_io_lock); 1143 error = mfi_dcmd_command(sc, &cm, MFI_DCMD_CTRL_EVENT_WAIT, 1144 (void **)&ed, sizeof(*ed)); 1145 mtx_unlock(&sc->mfi_io_lock); 1146 if (error) 1147 return (error); 1148 1149 dcmd = &cm->cm_frame->dcmd; 1150 ((uint32_t *)&dcmd->mbox)[0] = seq; 1151 ((uint32_t *)&dcmd->mbox)[1] = locale; 1152 cm->cm_flags = MFI_CMD_DATAIN; 1153 cm->cm_complete = mfi_aen_complete; 1154 1155 sc->mfi_aen_cm = cm; 1156 1157 mfi_enqueue_ready(cm); 1158 mfi_startio(sc); 1159 1160 return (0); 1161 } 1162 1163 static void 1164 mfi_aen_complete(struct mfi_command *cm) 1165 { 1166 struct mfi_frame_header *hdr; 1167 struct mfi_softc *sc; 1168 struct mfi_evt_detail *detail; 1169 struct mfi_aen *mfi_aen_entry; 1170 int seq = 0, aborted = 0; 1171 1172 sc = cm->cm_sc; 1173 hdr = &cm->cm_frame->header; 1174 1175 if (sc->mfi_aen_cm == NULL) 1176 return; 1177 1178 if (sc->mfi_aen_cm->cm_aen_abort || hdr->cmd_status == 0xff) { 1179 sc->mfi_aen_cm->cm_aen_abort = 0; 1180 aborted = 1; 1181 } else { 1182 sc->mfi_aen_triggered = 1; 1183 if (sc->mfi_poll_waiting) 1184 selwakeup(&sc->mfi_select); 1185 detail = cm->cm_data; 1186 mtx_unlock(&sc->mfi_io_lock); 1187 mfi_decode_evt(sc, detail); 1188 mtx_lock(&sc->mfi_io_lock); 1189 seq = detail->seq + 1; 1190 TAILQ_FOREACH(mfi_aen_entry, &sc->mfi_aen_pids, aen_link) { 1191 TAILQ_REMOVE(&sc->mfi_aen_pids, mfi_aen_entry, 1192 aen_link); 1193 psignal(mfi_aen_entry->p, SIGIO); 1194 free(mfi_aen_entry, M_MFIBUF); 1195 } 1196 } 1197 1198 free(cm->cm_data, M_MFIBUF); 1199 sc->mfi_aen_cm = NULL; 1200 wakeup(&sc->mfi_aen_cm); 1201 mfi_release_command(cm); 1202 1203 /* set it up again so the driver can catch more events */ 1204 if (!aborted) { 1205 mtx_unlock(&sc->mfi_io_lock); 1206 mfi_aen_setup(sc, seq); 1207 mtx_lock(&sc->mfi_io_lock); 1208 } 1209 } 1210 1211 #ifdef NOTYET 1212 static int 1213 mfi_get_entry(struct mfi_softc *sc, int seq) 1214 { 1215 struct mfi_command *cm; 1216 struct mfi_dcmd_frame *dcmd; 1217 struct mfi_log_detail *ed; 1218 int error; 1219 1220 mtx_lock(&sc->mfi_io_lock); 1221 if ((cm = mfi_dequeue_free(sc)) == NULL) { 1222 mtx_unlock(&sc->mfi_io_lock); 1223 return (EBUSY); 1224 } 1225 mtx_unlock(&sc->mfi_io_lock); 1226 1227 ed = malloc(sizeof(struct mfi_log_detail), M_MFIBUF, M_NOWAIT | M_ZERO); 1228 if (ed == NULL) { 1229 mtx_lock(&sc->mfi_io_lock); 1230 mfi_release_command(cm); 1231 mtx_unlock(&sc->mfi_io_lock); 1232 return (ENOMEM); 1233 } 1234 1235 dcmd = &cm->cm_frame->dcmd; 1236 bzero(dcmd->mbox, MFI_MBOX_SIZE); 1237 dcmd->header.cmd = MFI_CMD_DCMD; 1238 dcmd->header.timeout = 0; 1239 dcmd->header.data_len = sizeof(struct mfi_log_detail); 1240 dcmd->opcode = MFI_DCMD_CTRL_EVENT_GET; 1241 ((uint32_t *)&dcmd->mbox)[0] = seq; 1242 ((uint32_t *)&dcmd->mbox)[1] = MFI_EVT_LOCALE_ALL; 1243 cm->cm_sg = &dcmd->sgl; 1244 cm->cm_total_frame_size = MFI_DCMD_FRAME_SIZE; 1245 cm->cm_flags = MFI_CMD_DATAIN | MFI_CMD_POLLED; 1246 cm->cm_data = ed; 1247 cm->cm_len = sizeof(struct mfi_evt_detail); 1248 1249 if ((error = mfi_mapcmd(sc, cm)) != 0) { 1250 device_printf(sc->mfi_dev, "Controller info buffer map failed"); 1251 free(ed, M_MFIBUF); 1252 mfi_release_command(cm); 1253 return (error); 1254 } 1255 1256 if ((error = mfi_polled_command(sc, cm)) != 0) { 1257 device_printf(sc->mfi_dev, "Failed to get controller entry\n"); 1258 sc->mfi_max_io = (sc->mfi_total_sgl - 1) * PAGE_SIZE / 1259 MFI_SECTOR_LEN; 1260 free(ed, M_MFIBUF); 1261 mfi_release_command(cm); 1262 return (0); 1263 } 1264 1265 bus_dmamap_sync(sc->mfi_buffer_dmat, cm->cm_dmamap, 1266 BUS_DMASYNC_POSTREAD); 1267 bus_dmamap_unload(sc->mfi_buffer_dmat, cm->cm_dmamap); 1268 1269 mfi_decode_log(sc, ed); 1270 1271 mtx_lock(&sc->mfi_io_lock); 1272 free(cm->cm_data, M_MFIBUF); 1273 mfi_release_command(cm); 1274 mtx_unlock(&sc->mfi_io_lock); 1275 return (0); 1276 } 1277 #endif 1278 1279 static int 1280 mfi_add_ld(struct mfi_softc *sc, int id) 1281 { 1282 struct mfi_command *cm; 1283 struct mfi_dcmd_frame *dcmd = NULL; 1284 struct mfi_ld_info *ld_info = NULL; 1285 int error; 1286 1287 mtx_assert(&sc->mfi_io_lock, MA_OWNED); 1288 1289 error = mfi_dcmd_command(sc, &cm, MFI_DCMD_LD_GET_INFO, 1290 (void **)&ld_info, sizeof(*ld_info)); 1291 if (error) { 1292 device_printf(sc->mfi_dev, 1293 "Failed to allocate for MFI_DCMD_LD_GET_INFO %d\n", error); 1294 if (ld_info) 1295 free(ld_info, M_MFIBUF); 1296 return (error); 1297 } 1298 cm->cm_flags = MFI_CMD_DATAIN; 1299 dcmd = &cm->cm_frame->dcmd; 1300 dcmd->mbox[0] = id; 1301 if (mfi_wait_command(sc, cm) != 0) { 1302 device_printf(sc->mfi_dev, 1303 "Failed to get logical drive: %d\n", id); 1304 free(ld_info, M_MFIBUF); 1305 return (0); 1306 } 1307 1308 mfi_add_ld_complete(cm); 1309 return (0); 1310 } 1311 1312 static void 1313 mfi_add_ld_complete(struct mfi_command *cm) 1314 { 1315 struct mfi_frame_header *hdr; 1316 struct mfi_ld_info *ld_info; 1317 struct mfi_softc *sc; 1318 struct mfi_ld *ld; 1319 device_t child; 1320 1321 sc = cm->cm_sc; 1322 hdr = &cm->cm_frame->header; 1323 ld_info = cm->cm_private; 1324 1325 if (hdr->cmd_status != MFI_STAT_OK) { 1326 free(ld_info, M_MFIBUF); 1327 mfi_release_command(cm); 1328 return; 1329 } 1330 mfi_release_command(cm); 1331 1332 ld = malloc(sizeof(struct mfi_ld), M_MFIBUF, M_NOWAIT|M_ZERO); 1333 if (ld == NULL) { 1334 device_printf(sc->mfi_dev, "Cannot allocate ld\n"); 1335 free(ld_info, M_MFIBUF); 1336 return; 1337 } 1338 1339 if ((child = device_add_child(sc->mfi_dev, "mfid", -1)) == NULL) { 1340 device_printf(sc->mfi_dev, "Failed to add logical disk\n"); 1341 free(ld, M_MFIBUF); 1342 free(ld_info, M_MFIBUF); 1343 return; 1344 } 1345 1346 ld->ld_id = ld_info->ld_config.properties.ld.target_id; 1347 ld->ld_disk = child; 1348 ld->ld_info = ld_info; 1349 1350 device_set_ivars(child, ld); 1351 device_set_desc(child, "MFI Logical Disk"); 1352 mtx_unlock(&sc->mfi_io_lock); 1353 mtx_lock(&Giant); 1354 bus_generic_attach(sc->mfi_dev); 1355 mtx_unlock(&Giant); 1356 mtx_lock(&sc->mfi_io_lock); 1357 } 1358 1359 static struct mfi_command * 1360 mfi_bio_command(struct mfi_softc *sc) 1361 { 1362 struct mfi_io_frame *io; 1363 struct mfi_command *cm; 1364 struct bio *bio; 1365 int flags, blkcount; 1366 1367 if ((cm = mfi_dequeue_free(sc)) == NULL) 1368 return (NULL); 1369 1370 if ((bio = mfi_dequeue_bio(sc)) == NULL) { 1371 mfi_release_command(cm); 1372 return (NULL); 1373 } 1374 1375 io = &cm->cm_frame->io; 1376 switch (bio->bio_cmd & 0x03) { 1377 case BIO_READ: 1378 io->header.cmd = MFI_CMD_LD_READ; 1379 flags = MFI_CMD_DATAIN; 1380 break; 1381 case BIO_WRITE: 1382 io->header.cmd = MFI_CMD_LD_WRITE; 1383 flags = MFI_CMD_DATAOUT; 1384 break; 1385 default: 1386 panic("Invalid bio command"); 1387 } 1388 1389 /* Cheat with the sector length to avoid a non-constant division */ 1390 blkcount = (bio->bio_bcount + MFI_SECTOR_LEN - 1) / MFI_SECTOR_LEN; 1391 io->header.target_id = (uintptr_t)bio->bio_driver1; 1392 io->header.timeout = 0; 1393 io->header.flags = 0; 1394 io->header.sense_len = MFI_SENSE_LEN; 1395 io->header.data_len = blkcount; 1396 io->sense_addr_lo = cm->cm_sense_busaddr; 1397 io->sense_addr_hi = 0; 1398 io->lba_hi = (bio->bio_pblkno & 0xffffffff00000000) >> 32; 1399 io->lba_lo = bio->bio_pblkno & 0xffffffff; 1400 cm->cm_complete = mfi_bio_complete; 1401 cm->cm_private = bio; 1402 cm->cm_data = bio->bio_data; 1403 cm->cm_len = bio->bio_bcount; 1404 cm->cm_sg = &io->sgl; 1405 cm->cm_total_frame_size = MFI_IO_FRAME_SIZE; 1406 cm->cm_flags = flags; 1407 1408 return (cm); 1409 } 1410 1411 static void 1412 mfi_bio_complete(struct mfi_command *cm) 1413 { 1414 struct bio *bio; 1415 struct mfi_frame_header *hdr; 1416 struct mfi_softc *sc; 1417 1418 bio = cm->cm_private; 1419 hdr = &cm->cm_frame->header; 1420 sc = cm->cm_sc; 1421 1422 if ((hdr->cmd_status != 0) || (hdr->scsi_status != 0)) { 1423 bio->bio_flags |= BIO_ERROR; 1424 bio->bio_error = EIO; 1425 device_printf(sc->mfi_dev, "I/O error, status= %d " 1426 "scsi_status= %d\n", hdr->cmd_status, hdr->scsi_status); 1427 mfi_print_sense(cm->cm_sc, cm->cm_sense); 1428 } 1429 1430 mfi_release_command(cm); 1431 mfi_disk_complete(bio); 1432 } 1433 1434 void 1435 mfi_startio(struct mfi_softc *sc) 1436 { 1437 struct mfi_command *cm; 1438 1439 for (;;) { 1440 /* Don't bother if we're short on resources */ 1441 if (sc->mfi_flags & MFI_FLAGS_QFRZN) 1442 break; 1443 1444 /* Try a command that has already been prepared */ 1445 cm = mfi_dequeue_ready(sc); 1446 1447 /* Nope, so look for work on the bioq */ 1448 if (cm == NULL) 1449 cm = mfi_bio_command(sc); 1450 1451 /* No work available, so exit */ 1452 if (cm == NULL) 1453 break; 1454 1455 /* Send the command to the controller */ 1456 if (mfi_mapcmd(sc, cm) != 0) { 1457 mfi_requeue_ready(cm); 1458 break; 1459 } 1460 } 1461 } 1462 1463 static int 1464 mfi_mapcmd(struct mfi_softc *sc, struct mfi_command *cm) 1465 { 1466 int error, polled; 1467 1468 if (cm->cm_data != NULL) { 1469 polled = (cm->cm_flags & MFI_CMD_POLLED) ? BUS_DMA_NOWAIT : 0; 1470 error = bus_dmamap_load(sc->mfi_buffer_dmat, cm->cm_dmamap, 1471 cm->cm_data, cm->cm_len, mfi_data_cb, cm, polled); 1472 if (error == EINPROGRESS) { 1473 sc->mfi_flags |= MFI_FLAGS_QFRZN; 1474 return (0); 1475 } 1476 } else { 1477 mfi_enqueue_busy(cm); 1478 error = mfi_send_frame(sc, cm); 1479 } 1480 1481 return (error); 1482 } 1483 1484 static void 1485 mfi_data_cb(void *arg, bus_dma_segment_t *segs, int nsegs, int error) 1486 { 1487 struct mfi_frame_header *hdr; 1488 struct mfi_command *cm; 1489 union mfi_sgl *sgl; 1490 struct mfi_softc *sc; 1491 int i, dir; 1492 1493 if (error) 1494 return; 1495 1496 cm = (struct mfi_command *)arg; 1497 sc = cm->cm_sc; 1498 hdr = &cm->cm_frame->header; 1499 sgl = cm->cm_sg; 1500 1501 if ((sc->mfi_flags & MFI_FLAGS_SG64) == 0) { 1502 for (i = 0; i < nsegs; i++) { 1503 sgl->sg32[i].addr = segs[i].ds_addr; 1504 sgl->sg32[i].len = segs[i].ds_len; 1505 } 1506 } else { 1507 for (i = 0; i < nsegs; i++) { 1508 sgl->sg64[i].addr = segs[i].ds_addr; 1509 sgl->sg64[i].len = segs[i].ds_len; 1510 } 1511 hdr->flags |= MFI_FRAME_SGL64; 1512 } 1513 hdr->sg_count = nsegs; 1514 1515 dir = 0; 1516 if (cm->cm_flags & MFI_CMD_DATAIN) { 1517 dir |= BUS_DMASYNC_PREREAD; 1518 hdr->flags |= MFI_FRAME_DIR_READ; 1519 } 1520 if (cm->cm_flags & MFI_CMD_DATAOUT) { 1521 dir |= BUS_DMASYNC_PREWRITE; 1522 hdr->flags |= MFI_FRAME_DIR_WRITE; 1523 } 1524 bus_dmamap_sync(sc->mfi_buffer_dmat, cm->cm_dmamap, dir); 1525 cm->cm_flags |= MFI_CMD_MAPPED; 1526 1527 /* 1528 * Instead of calculating the total number of frames in the 1529 * compound frame, it's already assumed that there will be at 1530 * least 1 frame, so don't compensate for the modulo of the 1531 * following division. 1532 */ 1533 cm->cm_total_frame_size += (sc->mfi_sgsize * nsegs); 1534 cm->cm_extra_frames = (cm->cm_total_frame_size - 1) / MFI_FRAME_SIZE; 1535 1536 /* The caller will take care of delivering polled commands */ 1537 if ((cm->cm_flags & MFI_CMD_POLLED) == 0) { 1538 mfi_enqueue_busy(cm); 1539 mfi_send_frame(sc, cm); 1540 } 1541 1542 return; 1543 } 1544 1545 static int 1546 mfi_send_frame(struct mfi_softc *sc, struct mfi_command *cm) 1547 { 1548 1549 /* 1550 * The bus address of the command is aligned on a 64 byte boundary, 1551 * leaving the least 6 bits as zero. For whatever reason, the 1552 * hardware wants the address shifted right by three, leaving just 1553 * 3 zero bits. These three bits are then used to indicate how many 1554 * 64 byte frames beyond the first one are used in the command. The 1555 * extra frames are typically filled with S/G elements. The extra 1556 * frames must also be contiguous. Thus, a compound frame can be at 1557 * most 512 bytes long, allowing for up to 59 32-bit S/G elements or 1558 * 39 64-bit S/G elements for block I/O commands. This means that 1559 * I/O transfers of 256k and higher simply are not possible, which 1560 * is quite odd for such a modern adapter. 1561 */ 1562 MFI_WRITE4(sc, MFI_IQP, (cm->cm_frame_busaddr >> 3) | 1563 cm->cm_extra_frames); 1564 return (0); 1565 } 1566 1567 static void 1568 mfi_complete(struct mfi_softc *sc, struct mfi_command *cm) 1569 { 1570 int dir; 1571 1572 if ((cm->cm_flags & MFI_CMD_MAPPED) != 0) { 1573 dir = 0; 1574 if (cm->cm_flags & MFI_CMD_DATAIN) 1575 dir |= BUS_DMASYNC_POSTREAD; 1576 if (cm->cm_flags & MFI_CMD_DATAOUT) 1577 dir |= BUS_DMASYNC_POSTWRITE; 1578 1579 bus_dmamap_sync(sc->mfi_buffer_dmat, cm->cm_dmamap, dir); 1580 bus_dmamap_unload(sc->mfi_buffer_dmat, cm->cm_dmamap); 1581 cm->cm_flags &= ~MFI_CMD_MAPPED; 1582 } 1583 1584 if (cm->cm_complete != NULL) 1585 cm->cm_complete(cm); 1586 else 1587 wakeup(cm); 1588 1589 sc->mfi_flags &= ~MFI_FLAGS_QFRZN; 1590 mfi_startio(sc); 1591 } 1592 1593 static int 1594 mfi_abort(struct mfi_softc *sc, struct mfi_command *cm_abort) 1595 { 1596 struct mfi_command *cm; 1597 struct mfi_abort_frame *abort; 1598 1599 mtx_lock(&sc->mfi_io_lock); 1600 if ((cm = mfi_dequeue_free(sc)) == NULL) { 1601 mtx_unlock(&sc->mfi_io_lock); 1602 return (EBUSY); 1603 } 1604 mtx_unlock(&sc->mfi_io_lock); 1605 1606 abort = &cm->cm_frame->abort; 1607 abort->header.cmd = MFI_CMD_ABORT; 1608 abort->header.flags = 0; 1609 abort->abort_context = cm_abort->cm_frame->header.context; 1610 abort->abort_mfi_addr_lo = cm_abort->cm_frame_busaddr; 1611 abort->abort_mfi_addr_hi = 0; 1612 cm->cm_data = NULL; 1613 1614 sc->mfi_aen_cm->cm_aen_abort = 1; 1615 mfi_mapcmd(sc, cm); 1616 mfi_polled_command(sc, cm); 1617 mtx_lock(&sc->mfi_io_lock); 1618 mfi_release_command(cm); 1619 mtx_unlock(&sc->mfi_io_lock); 1620 1621 while (sc->mfi_aen_cm != NULL) { 1622 tsleep(&sc->mfi_aen_cm, 0, "mfiabort", 5 * hz); 1623 } 1624 1625 return (0); 1626 } 1627 1628 int 1629 mfi_dump_blocks(struct mfi_softc *sc, int id, uint64_t lba, void *virt, int len) 1630 { 1631 struct mfi_command *cm; 1632 struct mfi_io_frame *io; 1633 int error; 1634 1635 if ((cm = mfi_dequeue_free(sc)) == NULL) 1636 return (EBUSY); 1637 1638 io = &cm->cm_frame->io; 1639 io->header.cmd = MFI_CMD_LD_WRITE; 1640 io->header.target_id = id; 1641 io->header.timeout = 0; 1642 io->header.flags = 0; 1643 io->header.sense_len = MFI_SENSE_LEN; 1644 io->header.data_len = (len + MFI_SECTOR_LEN - 1) / MFI_SECTOR_LEN; 1645 io->sense_addr_lo = cm->cm_sense_busaddr; 1646 io->sense_addr_hi = 0; 1647 io->lba_hi = (lba & 0xffffffff00000000) >> 32; 1648 io->lba_lo = lba & 0xffffffff; 1649 cm->cm_data = virt; 1650 cm->cm_len = len; 1651 cm->cm_sg = &io->sgl; 1652 cm->cm_total_frame_size = MFI_IO_FRAME_SIZE; 1653 cm->cm_flags = MFI_CMD_POLLED | MFI_CMD_DATAOUT; 1654 1655 if ((error = mfi_mapcmd(sc, cm)) != 0) { 1656 mfi_release_command(cm); 1657 return (error); 1658 } 1659 1660 error = mfi_polled_command(sc, cm); 1661 bus_dmamap_sync(sc->mfi_buffer_dmat, cm->cm_dmamap, 1662 BUS_DMASYNC_POSTWRITE); 1663 bus_dmamap_unload(sc->mfi_buffer_dmat, cm->cm_dmamap); 1664 mfi_release_command(cm); 1665 1666 return (error); 1667 } 1668 1669 static int 1670 mfi_open(struct cdev *dev, int flags, int fmt, d_thread_t *td) 1671 { 1672 struct mfi_softc *sc; 1673 1674 sc = dev->si_drv1; 1675 sc->mfi_flags |= MFI_FLAGS_OPEN; 1676 1677 return (0); 1678 } 1679 1680 static int 1681 mfi_close(struct cdev *dev, int flags, int fmt, d_thread_t *td) 1682 { 1683 struct mfi_softc *sc; 1684 struct mfi_aen *mfi_aen_entry; 1685 1686 sc = dev->si_drv1; 1687 sc->mfi_flags &= ~MFI_FLAGS_OPEN; 1688 1689 TAILQ_FOREACH(mfi_aen_entry, &sc->mfi_aen_pids, aen_link) { 1690 if (mfi_aen_entry->p == curproc) { 1691 TAILQ_REMOVE(&sc->mfi_aen_pids, mfi_aen_entry, 1692 aen_link); 1693 free(mfi_aen_entry, M_MFIBUF); 1694 } 1695 } 1696 return (0); 1697 } 1698 1699 static int 1700 mfi_ioctl(struct cdev *dev, u_long cmd, caddr_t arg, int flag, d_thread_t *td) 1701 { 1702 struct mfi_softc *sc; 1703 union mfi_statrequest *ms; 1704 int error; 1705 1706 sc = dev->si_drv1; 1707 error = 0; 1708 1709 switch (cmd) { 1710 case MFIIO_STATS: 1711 ms = (union mfi_statrequest *)arg; 1712 switch (ms->ms_item) { 1713 case MFIQ_FREE: 1714 case MFIQ_BIO: 1715 case MFIQ_READY: 1716 case MFIQ_BUSY: 1717 bcopy(&sc->mfi_qstat[ms->ms_item], &ms->ms_qstat, 1718 sizeof(struct mfi_qstat)); 1719 break; 1720 default: 1721 error = ENOIOCTL; 1722 break; 1723 } 1724 break; 1725 case 0xc1144d01: /* Firmware Linux ioctl shim */ 1726 { 1727 devclass_t devclass; 1728 struct mfi_linux_ioc_packet l_ioc; 1729 int adapter; 1730 1731 devclass = devclass_find("mfi"); 1732 if (devclass == NULL) 1733 return (ENOENT); 1734 1735 error = copyin(arg, &l_ioc, sizeof(l_ioc)); 1736 if (error) 1737 return (error); 1738 adapter = l_ioc.lioc_adapter_no; 1739 sc = devclass_get_softc(devclass, adapter); 1740 if (sc == NULL) 1741 return (ENOENT); 1742 return (mfi_linux_ioctl_int(sc->mfi_cdev, 1743 cmd, arg, flag, td)); 1744 break; 1745 } 1746 case 0x400c4d03: /* AEN Linux ioctl shim */ 1747 { 1748 devclass_t devclass; 1749 struct mfi_linux_ioc_aen l_aen; 1750 int adapter; 1751 1752 devclass = devclass_find("mfi"); 1753 if (devclass == NULL) 1754 return (ENOENT); 1755 1756 error = copyin(arg, &l_aen, sizeof(l_aen)); 1757 if (error) 1758 return (error); 1759 adapter = l_aen.laen_adapter_no; 1760 sc = devclass_get_softc(devclass, adapter); 1761 if (sc == NULL) 1762 return (ENOENT); 1763 return (mfi_linux_ioctl_int(sc->mfi_cdev, 1764 cmd, arg, flag, td)); 1765 break; 1766 } 1767 default: 1768 error = ENOENT; 1769 break; 1770 } 1771 1772 return (error); 1773 } 1774 1775 static int 1776 mfi_linux_ioctl_int(struct cdev *dev, u_long cmd, caddr_t arg, int flag, d_thread_t *td) 1777 { 1778 struct mfi_softc *sc; 1779 struct mfi_linux_ioc_packet l_ioc; 1780 struct mfi_linux_ioc_aen l_aen; 1781 struct mfi_command *cm = NULL; 1782 struct mfi_aen *mfi_aen_entry; 1783 uint32_t *sense_ptr; 1784 uint32_t context; 1785 uint8_t *data = NULL, *temp; 1786 int i; 1787 int error; 1788 1789 sc = dev->si_drv1; 1790 error = 0; 1791 switch (cmd) { 1792 case 0xc1144d01: /* Firmware Linux ioctl shim */ 1793 error = copyin(arg, &l_ioc, sizeof(l_ioc)); 1794 if (error != 0) 1795 return (error); 1796 1797 if (l_ioc.lioc_sge_count > MAX_LINUX_IOCTL_SGE) { 1798 return (EINVAL); 1799 } 1800 1801 mtx_lock(&sc->mfi_io_lock); 1802 if ((cm = mfi_dequeue_free(sc)) == NULL) { 1803 mtx_unlock(&sc->mfi_io_lock); 1804 return (EBUSY); 1805 } 1806 mtx_unlock(&sc->mfi_io_lock); 1807 1808 /* 1809 * save off original context since copying from user 1810 * will clobber some data 1811 */ 1812 context = cm->cm_frame->header.context; 1813 1814 bcopy(l_ioc.lioc_frame.raw, cm->cm_frame, 1815 l_ioc.lioc_sgl_off); /* Linux can do 2 frames ? */ 1816 cm->cm_total_frame_size = l_ioc.lioc_sgl_off; 1817 cm->cm_sg = 1818 (union mfi_sgl *)&cm->cm_frame->bytes[l_ioc.lioc_sgl_off]; 1819 cm->cm_flags = MFI_CMD_DATAIN | MFI_CMD_DATAOUT 1820 | MFI_CMD_POLLED; 1821 cm->cm_len = cm->cm_frame->header.data_len; 1822 cm->cm_data = data = malloc(cm->cm_len, M_MFIBUF, 1823 M_WAITOK | M_ZERO); 1824 1825 /* restore header context */ 1826 cm->cm_frame->header.context = context; 1827 1828 temp = data; 1829 for (i = 0; i < l_ioc.lioc_sge_count; i++) { 1830 error = copyin(l_ioc.lioc_sgl[i].iov_base, 1831 temp, 1832 l_ioc.lioc_sgl[i].iov_len); 1833 if (error != 0) { 1834 device_printf(sc->mfi_dev, 1835 "Copy in failed"); 1836 goto out; 1837 } 1838 temp = &temp[l_ioc.lioc_sgl[i].iov_len]; 1839 } 1840 1841 if (l_ioc.lioc_sense_len) { 1842 sense_ptr = 1843 (void *)&cm->cm_frame->bytes[l_ioc.lioc_sense_off]; 1844 *sense_ptr = cm->cm_sense_busaddr; 1845 } 1846 1847 if ((error = mfi_mapcmd(sc, cm)) != 0) { 1848 device_printf(sc->mfi_dev, 1849 "Controller info buffer map failed"); 1850 goto out; 1851 } 1852 1853 if ((error = mfi_polled_command(sc, cm)) != 0) { 1854 device_printf(sc->mfi_dev, 1855 "Controller polled failed"); 1856 goto out; 1857 } 1858 1859 bus_dmamap_sync(sc->mfi_buffer_dmat, cm->cm_dmamap, 1860 BUS_DMASYNC_POSTREAD); 1861 bus_dmamap_unload(sc->mfi_buffer_dmat, cm->cm_dmamap); 1862 1863 temp = data; 1864 for (i = 0; i < l_ioc.lioc_sge_count; i++) { 1865 error = copyout(temp, 1866 l_ioc.lioc_sgl[i].iov_base, 1867 l_ioc.lioc_sgl[i].iov_len); 1868 if (error != 0) { 1869 device_printf(sc->mfi_dev, 1870 "Copy out failed"); 1871 goto out; 1872 } 1873 temp = &temp[l_ioc.lioc_sgl[i].iov_len]; 1874 } 1875 1876 if (l_ioc.lioc_sense_len) { 1877 /* copy out sense */ 1878 sense_ptr = (void *) 1879 &l_ioc.lioc_frame.raw[l_ioc.lioc_sense_off]; 1880 temp = 0; 1881 temp += cm->cm_sense_busaddr; 1882 error = copyout(temp, sense_ptr, 1883 l_ioc.lioc_sense_len); 1884 if (error != 0) { 1885 device_printf(sc->mfi_dev, 1886 "Copy out failed"); 1887 goto out; 1888 } 1889 } 1890 1891 error = copyout(&cm->cm_frame->header.cmd_status, 1892 &((struct mfi_linux_ioc_packet*)arg) 1893 ->lioc_frame.hdr.cmd_status, 1894 1); 1895 if (error != 0) { 1896 device_printf(sc->mfi_dev, 1897 "Copy out failed"); 1898 goto out; 1899 } 1900 1901 out: 1902 if (data) 1903 free(data, M_MFIBUF); 1904 if (cm) { 1905 mtx_lock(&sc->mfi_io_lock); 1906 mfi_release_command(cm); 1907 mtx_unlock(&sc->mfi_io_lock); 1908 } 1909 1910 return (error); 1911 case 0x400c4d03: /* AEN Linux ioctl shim */ 1912 error = copyin(arg, &l_aen, sizeof(l_aen)); 1913 if (error != 0) 1914 return (error); 1915 printf("AEN IMPLEMENTED for pid %d\n", curproc->p_pid); 1916 mfi_aen_entry = malloc(sizeof(struct mfi_aen), M_MFIBUF, 1917 M_WAITOK); 1918 if (mfi_aen_entry != NULL) { 1919 mfi_aen_entry->p = curproc; 1920 TAILQ_INSERT_TAIL(&sc->mfi_aen_pids, mfi_aen_entry, 1921 aen_link); 1922 } 1923 error = mfi_aen_register(sc, l_aen.laen_seq_num, 1924 l_aen.laen_class_locale); 1925 1926 if (error != 0) { 1927 TAILQ_REMOVE(&sc->mfi_aen_pids, mfi_aen_entry, 1928 aen_link); 1929 free(mfi_aen_entry, M_MFIBUF); 1930 } 1931 1932 return (error); 1933 default: 1934 device_printf(sc->mfi_dev, "IOCTL 0x%lx not handled\n", cmd); 1935 error = ENOENT; 1936 break; 1937 } 1938 1939 return (error); 1940 } 1941 1942 static int 1943 mfi_poll(struct cdev *dev, int poll_events, struct thread *td) 1944 { 1945 struct mfi_softc *sc; 1946 int revents = 0; 1947 1948 sc = dev->si_drv1; 1949 1950 if (poll_events & (POLLIN | POLLRDNORM)) { 1951 if (sc->mfi_aen_triggered != 0) 1952 revents |= poll_events & (POLLIN | POLLRDNORM); 1953 if (sc->mfi_aen_triggered == 0 && sc->mfi_aen_cm == NULL) { 1954 revents |= POLLERR; 1955 } 1956 } 1957 1958 if (revents == 0) { 1959 if (poll_events & (POLLIN | POLLRDNORM)) { 1960 sc->mfi_poll_waiting = 1; 1961 selrecord(td, &sc->mfi_select); 1962 sc->mfi_poll_waiting = 0; 1963 } 1964 } 1965 1966 return revents; 1967 } 1968