mly.c revision 143158
1/*- 2 * Copyright (c) 2000, 2001 Michael Smith 3 * Copyright (c) 2000 BSDi 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 16 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE 19 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 20 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 21 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 22 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 23 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 * 27 * $FreeBSD: head/sys/dev/mly/mly.c 143158 2005-03-05 18:10:49Z imp $ 28 */ 29 30#include <sys/param.h> 31#include <sys/systm.h> 32#include <sys/malloc.h> 33#include <sys/kernel.h> 34#include <sys/bus.h> 35#include <sys/conf.h> 36#include <sys/ctype.h> 37#include <sys/ioccom.h> 38#include <sys/stat.h> 39 40#include <machine/bus_memio.h> 41#include <machine/bus.h> 42#include <machine/resource.h> 43#include <sys/rman.h> 44 45#include <cam/cam.h> 46#include <cam/cam_ccb.h> 47#include <cam/cam_periph.h> 48#include <cam/cam_sim.h> 49#include <cam/cam_xpt_sim.h> 50#include <cam/scsi/scsi_all.h> 51#include <cam/scsi/scsi_message.h> 52 53#include <dev/pci/pcireg.h> 54#include <dev/pci/pcivar.h> 55 56#include <dev/mly/mlyreg.h> 57#include <dev/mly/mlyio.h> 58#include <dev/mly/mlyvar.h> 59#include <dev/mly/mly_tables.h> 60 61static int mly_probe(device_t dev); 62static int mly_attach(device_t dev); 63static int mly_pci_attach(struct mly_softc *sc); 64static int mly_detach(device_t dev); 65static int mly_shutdown(device_t dev); 66static void mly_intr(void *arg); 67 68static int mly_sg_map(struct mly_softc *sc); 69static void mly_sg_map_helper(void *arg, bus_dma_segment_t *segs, int nseg, int error); 70static int mly_mmbox_map(struct mly_softc *sc); 71static void mly_mmbox_map_helper(void *arg, bus_dma_segment_t *segs, int nseg, int error); 72static void mly_free(struct mly_softc *sc); 73 74static int mly_get_controllerinfo(struct mly_softc *sc); 75static void mly_scan_devices(struct mly_softc *sc); 76static void mly_rescan_btl(struct mly_softc *sc, int bus, int target); 77static void mly_complete_rescan(struct mly_command *mc); 78static int mly_get_eventstatus(struct mly_softc *sc); 79static int mly_enable_mmbox(struct mly_softc *sc); 80static int mly_flush(struct mly_softc *sc); 81static int mly_ioctl(struct mly_softc *sc, struct mly_command_ioctl *ioctl, void **data, 82 size_t datasize, u_int8_t *status, void *sense_buffer, size_t *sense_length); 83static void mly_check_event(struct mly_softc *sc); 84static void mly_fetch_event(struct mly_softc *sc); 85static void mly_complete_event(struct mly_command *mc); 86static void mly_process_event(struct mly_softc *sc, struct mly_event *me); 87static void mly_periodic(void *data); 88 89static int mly_immediate_command(struct mly_command *mc); 90static int mly_start(struct mly_command *mc); 91static void mly_done(struct mly_softc *sc); 92static void mly_complete(void *context, int pending); 93 94static int mly_alloc_command(struct mly_softc *sc, struct mly_command **mcp); 95static void mly_release_command(struct mly_command *mc); 96static void mly_alloc_commands_map(void *arg, bus_dma_segment_t *segs, int nseg, int error); 97static int mly_alloc_commands(struct mly_softc *sc); 98static void mly_release_commands(struct mly_softc *sc); 99static void mly_map_command(struct mly_command *mc); 100static void mly_unmap_command(struct mly_command *mc); 101 102static int mly_cam_attach(struct mly_softc *sc); 103static void mly_cam_detach(struct mly_softc *sc); 104static void mly_cam_rescan_btl(struct mly_softc *sc, int bus, int target); 105static void mly_cam_rescan_callback(struct cam_periph *periph, union ccb *ccb); 106static void mly_cam_action(struct cam_sim *sim, union ccb *ccb); 107static int mly_cam_action_io(struct cam_sim *sim, struct ccb_scsiio *csio); 108static void mly_cam_poll(struct cam_sim *sim); 109static void mly_cam_complete(struct mly_command *mc); 110static struct cam_periph *mly_find_periph(struct mly_softc *sc, int bus, int target); 111static int mly_name_device(struct mly_softc *sc, int bus, int target); 112 113static int mly_fwhandshake(struct mly_softc *sc); 114 115static void mly_describe_controller(struct mly_softc *sc); 116#ifdef MLY_DEBUG 117static void mly_printstate(struct mly_softc *sc); 118static void mly_print_command(struct mly_command *mc); 119static void mly_print_packet(struct mly_command *mc); 120static void mly_panic(struct mly_softc *sc, char *reason); 121#endif 122void mly_print_controller(int controller); 123static int mly_timeout(struct mly_softc *sc); 124 125 126static d_open_t mly_user_open; 127static d_close_t mly_user_close; 128static d_ioctl_t mly_user_ioctl; 129static int mly_user_command(struct mly_softc *sc, struct mly_user_command *uc); 130static int mly_user_health(struct mly_softc *sc, struct mly_user_health *uh); 131 132#define MLY_CMD_TIMEOUT 20 133 134static device_method_t mly_methods[] = { 135 /* Device interface */ 136 DEVMETHOD(device_probe, mly_probe), 137 DEVMETHOD(device_attach, mly_attach), 138 DEVMETHOD(device_detach, mly_detach), 139 DEVMETHOD(device_shutdown, mly_shutdown), 140 { 0, 0 } 141}; 142 143static driver_t mly_pci_driver = { 144 "mly", 145 mly_methods, 146 sizeof(struct mly_softc) 147}; 148 149static devclass_t mly_devclass; 150DRIVER_MODULE(mly, pci, mly_pci_driver, mly_devclass, 0, 0); 151 152static struct cdevsw mly_cdevsw = { 153 .d_version = D_VERSION, 154 .d_flags = D_NEEDGIANT, 155 .d_open = mly_user_open, 156 .d_close = mly_user_close, 157 .d_ioctl = mly_user_ioctl, 158 .d_name = "mly", 159}; 160 161/******************************************************************************** 162 ******************************************************************************** 163 Device Interface 164 ******************************************************************************** 165 ********************************************************************************/ 166 167static struct mly_ident 168{ 169 u_int16_t vendor; 170 u_int16_t device; 171 u_int16_t subvendor; 172 u_int16_t subdevice; 173 int hwif; 174 char *desc; 175} mly_identifiers[] = { 176 {0x1069, 0xba56, 0x1069, 0x0040, MLY_HWIF_STRONGARM, "Mylex eXtremeRAID 2000"}, 177 {0x1069, 0xba56, 0x1069, 0x0030, MLY_HWIF_STRONGARM, "Mylex eXtremeRAID 3000"}, 178 {0x1069, 0x0050, 0x1069, 0x0050, MLY_HWIF_I960RX, "Mylex AcceleRAID 352"}, 179 {0x1069, 0x0050, 0x1069, 0x0052, MLY_HWIF_I960RX, "Mylex AcceleRAID 170"}, 180 {0x1069, 0x0050, 0x1069, 0x0054, MLY_HWIF_I960RX, "Mylex AcceleRAID 160"}, 181 {0, 0, 0, 0, 0, 0} 182}; 183 184/******************************************************************************** 185 * Compare the provided PCI device with the list we support. 186 */ 187static int 188mly_probe(device_t dev) 189{ 190 struct mly_ident *m; 191 192 debug_called(1); 193 194 for (m = mly_identifiers; m->vendor != 0; m++) { 195 if ((m->vendor == pci_get_vendor(dev)) && 196 (m->device == pci_get_device(dev)) && 197 ((m->subvendor == 0) || ((m->subvendor == pci_get_subvendor(dev)) && 198 (m->subdevice == pci_get_subdevice(dev))))) { 199 200 device_set_desc(dev, m->desc); 201 return(BUS_PROBE_DEFAULT); /* allow room to be overridden */ 202 } 203 } 204 return(ENXIO); 205} 206 207/******************************************************************************** 208 * Initialise the controller and softc 209 */ 210static int 211mly_attach(device_t dev) 212{ 213 struct mly_softc *sc = device_get_softc(dev); 214 int error; 215 216 debug_called(1); 217 218 sc->mly_dev = dev; 219 220#ifdef MLY_DEBUG 221 if (device_get_unit(sc->mly_dev) == 0) 222 mly_softc0 = sc; 223#endif 224 225 /* 226 * Do PCI-specific initialisation. 227 */ 228 if ((error = mly_pci_attach(sc)) != 0) 229 goto out; 230 231 /* 232 * Initialise per-controller queues. 233 */ 234 mly_initq_free(sc); 235 mly_initq_busy(sc); 236 mly_initq_complete(sc); 237 238#if __FreeBSD_version >= 500005 239 /* 240 * Initialise command-completion task. 241 */ 242 TASK_INIT(&sc->mly_task_complete, 0, mly_complete, sc); 243#endif 244 245 /* disable interrupts before we start talking to the controller */ 246 MLY_MASK_INTERRUPTS(sc); 247 248 /* 249 * Wait for the controller to come ready, handshake with the firmware if required. 250 * This is typically only necessary on platforms where the controller BIOS does not 251 * run. 252 */ 253 if ((error = mly_fwhandshake(sc))) 254 goto out; 255 256 /* 257 * Allocate initial command buffers. 258 */ 259 if ((error = mly_alloc_commands(sc))) 260 goto out; 261 262 /* 263 * Obtain controller feature information 264 */ 265 if ((error = mly_get_controllerinfo(sc))) 266 goto out; 267 268 /* 269 * Reallocate command buffers now we know how many we want. 270 */ 271 mly_release_commands(sc); 272 if ((error = mly_alloc_commands(sc))) 273 goto out; 274 275 /* 276 * Get the current event counter for health purposes, populate the initial 277 * health status buffer. 278 */ 279 if ((error = mly_get_eventstatus(sc))) 280 goto out; 281 282 /* 283 * Enable memory-mailbox mode. 284 */ 285 if ((error = mly_enable_mmbox(sc))) 286 goto out; 287 288 /* 289 * Attach to CAM. 290 */ 291 if ((error = mly_cam_attach(sc))) 292 goto out; 293 294 /* 295 * Print a little information about the controller 296 */ 297 mly_describe_controller(sc); 298 299 /* 300 * Mark all attached devices for rescan. 301 */ 302 mly_scan_devices(sc); 303 304 /* 305 * Instigate the first status poll immediately. Rescan completions won't 306 * happen until interrupts are enabled, which should still be before 307 * the SCSI subsystem gets to us, courtesy of the "SCSI settling delay". 308 */ 309 mly_periodic((void *)sc); 310 311 /* 312 * Create the control device. 313 */ 314 sc->mly_dev_t = make_dev(&mly_cdevsw, device_get_unit(sc->mly_dev), UID_ROOT, GID_OPERATOR, 315 S_IRUSR | S_IWUSR, "mly%d", device_get_unit(sc->mly_dev)); 316 sc->mly_dev_t->si_drv1 = sc; 317 318 /* enable interrupts now */ 319 MLY_UNMASK_INTERRUPTS(sc); 320 321#ifdef MLY_DEBUG 322 timeout((timeout_t *)mly_timeout, sc, MLY_CMD_TIMEOUT * hz); 323#endif 324 325 out: 326 if (error != 0) 327 mly_free(sc); 328 return(error); 329} 330 331/******************************************************************************** 332 * Perform PCI-specific initialisation. 333 */ 334static int 335mly_pci_attach(struct mly_softc *sc) 336{ 337 int i, error; 338 u_int32_t command; 339 340 debug_called(1); 341 342 /* assume failure is 'not configured' */ 343 error = ENXIO; 344 345 /* 346 * Verify that the adapter is correctly set up in PCI space. 347 * 348 * XXX we shouldn't do this; the PCI code should. 349 */ 350 command = pci_read_config(sc->mly_dev, PCIR_COMMAND, 2); 351 command |= PCIM_CMD_BUSMASTEREN; 352 pci_write_config(sc->mly_dev, PCIR_COMMAND, command, 2); 353 command = pci_read_config(sc->mly_dev, PCIR_COMMAND, 2); 354 if (!(command & PCIM_CMD_BUSMASTEREN)) { 355 mly_printf(sc, "can't enable busmaster feature\n"); 356 goto fail; 357 } 358 if ((command & PCIM_CMD_MEMEN) == 0) { 359 mly_printf(sc, "memory window not available\n"); 360 goto fail; 361 } 362 363 /* 364 * Allocate the PCI register window. 365 */ 366 sc->mly_regs_rid = PCIR_BAR(0); /* first base address register */ 367 if ((sc->mly_regs_resource = bus_alloc_resource_any(sc->mly_dev, 368 SYS_RES_MEMORY, &sc->mly_regs_rid, RF_ACTIVE)) == NULL) { 369 mly_printf(sc, "can't allocate register window\n"); 370 goto fail; 371 } 372 sc->mly_btag = rman_get_bustag(sc->mly_regs_resource); 373 sc->mly_bhandle = rman_get_bushandle(sc->mly_regs_resource); 374 375 /* 376 * Allocate and connect our interrupt. 377 */ 378 sc->mly_irq_rid = 0; 379 if ((sc->mly_irq = bus_alloc_resource_any(sc->mly_dev, SYS_RES_IRQ, 380 &sc->mly_irq_rid, RF_SHAREABLE | RF_ACTIVE)) == NULL) { 381 mly_printf(sc, "can't allocate interrupt\n"); 382 goto fail; 383 } 384 if (bus_setup_intr(sc->mly_dev, sc->mly_irq, INTR_TYPE_CAM | INTR_ENTROPY, mly_intr, sc, &sc->mly_intr)) { 385 mly_printf(sc, "can't set up interrupt\n"); 386 goto fail; 387 } 388 389 /* assume failure is 'out of memory' */ 390 error = ENOMEM; 391 392 /* 393 * Allocate the parent bus DMA tag appropriate for our PCI interface. 394 * 395 * Note that all of these controllers are 64-bit capable. 396 */ 397 if (bus_dma_tag_create(NULL, /* parent */ 398 1, 0, /* alignment, boundary */ 399 BUS_SPACE_MAXADDR_32BIT, /* lowaddr */ 400 BUS_SPACE_MAXADDR, /* highaddr */ 401 NULL, NULL, /* filter, filterarg */ 402 MAXBSIZE, MLY_MAX_SGENTRIES, /* maxsize, nsegments */ 403 BUS_SPACE_MAXSIZE_32BIT, /* maxsegsize */ 404 BUS_DMA_ALLOCNOW, /* flags */ 405 NULL, /* lockfunc */ 406 NULL, /* lockarg */ 407 &sc->mly_parent_dmat)) { 408 mly_printf(sc, "can't allocate parent DMA tag\n"); 409 goto fail; 410 } 411 412 /* 413 * Create DMA tag for mapping buffers into controller-addressable space. 414 */ 415 if (bus_dma_tag_create(sc->mly_parent_dmat, /* parent */ 416 1, 0, /* alignment, boundary */ 417 BUS_SPACE_MAXADDR, /* lowaddr */ 418 BUS_SPACE_MAXADDR, /* highaddr */ 419 NULL, NULL, /* filter, filterarg */ 420 MAXBSIZE, MLY_MAX_SGENTRIES, /* maxsize, nsegments */ 421 BUS_SPACE_MAXSIZE_32BIT, /* maxsegsize */ 422 0, /* flags */ 423 busdma_lock_mutex, /* lockfunc */ 424 &Giant, /* lockarg */ 425 &sc->mly_buffer_dmat)) { 426 mly_printf(sc, "can't allocate buffer DMA tag\n"); 427 goto fail; 428 } 429 430 /* 431 * Initialise the DMA tag for command packets. 432 */ 433 if (bus_dma_tag_create(sc->mly_parent_dmat, /* parent */ 434 1, 0, /* alignment, boundary */ 435 BUS_SPACE_MAXADDR, /* lowaddr */ 436 BUS_SPACE_MAXADDR, /* highaddr */ 437 NULL, NULL, /* filter, filterarg */ 438 sizeof(union mly_command_packet) * MLY_MAX_COMMANDS, 1, /* maxsize, nsegments */ 439 BUS_SPACE_MAXSIZE_32BIT, /* maxsegsize */ 440 BUS_DMA_ALLOCNOW, /* flags */ 441 NULL, NULL, /* lockfunc, lockarg */ 442 &sc->mly_packet_dmat)) { 443 mly_printf(sc, "can't allocate command packet DMA tag\n"); 444 goto fail; 445 } 446 447 /* 448 * Detect the hardware interface version 449 */ 450 for (i = 0; mly_identifiers[i].vendor != 0; i++) { 451 if ((mly_identifiers[i].vendor == pci_get_vendor(sc->mly_dev)) && 452 (mly_identifiers[i].device == pci_get_device(sc->mly_dev))) { 453 sc->mly_hwif = mly_identifiers[i].hwif; 454 switch(sc->mly_hwif) { 455 case MLY_HWIF_I960RX: 456 debug(1, "set hardware up for i960RX"); 457 sc->mly_doorbell_true = 0x00; 458 sc->mly_command_mailbox = MLY_I960RX_COMMAND_MAILBOX; 459 sc->mly_status_mailbox = MLY_I960RX_STATUS_MAILBOX; 460 sc->mly_idbr = MLY_I960RX_IDBR; 461 sc->mly_odbr = MLY_I960RX_ODBR; 462 sc->mly_error_status = MLY_I960RX_ERROR_STATUS; 463 sc->mly_interrupt_status = MLY_I960RX_INTERRUPT_STATUS; 464 sc->mly_interrupt_mask = MLY_I960RX_INTERRUPT_MASK; 465 break; 466 case MLY_HWIF_STRONGARM: 467 debug(1, "set hardware up for StrongARM"); 468 sc->mly_doorbell_true = 0xff; /* doorbell 'true' is 0 */ 469 sc->mly_command_mailbox = MLY_STRONGARM_COMMAND_MAILBOX; 470 sc->mly_status_mailbox = MLY_STRONGARM_STATUS_MAILBOX; 471 sc->mly_idbr = MLY_STRONGARM_IDBR; 472 sc->mly_odbr = MLY_STRONGARM_ODBR; 473 sc->mly_error_status = MLY_STRONGARM_ERROR_STATUS; 474 sc->mly_interrupt_status = MLY_STRONGARM_INTERRUPT_STATUS; 475 sc->mly_interrupt_mask = MLY_STRONGARM_INTERRUPT_MASK; 476 break; 477 } 478 break; 479 } 480 } 481 482 /* 483 * Create the scatter/gather mappings. 484 */ 485 if ((error = mly_sg_map(sc))) 486 goto fail; 487 488 /* 489 * Allocate and map the memory mailbox 490 */ 491 if ((error = mly_mmbox_map(sc))) 492 goto fail; 493 494 error = 0; 495 496fail: 497 return(error); 498} 499 500/******************************************************************************** 501 * Shut the controller down and detach all our resources. 502 */ 503static int 504mly_detach(device_t dev) 505{ 506 int error; 507 508 if ((error = mly_shutdown(dev)) != 0) 509 return(error); 510 511 mly_free(device_get_softc(dev)); 512 return(0); 513} 514 515/******************************************************************************** 516 * Bring the controller to a state where it can be safely left alone. 517 * 518 * Note that it should not be necessary to wait for any outstanding commands, 519 * as they should be completed prior to calling here. 520 * 521 * XXX this applies for I/O, but not status polls; we should beware of 522 * the case where a status command is running while we detach. 523 */ 524static int 525mly_shutdown(device_t dev) 526{ 527 struct mly_softc *sc = device_get_softc(dev); 528 529 debug_called(1); 530 531 if (sc->mly_state & MLY_STATE_OPEN) 532 return(EBUSY); 533 534 /* kill the periodic event */ 535 untimeout(mly_periodic, sc, sc->mly_periodic); 536 537 /* flush controller */ 538 mly_printf(sc, "flushing cache..."); 539 printf("%s\n", mly_flush(sc) ? "failed" : "done"); 540 541 MLY_MASK_INTERRUPTS(sc); 542 543 return(0); 544} 545 546/******************************************************************************* 547 * Take an interrupt, or be poked by other code to look for interrupt-worthy 548 * status. 549 */ 550static void 551mly_intr(void *arg) 552{ 553 struct mly_softc *sc = (struct mly_softc *)arg; 554 555 debug_called(2); 556 557 mly_done(sc); 558}; 559 560/******************************************************************************** 561 ******************************************************************************** 562 Bus-dependant Resource Management 563 ******************************************************************************** 564 ********************************************************************************/ 565 566/******************************************************************************** 567 * Allocate memory for the scatter/gather tables 568 */ 569static int 570mly_sg_map(struct mly_softc *sc) 571{ 572 size_t segsize; 573 574 debug_called(1); 575 576 /* 577 * Create a single tag describing a region large enough to hold all of 578 * the s/g lists we will need. 579 */ 580 segsize = sizeof(struct mly_sg_entry) * MLY_MAX_COMMANDS *MLY_MAX_SGENTRIES; 581 if (bus_dma_tag_create(sc->mly_parent_dmat, /* parent */ 582 1, 0, /* alignment,boundary */ 583 BUS_SPACE_MAXADDR, /* lowaddr */ 584 BUS_SPACE_MAXADDR, /* highaddr */ 585 NULL, NULL, /* filter, filterarg */ 586 segsize, 1, /* maxsize, nsegments */ 587 BUS_SPACE_MAXSIZE_32BIT, /* maxsegsize */ 588 BUS_DMA_ALLOCNOW, /* flags */ 589 NULL, NULL, /* lockfunc, lockarg */ 590 &sc->mly_sg_dmat)) { 591 mly_printf(sc, "can't allocate scatter/gather DMA tag\n"); 592 return(ENOMEM); 593 } 594 595 /* 596 * Allocate enough s/g maps for all commands and permanently map them into 597 * controller-visible space. 598 * 599 * XXX this assumes we can get enough space for all the s/g maps in one 600 * contiguous slab. 601 */ 602 if (bus_dmamem_alloc(sc->mly_sg_dmat, (void **)&sc->mly_sg_table, 603 BUS_DMA_NOWAIT, &sc->mly_sg_dmamap)) { 604 mly_printf(sc, "can't allocate s/g table\n"); 605 return(ENOMEM); 606 } 607 if (bus_dmamap_load(sc->mly_sg_dmat, sc->mly_sg_dmamap, sc->mly_sg_table, 608 segsize, mly_sg_map_helper, sc, BUS_DMA_NOWAIT) != 0) 609 return (ENOMEM); 610 return(0); 611} 612 613/******************************************************************************** 614 * Save the physical address of the base of the s/g table. 615 */ 616static void 617mly_sg_map_helper(void *arg, bus_dma_segment_t *segs, int nseg, int error) 618{ 619 struct mly_softc *sc = (struct mly_softc *)arg; 620 621 debug_called(1); 622 623 /* save base of s/g table's address in bus space */ 624 sc->mly_sg_busaddr = segs->ds_addr; 625} 626 627/******************************************************************************** 628 * Allocate memory for the memory-mailbox interface 629 */ 630static int 631mly_mmbox_map(struct mly_softc *sc) 632{ 633 634 /* 635 * Create a DMA tag for a single contiguous region large enough for the 636 * memory mailbox structure. 637 */ 638 if (bus_dma_tag_create(sc->mly_parent_dmat, /* parent */ 639 1, 0, /* alignment,boundary */ 640 BUS_SPACE_MAXADDR, /* lowaddr */ 641 BUS_SPACE_MAXADDR, /* highaddr */ 642 NULL, NULL, /* filter, filterarg */ 643 sizeof(struct mly_mmbox), 1, /* maxsize, nsegments */ 644 BUS_SPACE_MAXSIZE_32BIT, /* maxsegsize */ 645 BUS_DMA_ALLOCNOW, /* flags */ 646 NULL, NULL, /* lockfunc, lockarg */ 647 &sc->mly_mmbox_dmat)) { 648 mly_printf(sc, "can't allocate memory mailbox DMA tag\n"); 649 return(ENOMEM); 650 } 651 652 /* 653 * Allocate the buffer 654 */ 655 if (bus_dmamem_alloc(sc->mly_mmbox_dmat, (void **)&sc->mly_mmbox, BUS_DMA_NOWAIT, &sc->mly_mmbox_dmamap)) { 656 mly_printf(sc, "can't allocate memory mailbox\n"); 657 return(ENOMEM); 658 } 659 if (bus_dmamap_load(sc->mly_mmbox_dmat, sc->mly_mmbox_dmamap, sc->mly_mmbox, 660 sizeof(struct mly_mmbox), mly_mmbox_map_helper, sc, 661 BUS_DMA_NOWAIT) != 0) 662 return (ENOMEM); 663 bzero(sc->mly_mmbox, sizeof(*sc->mly_mmbox)); 664 return(0); 665 666} 667 668/******************************************************************************** 669 * Save the physical address of the memory mailbox 670 */ 671static void 672mly_mmbox_map_helper(void *arg, bus_dma_segment_t *segs, int nseg, int error) 673{ 674 struct mly_softc *sc = (struct mly_softc *)arg; 675 676 debug_called(1); 677 678 sc->mly_mmbox_busaddr = segs->ds_addr; 679} 680 681/******************************************************************************** 682 * Free all of the resources associated with (sc) 683 * 684 * Should not be called if the controller is active. 685 */ 686static void 687mly_free(struct mly_softc *sc) 688{ 689 690 debug_called(1); 691 692 /* Remove the management device */ 693 destroy_dev(sc->mly_dev_t); 694 695 /* detach from CAM */ 696 mly_cam_detach(sc); 697 698 /* release command memory */ 699 mly_release_commands(sc); 700 701 /* throw away the controllerinfo structure */ 702 if (sc->mly_controllerinfo != NULL) 703 free(sc->mly_controllerinfo, M_DEVBUF); 704 705 /* throw away the controllerparam structure */ 706 if (sc->mly_controllerparam != NULL) 707 free(sc->mly_controllerparam, M_DEVBUF); 708 709 /* destroy data-transfer DMA tag */ 710 if (sc->mly_buffer_dmat) 711 bus_dma_tag_destroy(sc->mly_buffer_dmat); 712 713 /* free and destroy DMA memory and tag for s/g lists */ 714 if (sc->mly_sg_table) { 715 bus_dmamap_unload(sc->mly_sg_dmat, sc->mly_sg_dmamap); 716 bus_dmamem_free(sc->mly_sg_dmat, sc->mly_sg_table, sc->mly_sg_dmamap); 717 } 718 if (sc->mly_sg_dmat) 719 bus_dma_tag_destroy(sc->mly_sg_dmat); 720 721 /* free and destroy DMA memory and tag for memory mailbox */ 722 if (sc->mly_mmbox) { 723 bus_dmamap_unload(sc->mly_mmbox_dmat, sc->mly_mmbox_dmamap); 724 bus_dmamem_free(sc->mly_mmbox_dmat, sc->mly_mmbox, sc->mly_mmbox_dmamap); 725 } 726 if (sc->mly_mmbox_dmat) 727 bus_dma_tag_destroy(sc->mly_mmbox_dmat); 728 729 /* disconnect the interrupt handler */ 730 if (sc->mly_intr) 731 bus_teardown_intr(sc->mly_dev, sc->mly_irq, sc->mly_intr); 732 if (sc->mly_irq != NULL) 733 bus_release_resource(sc->mly_dev, SYS_RES_IRQ, sc->mly_irq_rid, sc->mly_irq); 734 735 /* destroy the parent DMA tag */ 736 if (sc->mly_parent_dmat) 737 bus_dma_tag_destroy(sc->mly_parent_dmat); 738 739 /* release the register window mapping */ 740 if (sc->mly_regs_resource != NULL) 741 bus_release_resource(sc->mly_dev, SYS_RES_MEMORY, sc->mly_regs_rid, sc->mly_regs_resource); 742} 743 744/******************************************************************************** 745 ******************************************************************************** 746 Command Wrappers 747 ******************************************************************************** 748 ********************************************************************************/ 749 750/******************************************************************************** 751 * Fill in the mly_controllerinfo and mly_controllerparam fields in the softc. 752 */ 753static int 754mly_get_controllerinfo(struct mly_softc *sc) 755{ 756 struct mly_command_ioctl mci; 757 u_int8_t status; 758 int error; 759 760 debug_called(1); 761 762 if (sc->mly_controllerinfo != NULL) 763 free(sc->mly_controllerinfo, M_DEVBUF); 764 765 /* build the getcontrollerinfo ioctl and send it */ 766 bzero(&mci, sizeof(mci)); 767 sc->mly_controllerinfo = NULL; 768 mci.sub_ioctl = MDACIOCTL_GETCONTROLLERINFO; 769 if ((error = mly_ioctl(sc, &mci, (void **)&sc->mly_controllerinfo, sizeof(*sc->mly_controllerinfo), 770 &status, NULL, NULL))) 771 return(error); 772 if (status != 0) 773 return(EIO); 774 775 if (sc->mly_controllerparam != NULL) 776 free(sc->mly_controllerparam, M_DEVBUF); 777 778 /* build the getcontrollerparameter ioctl and send it */ 779 bzero(&mci, sizeof(mci)); 780 sc->mly_controllerparam = NULL; 781 mci.sub_ioctl = MDACIOCTL_GETCONTROLLERPARAMETER; 782 if ((error = mly_ioctl(sc, &mci, (void **)&sc->mly_controllerparam, sizeof(*sc->mly_controllerparam), 783 &status, NULL, NULL))) 784 return(error); 785 if (status != 0) 786 return(EIO); 787 788 return(0); 789} 790 791/******************************************************************************** 792 * Schedule all possible devices for a rescan. 793 * 794 */ 795static void 796mly_scan_devices(struct mly_softc *sc) 797{ 798 int bus, target; 799 800 debug_called(1); 801 802 /* 803 * Clear any previous BTL information. 804 */ 805 bzero(&sc->mly_btl, sizeof(sc->mly_btl)); 806 807 /* 808 * Mark all devices as requiring a rescan, and let the next 809 * periodic scan collect them. 810 */ 811 for (bus = 0; bus < sc->mly_cam_channels; bus++) 812 if (MLY_BUS_IS_VALID(sc, bus)) 813 for (target = 0; target < MLY_MAX_TARGETS; target++) 814 sc->mly_btl[bus][target].mb_flags = MLY_BTL_RESCAN; 815 816} 817 818/******************************************************************************** 819 * Rescan a device, possibly as a consequence of getting an event which suggests 820 * that it may have changed. 821 * 822 * If we suffer resource starvation, we can abandon the rescan as we'll be 823 * retried. 824 */ 825static void 826mly_rescan_btl(struct mly_softc *sc, int bus, int target) 827{ 828 struct mly_command *mc; 829 struct mly_command_ioctl *mci; 830 831 debug_called(1); 832 833 /* check that this bus is valid */ 834 if (!MLY_BUS_IS_VALID(sc, bus)) 835 return; 836 837 /* get a command */ 838 if (mly_alloc_command(sc, &mc)) 839 return; 840 841 /* set up the data buffer */ 842 if ((mc->mc_data = malloc(sizeof(union mly_devinfo), M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) { 843 mly_release_command(mc); 844 return; 845 } 846 mc->mc_flags |= MLY_CMD_DATAIN; 847 mc->mc_complete = mly_complete_rescan; 848 849 /* 850 * Build the ioctl. 851 */ 852 mci = (struct mly_command_ioctl *)&mc->mc_packet->ioctl; 853 mci->opcode = MDACMD_IOCTL; 854 mci->addr.phys.controller = 0; 855 mci->timeout.value = 30; 856 mci->timeout.scale = MLY_TIMEOUT_SECONDS; 857 if (MLY_BUS_IS_VIRTUAL(sc, bus)) { 858 mc->mc_length = mci->data_size = sizeof(struct mly_ioctl_getlogdevinfovalid); 859 mci->sub_ioctl = MDACIOCTL_GETLOGDEVINFOVALID; 860 mci->addr.log.logdev = MLY_LOGDEV_ID(sc, bus, target); 861 debug(1, "logical device %d", mci->addr.log.logdev); 862 } else { 863 mc->mc_length = mci->data_size = sizeof(struct mly_ioctl_getphysdevinfovalid); 864 mci->sub_ioctl = MDACIOCTL_GETPHYSDEVINFOVALID; 865 mci->addr.phys.lun = 0; 866 mci->addr.phys.target = target; 867 mci->addr.phys.channel = bus; 868 debug(1, "physical device %d:%d", mci->addr.phys.channel, mci->addr.phys.target); 869 } 870 871 /* 872 * Dispatch the command. If we successfully send the command, clear the rescan 873 * bit. 874 */ 875 if (mly_start(mc) != 0) { 876 mly_release_command(mc); 877 } else { 878 sc->mly_btl[bus][target].mb_flags &= ~MLY_BTL_RESCAN; /* success */ 879 } 880} 881 882/******************************************************************************** 883 * Handle the completion of a rescan operation 884 */ 885static void 886mly_complete_rescan(struct mly_command *mc) 887{ 888 struct mly_softc *sc = mc->mc_sc; 889 struct mly_ioctl_getlogdevinfovalid *ldi; 890 struct mly_ioctl_getphysdevinfovalid *pdi; 891 struct mly_command_ioctl *mci; 892 struct mly_btl btl, *btlp; 893 int bus, target, rescan; 894 895 debug_called(1); 896 897 /* 898 * Recover the bus and target from the command. We need these even in 899 * the case where we don't have a useful response. 900 */ 901 mci = (struct mly_command_ioctl *)&mc->mc_packet->ioctl; 902 if (mci->sub_ioctl == MDACIOCTL_GETLOGDEVINFOVALID) { 903 bus = MLY_LOGDEV_BUS(sc, mci->addr.log.logdev); 904 target = MLY_LOGDEV_TARGET(sc, mci->addr.log.logdev); 905 } else { 906 bus = mci->addr.phys.channel; 907 target = mci->addr.phys.target; 908 } 909 /* XXX validate bus/target? */ 910 911 /* the default result is 'no device' */ 912 bzero(&btl, sizeof(btl)); 913 914 /* if the rescan completed OK, we have possibly-new BTL data */ 915 if (mc->mc_status == 0) { 916 if (mc->mc_length == sizeof(*ldi)) { 917 ldi = (struct mly_ioctl_getlogdevinfovalid *)mc->mc_data; 918 if ((MLY_LOGDEV_BUS(sc, ldi->logical_device_number) != bus) || 919 (MLY_LOGDEV_TARGET(sc, ldi->logical_device_number) != target)) { 920 mly_printf(sc, "WARNING: BTL rescan for %d:%d returned data for %d:%d instead\n", 921 bus, target, MLY_LOGDEV_BUS(sc, ldi->logical_device_number), 922 MLY_LOGDEV_TARGET(sc, ldi->logical_device_number)); 923 /* XXX what can we do about this? */ 924 } 925 btl.mb_flags = MLY_BTL_LOGICAL; 926 btl.mb_type = ldi->raid_level; 927 btl.mb_state = ldi->state; 928 debug(1, "BTL rescan for %d returns %s, %s", ldi->logical_device_number, 929 mly_describe_code(mly_table_device_type, ldi->raid_level), 930 mly_describe_code(mly_table_device_state, ldi->state)); 931 } else if (mc->mc_length == sizeof(*pdi)) { 932 pdi = (struct mly_ioctl_getphysdevinfovalid *)mc->mc_data; 933 if ((pdi->channel != bus) || (pdi->target != target)) { 934 mly_printf(sc, "WARNING: BTL rescan for %d:%d returned data for %d:%d instead\n", 935 bus, target, pdi->channel, pdi->target); 936 /* XXX what can we do about this? */ 937 } 938 btl.mb_flags = MLY_BTL_PHYSICAL; 939 btl.mb_type = MLY_DEVICE_TYPE_PHYSICAL; 940 btl.mb_state = pdi->state; 941 btl.mb_speed = pdi->speed; 942 btl.mb_width = pdi->width; 943 if (pdi->state != MLY_DEVICE_STATE_UNCONFIGURED) 944 sc->mly_btl[bus][target].mb_flags |= MLY_BTL_PROTECTED; 945 debug(1, "BTL rescan for %d:%d returns %s", bus, target, 946 mly_describe_code(mly_table_device_state, pdi->state)); 947 } else { 948 mly_printf(sc, "BTL rescan result invalid\n"); 949 } 950 } 951 952 free(mc->mc_data, M_DEVBUF); 953 mly_release_command(mc); 954 955 /* 956 * Decide whether we need to rescan the device. 957 */ 958 rescan = 0; 959 960 /* device type changes (usually between 'nothing' and 'something') */ 961 btlp = &sc->mly_btl[bus][target]; 962 if (btl.mb_flags != btlp->mb_flags) { 963 debug(1, "flags changed, rescanning"); 964 rescan = 1; 965 } 966 967 /* XXX other reasons? */ 968 969 /* 970 * Update BTL information. 971 */ 972 *btlp = btl; 973 974 /* 975 * Perform CAM rescan if required. 976 */ 977 if (rescan) 978 mly_cam_rescan_btl(sc, bus, target); 979} 980 981/******************************************************************************** 982 * Get the current health status and set the 'next event' counter to suit. 983 */ 984static int 985mly_get_eventstatus(struct mly_softc *sc) 986{ 987 struct mly_command_ioctl mci; 988 struct mly_health_status *mh; 989 u_int8_t status; 990 int error; 991 992 /* build the gethealthstatus ioctl and send it */ 993 bzero(&mci, sizeof(mci)); 994 mh = NULL; 995 mci.sub_ioctl = MDACIOCTL_GETHEALTHSTATUS; 996 997 if ((error = mly_ioctl(sc, &mci, (void **)&mh, sizeof(*mh), &status, NULL, NULL))) 998 return(error); 999 if (status != 0) 1000 return(EIO); 1001 1002 /* get the event counter */ 1003 sc->mly_event_change = mh->change_counter; 1004 sc->mly_event_waiting = mh->next_event; 1005 sc->mly_event_counter = mh->next_event; 1006 1007 /* save the health status into the memory mailbox */ 1008 bcopy(mh, &sc->mly_mmbox->mmm_health.status, sizeof(*mh)); 1009 1010 debug(1, "initial change counter %d, event counter %d", mh->change_counter, mh->next_event); 1011 1012 free(mh, M_DEVBUF); 1013 return(0); 1014} 1015 1016/******************************************************************************** 1017 * Enable the memory mailbox mode. 1018 */ 1019static int 1020mly_enable_mmbox(struct mly_softc *sc) 1021{ 1022 struct mly_command_ioctl mci; 1023 u_int8_t *sp, status; 1024 int error; 1025 1026 debug_called(1); 1027 1028 /* build the ioctl and send it */ 1029 bzero(&mci, sizeof(mci)); 1030 mci.sub_ioctl = MDACIOCTL_SETMEMORYMAILBOX; 1031 /* set buffer addresses */ 1032 mci.param.setmemorymailbox.command_mailbox_physaddr = 1033 sc->mly_mmbox_busaddr + offsetof(struct mly_mmbox, mmm_command); 1034 mci.param.setmemorymailbox.status_mailbox_physaddr = 1035 sc->mly_mmbox_busaddr + offsetof(struct mly_mmbox, mmm_status); 1036 mci.param.setmemorymailbox.health_buffer_physaddr = 1037 sc->mly_mmbox_busaddr + offsetof(struct mly_mmbox, mmm_health); 1038 1039 /* set buffer sizes - abuse of data_size field is revolting */ 1040 sp = (u_int8_t *)&mci.data_size; 1041 sp[0] = ((sizeof(union mly_command_packet) * MLY_MMBOX_COMMANDS) / 1024); 1042 sp[1] = (sizeof(union mly_status_packet) * MLY_MMBOX_STATUS) / 1024; 1043 mci.param.setmemorymailbox.health_buffer_size = sizeof(union mly_health_region) / 1024; 1044 1045 debug(1, "memory mailbox at %p (0x%llx/%d 0x%llx/%d 0x%llx/%d", sc->mly_mmbox, 1046 mci.param.setmemorymailbox.command_mailbox_physaddr, sp[0], 1047 mci.param.setmemorymailbox.status_mailbox_physaddr, sp[1], 1048 mci.param.setmemorymailbox.health_buffer_physaddr, 1049 mci.param.setmemorymailbox.health_buffer_size); 1050 1051 if ((error = mly_ioctl(sc, &mci, NULL, 0, &status, NULL, NULL))) 1052 return(error); 1053 if (status != 0) 1054 return(EIO); 1055 sc->mly_state |= MLY_STATE_MMBOX_ACTIVE; 1056 debug(1, "memory mailbox active"); 1057 return(0); 1058} 1059 1060/******************************************************************************** 1061 * Flush all pending I/O from the controller. 1062 */ 1063static int 1064mly_flush(struct mly_softc *sc) 1065{ 1066 struct mly_command_ioctl mci; 1067 u_int8_t status; 1068 int error; 1069 1070 debug_called(1); 1071 1072 /* build the ioctl */ 1073 bzero(&mci, sizeof(mci)); 1074 mci.sub_ioctl = MDACIOCTL_FLUSHDEVICEDATA; 1075 mci.param.deviceoperation.operation_device = MLY_OPDEVICE_PHYSICAL_CONTROLLER; 1076 1077 /* pass it off to the controller */ 1078 if ((error = mly_ioctl(sc, &mci, NULL, 0, &status, NULL, NULL))) 1079 return(error); 1080 1081 return((status == 0) ? 0 : EIO); 1082} 1083 1084/******************************************************************************** 1085 * Perform an ioctl command. 1086 * 1087 * If (data) is not NULL, the command requires data transfer. If (*data) is NULL 1088 * the command requires data transfer from the controller, and we will allocate 1089 * a buffer for it. If (*data) is not NULL, the command requires data transfer 1090 * to the controller. 1091 * 1092 * XXX passing in the whole ioctl structure is ugly. Better ideas? 1093 * 1094 * XXX we don't even try to handle the case where datasize > 4k. We should. 1095 */ 1096static int 1097mly_ioctl(struct mly_softc *sc, struct mly_command_ioctl *ioctl, void **data, size_t datasize, 1098 u_int8_t *status, void *sense_buffer, size_t *sense_length) 1099{ 1100 struct mly_command *mc; 1101 struct mly_command_ioctl *mci; 1102 int error; 1103 1104 debug_called(1); 1105 1106 mc = NULL; 1107 if (mly_alloc_command(sc, &mc)) { 1108 error = ENOMEM; 1109 goto out; 1110 } 1111 1112 /* copy the ioctl structure, but save some important fields and then fixup */ 1113 mci = &mc->mc_packet->ioctl; 1114 ioctl->sense_buffer_address = mci->sense_buffer_address; 1115 ioctl->maximum_sense_size = mci->maximum_sense_size; 1116 *mci = *ioctl; 1117 mci->opcode = MDACMD_IOCTL; 1118 mci->timeout.value = 30; 1119 mci->timeout.scale = MLY_TIMEOUT_SECONDS; 1120 1121 /* handle the data buffer */ 1122 if (data != NULL) { 1123 if (*data == NULL) { 1124 /* allocate data buffer */ 1125 if ((mc->mc_data = malloc(datasize, M_DEVBUF, M_NOWAIT)) == NULL) { 1126 error = ENOMEM; 1127 goto out; 1128 } 1129 mc->mc_flags |= MLY_CMD_DATAIN; 1130 } else { 1131 mc->mc_data = *data; 1132 mc->mc_flags |= MLY_CMD_DATAOUT; 1133 } 1134 mc->mc_length = datasize; 1135 mc->mc_packet->generic.data_size = datasize; 1136 } 1137 1138 /* run the command */ 1139 if ((error = mly_immediate_command(mc))) 1140 goto out; 1141 1142 /* clean up and return any data */ 1143 *status = mc->mc_status; 1144 if ((mc->mc_sense > 0) && (sense_buffer != NULL)) { 1145 bcopy(mc->mc_packet, sense_buffer, mc->mc_sense); 1146 *sense_length = mc->mc_sense; 1147 goto out; 1148 } 1149 1150 /* should we return a data pointer? */ 1151 if ((data != NULL) && (*data == NULL)) 1152 *data = mc->mc_data; 1153 1154 /* command completed OK */ 1155 error = 0; 1156 1157out: 1158 if (mc != NULL) { 1159 /* do we need to free a data buffer we allocated? */ 1160 if (error && (mc->mc_data != NULL) && (*data == NULL)) 1161 free(mc->mc_data, M_DEVBUF); 1162 mly_release_command(mc); 1163 } 1164 return(error); 1165} 1166 1167/******************************************************************************** 1168 * Check for event(s) outstanding in the controller. 1169 */ 1170static void 1171mly_check_event(struct mly_softc *sc) 1172{ 1173 1174 /* 1175 * The controller may have updated the health status information, 1176 * so check for it here. Note that the counters are all in host memory, 1177 * so this check is very cheap. Also note that we depend on checking on 1178 * completion 1179 */ 1180 if (sc->mly_mmbox->mmm_health.status.change_counter != sc->mly_event_change) { 1181 sc->mly_event_change = sc->mly_mmbox->mmm_health.status.change_counter; 1182 debug(1, "event change %d, event status update, %d -> %d", sc->mly_event_change, 1183 sc->mly_event_waiting, sc->mly_mmbox->mmm_health.status.next_event); 1184 sc->mly_event_waiting = sc->mly_mmbox->mmm_health.status.next_event; 1185 1186 /* wake up anyone that might be interested in this */ 1187 wakeup(&sc->mly_event_change); 1188 } 1189 if (sc->mly_event_counter != sc->mly_event_waiting) 1190 mly_fetch_event(sc); 1191} 1192 1193/******************************************************************************** 1194 * Fetch one event from the controller. 1195 * 1196 * If we fail due to resource starvation, we'll be retried the next time a 1197 * command completes. 1198 */ 1199static void 1200mly_fetch_event(struct mly_softc *sc) 1201{ 1202 struct mly_command *mc; 1203 struct mly_command_ioctl *mci; 1204 int s; 1205 u_int32_t event; 1206 1207 debug_called(1); 1208 1209 /* get a command */ 1210 if (mly_alloc_command(sc, &mc)) 1211 return; 1212 1213 /* set up the data buffer */ 1214 if ((mc->mc_data = malloc(sizeof(struct mly_event), M_DEVBUF, M_NOWAIT | M_ZERO)) == NULL) { 1215 mly_release_command(mc); 1216 return; 1217 } 1218 mc->mc_length = sizeof(struct mly_event); 1219 mc->mc_flags |= MLY_CMD_DATAIN; 1220 mc->mc_complete = mly_complete_event; 1221 1222 /* 1223 * Get an event number to fetch. It's possible that we've raced with another 1224 * context for the last event, in which case there will be no more events. 1225 */ 1226 s = splcam(); 1227 if (sc->mly_event_counter == sc->mly_event_waiting) { 1228 mly_release_command(mc); 1229 splx(s); 1230 return; 1231 } 1232 event = sc->mly_event_counter++; 1233 splx(s); 1234 1235 /* 1236 * Build the ioctl. 1237 * 1238 * At this point we are committed to sending this request, as it 1239 * will be the only one constructed for this particular event number. 1240 */ 1241 mci = (struct mly_command_ioctl *)&mc->mc_packet->ioctl; 1242 mci->opcode = MDACMD_IOCTL; 1243 mci->data_size = sizeof(struct mly_event); 1244 mci->addr.phys.lun = (event >> 16) & 0xff; 1245 mci->addr.phys.target = (event >> 24) & 0xff; 1246 mci->addr.phys.channel = 0; 1247 mci->addr.phys.controller = 0; 1248 mci->timeout.value = 30; 1249 mci->timeout.scale = MLY_TIMEOUT_SECONDS; 1250 mci->sub_ioctl = MDACIOCTL_GETEVENT; 1251 mci->param.getevent.sequence_number_low = event & 0xffff; 1252 1253 debug(1, "fetch event %u", event); 1254 1255 /* 1256 * Submit the command. 1257 * 1258 * Note that failure of mly_start() will result in this event never being 1259 * fetched. 1260 */ 1261 if (mly_start(mc) != 0) { 1262 mly_printf(sc, "couldn't fetch event %u\n", event); 1263 mly_release_command(mc); 1264 } 1265} 1266 1267/******************************************************************************** 1268 * Handle the completion of an event poll. 1269 */ 1270static void 1271mly_complete_event(struct mly_command *mc) 1272{ 1273 struct mly_softc *sc = mc->mc_sc; 1274 struct mly_event *me = (struct mly_event *)mc->mc_data; 1275 1276 debug_called(1); 1277 1278 /* 1279 * If the event was successfully fetched, process it. 1280 */ 1281 if (mc->mc_status == SCSI_STATUS_OK) { 1282 mly_process_event(sc, me); 1283 free(me, M_DEVBUF); 1284 } 1285 mly_release_command(mc); 1286 1287 /* 1288 * Check for another event. 1289 */ 1290 mly_check_event(sc); 1291} 1292 1293/******************************************************************************** 1294 * Process a controller event. 1295 */ 1296static void 1297mly_process_event(struct mly_softc *sc, struct mly_event *me) 1298{ 1299 struct scsi_sense_data *ssd = (struct scsi_sense_data *)&me->sense[0]; 1300 char *fp, *tp; 1301 int bus, target, event, class, action; 1302 1303 /* 1304 * Errors can be reported using vendor-unique sense data. In this case, the 1305 * event code will be 0x1c (Request sense data present), the sense key will 1306 * be 0x09 (vendor specific), the MSB of the ASC will be set, and the 1307 * actual event code will be a 16-bit value comprised of the ASCQ (low byte) 1308 * and low seven bits of the ASC (low seven bits of the high byte). 1309 */ 1310 if ((me->code == 0x1c) && 1311 ((ssd->flags & SSD_KEY) == SSD_KEY_Vendor_Specific) && 1312 (ssd->add_sense_code & 0x80)) { 1313 event = ((int)(ssd->add_sense_code & ~0x80) << 8) + ssd->add_sense_code_qual; 1314 } else { 1315 event = me->code; 1316 } 1317 1318 /* look up event, get codes */ 1319 fp = mly_describe_code(mly_table_event, event); 1320 1321 debug(1, "Event %d code 0x%x", me->sequence_number, me->code); 1322 1323 /* quiet event? */ 1324 class = fp[0]; 1325 if (isupper(class) && bootverbose) 1326 class = tolower(class); 1327 1328 /* get action code, text string */ 1329 action = fp[1]; 1330 tp = &fp[2]; 1331 1332 /* 1333 * Print some information about the event. 1334 * 1335 * This code uses a table derived from the corresponding portion of the Linux 1336 * driver, and thus the parser is very similar. 1337 */ 1338 switch(class) { 1339 case 'p': /* error on physical device */ 1340 mly_printf(sc, "physical device %d:%d %s\n", me->channel, me->target, tp); 1341 if (action == 'r') 1342 sc->mly_btl[me->channel][me->target].mb_flags |= MLY_BTL_RESCAN; 1343 break; 1344 case 'l': /* error on logical unit */ 1345 case 'm': /* message about logical unit */ 1346 bus = MLY_LOGDEV_BUS(sc, me->lun); 1347 target = MLY_LOGDEV_TARGET(sc, me->lun); 1348 mly_name_device(sc, bus, target); 1349 mly_printf(sc, "logical device %d (%s) %s\n", me->lun, sc->mly_btl[bus][target].mb_name, tp); 1350 if (action == 'r') 1351 sc->mly_btl[bus][target].mb_flags |= MLY_BTL_RESCAN; 1352 break; 1353 break; 1354 case 's': /* report of sense data */ 1355 if (((ssd->flags & SSD_KEY) == SSD_KEY_NO_SENSE) || 1356 (((ssd->flags & SSD_KEY) == SSD_KEY_NOT_READY) && 1357 (ssd->add_sense_code == 0x04) && 1358 ((ssd->add_sense_code_qual == 0x01) || (ssd->add_sense_code_qual == 0x02)))) 1359 break; /* ignore NO_SENSE or NOT_READY in one case */ 1360 1361 mly_printf(sc, "physical device %d:%d %s\n", me->channel, me->target, tp); 1362 mly_printf(sc, " sense key %d asc %02x ascq %02x\n", 1363 ssd->flags & SSD_KEY, ssd->add_sense_code, ssd->add_sense_code_qual); 1364 mly_printf(sc, " info %4D csi %4D\n", ssd->info, "", ssd->cmd_spec_info, ""); 1365 if (action == 'r') 1366 sc->mly_btl[me->channel][me->target].mb_flags |= MLY_BTL_RESCAN; 1367 break; 1368 case 'e': 1369 mly_printf(sc, tp, me->target, me->lun); 1370 printf("\n"); 1371 break; 1372 case 'c': 1373 mly_printf(sc, "controller %s\n", tp); 1374 break; 1375 case '?': 1376 mly_printf(sc, "%s - %d\n", tp, me->code); 1377 break; 1378 default: /* probably a 'noisy' event being ignored */ 1379 break; 1380 } 1381} 1382 1383/******************************************************************************** 1384 * Perform periodic activities. 1385 */ 1386static void 1387mly_periodic(void *data) 1388{ 1389 struct mly_softc *sc = (struct mly_softc *)data; 1390 int bus, target; 1391 1392 debug_called(2); 1393 1394 /* 1395 * Scan devices. 1396 */ 1397 for (bus = 0; bus < sc->mly_cam_channels; bus++) { 1398 if (MLY_BUS_IS_VALID(sc, bus)) { 1399 for (target = 0; target < MLY_MAX_TARGETS; target++) { 1400 1401 /* ignore the controller in this scan */ 1402 if (target == sc->mly_controllerparam->initiator_id) 1403 continue; 1404 1405 /* perform device rescan? */ 1406 if (sc->mly_btl[bus][target].mb_flags & MLY_BTL_RESCAN) 1407 mly_rescan_btl(sc, bus, target); 1408 } 1409 } 1410 } 1411 1412 /* check for controller events */ 1413 mly_check_event(sc); 1414 1415 /* reschedule ourselves */ 1416 sc->mly_periodic = timeout(mly_periodic, sc, MLY_PERIODIC_INTERVAL * hz); 1417} 1418 1419/******************************************************************************** 1420 ******************************************************************************** 1421 Command Processing 1422 ******************************************************************************** 1423 ********************************************************************************/ 1424 1425/******************************************************************************** 1426 * Run a command and wait for it to complete. 1427 * 1428 */ 1429static int 1430mly_immediate_command(struct mly_command *mc) 1431{ 1432 struct mly_softc *sc = mc->mc_sc; 1433 int error, s; 1434 1435 debug_called(1); 1436 1437 /* spinning at splcam is ugly, but we're only used during controller init */ 1438 s = splcam(); 1439 if ((error = mly_start(mc))) { 1440 splx(s); 1441 return(error); 1442 } 1443 1444 if (sc->mly_state & MLY_STATE_INTERRUPTS_ON) { 1445 /* sleep on the command */ 1446 while(!(mc->mc_flags & MLY_CMD_COMPLETE)) { 1447 tsleep(mc, PRIBIO, "mlywait", 0); 1448 } 1449 } else { 1450 /* spin and collect status while we do */ 1451 while(!(mc->mc_flags & MLY_CMD_COMPLETE)) { 1452 mly_done(mc->mc_sc); 1453 } 1454 } 1455 splx(s); 1456 return(0); 1457} 1458 1459/******************************************************************************** 1460 * Deliver a command to the controller. 1461 * 1462 * XXX it would be good to just queue commands that we can't submit immediately 1463 * and send them later, but we probably want a wrapper for that so that 1464 * we don't hang on a failed submission for an immediate command. 1465 */ 1466static int 1467mly_start(struct mly_command *mc) 1468{ 1469 struct mly_softc *sc = mc->mc_sc; 1470 union mly_command_packet *pkt; 1471 int s; 1472 1473 debug_called(2); 1474 1475 /* 1476 * Set the command up for delivery to the controller. 1477 */ 1478 mly_map_command(mc); 1479 mc->mc_packet->generic.command_id = mc->mc_slot; 1480 1481#ifdef MLY_DEBUG 1482 mc->mc_timestamp = time_second; 1483#endif 1484 1485 s = splcam(); 1486 1487 /* 1488 * Do we have to use the hardware mailbox? 1489 */ 1490 if (!(sc->mly_state & MLY_STATE_MMBOX_ACTIVE)) { 1491 /* 1492 * Check to see if the controller is ready for us. 1493 */ 1494 if (MLY_IDBR_TRUE(sc, MLY_HM_CMDSENT)) { 1495 splx(s); 1496 return(EBUSY); 1497 } 1498 mc->mc_flags |= MLY_CMD_BUSY; 1499 1500 /* 1501 * It's ready, send the command. 1502 */ 1503 MLY_SET_MBOX(sc, sc->mly_command_mailbox, &mc->mc_packetphys); 1504 MLY_SET_REG(sc, sc->mly_idbr, MLY_HM_CMDSENT); 1505 1506 } else { /* use memory-mailbox mode */ 1507 1508 pkt = &sc->mly_mmbox->mmm_command[sc->mly_mmbox_command_index]; 1509 1510 /* check to see if the next index is free yet */ 1511 if (pkt->mmbox.flag != 0) { 1512 splx(s); 1513 return(EBUSY); 1514 } 1515 mc->mc_flags |= MLY_CMD_BUSY; 1516 1517 /* copy in new command */ 1518 bcopy(mc->mc_packet->mmbox.data, pkt->mmbox.data, sizeof(pkt->mmbox.data)); 1519 /* barrier to ensure completion of previous write before we write the flag */ 1520 bus_space_barrier(sc->mly_btag, sc->mly_bhandle, 0, 0, 1521 BUS_SPACE_BARRIER_WRITE); 1522 /* copy flag last */ 1523 pkt->mmbox.flag = mc->mc_packet->mmbox.flag; 1524 /* barrier to ensure completion of previous write before we notify the controller */ 1525 bus_space_barrier(sc->mly_btag, sc->mly_bhandle, 0, 0, 1526 BUS_SPACE_BARRIER_WRITE); 1527 1528 /* signal controller, update index */ 1529 MLY_SET_REG(sc, sc->mly_idbr, MLY_AM_CMDSENT); 1530 sc->mly_mmbox_command_index = (sc->mly_mmbox_command_index + 1) % MLY_MMBOX_COMMANDS; 1531 } 1532 1533 mly_enqueue_busy(mc); 1534 splx(s); 1535 return(0); 1536} 1537 1538/******************************************************************************** 1539 * Pick up command status from the controller, schedule a completion event 1540 */ 1541static void 1542mly_done(struct mly_softc *sc) 1543{ 1544 struct mly_command *mc; 1545 union mly_status_packet *sp; 1546 u_int16_t slot; 1547 int s, worked; 1548 1549 s = splcam(); 1550 worked = 0; 1551 1552 /* pick up hardware-mailbox commands */ 1553 if (MLY_ODBR_TRUE(sc, MLY_HM_STSREADY)) { 1554 slot = MLY_GET_REG2(sc, sc->mly_status_mailbox); 1555 if (slot < MLY_SLOT_MAX) { 1556 mc = &sc->mly_command[slot - MLY_SLOT_START]; 1557 mc->mc_status = MLY_GET_REG(sc, sc->mly_status_mailbox + 2); 1558 mc->mc_sense = MLY_GET_REG(sc, sc->mly_status_mailbox + 3); 1559 mc->mc_resid = MLY_GET_REG4(sc, sc->mly_status_mailbox + 4); 1560 mly_remove_busy(mc); 1561 mc->mc_flags &= ~MLY_CMD_BUSY; 1562 mly_enqueue_complete(mc); 1563 worked = 1; 1564 } else { 1565 /* slot 0xffff may mean "extremely bogus command" */ 1566 mly_printf(sc, "got HM completion for illegal slot %u\n", slot); 1567 } 1568 /* unconditionally acknowledge status */ 1569 MLY_SET_REG(sc, sc->mly_odbr, MLY_HM_STSREADY); 1570 MLY_SET_REG(sc, sc->mly_idbr, MLY_HM_STSACK); 1571 } 1572 1573 /* pick up memory-mailbox commands */ 1574 if (MLY_ODBR_TRUE(sc, MLY_AM_STSREADY)) { 1575 for (;;) { 1576 sp = &sc->mly_mmbox->mmm_status[sc->mly_mmbox_status_index]; 1577 1578 /* check for more status */ 1579 if (sp->mmbox.flag == 0) 1580 break; 1581 1582 /* get slot number */ 1583 slot = sp->status.command_id; 1584 if (slot < MLY_SLOT_MAX) { 1585 mc = &sc->mly_command[slot - MLY_SLOT_START]; 1586 mc->mc_status = sp->status.status; 1587 mc->mc_sense = sp->status.sense_length; 1588 mc->mc_resid = sp->status.residue; 1589 mly_remove_busy(mc); 1590 mc->mc_flags &= ~MLY_CMD_BUSY; 1591 mly_enqueue_complete(mc); 1592 worked = 1; 1593 } else { 1594 /* slot 0xffff may mean "extremely bogus command" */ 1595 mly_printf(sc, "got AM completion for illegal slot %u at %d\n", 1596 slot, sc->mly_mmbox_status_index); 1597 } 1598 1599 /* clear and move to next index */ 1600 sp->mmbox.flag = 0; 1601 sc->mly_mmbox_status_index = (sc->mly_mmbox_status_index + 1) % MLY_MMBOX_STATUS; 1602 } 1603 /* acknowledge that we have collected status value(s) */ 1604 MLY_SET_REG(sc, sc->mly_odbr, MLY_AM_STSREADY); 1605 } 1606 1607 splx(s); 1608 if (worked) { 1609#if __FreeBSD_version >= 500005 1610 if (sc->mly_state & MLY_STATE_INTERRUPTS_ON) 1611 taskqueue_enqueue(taskqueue_swi_giant, &sc->mly_task_complete); 1612 else 1613#endif 1614 mly_complete(sc, 0); 1615 } 1616} 1617 1618/******************************************************************************** 1619 * Process completed commands 1620 */ 1621static void 1622mly_complete(void *context, int pending) 1623{ 1624 struct mly_softc *sc = (struct mly_softc *)context; 1625 struct mly_command *mc; 1626 void (* mc_complete)(struct mly_command *mc); 1627 1628 1629 debug_called(2); 1630 1631 /* 1632 * Spin pulling commands off the completed queue and processing them. 1633 */ 1634 while ((mc = mly_dequeue_complete(sc)) != NULL) { 1635 1636 /* 1637 * Free controller resources, mark command complete. 1638 * 1639 * Note that as soon as we mark the command complete, it may be freed 1640 * out from under us, so we need to save the mc_complete field in 1641 * order to later avoid dereferencing mc. (We would not expect to 1642 * have a polling/sleeping consumer with mc_complete != NULL). 1643 */ 1644 mly_unmap_command(mc); 1645 mc_complete = mc->mc_complete; 1646 mc->mc_flags |= MLY_CMD_COMPLETE; 1647 1648 /* 1649 * Call completion handler or wake up sleeping consumer. 1650 */ 1651 if (mc_complete != NULL) { 1652 mc_complete(mc); 1653 } else { 1654 wakeup(mc); 1655 } 1656 } 1657 1658 /* 1659 * XXX if we are deferring commands due to controller-busy status, we should 1660 * retry submitting them here. 1661 */ 1662} 1663 1664/******************************************************************************** 1665 ******************************************************************************** 1666 Command Buffer Management 1667 ******************************************************************************** 1668 ********************************************************************************/ 1669 1670/******************************************************************************** 1671 * Allocate a command. 1672 */ 1673static int 1674mly_alloc_command(struct mly_softc *sc, struct mly_command **mcp) 1675{ 1676 struct mly_command *mc; 1677 1678 debug_called(3); 1679 1680 if ((mc = mly_dequeue_free(sc)) == NULL) 1681 return(ENOMEM); 1682 1683 *mcp = mc; 1684 return(0); 1685} 1686 1687/******************************************************************************** 1688 * Release a command back to the freelist. 1689 */ 1690static void 1691mly_release_command(struct mly_command *mc) 1692{ 1693 debug_called(3); 1694 1695 /* 1696 * Fill in parts of the command that may cause confusion if 1697 * a consumer doesn't when we are later allocated. 1698 */ 1699 mc->mc_data = NULL; 1700 mc->mc_flags = 0; 1701 mc->mc_complete = NULL; 1702 mc->mc_private = NULL; 1703 1704 /* 1705 * By default, we set up to overwrite the command packet with 1706 * sense information. 1707 */ 1708 mc->mc_packet->generic.sense_buffer_address = mc->mc_packetphys; 1709 mc->mc_packet->generic.maximum_sense_size = sizeof(union mly_command_packet); 1710 1711 mly_enqueue_free(mc); 1712} 1713 1714/******************************************************************************** 1715 * Map helper for command allocation. 1716 */ 1717static void 1718mly_alloc_commands_map(void *arg, bus_dma_segment_t *segs, int nseg, int error) 1719{ 1720 struct mly_softc *sc = (struct mly_softc *)arg; 1721 1722 debug_called(1); 1723 1724 sc->mly_packetphys = segs[0].ds_addr; 1725} 1726 1727/******************************************************************************** 1728 * Allocate and initialise command and packet structures. 1729 * 1730 * If the controller supports fewer than MLY_MAX_COMMANDS commands, limit our 1731 * allocation to that number. If we don't yet know how many commands the 1732 * controller supports, allocate a very small set (suitable for initialisation 1733 * purposes only). 1734 */ 1735static int 1736mly_alloc_commands(struct mly_softc *sc) 1737{ 1738 struct mly_command *mc; 1739 int i, ncmd; 1740 1741 if (sc->mly_controllerinfo == NULL) { 1742 ncmd = 4; 1743 } else { 1744 ncmd = min(MLY_MAX_COMMANDS, sc->mly_controllerinfo->maximum_parallel_commands); 1745 } 1746 1747 /* 1748 * Allocate enough space for all the command packets in one chunk and 1749 * map them permanently into controller-visible space. 1750 */ 1751 if (bus_dmamem_alloc(sc->mly_packet_dmat, (void **)&sc->mly_packet, 1752 BUS_DMA_NOWAIT, &sc->mly_packetmap)) { 1753 return(ENOMEM); 1754 } 1755 if (bus_dmamap_load(sc->mly_packet_dmat, sc->mly_packetmap, sc->mly_packet, 1756 ncmd * sizeof(union mly_command_packet), 1757 mly_alloc_commands_map, sc, BUS_DMA_NOWAIT) != 0) 1758 return (ENOMEM); 1759 1760 for (i = 0; i < ncmd; i++) { 1761 mc = &sc->mly_command[i]; 1762 bzero(mc, sizeof(*mc)); 1763 mc->mc_sc = sc; 1764 mc->mc_slot = MLY_SLOT_START + i; 1765 mc->mc_packet = sc->mly_packet + i; 1766 mc->mc_packetphys = sc->mly_packetphys + (i * sizeof(union mly_command_packet)); 1767 if (!bus_dmamap_create(sc->mly_buffer_dmat, 0, &mc->mc_datamap)) 1768 mly_release_command(mc); 1769 } 1770 return(0); 1771} 1772 1773/******************************************************************************** 1774 * Free all the storage held by commands. 1775 * 1776 * Must be called with all commands on the free list. 1777 */ 1778static void 1779mly_release_commands(struct mly_softc *sc) 1780{ 1781 struct mly_command *mc; 1782 1783 /* throw away command buffer DMA maps */ 1784 while (mly_alloc_command(sc, &mc) == 0) 1785 bus_dmamap_destroy(sc->mly_buffer_dmat, mc->mc_datamap); 1786 1787 /* release the packet storage */ 1788 if (sc->mly_packet != NULL) { 1789 bus_dmamap_unload(sc->mly_packet_dmat, sc->mly_packetmap); 1790 bus_dmamem_free(sc->mly_packet_dmat, sc->mly_packet, sc->mly_packetmap); 1791 sc->mly_packet = NULL; 1792 } 1793} 1794 1795 1796/******************************************************************************** 1797 * Command-mapping helper function - populate this command's s/g table 1798 * with the s/g entries for its data. 1799 */ 1800static void 1801mly_map_command_sg(void *arg, bus_dma_segment_t *segs, int nseg, int error) 1802{ 1803 struct mly_command *mc = (struct mly_command *)arg; 1804 struct mly_softc *sc = mc->mc_sc; 1805 struct mly_command_generic *gen = &(mc->mc_packet->generic); 1806 struct mly_sg_entry *sg; 1807 int i, tabofs; 1808 1809 debug_called(2); 1810 1811 /* can we use the transfer structure directly? */ 1812 if (nseg <= 2) { 1813 sg = &gen->transfer.direct.sg[0]; 1814 gen->command_control.extended_sg_table = 0; 1815 } else { 1816 tabofs = ((mc->mc_slot - MLY_SLOT_START) * MLY_MAX_SGENTRIES); 1817 sg = sc->mly_sg_table + tabofs; 1818 gen->transfer.indirect.entries[0] = nseg; 1819 gen->transfer.indirect.table_physaddr[0] = sc->mly_sg_busaddr + (tabofs * sizeof(struct mly_sg_entry)); 1820 gen->command_control.extended_sg_table = 1; 1821 } 1822 1823 /* copy the s/g table */ 1824 for (i = 0; i < nseg; i++) { 1825 sg[i].physaddr = segs[i].ds_addr; 1826 sg[i].length = segs[i].ds_len; 1827 } 1828 1829} 1830 1831#if 0 1832/******************************************************************************** 1833 * Command-mapping helper function - save the cdb's physical address. 1834 * 1835 * We don't support 'large' SCSI commands at this time, so this is unused. 1836 */ 1837static void 1838mly_map_command_cdb(void *arg, bus_dma_segment_t *segs, int nseg, int error) 1839{ 1840 struct mly_command *mc = (struct mly_command *)arg; 1841 1842 debug_called(2); 1843 1844 /* XXX can we safely assume that a CDB will never cross a page boundary? */ 1845 if ((segs[0].ds_addr % PAGE_SIZE) > 1846 ((segs[0].ds_addr + mc->mc_packet->scsi_large.cdb_length) % PAGE_SIZE)) 1847 panic("cdb crosses page boundary"); 1848 1849 /* fix up fields in the command packet */ 1850 mc->mc_packet->scsi_large.cdb_physaddr = segs[0].ds_addr; 1851} 1852#endif 1853 1854/******************************************************************************** 1855 * Map a command into controller-visible space 1856 */ 1857static void 1858mly_map_command(struct mly_command *mc) 1859{ 1860 struct mly_softc *sc = mc->mc_sc; 1861 1862 debug_called(2); 1863 1864 /* don't map more than once */ 1865 if (mc->mc_flags & MLY_CMD_MAPPED) 1866 return; 1867 1868 /* does the command have a data buffer? */ 1869 if (mc->mc_data != NULL) { 1870 bus_dmamap_load(sc->mly_buffer_dmat, mc->mc_datamap, mc->mc_data, mc->mc_length, 1871 mly_map_command_sg, mc, 0); 1872 1873 if (mc->mc_flags & MLY_CMD_DATAIN) 1874 bus_dmamap_sync(sc->mly_buffer_dmat, mc->mc_datamap, BUS_DMASYNC_PREREAD); 1875 if (mc->mc_flags & MLY_CMD_DATAOUT) 1876 bus_dmamap_sync(sc->mly_buffer_dmat, mc->mc_datamap, BUS_DMASYNC_PREWRITE); 1877 } 1878 mc->mc_flags |= MLY_CMD_MAPPED; 1879} 1880 1881/******************************************************************************** 1882 * Unmap a command from controller-visible space 1883 */ 1884static void 1885mly_unmap_command(struct mly_command *mc) 1886{ 1887 struct mly_softc *sc = mc->mc_sc; 1888 1889 debug_called(2); 1890 1891 if (!(mc->mc_flags & MLY_CMD_MAPPED)) 1892 return; 1893 1894 /* does the command have a data buffer? */ 1895 if (mc->mc_data != NULL) { 1896 if (mc->mc_flags & MLY_CMD_DATAIN) 1897 bus_dmamap_sync(sc->mly_buffer_dmat, mc->mc_datamap, BUS_DMASYNC_POSTREAD); 1898 if (mc->mc_flags & MLY_CMD_DATAOUT) 1899 bus_dmamap_sync(sc->mly_buffer_dmat, mc->mc_datamap, BUS_DMASYNC_POSTWRITE); 1900 1901 bus_dmamap_unload(sc->mly_buffer_dmat, mc->mc_datamap); 1902 } 1903 mc->mc_flags &= ~MLY_CMD_MAPPED; 1904} 1905 1906 1907/******************************************************************************** 1908 ******************************************************************************** 1909 CAM interface 1910 ******************************************************************************** 1911 ********************************************************************************/ 1912 1913/******************************************************************************** 1914 * Attach the physical and virtual SCSI busses to CAM. 1915 * 1916 * Physical bus numbering starts from 0, virtual bus numbering from one greater 1917 * than the highest physical bus. Physical busses are only registered if 1918 * the kernel environment variable "hw.mly.register_physical_channels" is set. 1919 * 1920 * When we refer to a "bus", we are referring to the bus number registered with 1921 * the SIM, wheras a "channel" is a channel number given to the adapter. In order 1922 * to keep things simple, we map these 1:1, so "bus" and "channel" may be used 1923 * interchangeably. 1924 */ 1925static int 1926mly_cam_attach(struct mly_softc *sc) 1927{ 1928 struct cam_devq *devq; 1929 int chn, i; 1930 1931 debug_called(1); 1932 1933 /* 1934 * Allocate a devq for all our channels combined. 1935 */ 1936 if ((devq = cam_simq_alloc(sc->mly_controllerinfo->maximum_parallel_commands)) == NULL) { 1937 mly_printf(sc, "can't allocate CAM SIM queue\n"); 1938 return(ENOMEM); 1939 } 1940 1941 /* 1942 * If physical channel registration has been requested, register these first. 1943 * Note that we enable tagged command queueing for physical channels. 1944 */ 1945 if (testenv("hw.mly.register_physical_channels")) { 1946 chn = 0; 1947 for (i = 0; i < sc->mly_controllerinfo->physical_channels_present; i++, chn++) { 1948 1949 if ((sc->mly_cam_sim[chn] = cam_sim_alloc(mly_cam_action, mly_cam_poll, "mly", sc, 1950 device_get_unit(sc->mly_dev), 1951 sc->mly_controllerinfo->maximum_parallel_commands, 1952 1, devq)) == NULL) { 1953 return(ENOMEM); 1954 } 1955 if (xpt_bus_register(sc->mly_cam_sim[chn], chn)) { 1956 mly_printf(sc, "CAM XPT phsyical channel registration failed\n"); 1957 return(ENXIO); 1958 } 1959 debug(1, "registered physical channel %d", chn); 1960 } 1961 } 1962 1963 /* 1964 * Register our virtual channels, with bus numbers matching channel numbers. 1965 */ 1966 chn = sc->mly_controllerinfo->physical_channels_present; 1967 for (i = 0; i < sc->mly_controllerinfo->virtual_channels_present; i++, chn++) { 1968 if ((sc->mly_cam_sim[chn] = cam_sim_alloc(mly_cam_action, mly_cam_poll, "mly", sc, 1969 device_get_unit(sc->mly_dev), 1970 sc->mly_controllerinfo->maximum_parallel_commands, 1971 0, devq)) == NULL) { 1972 return(ENOMEM); 1973 } 1974 if (xpt_bus_register(sc->mly_cam_sim[chn], chn)) { 1975 mly_printf(sc, "CAM XPT virtual channel registration failed\n"); 1976 return(ENXIO); 1977 } 1978 debug(1, "registered virtual channel %d", chn); 1979 } 1980 1981 /* 1982 * This is the total number of channels that (might have been) registered with 1983 * CAM. Some may not have been; check the mly_cam_sim array to be certain. 1984 */ 1985 sc->mly_cam_channels = sc->mly_controllerinfo->physical_channels_present + 1986 sc->mly_controllerinfo->virtual_channels_present; 1987 1988 return(0); 1989} 1990 1991/******************************************************************************** 1992 * Detach from CAM 1993 */ 1994static void 1995mly_cam_detach(struct mly_softc *sc) 1996{ 1997 int i; 1998 1999 debug_called(1); 2000 2001 for (i = 0; i < sc->mly_cam_channels; i++) { 2002 if (sc->mly_cam_sim[i] != NULL) { 2003 xpt_bus_deregister(cam_sim_path(sc->mly_cam_sim[i])); 2004 cam_sim_free(sc->mly_cam_sim[i], 0); 2005 } 2006 } 2007 if (sc->mly_cam_devq != NULL) 2008 cam_simq_free(sc->mly_cam_devq); 2009} 2010 2011/************************************************************************ 2012 * Rescan a device. 2013 */ 2014static void 2015mly_cam_rescan_btl(struct mly_softc *sc, int bus, int target) 2016{ 2017 union ccb *ccb; 2018 2019 debug_called(1); 2020 2021 if ((ccb = malloc(sizeof(union ccb), M_TEMP, M_WAITOK | M_ZERO)) == NULL) { 2022 mly_printf(sc, "rescan failed (can't allocate CCB)\n"); 2023 return; 2024 } 2025 2026 if (xpt_create_path(&sc->mly_cam_path, xpt_periph, 2027 cam_sim_path(sc->mly_cam_sim[bus]), target, 0) != CAM_REQ_CMP) { 2028 mly_printf(sc, "rescan failed (can't create path)\n"); 2029 free(ccb, M_TEMP); 2030 return; 2031 } 2032 xpt_setup_ccb(&ccb->ccb_h, sc->mly_cam_path, 5/*priority (low)*/); 2033 ccb->ccb_h.func_code = XPT_SCAN_LUN; 2034 ccb->ccb_h.cbfcnp = mly_cam_rescan_callback; 2035 ccb->crcn.flags = CAM_FLAG_NONE; 2036 debug(1, "rescan target %d:%d", bus, target); 2037 xpt_action(ccb); 2038} 2039 2040static void 2041mly_cam_rescan_callback(struct cam_periph *periph, union ccb *ccb) 2042{ 2043 free(ccb, M_TEMP); 2044} 2045 2046/******************************************************************************** 2047 * Handle an action requested by CAM 2048 */ 2049static void 2050mly_cam_action(struct cam_sim *sim, union ccb *ccb) 2051{ 2052 struct mly_softc *sc = cam_sim_softc(sim); 2053 2054 debug_called(2); 2055 2056 switch (ccb->ccb_h.func_code) { 2057 2058 /* perform SCSI I/O */ 2059 case XPT_SCSI_IO: 2060 if (!mly_cam_action_io(sim, (struct ccb_scsiio *)&ccb->csio)) 2061 return; 2062 break; 2063 2064 /* perform geometry calculations */ 2065 case XPT_CALC_GEOMETRY: 2066 { 2067 struct ccb_calc_geometry *ccg = &ccb->ccg; 2068 u_int32_t secs_per_cylinder; 2069 2070 debug(2, "XPT_CALC_GEOMETRY %d:%d:%d", cam_sim_bus(sim), ccb->ccb_h.target_id, ccb->ccb_h.target_lun); 2071 2072 if (sc->mly_controllerparam->bios_geometry == MLY_BIOSGEOM_8G) { 2073 ccg->heads = 255; 2074 ccg->secs_per_track = 63; 2075 } else { /* MLY_BIOSGEOM_2G */ 2076 ccg->heads = 128; 2077 ccg->secs_per_track = 32; 2078 } 2079 secs_per_cylinder = ccg->heads * ccg->secs_per_track; 2080 ccg->cylinders = ccg->volume_size / secs_per_cylinder; 2081 ccb->ccb_h.status = CAM_REQ_CMP; 2082 break; 2083 } 2084 2085 /* handle path attribute inquiry */ 2086 case XPT_PATH_INQ: 2087 { 2088 struct ccb_pathinq *cpi = &ccb->cpi; 2089 2090 debug(2, "XPT_PATH_INQ %d:%d:%d", cam_sim_bus(sim), ccb->ccb_h.target_id, ccb->ccb_h.target_lun); 2091 2092 cpi->version_num = 1; 2093 cpi->hba_inquiry = PI_TAG_ABLE; /* XXX extra flags for physical channels? */ 2094 cpi->target_sprt = 0; 2095 cpi->hba_misc = 0; 2096 cpi->max_target = MLY_MAX_TARGETS - 1; 2097 cpi->max_lun = MLY_MAX_LUNS - 1; 2098 cpi->initiator_id = sc->mly_controllerparam->initiator_id; 2099 strncpy(cpi->sim_vid, "FreeBSD", SIM_IDLEN); 2100 strncpy(cpi->hba_vid, "FreeBSD", HBA_IDLEN); 2101 strncpy(cpi->dev_name, cam_sim_name(sim), DEV_IDLEN); 2102 cpi->unit_number = cam_sim_unit(sim); 2103 cpi->bus_id = cam_sim_bus(sim); 2104 cpi->base_transfer_speed = 132 * 1024; /* XXX what to set this to? */ 2105 ccb->ccb_h.status = CAM_REQ_CMP; 2106 break; 2107 } 2108 2109 case XPT_GET_TRAN_SETTINGS: 2110 { 2111 struct ccb_trans_settings *cts = &ccb->cts; 2112 int bus, target; 2113 2114 bus = cam_sim_bus(sim); 2115 target = cts->ccb_h.target_id; 2116 /* XXX validate bus/target? */ 2117 2118 debug(2, "XPT_GET_TRAN_SETTINGS %d:%d", bus, target); 2119 cts->valid = 0; 2120 2121 /* logical device? */ 2122 if (sc->mly_btl[bus][target].mb_flags & MLY_BTL_LOGICAL) { 2123 /* nothing special for these */ 2124 2125 /* physical device? */ 2126 } else if (sc->mly_btl[bus][target].mb_flags & MLY_BTL_PHYSICAL) { 2127 /* allow CAM to try tagged transactions */ 2128 cts->flags |= CCB_TRANS_TAG_ENB; 2129 cts->valid |= CCB_TRANS_TQ_VALID; 2130 2131 /* convert speed (MHz) to usec */ 2132 if (sc->mly_btl[bus][target].mb_speed == 0) { 2133 cts->sync_period = 1000000 / 5; 2134 } else { 2135 cts->sync_period = 1000000 / sc->mly_btl[bus][target].mb_speed; 2136 } 2137 2138 /* convert bus width to CAM internal encoding */ 2139 switch (sc->mly_btl[bus][target].mb_width) { 2140 case 32: 2141 cts->bus_width = MSG_EXT_WDTR_BUS_32_BIT; 2142 break; 2143 case 16: 2144 cts->bus_width = MSG_EXT_WDTR_BUS_16_BIT; 2145 break; 2146 case 8: 2147 default: 2148 cts->bus_width = MSG_EXT_WDTR_BUS_8_BIT; 2149 break; 2150 } 2151 cts->valid |= CCB_TRANS_SYNC_RATE_VALID | CCB_TRANS_BUS_WIDTH_VALID; 2152 2153 /* not a device, bail out */ 2154 } else { 2155 cts->ccb_h.status = CAM_REQ_CMP_ERR; 2156 break; 2157 } 2158 2159 /* disconnect always OK */ 2160 cts->flags |= CCB_TRANS_DISC_ENB; 2161 cts->valid |= CCB_TRANS_DISC_VALID; 2162 2163 cts->ccb_h.status = CAM_REQ_CMP; 2164 break; 2165 } 2166 2167 default: /* we can't do this */ 2168 debug(2, "unspported func_code = 0x%x", ccb->ccb_h.func_code); 2169 ccb->ccb_h.status = CAM_REQ_INVALID; 2170 break; 2171 } 2172 2173 xpt_done(ccb); 2174} 2175 2176/******************************************************************************** 2177 * Handle an I/O operation requested by CAM 2178 */ 2179static int 2180mly_cam_action_io(struct cam_sim *sim, struct ccb_scsiio *csio) 2181{ 2182 struct mly_softc *sc = cam_sim_softc(sim); 2183 struct mly_command *mc; 2184 struct mly_command_scsi_small *ss; 2185 int bus, target; 2186 int error; 2187 int s; 2188 2189 bus = cam_sim_bus(sim); 2190 target = csio->ccb_h.target_id; 2191 2192 debug(2, "XPT_SCSI_IO %d:%d:%d", bus, target, csio->ccb_h.target_lun); 2193 2194 /* validate bus number */ 2195 if (!MLY_BUS_IS_VALID(sc, bus)) { 2196 debug(0, " invalid bus %d", bus); 2197 csio->ccb_h.status = CAM_REQ_CMP_ERR; 2198 } 2199 2200 /* check for I/O attempt to a protected device */ 2201 if (sc->mly_btl[bus][target].mb_flags & MLY_BTL_PROTECTED) { 2202 debug(2, " device protected"); 2203 csio->ccb_h.status = CAM_REQ_CMP_ERR; 2204 } 2205 2206 /* check for I/O attempt to nonexistent device */ 2207 if (!(sc->mly_btl[bus][target].mb_flags & (MLY_BTL_LOGICAL | MLY_BTL_PHYSICAL))) { 2208 debug(2, " device %d:%d does not exist", bus, target); 2209 csio->ccb_h.status = CAM_REQ_CMP_ERR; 2210 } 2211 2212 /* XXX increase if/when we support large SCSI commands */ 2213 if (csio->cdb_len > MLY_CMD_SCSI_SMALL_CDB) { 2214 debug(0, " command too large (%d > %d)", csio->cdb_len, MLY_CMD_SCSI_SMALL_CDB); 2215 csio->ccb_h.status = CAM_REQ_CMP_ERR; 2216 } 2217 2218 /* check that the CDB pointer is not to a physical address */ 2219 if ((csio->ccb_h.flags & CAM_CDB_POINTER) && (csio->ccb_h.flags & CAM_CDB_PHYS)) { 2220 debug(0, " CDB pointer is to physical address"); 2221 csio->ccb_h.status = CAM_REQ_CMP_ERR; 2222 } 2223 2224 /* if there is data transfer, it must be to/from a virtual address */ 2225 if ((csio->ccb_h.flags & CAM_DIR_MASK) != CAM_DIR_NONE) { 2226 if (csio->ccb_h.flags & CAM_DATA_PHYS) { /* we can't map it */ 2227 debug(0, " data pointer is to physical address"); 2228 csio->ccb_h.status = CAM_REQ_CMP_ERR; 2229 } 2230 if (csio->ccb_h.flags & CAM_SCATTER_VALID) { /* we want to do the s/g setup */ 2231 debug(0, " data has premature s/g setup"); 2232 csio->ccb_h.status = CAM_REQ_CMP_ERR; 2233 } 2234 } 2235 2236 /* abandon aborted ccbs or those that have failed validation */ 2237 if ((csio->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_INPROG) { 2238 debug(2, "abandoning CCB due to abort/validation failure"); 2239 return(EINVAL); 2240 } 2241 2242 /* 2243 * Get a command, or push the ccb back to CAM and freeze the queue. 2244 */ 2245 if ((error = mly_alloc_command(sc, &mc))) { 2246 s = splcam(); 2247 xpt_freeze_simq(sim, 1); 2248 csio->ccb_h.status |= CAM_REQUEUE_REQ; 2249 sc->mly_qfrzn_cnt++; 2250 splx(s); 2251 return(error); 2252 } 2253 2254 /* build the command */ 2255 mc->mc_data = csio->data_ptr; 2256 mc->mc_length = csio->dxfer_len; 2257 mc->mc_complete = mly_cam_complete; 2258 mc->mc_private = csio; 2259 2260 /* save the bus number in the ccb for later recovery XXX should be a better way */ 2261 csio->ccb_h.sim_priv.entries[0].field = bus; 2262 2263 /* build the packet for the controller */ 2264 ss = &mc->mc_packet->scsi_small; 2265 ss->opcode = MDACMD_SCSI; 2266 if (csio->ccb_h.flags & CAM_DIS_DISCONNECT) 2267 ss->command_control.disable_disconnect = 1; 2268 if ((csio->ccb_h.flags & CAM_DIR_MASK) == CAM_DIR_OUT) 2269 ss->command_control.data_direction = MLY_CCB_WRITE; 2270 ss->data_size = csio->dxfer_len; 2271 ss->addr.phys.lun = csio->ccb_h.target_lun; 2272 ss->addr.phys.target = csio->ccb_h.target_id; 2273 ss->addr.phys.channel = bus; 2274 if (csio->ccb_h.timeout < (60 * 1000)) { 2275 ss->timeout.value = csio->ccb_h.timeout / 1000; 2276 ss->timeout.scale = MLY_TIMEOUT_SECONDS; 2277 } else if (csio->ccb_h.timeout < (60 * 60 * 1000)) { 2278 ss->timeout.value = csio->ccb_h.timeout / (60 * 1000); 2279 ss->timeout.scale = MLY_TIMEOUT_MINUTES; 2280 } else { 2281 ss->timeout.value = csio->ccb_h.timeout / (60 * 60 * 1000); /* overflow? */ 2282 ss->timeout.scale = MLY_TIMEOUT_HOURS; 2283 } 2284 ss->maximum_sense_size = csio->sense_len; 2285 ss->cdb_length = csio->cdb_len; 2286 if (csio->ccb_h.flags & CAM_CDB_POINTER) { 2287 bcopy(csio->cdb_io.cdb_ptr, ss->cdb, csio->cdb_len); 2288 } else { 2289 bcopy(csio->cdb_io.cdb_bytes, ss->cdb, csio->cdb_len); 2290 } 2291 2292 /* give the command to the controller */ 2293 if ((error = mly_start(mc))) { 2294 s = splcam(); 2295 xpt_freeze_simq(sim, 1); 2296 csio->ccb_h.status |= CAM_REQUEUE_REQ; 2297 sc->mly_qfrzn_cnt++; 2298 splx(s); 2299 return(error); 2300 } 2301 2302 return(0); 2303} 2304 2305/******************************************************************************** 2306 * Check for possibly-completed commands. 2307 */ 2308static void 2309mly_cam_poll(struct cam_sim *sim) 2310{ 2311 struct mly_softc *sc = cam_sim_softc(sim); 2312 2313 debug_called(2); 2314 2315 mly_done(sc); 2316} 2317 2318/******************************************************************************** 2319 * Handle completion of a command - pass results back through the CCB 2320 */ 2321static void 2322mly_cam_complete(struct mly_command *mc) 2323{ 2324 struct mly_softc *sc = mc->mc_sc; 2325 struct ccb_scsiio *csio = (struct ccb_scsiio *)mc->mc_private; 2326 struct scsi_inquiry_data *inq = (struct scsi_inquiry_data *)csio->data_ptr; 2327 struct mly_btl *btl; 2328 u_int8_t cmd; 2329 int bus, target; 2330 int s; 2331 2332 debug_called(2); 2333 2334 csio->scsi_status = mc->mc_status; 2335 switch(mc->mc_status) { 2336 case SCSI_STATUS_OK: 2337 /* 2338 * In order to report logical device type and status, we overwrite 2339 * the result of the INQUIRY command to logical devices. 2340 */ 2341 bus = csio->ccb_h.sim_priv.entries[0].field; 2342 target = csio->ccb_h.target_id; 2343 /* XXX validate bus/target? */ 2344 if (sc->mly_btl[bus][target].mb_flags & MLY_BTL_LOGICAL) { 2345 if (csio->ccb_h.flags & CAM_CDB_POINTER) { 2346 cmd = *csio->cdb_io.cdb_ptr; 2347 } else { 2348 cmd = csio->cdb_io.cdb_bytes[0]; 2349 } 2350 if (cmd == INQUIRY) { 2351 btl = &sc->mly_btl[bus][target]; 2352 padstr(inq->vendor, mly_describe_code(mly_table_device_type, btl->mb_type), 8); 2353 padstr(inq->product, mly_describe_code(mly_table_device_state, btl->mb_state), 16); 2354 padstr(inq->revision, "", 4); 2355 } 2356 } 2357 2358 debug(2, "SCSI_STATUS_OK"); 2359 csio->ccb_h.status = CAM_REQ_CMP; 2360 break; 2361 2362 case SCSI_STATUS_CHECK_COND: 2363 debug(1, "SCSI_STATUS_CHECK_COND sense %d resid %d", mc->mc_sense, mc->mc_resid); 2364 csio->ccb_h.status = CAM_SCSI_STATUS_ERROR; 2365 bzero(&csio->sense_data, SSD_FULL_SIZE); 2366 bcopy(mc->mc_packet, &csio->sense_data, mc->mc_sense); 2367 csio->sense_len = mc->mc_sense; 2368 csio->ccb_h.status |= CAM_AUTOSNS_VALID; 2369 csio->resid = mc->mc_resid; /* XXX this is a signed value... */ 2370 break; 2371 2372 case SCSI_STATUS_BUSY: 2373 debug(1, "SCSI_STATUS_BUSY"); 2374 csio->ccb_h.status = CAM_SCSI_BUSY; 2375 break; 2376 2377 default: 2378 debug(1, "unknown status 0x%x", csio->scsi_status); 2379 csio->ccb_h.status = CAM_REQ_CMP_ERR; 2380 break; 2381 } 2382 2383 s = splcam(); 2384 if (sc->mly_qfrzn_cnt) { 2385 csio->ccb_h.status |= CAM_RELEASE_SIMQ; 2386 sc->mly_qfrzn_cnt--; 2387 } 2388 splx(s); 2389 2390 xpt_done((union ccb *)csio); 2391 mly_release_command(mc); 2392} 2393 2394/******************************************************************************** 2395 * Find a peripheral attahed at (bus),(target) 2396 */ 2397static struct cam_periph * 2398mly_find_periph(struct mly_softc *sc, int bus, int target) 2399{ 2400 struct cam_periph *periph; 2401 struct cam_path *path; 2402 int status; 2403 2404 status = xpt_create_path(&path, NULL, cam_sim_path(sc->mly_cam_sim[bus]), target, 0); 2405 if (status == CAM_REQ_CMP) { 2406 periph = cam_periph_find(path, NULL); 2407 xpt_free_path(path); 2408 } else { 2409 periph = NULL; 2410 } 2411 return(periph); 2412} 2413 2414/******************************************************************************** 2415 * Name the device at (bus)(target) 2416 */ 2417static int 2418mly_name_device(struct mly_softc *sc, int bus, int target) 2419{ 2420 struct cam_periph *periph; 2421 2422 if ((periph = mly_find_periph(sc, bus, target)) != NULL) { 2423 sprintf(sc->mly_btl[bus][target].mb_name, "%s%d", periph->periph_name, periph->unit_number); 2424 return(0); 2425 } 2426 sc->mly_btl[bus][target].mb_name[0] = 0; 2427 return(ENOENT); 2428} 2429 2430/******************************************************************************** 2431 ******************************************************************************** 2432 Hardware Control 2433 ******************************************************************************** 2434 ********************************************************************************/ 2435 2436/******************************************************************************** 2437 * Handshake with the firmware while the card is being initialised. 2438 */ 2439static int 2440mly_fwhandshake(struct mly_softc *sc) 2441{ 2442 u_int8_t error, param0, param1; 2443 int spinup = 0; 2444 2445 debug_called(1); 2446 2447 /* set HM_STSACK and let the firmware initialise */ 2448 MLY_SET_REG(sc, sc->mly_idbr, MLY_HM_STSACK); 2449 DELAY(1000); /* too short? */ 2450 2451 /* if HM_STSACK is still true, the controller is initialising */ 2452 if (!MLY_IDBR_TRUE(sc, MLY_HM_STSACK)) 2453 return(0); 2454 mly_printf(sc, "controller initialisation started\n"); 2455 2456 /* spin waiting for initialisation to finish, or for a message to be delivered */ 2457 while (MLY_IDBR_TRUE(sc, MLY_HM_STSACK)) { 2458 /* check for a message */ 2459 if (MLY_ERROR_VALID(sc)) { 2460 error = MLY_GET_REG(sc, sc->mly_error_status) & ~MLY_MSG_EMPTY; 2461 param0 = MLY_GET_REG(sc, sc->mly_command_mailbox); 2462 param1 = MLY_GET_REG(sc, sc->mly_command_mailbox + 1); 2463 2464 switch(error) { 2465 case MLY_MSG_SPINUP: 2466 if (!spinup) { 2467 mly_printf(sc, "drive spinup in progress\n"); 2468 spinup = 1; /* only print this once (should print drive being spun?) */ 2469 } 2470 break; 2471 case MLY_MSG_RACE_RECOVERY_FAIL: 2472 mly_printf(sc, "mirror race recovery failed, one or more drives offline\n"); 2473 break; 2474 case MLY_MSG_RACE_IN_PROGRESS: 2475 mly_printf(sc, "mirror race recovery in progress\n"); 2476 break; 2477 case MLY_MSG_RACE_ON_CRITICAL: 2478 mly_printf(sc, "mirror race recovery on a critical drive\n"); 2479 break; 2480 case MLY_MSG_PARITY_ERROR: 2481 mly_printf(sc, "FATAL MEMORY PARITY ERROR\n"); 2482 return(ENXIO); 2483 default: 2484 mly_printf(sc, "unknown initialisation code 0x%x\n", error); 2485 } 2486 } 2487 } 2488 return(0); 2489} 2490 2491/******************************************************************************** 2492 ******************************************************************************** 2493 Debugging and Diagnostics 2494 ******************************************************************************** 2495 ********************************************************************************/ 2496 2497/******************************************************************************** 2498 * Print some information about the controller. 2499 */ 2500static void 2501mly_describe_controller(struct mly_softc *sc) 2502{ 2503 struct mly_ioctl_getcontrollerinfo *mi = sc->mly_controllerinfo; 2504 2505 mly_printf(sc, "%16s, %d channel%s, firmware %d.%02d-%d-%02d (%02d%02d%02d%02d), %dMB RAM\n", 2506 mi->controller_name, mi->physical_channels_present, (mi->physical_channels_present) > 1 ? "s" : "", 2507 mi->fw_major, mi->fw_minor, mi->fw_turn, mi->fw_build, /* XXX turn encoding? */ 2508 mi->fw_century, mi->fw_year, mi->fw_month, mi->fw_day, 2509 mi->memory_size); 2510 2511 if (bootverbose) { 2512 mly_printf(sc, "%s %s (%x), %dMHz %d-bit %.16s\n", 2513 mly_describe_code(mly_table_oemname, mi->oem_information), 2514 mly_describe_code(mly_table_controllertype, mi->controller_type), mi->controller_type, 2515 mi->interface_speed, mi->interface_width, mi->interface_name); 2516 mly_printf(sc, "%dMB %dMHz %d-bit %s%s%s, cache %dMB\n", 2517 mi->memory_size, mi->memory_speed, mi->memory_width, 2518 mly_describe_code(mly_table_memorytype, mi->memory_type), 2519 mi->memory_parity ? "+parity": "",mi->memory_ecc ? "+ECC": "", 2520 mi->cache_size); 2521 mly_printf(sc, "CPU: %s @ %dMHZ\n", 2522 mly_describe_code(mly_table_cputype, mi->cpu[0].type), mi->cpu[0].speed); 2523 if (mi->l2cache_size != 0) 2524 mly_printf(sc, "%dKB L2 cache\n", mi->l2cache_size); 2525 if (mi->exmemory_size != 0) 2526 mly_printf(sc, "%dMB %dMHz %d-bit private %s%s%s\n", 2527 mi->exmemory_size, mi->exmemory_speed, mi->exmemory_width, 2528 mly_describe_code(mly_table_memorytype, mi->exmemory_type), 2529 mi->exmemory_parity ? "+parity": "",mi->exmemory_ecc ? "+ECC": ""); 2530 mly_printf(sc, "battery backup %s\n", mi->bbu_present ? "present" : "not installed"); 2531 mly_printf(sc, "maximum data transfer %d blocks, maximum sg entries/command %d\n", 2532 mi->maximum_block_count, mi->maximum_sg_entries); 2533 mly_printf(sc, "logical devices present/critical/offline %d/%d/%d\n", 2534 mi->logical_devices_present, mi->logical_devices_critical, mi->logical_devices_offline); 2535 mly_printf(sc, "physical devices present %d\n", 2536 mi->physical_devices_present); 2537 mly_printf(sc, "physical disks present/offline %d/%d\n", 2538 mi->physical_disks_present, mi->physical_disks_offline); 2539 mly_printf(sc, "%d physical channel%s, %d virtual channel%s of %d possible\n", 2540 mi->physical_channels_present, mi->physical_channels_present == 1 ? "" : "s", 2541 mi->virtual_channels_present, mi->virtual_channels_present == 1 ? "" : "s", 2542 mi->virtual_channels_possible); 2543 mly_printf(sc, "%d parallel commands supported\n", mi->maximum_parallel_commands); 2544 mly_printf(sc, "%dMB flash ROM, %d of %d maximum cycles\n", 2545 mi->flash_size, mi->flash_age, mi->flash_maximum_age); 2546 } 2547} 2548 2549#ifdef MLY_DEBUG 2550/******************************************************************************** 2551 * Print some controller state 2552 */ 2553static void 2554mly_printstate(struct mly_softc *sc) 2555{ 2556 mly_printf(sc, "IDBR %02x ODBR %02x ERROR %02x (%x %x %x)\n", 2557 MLY_GET_REG(sc, sc->mly_idbr), 2558 MLY_GET_REG(sc, sc->mly_odbr), 2559 MLY_GET_REG(sc, sc->mly_error_status), 2560 sc->mly_idbr, 2561 sc->mly_odbr, 2562 sc->mly_error_status); 2563 mly_printf(sc, "IMASK %02x ISTATUS %02x\n", 2564 MLY_GET_REG(sc, sc->mly_interrupt_mask), 2565 MLY_GET_REG(sc, sc->mly_interrupt_status)); 2566 mly_printf(sc, "COMMAND %02x %02x %02x %02x %02x %02x %02x %02x\n", 2567 MLY_GET_REG(sc, sc->mly_command_mailbox), 2568 MLY_GET_REG(sc, sc->mly_command_mailbox + 1), 2569 MLY_GET_REG(sc, sc->mly_command_mailbox + 2), 2570 MLY_GET_REG(sc, sc->mly_command_mailbox + 3), 2571 MLY_GET_REG(sc, sc->mly_command_mailbox + 4), 2572 MLY_GET_REG(sc, sc->mly_command_mailbox + 5), 2573 MLY_GET_REG(sc, sc->mly_command_mailbox + 6), 2574 MLY_GET_REG(sc, sc->mly_command_mailbox + 7)); 2575 mly_printf(sc, "STATUS %02x %02x %02x %02x %02x %02x %02x %02x\n", 2576 MLY_GET_REG(sc, sc->mly_status_mailbox), 2577 MLY_GET_REG(sc, sc->mly_status_mailbox + 1), 2578 MLY_GET_REG(sc, sc->mly_status_mailbox + 2), 2579 MLY_GET_REG(sc, sc->mly_status_mailbox + 3), 2580 MLY_GET_REG(sc, sc->mly_status_mailbox + 4), 2581 MLY_GET_REG(sc, sc->mly_status_mailbox + 5), 2582 MLY_GET_REG(sc, sc->mly_status_mailbox + 6), 2583 MLY_GET_REG(sc, sc->mly_status_mailbox + 7)); 2584 mly_printf(sc, " %04x %08x\n", 2585 MLY_GET_REG2(sc, sc->mly_status_mailbox), 2586 MLY_GET_REG4(sc, sc->mly_status_mailbox + 4)); 2587} 2588 2589struct mly_softc *mly_softc0 = NULL; 2590void 2591mly_printstate0(void) 2592{ 2593 if (mly_softc0 != NULL) 2594 mly_printstate(mly_softc0); 2595} 2596 2597/******************************************************************************** 2598 * Print a command 2599 */ 2600static void 2601mly_print_command(struct mly_command *mc) 2602{ 2603 struct mly_softc *sc = mc->mc_sc; 2604 2605 mly_printf(sc, "COMMAND @ %p\n", mc); 2606 mly_printf(sc, " slot %d\n", mc->mc_slot); 2607 mly_printf(sc, " status 0x%x\n", mc->mc_status); 2608 mly_printf(sc, " sense len %d\n", mc->mc_sense); 2609 mly_printf(sc, " resid %d\n", mc->mc_resid); 2610 mly_printf(sc, " packet %p/0x%llx\n", mc->mc_packet, mc->mc_packetphys); 2611 if (mc->mc_packet != NULL) 2612 mly_print_packet(mc); 2613 mly_printf(sc, " data %p/%d\n", mc->mc_data, mc->mc_length); 2614 mly_printf(sc, " flags %b\n", mc->mc_flags, "\20\1busy\2complete\3slotted\4mapped\5datain\6dataout\n"); 2615 mly_printf(sc, " complete %p\n", mc->mc_complete); 2616 mly_printf(sc, " private %p\n", mc->mc_private); 2617} 2618 2619/******************************************************************************** 2620 * Print a command packet 2621 */ 2622static void 2623mly_print_packet(struct mly_command *mc) 2624{ 2625 struct mly_softc *sc = mc->mc_sc; 2626 struct mly_command_generic *ge = (struct mly_command_generic *)mc->mc_packet; 2627 struct mly_command_scsi_small *ss = (struct mly_command_scsi_small *)mc->mc_packet; 2628 struct mly_command_scsi_large *sl = (struct mly_command_scsi_large *)mc->mc_packet; 2629 struct mly_command_ioctl *io = (struct mly_command_ioctl *)mc->mc_packet; 2630 int transfer; 2631 2632 mly_printf(sc, " command_id %d\n", ge->command_id); 2633 mly_printf(sc, " opcode %d\n", ge->opcode); 2634 mly_printf(sc, " command_control fua %d dpo %d est %d dd %s nas %d ddis %d\n", 2635 ge->command_control.force_unit_access, 2636 ge->command_control.disable_page_out, 2637 ge->command_control.extended_sg_table, 2638 (ge->command_control.data_direction == MLY_CCB_WRITE) ? "WRITE" : "READ", 2639 ge->command_control.no_auto_sense, 2640 ge->command_control.disable_disconnect); 2641 mly_printf(sc, " data_size %d\n", ge->data_size); 2642 mly_printf(sc, " sense_buffer_address 0x%llx\n", ge->sense_buffer_address); 2643 mly_printf(sc, " lun %d\n", ge->addr.phys.lun); 2644 mly_printf(sc, " target %d\n", ge->addr.phys.target); 2645 mly_printf(sc, " channel %d\n", ge->addr.phys.channel); 2646 mly_printf(sc, " logical device %d\n", ge->addr.log.logdev); 2647 mly_printf(sc, " controller %d\n", ge->addr.phys.controller); 2648 mly_printf(sc, " timeout %d %s\n", 2649 ge->timeout.value, 2650 (ge->timeout.scale == MLY_TIMEOUT_SECONDS) ? "seconds" : 2651 ((ge->timeout.scale == MLY_TIMEOUT_MINUTES) ? "minutes" : "hours")); 2652 mly_printf(sc, " maximum_sense_size %d\n", ge->maximum_sense_size); 2653 switch(ge->opcode) { 2654 case MDACMD_SCSIPT: 2655 case MDACMD_SCSI: 2656 mly_printf(sc, " cdb length %d\n", ss->cdb_length); 2657 mly_printf(sc, " cdb %*D\n", ss->cdb_length, ss->cdb, " "); 2658 transfer = 1; 2659 break; 2660 case MDACMD_SCSILC: 2661 case MDACMD_SCSILCPT: 2662 mly_printf(sc, " cdb length %d\n", sl->cdb_length); 2663 mly_printf(sc, " cdb 0x%llx\n", sl->cdb_physaddr); 2664 transfer = 1; 2665 break; 2666 case MDACMD_IOCTL: 2667 mly_printf(sc, " sub_ioctl 0x%x\n", io->sub_ioctl); 2668 switch(io->sub_ioctl) { 2669 case MDACIOCTL_SETMEMORYMAILBOX: 2670 mly_printf(sc, " health_buffer_size %d\n", 2671 io->param.setmemorymailbox.health_buffer_size); 2672 mly_printf(sc, " health_buffer_phys 0x%llx\n", 2673 io->param.setmemorymailbox.health_buffer_physaddr); 2674 mly_printf(sc, " command_mailbox 0x%llx\n", 2675 io->param.setmemorymailbox.command_mailbox_physaddr); 2676 mly_printf(sc, " status_mailbox 0x%llx\n", 2677 io->param.setmemorymailbox.status_mailbox_physaddr); 2678 transfer = 0; 2679 break; 2680 2681 case MDACIOCTL_SETREALTIMECLOCK: 2682 case MDACIOCTL_GETHEALTHSTATUS: 2683 case MDACIOCTL_GETCONTROLLERINFO: 2684 case MDACIOCTL_GETLOGDEVINFOVALID: 2685 case MDACIOCTL_GETPHYSDEVINFOVALID: 2686 case MDACIOCTL_GETPHYSDEVSTATISTICS: 2687 case MDACIOCTL_GETLOGDEVSTATISTICS: 2688 case MDACIOCTL_GETCONTROLLERSTATISTICS: 2689 case MDACIOCTL_GETBDT_FOR_SYSDRIVE: 2690 case MDACIOCTL_CREATENEWCONF: 2691 case MDACIOCTL_ADDNEWCONF: 2692 case MDACIOCTL_GETDEVCONFINFO: 2693 case MDACIOCTL_GETFREESPACELIST: 2694 case MDACIOCTL_MORE: 2695 case MDACIOCTL_SETPHYSDEVPARAMETER: 2696 case MDACIOCTL_GETPHYSDEVPARAMETER: 2697 case MDACIOCTL_GETLOGDEVPARAMETER: 2698 case MDACIOCTL_SETLOGDEVPARAMETER: 2699 mly_printf(sc, " param %10D\n", io->param.data.param, " "); 2700 transfer = 1; 2701 break; 2702 2703 case MDACIOCTL_GETEVENT: 2704 mly_printf(sc, " event %d\n", 2705 io->param.getevent.sequence_number_low + ((u_int32_t)io->addr.log.logdev << 16)); 2706 transfer = 1; 2707 break; 2708 2709 case MDACIOCTL_SETRAIDDEVSTATE: 2710 mly_printf(sc, " state %d\n", io->param.setraiddevstate.state); 2711 transfer = 0; 2712 break; 2713 2714 case MDACIOCTL_XLATEPHYSDEVTORAIDDEV: 2715 mly_printf(sc, " raid_device %d\n", io->param.xlatephysdevtoraiddev.raid_device); 2716 mly_printf(sc, " controller %d\n", io->param.xlatephysdevtoraiddev.controller); 2717 mly_printf(sc, " channel %d\n", io->param.xlatephysdevtoraiddev.channel); 2718 mly_printf(sc, " target %d\n", io->param.xlatephysdevtoraiddev.target); 2719 mly_printf(sc, " lun %d\n", io->param.xlatephysdevtoraiddev.lun); 2720 transfer = 0; 2721 break; 2722 2723 case MDACIOCTL_GETGROUPCONFINFO: 2724 mly_printf(sc, " group %d\n", io->param.getgroupconfinfo.group); 2725 transfer = 1; 2726 break; 2727 2728 case MDACIOCTL_GET_SUBSYSTEM_DATA: 2729 case MDACIOCTL_SET_SUBSYSTEM_DATA: 2730 case MDACIOCTL_STARTDISOCVERY: 2731 case MDACIOCTL_INITPHYSDEVSTART: 2732 case MDACIOCTL_INITPHYSDEVSTOP: 2733 case MDACIOCTL_INITRAIDDEVSTART: 2734 case MDACIOCTL_INITRAIDDEVSTOP: 2735 case MDACIOCTL_REBUILDRAIDDEVSTART: 2736 case MDACIOCTL_REBUILDRAIDDEVSTOP: 2737 case MDACIOCTL_MAKECONSISTENTDATASTART: 2738 case MDACIOCTL_MAKECONSISTENTDATASTOP: 2739 case MDACIOCTL_CONSISTENCYCHECKSTART: 2740 case MDACIOCTL_CONSISTENCYCHECKSTOP: 2741 case MDACIOCTL_RESETDEVICE: 2742 case MDACIOCTL_FLUSHDEVICEDATA: 2743 case MDACIOCTL_PAUSEDEVICE: 2744 case MDACIOCTL_UNPAUSEDEVICE: 2745 case MDACIOCTL_LOCATEDEVICE: 2746 case MDACIOCTL_SETMASTERSLAVEMODE: 2747 case MDACIOCTL_DELETERAIDDEV: 2748 case MDACIOCTL_REPLACEINTERNALDEV: 2749 case MDACIOCTL_CLEARCONF: 2750 case MDACIOCTL_GETCONTROLLERPARAMETER: 2751 case MDACIOCTL_SETCONTRLLERPARAMETER: 2752 case MDACIOCTL_CLEARCONFSUSPMODE: 2753 case MDACIOCTL_STOREIMAGE: 2754 case MDACIOCTL_READIMAGE: 2755 case MDACIOCTL_FLASHIMAGES: 2756 case MDACIOCTL_RENAMERAIDDEV: 2757 default: /* no idea what to print */ 2758 transfer = 0; 2759 break; 2760 } 2761 break; 2762 2763 case MDACMD_IOCTLCHECK: 2764 case MDACMD_MEMCOPY: 2765 default: 2766 transfer = 0; 2767 break; /* print nothing */ 2768 } 2769 if (transfer) { 2770 if (ge->command_control.extended_sg_table) { 2771 mly_printf(sc, " sg table 0x%llx/%d\n", 2772 ge->transfer.indirect.table_physaddr[0], ge->transfer.indirect.entries[0]); 2773 } else { 2774 mly_printf(sc, " 0000 0x%llx/%lld\n", 2775 ge->transfer.direct.sg[0].physaddr, ge->transfer.direct.sg[0].length); 2776 mly_printf(sc, " 0001 0x%llx/%lld\n", 2777 ge->transfer.direct.sg[1].physaddr, ge->transfer.direct.sg[1].length); 2778 } 2779 } 2780} 2781 2782/******************************************************************************** 2783 * Panic in a slightly informative fashion 2784 */ 2785static void 2786mly_panic(struct mly_softc *sc, char *reason) 2787{ 2788 mly_printstate(sc); 2789 panic(reason); 2790} 2791 2792/******************************************************************************** 2793 * Print queue statistics, callable from DDB. 2794 */ 2795void 2796mly_print_controller(int controller) 2797{ 2798 struct mly_softc *sc; 2799 2800 if ((sc = devclass_get_softc(devclass_find("mly"), controller)) == NULL) { 2801 printf("mly: controller %d invalid\n", controller); 2802 } else { 2803 device_printf(sc->mly_dev, "queue curr max\n"); 2804 device_printf(sc->mly_dev, "free %04d/%04d\n", 2805 sc->mly_qstat[MLYQ_FREE].q_length, sc->mly_qstat[MLYQ_FREE].q_max); 2806 device_printf(sc->mly_dev, "busy %04d/%04d\n", 2807 sc->mly_qstat[MLYQ_BUSY].q_length, sc->mly_qstat[MLYQ_BUSY].q_max); 2808 device_printf(sc->mly_dev, "complete %04d/%04d\n", 2809 sc->mly_qstat[MLYQ_COMPLETE].q_length, sc->mly_qstat[MLYQ_COMPLETE].q_max); 2810 } 2811} 2812#endif 2813 2814 2815/******************************************************************************** 2816 ******************************************************************************** 2817 Control device interface 2818 ******************************************************************************** 2819 ********************************************************************************/ 2820 2821/******************************************************************************** 2822 * Accept an open operation on the control device. 2823 */ 2824static int 2825mly_user_open(struct cdev *dev, int flags, int fmt, struct thread *td) 2826{ 2827 int unit = minor(dev); 2828 struct mly_softc *sc = devclass_get_softc(devclass_find("mly"), unit); 2829 2830 sc->mly_state |= MLY_STATE_OPEN; 2831 return(0); 2832} 2833 2834/******************************************************************************** 2835 * Accept the last close on the control device. 2836 */ 2837static int 2838mly_user_close(struct cdev *dev, int flags, int fmt, struct thread *td) 2839{ 2840 int unit = minor(dev); 2841 struct mly_softc *sc = devclass_get_softc(devclass_find("mly"), unit); 2842 2843 sc->mly_state &= ~MLY_STATE_OPEN; 2844 return (0); 2845} 2846 2847/******************************************************************************** 2848 * Handle controller-specific control operations. 2849 */ 2850static int 2851mly_user_ioctl(struct cdev *dev, u_long cmd, caddr_t addr, 2852 int32_t flag, struct thread *td) 2853{ 2854 struct mly_softc *sc = (struct mly_softc *)dev->si_drv1; 2855 struct mly_user_command *uc = (struct mly_user_command *)addr; 2856 struct mly_user_health *uh = (struct mly_user_health *)addr; 2857 2858 switch(cmd) { 2859 case MLYIO_COMMAND: 2860 return(mly_user_command(sc, uc)); 2861 case MLYIO_HEALTH: 2862 return(mly_user_health(sc, uh)); 2863 default: 2864 return(ENOIOCTL); 2865 } 2866} 2867 2868/******************************************************************************** 2869 * Execute a command passed in from userspace. 2870 * 2871 * The control structure contains the actual command for the controller, as well 2872 * as the user-space data pointer and data size, and an optional sense buffer 2873 * size/pointer. On completion, the data size is adjusted to the command 2874 * residual, and the sense buffer size to the size of the returned sense data. 2875 * 2876 */ 2877static int 2878mly_user_command(struct mly_softc *sc, struct mly_user_command *uc) 2879{ 2880 struct mly_command *mc; 2881 int error, s; 2882 2883 /* allocate a command */ 2884 if (mly_alloc_command(sc, &mc)) { 2885 error = ENOMEM; 2886 goto out; /* XXX Linux version will wait for a command */ 2887 } 2888 2889 /* handle data size/direction */ 2890 mc->mc_length = (uc->DataTransferLength >= 0) ? uc->DataTransferLength : -uc->DataTransferLength; 2891 if (mc->mc_length > 0) { 2892 if ((mc->mc_data = malloc(mc->mc_length, M_DEVBUF, M_NOWAIT)) == NULL) { 2893 error = ENOMEM; 2894 goto out; 2895 } 2896 } 2897 if (uc->DataTransferLength > 0) { 2898 mc->mc_flags |= MLY_CMD_DATAIN; 2899 bzero(mc->mc_data, mc->mc_length); 2900 } 2901 if (uc->DataTransferLength < 0) { 2902 mc->mc_flags |= MLY_CMD_DATAOUT; 2903 if ((error = copyin(uc->DataTransferBuffer, mc->mc_data, mc->mc_length)) != 0) 2904 goto out; 2905 } 2906 2907 /* copy the controller command */ 2908 bcopy(&uc->CommandMailbox, mc->mc_packet, sizeof(uc->CommandMailbox)); 2909 2910 /* clear command completion handler so that we get woken up */ 2911 mc->mc_complete = NULL; 2912 2913 /* execute the command */ 2914 if ((error = mly_start(mc)) != 0) 2915 goto out; 2916 s = splcam(); 2917 while (!(mc->mc_flags & MLY_CMD_COMPLETE)) 2918 tsleep(mc, PRIBIO, "mlyioctl", 0); 2919 splx(s); 2920 2921 /* return the data to userspace */ 2922 if (uc->DataTransferLength > 0) 2923 if ((error = copyout(mc->mc_data, uc->DataTransferBuffer, mc->mc_length)) != 0) 2924 goto out; 2925 2926 /* return the sense buffer to userspace */ 2927 if ((uc->RequestSenseLength > 0) && (mc->mc_sense > 0)) { 2928 if ((error = copyout(mc->mc_packet, uc->RequestSenseBuffer, 2929 min(uc->RequestSenseLength, mc->mc_sense))) != 0) 2930 goto out; 2931 } 2932 2933 /* return command results to userspace (caller will copy out) */ 2934 uc->DataTransferLength = mc->mc_resid; 2935 uc->RequestSenseLength = min(uc->RequestSenseLength, mc->mc_sense); 2936 uc->CommandStatus = mc->mc_status; 2937 error = 0; 2938 2939 out: 2940 if (mc->mc_data != NULL) 2941 free(mc->mc_data, M_DEVBUF); 2942 if (mc != NULL) 2943 mly_release_command(mc); 2944 return(error); 2945} 2946 2947/******************************************************************************** 2948 * Return health status to userspace. If the health change index in the user 2949 * structure does not match that currently exported by the controller, we 2950 * return the current status immediately. Otherwise, we block until either 2951 * interrupted or new status is delivered. 2952 */ 2953static int 2954mly_user_health(struct mly_softc *sc, struct mly_user_health *uh) 2955{ 2956 struct mly_health_status mh; 2957 int error, s; 2958 2959 /* fetch the current health status from userspace */ 2960 if ((error = copyin(uh->HealthStatusBuffer, &mh, sizeof(mh))) != 0) 2961 return(error); 2962 2963 /* spin waiting for a status update */ 2964 s = splcam(); 2965 error = EWOULDBLOCK; 2966 while ((error != 0) && (sc->mly_event_change == mh.change_counter)) 2967 error = tsleep(&sc->mly_event_change, PRIBIO | PCATCH, "mlyhealth", 0); 2968 splx(s); 2969 2970 /* copy the controller's health status buffer out (there is a race here if it changes again) */ 2971 error = copyout(&sc->mly_mmbox->mmm_health.status, uh->HealthStatusBuffer, 2972 sizeof(uh->HealthStatusBuffer)); 2973 return(error); 2974} 2975 2976static int 2977mly_timeout(struct mly_softc *sc) 2978{ 2979 struct mly_command *mc; 2980 int deadline; 2981 2982 deadline = time_second - MLY_CMD_TIMEOUT; 2983 TAILQ_FOREACH(mc, &sc->mly_busy, mc_link) { 2984 if ((mc->mc_timestamp < deadline)) { 2985 device_printf(sc->mly_dev, 2986 "COMMAND %p TIMEOUT AFTER %d SECONDS\n", mc, 2987 (int)(time_second - mc->mc_timestamp)); 2988 } 2989 } 2990 2991 timeout((timeout_t *)mly_timeout, sc, MLY_CMD_TIMEOUT * hz); 2992 2993 return (0); 2994} 2995