1 /*- 2 * Copyright (c) 2009 Alexander Motin <mav@FreeBSD.org> 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions 7 * are met: 8 * 1. Redistributions of source code must retain the above copyright 9 * notice, this list of conditions and the following disclaimer, 10 * without modification, immediately at the beginning of the file. 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 ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 25 */ 26 27 #include <sys/cdefs.h> 28 __FBSDID("$FreeBSD$"); 29 30 #include <sys/param.h> 31 #include <sys/bus.h> 32 #include <sys/endian.h> 33 #include <sys/systm.h> 34 #include <sys/types.h> 35 #include <sys/malloc.h> 36 #include <sys/kernel.h> 37 #include <sys/time.h> 38 #include <sys/conf.h> 39 #include <sys/fcntl.h> 40 #include <sys/interrupt.h> 41 #include <sys/sbuf.h> 42 43 #include <sys/lock.h> 44 #include <sys/mutex.h> 45 #include <sys/sysctl.h> 46 47 #include <cam/cam.h> 48 #include <cam/cam_ccb.h> 49 #include <cam/cam_queue.h> 50 #include <cam/cam_periph.h> 51 #include <cam/cam_sim.h> 52 #include <cam/cam_xpt.h> 53 #include <cam/cam_xpt_sim.h> 54 #include <cam/cam_xpt_periph.h> 55 #include <cam/cam_xpt_internal.h> 56 #include <cam/cam_debug.h> 57 58 #include <cam/scsi/scsi_all.h> 59 #include <cam/scsi/scsi_message.h> 60 #include <cam/ata/ata_all.h> 61 #include <machine/stdarg.h> /* for xpt_print below */ 62 #include "opt_cam.h" 63 64 struct ata_quirk_entry { 65 struct scsi_inquiry_pattern inq_pat; 66 u_int8_t quirks; 67 #define CAM_QUIRK_MAXTAGS 0x01 68 u_int maxtags; 69 }; 70 71 static periph_init_t probe_periph_init; 72 73 static struct periph_driver probe_driver = 74 { 75 probe_periph_init, "aprobe", 76 TAILQ_HEAD_INITIALIZER(probe_driver.units), /* generation */ 0, 77 CAM_PERIPH_DRV_EARLY 78 }; 79 80 PERIPHDRIVER_DECLARE(aprobe, probe_driver); 81 82 typedef enum { 83 PROBE_RESET, 84 PROBE_IDENTIFY, 85 PROBE_SPINUP, 86 PROBE_SETMODE, 87 PROBE_SETPM, 88 PROBE_SETAPST, 89 PROBE_SETDMAAA, 90 PROBE_SET_MULTI, 91 PROBE_INQUIRY, 92 PROBE_FULL_INQUIRY, 93 PROBE_PM_PID, 94 PROBE_PM_PRV, 95 PROBE_INVALID 96 } probe_action; 97 98 static char *probe_action_text[] = { 99 "PROBE_RESET", 100 "PROBE_IDENTIFY", 101 "PROBE_SPINUP", 102 "PROBE_SETMODE", 103 "PROBE_SETPM", 104 "PROBE_SETAPST", 105 "PROBE_SETDMAAA", 106 "PROBE_SET_MULTI", 107 "PROBE_INQUIRY", 108 "PROBE_FULL_INQUIRY", 109 "PROBE_PM_PID", 110 "PROBE_PM_PRV", 111 "PROBE_INVALID" 112 }; 113 114 #define PROBE_SET_ACTION(softc, newaction) \ 115 do { \ 116 char **text; \ 117 text = probe_action_text; \ 118 CAM_DEBUG((softc)->periph->path, CAM_DEBUG_INFO, \ 119 ("Probe %s to %s\n", text[(softc)->action], \ 120 text[(newaction)])); \ 121 (softc)->action = (newaction); \ 122 } while(0) 123 124 typedef enum { 125 PROBE_NO_ANNOUNCE = 0x04 126 } probe_flags; 127 128 typedef struct { 129 TAILQ_HEAD(, ccb_hdr) request_ccbs; 130 struct ata_params ident_data; 131 probe_action action; 132 probe_flags flags; 133 uint32_t pm_pid; 134 uint32_t pm_prv; 135 int restart; 136 int spinup; 137 int faults; 138 u_int caps; 139 struct cam_periph *periph; 140 } probe_softc; 141 142 static struct ata_quirk_entry ata_quirk_table[] = 143 { 144 { 145 /* Default tagged queuing parameters for all devices */ 146 { 147 T_ANY, SIP_MEDIA_REMOVABLE|SIP_MEDIA_FIXED, 148 /*vendor*/"*", /*product*/"*", /*revision*/"*" 149 }, 150 /*quirks*/0, /*maxtags*/0 151 }, 152 }; 153 154 static const int ata_quirk_table_size = 155 sizeof(ata_quirk_table) / sizeof(*ata_quirk_table); 156 157 static cam_status proberegister(struct cam_periph *periph, 158 void *arg); 159 static void probeschedule(struct cam_periph *probe_periph); 160 static void probestart(struct cam_periph *periph, union ccb *start_ccb); 161 //static void proberequestdefaultnegotiation(struct cam_periph *periph); 162 //static int proberequestbackoff(struct cam_periph *periph, 163 // struct cam_ed *device); 164 static void probedone(struct cam_periph *periph, union ccb *done_ccb); 165 static void probecleanup(struct cam_periph *periph); 166 static void ata_find_quirk(struct cam_ed *device); 167 static void ata_scan_bus(struct cam_periph *periph, union ccb *ccb); 168 static void ata_scan_lun(struct cam_periph *periph, 169 struct cam_path *path, cam_flags flags, 170 union ccb *ccb); 171 static void xptscandone(struct cam_periph *periph, union ccb *done_ccb); 172 static struct cam_ed * 173 ata_alloc_device(struct cam_eb *bus, struct cam_et *target, 174 lun_id_t lun_id); 175 static void ata_device_transport(struct cam_path *path); 176 static void ata_set_transfer_settings(struct ccb_trans_settings *cts, 177 struct cam_ed *device, 178 int async_update); 179 static void ata_dev_async(u_int32_t async_code, 180 struct cam_eb *bus, 181 struct cam_et *target, 182 struct cam_ed *device, 183 void *async_arg); 184 static void ata_action(union ccb *start_ccb); 185 static void ata_announce_periph(struct cam_periph *periph); 186 187 static struct xpt_xport ata_xport = { 188 .alloc_device = ata_alloc_device, 189 .action = ata_action, 190 .async = ata_dev_async, 191 .announce = ata_announce_periph, 192 }; 193 194 struct xpt_xport * 195 ata_get_xport(void) 196 { 197 return (&ata_xport); 198 } 199 200 static void 201 probe_periph_init() 202 { 203 } 204 205 static cam_status 206 proberegister(struct cam_periph *periph, void *arg) 207 { 208 union ccb *request_ccb; /* CCB representing the probe request */ 209 cam_status status; 210 probe_softc *softc; 211 212 request_ccb = (union ccb *)arg; 213 if (periph == NULL) { 214 printf("proberegister: periph was NULL!!\n"); 215 return(CAM_REQ_CMP_ERR); 216 } 217 218 if (request_ccb == NULL) { 219 printf("proberegister: no probe CCB, " 220 "can't register device\n"); 221 return(CAM_REQ_CMP_ERR); 222 } 223 224 softc = (probe_softc *)malloc(sizeof(*softc), M_CAMXPT, M_ZERO | M_NOWAIT); 225 226 if (softc == NULL) { 227 printf("proberegister: Unable to probe new device. " 228 "Unable to allocate softc\n"); 229 return(CAM_REQ_CMP_ERR); 230 } 231 TAILQ_INIT(&softc->request_ccbs); 232 TAILQ_INSERT_TAIL(&softc->request_ccbs, &request_ccb->ccb_h, 233 periph_links.tqe); 234 softc->flags = 0; 235 periph->softc = softc; 236 softc->periph = periph; 237 softc->action = PROBE_INVALID; 238 status = cam_periph_acquire(periph); 239 if (status != CAM_REQ_CMP) { 240 return (status); 241 } 242 /* 243 * Ensure nobody slip in until probe finish. 244 */ 245 cam_freeze_devq_arg(periph->path, 246 RELSIM_RELEASE_RUNLEVEL, CAM_RL_XPT + 1); 247 probeschedule(periph); 248 return(CAM_REQ_CMP); 249 } 250 251 static void 252 probeschedule(struct cam_periph *periph) 253 { 254 union ccb *ccb; 255 probe_softc *softc; 256 257 softc = (probe_softc *)periph->softc; 258 ccb = (union ccb *)TAILQ_FIRST(&softc->request_ccbs); 259 260 if ((periph->path->device->flags & CAM_DEV_UNCONFIGURED) || 261 periph->path->device->protocol == PROTO_SATAPM) 262 PROBE_SET_ACTION(softc, PROBE_RESET); 263 else 264 PROBE_SET_ACTION(softc, PROBE_IDENTIFY); 265 266 if (ccb->crcn.flags & CAM_EXPECT_INQ_CHANGE) 267 softc->flags |= PROBE_NO_ANNOUNCE; 268 else 269 softc->flags &= ~PROBE_NO_ANNOUNCE; 270 271 xpt_schedule(periph, CAM_PRIORITY_XPT); 272 } 273 274 static void 275 probestart(struct cam_periph *periph, union ccb *start_ccb) 276 { 277 struct ccb_trans_settings cts; 278 struct ccb_ataio *ataio; 279 struct ccb_scsiio *csio; 280 probe_softc *softc; 281 struct cam_path *path; 282 struct ata_params *ident_buf; 283 284 CAM_DEBUG(start_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("probestart\n")); 285 286 softc = (probe_softc *)periph->softc; 287 path = start_ccb->ccb_h.path; 288 ataio = &start_ccb->ataio; 289 csio = &start_ccb->csio; 290 ident_buf = &periph->path->device->ident_data; 291 292 if (softc->restart) { 293 softc->restart = 0; 294 if ((path->device->flags & CAM_DEV_UNCONFIGURED) || 295 path->device->protocol == PROTO_SATAPM) 296 softc->action = PROBE_RESET; 297 else 298 softc->action = PROBE_IDENTIFY; 299 } 300 switch (softc->action) { 301 case PROBE_RESET: 302 cam_fill_ataio(ataio, 303 0, 304 probedone, 305 /*flags*/CAM_DIR_NONE, 306 0, 307 /*data_ptr*/NULL, 308 /*dxfer_len*/0, 309 15 * 1000); 310 ata_reset_cmd(ataio); 311 break; 312 case PROBE_IDENTIFY: 313 cam_fill_ataio(ataio, 314 1, 315 probedone, 316 /*flags*/CAM_DIR_IN, 317 0, 318 /*data_ptr*/(u_int8_t *)&softc->ident_data, 319 /*dxfer_len*/sizeof(softc->ident_data), 320 30 * 1000); 321 if (periph->path->device->protocol == PROTO_ATA) 322 ata_28bit_cmd(ataio, ATA_ATA_IDENTIFY, 0, 0, 0); 323 else 324 ata_28bit_cmd(ataio, ATA_ATAPI_IDENTIFY, 0, 0, 0); 325 break; 326 case PROBE_SPINUP: 327 if (bootverbose) 328 xpt_print(path, "Spinning up device\n"); 329 cam_fill_ataio(ataio, 330 1, 331 probedone, 332 /*flags*/CAM_DIR_NONE | CAM_HIGH_POWER, 333 0, 334 /*data_ptr*/NULL, 335 /*dxfer_len*/0, 336 30 * 1000); 337 ata_28bit_cmd(ataio, ATA_SETFEATURES, ATA_SF_PUIS_SPINUP, 0, 0); 338 break; 339 case PROBE_SETMODE: 340 { 341 int mode, wantmode; 342 343 mode = 0; 344 /* Fetch user modes from SIM. */ 345 bzero(&cts, sizeof(cts)); 346 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 347 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 348 cts.type = CTS_TYPE_USER_SETTINGS; 349 xpt_action((union ccb *)&cts); 350 if (path->device->transport == XPORT_ATA) { 351 if (cts.xport_specific.ata.valid & CTS_ATA_VALID_MODE) 352 mode = cts.xport_specific.ata.mode; 353 } else { 354 if (cts.xport_specific.sata.valid & CTS_SATA_VALID_MODE) 355 mode = cts.xport_specific.sata.mode; 356 } 357 negotiate: 358 /* Honor device capabilities. */ 359 wantmode = mode = ata_max_mode(ident_buf, mode); 360 /* Report modes to SIM. */ 361 bzero(&cts, sizeof(cts)); 362 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 363 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 364 cts.type = CTS_TYPE_CURRENT_SETTINGS; 365 if (path->device->transport == XPORT_ATA) { 366 cts.xport_specific.ata.mode = mode; 367 cts.xport_specific.ata.valid = CTS_ATA_VALID_MODE; 368 } else { 369 cts.xport_specific.sata.mode = mode; 370 cts.xport_specific.sata.valid = CTS_SATA_VALID_MODE; 371 } 372 xpt_action((union ccb *)&cts); 373 /* Fetch current modes from SIM. */ 374 bzero(&cts, sizeof(cts)); 375 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 376 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 377 cts.type = CTS_TYPE_CURRENT_SETTINGS; 378 xpt_action((union ccb *)&cts); 379 if (path->device->transport == XPORT_ATA) { 380 if (cts.xport_specific.ata.valid & CTS_ATA_VALID_MODE) 381 mode = cts.xport_specific.ata.mode; 382 } else { 383 if (cts.xport_specific.ata.valid & CTS_SATA_VALID_MODE) 384 mode = cts.xport_specific.sata.mode; 385 } 386 /* If SIM disagree - renegotiate. */ 387 if (mode != wantmode) 388 goto negotiate; 389 cam_fill_ataio(ataio, 390 1, 391 probedone, 392 /*flags*/CAM_DIR_NONE, 393 0, 394 /*data_ptr*/NULL, 395 /*dxfer_len*/0, 396 30 * 1000); 397 ata_28bit_cmd(ataio, ATA_SETFEATURES, ATA_SF_SETXFER, 0, mode); 398 break; 399 } 400 case PROBE_SETPM: 401 cam_fill_ataio(ataio, 402 1, 403 probedone, 404 CAM_DIR_NONE, 405 0, 406 NULL, 407 0, 408 30*1000); 409 ata_28bit_cmd(ataio, ATA_SETFEATURES, 410 (softc->caps & CTS_SATA_CAPS_H_PMREQ) ? 0x10 : 0x90, 411 0, 0x03); 412 break; 413 case PROBE_SETAPST: 414 cam_fill_ataio(ataio, 415 1, 416 probedone, 417 CAM_DIR_NONE, 418 0, 419 NULL, 420 0, 421 30*1000); 422 ata_28bit_cmd(ataio, ATA_SETFEATURES, 423 (softc->caps & CTS_SATA_CAPS_H_APST) ? 0x10 : 0x90, 424 0, 0x07); 425 break; 426 case PROBE_SETDMAAA: 427 cam_fill_ataio(ataio, 428 1, 429 probedone, 430 CAM_DIR_NONE, 431 0, 432 NULL, 433 0, 434 30*1000); 435 ata_28bit_cmd(ataio, ATA_SETFEATURES, 436 (softc->caps & CTS_SATA_CAPS_H_DMAAA) ? 0x10 : 0x90, 437 0, 0x02); 438 break; 439 case PROBE_SET_MULTI: 440 { 441 u_int sectors, bytecount; 442 443 bytecount = 8192; /* SATA maximum */ 444 /* Fetch user bytecount from SIM. */ 445 bzero(&cts, sizeof(cts)); 446 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 447 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 448 cts.type = CTS_TYPE_USER_SETTINGS; 449 xpt_action((union ccb *)&cts); 450 if (path->device->transport == XPORT_ATA) { 451 if (cts.xport_specific.ata.valid & CTS_ATA_VALID_BYTECOUNT) 452 bytecount = cts.xport_specific.ata.bytecount; 453 } else { 454 if (cts.xport_specific.sata.valid & CTS_SATA_VALID_BYTECOUNT) 455 bytecount = cts.xport_specific.sata.bytecount; 456 } 457 /* Honor device capabilities. */ 458 sectors = max(1, min(ident_buf->sectors_intr & 0xff, 459 bytecount / ata_logical_sector_size(ident_buf))); 460 /* Report bytecount to SIM. */ 461 bzero(&cts, sizeof(cts)); 462 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 463 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 464 cts.type = CTS_TYPE_CURRENT_SETTINGS; 465 if (path->device->transport == XPORT_ATA) { 466 cts.xport_specific.ata.bytecount = sectors * 467 ata_logical_sector_size(ident_buf); 468 cts.xport_specific.ata.valid = CTS_ATA_VALID_BYTECOUNT; 469 } else { 470 cts.xport_specific.sata.bytecount = sectors * 471 ata_logical_sector_size(ident_buf); 472 cts.xport_specific.sata.valid = CTS_SATA_VALID_BYTECOUNT; 473 } 474 xpt_action((union ccb *)&cts); 475 /* Fetch current bytecount from SIM. */ 476 bzero(&cts, sizeof(cts)); 477 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 478 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 479 cts.type = CTS_TYPE_CURRENT_SETTINGS; 480 xpt_action((union ccb *)&cts); 481 if (path->device->transport == XPORT_ATA) { 482 if (cts.xport_specific.ata.valid & CTS_ATA_VALID_BYTECOUNT) 483 bytecount = cts.xport_specific.ata.bytecount; 484 } else { 485 if (cts.xport_specific.sata.valid & CTS_SATA_VALID_BYTECOUNT) 486 bytecount = cts.xport_specific.sata.bytecount; 487 } 488 sectors = bytecount / ata_logical_sector_size(ident_buf); 489 490 cam_fill_ataio(ataio, 491 1, 492 probedone, 493 CAM_DIR_NONE, 494 0, 495 NULL, 496 0, 497 30*1000); 498 ata_28bit_cmd(ataio, ATA_SET_MULTI, 0, 0, sectors); 499 break; 500 } 501 case PROBE_INQUIRY: 502 { 503 u_int bytecount; 504 505 bytecount = 8192; /* SATA maximum */ 506 /* Fetch user bytecount from SIM. */ 507 bzero(&cts, sizeof(cts)); 508 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 509 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 510 cts.type = CTS_TYPE_USER_SETTINGS; 511 xpt_action((union ccb *)&cts); 512 if (path->device->transport == XPORT_ATA) { 513 if (cts.xport_specific.ata.valid & CTS_ATA_VALID_BYTECOUNT) 514 bytecount = cts.xport_specific.ata.bytecount; 515 } else { 516 if (cts.xport_specific.sata.valid & CTS_SATA_VALID_BYTECOUNT) 517 bytecount = cts.xport_specific.sata.bytecount; 518 } 519 /* Honor device capabilities. */ 520 bytecount &= ~1; 521 bytecount = max(2, min(65534, bytecount)); 522 if (ident_buf->satacapabilities != 0x0000 && 523 ident_buf->satacapabilities != 0xffff) { 524 bytecount = min(8192, bytecount); 525 } 526 /* Report bytecount to SIM. */ 527 bzero(&cts, sizeof(cts)); 528 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 529 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 530 cts.type = CTS_TYPE_CURRENT_SETTINGS; 531 if (path->device->transport == XPORT_ATA) { 532 cts.xport_specific.ata.bytecount = bytecount; 533 cts.xport_specific.ata.valid = CTS_ATA_VALID_BYTECOUNT; 534 } else { 535 cts.xport_specific.sata.bytecount = bytecount; 536 cts.xport_specific.sata.valid = CTS_SATA_VALID_BYTECOUNT; 537 } 538 xpt_action((union ccb *)&cts); 539 /* FALLTHROUGH */ 540 } 541 case PROBE_FULL_INQUIRY: 542 { 543 u_int inquiry_len; 544 struct scsi_inquiry_data *inq_buf = 545 &periph->path->device->inq_data; 546 547 if (softc->action == PROBE_INQUIRY) 548 inquiry_len = SHORT_INQUIRY_LENGTH; 549 else 550 inquiry_len = SID_ADDITIONAL_LENGTH(inq_buf); 551 /* 552 * Some parallel SCSI devices fail to send an 553 * ignore wide residue message when dealing with 554 * odd length inquiry requests. Round up to be 555 * safe. 556 */ 557 inquiry_len = roundup2(inquiry_len, 2); 558 scsi_inquiry(csio, 559 /*retries*/1, 560 probedone, 561 MSG_SIMPLE_Q_TAG, 562 (u_int8_t *)inq_buf, 563 inquiry_len, 564 /*evpd*/FALSE, 565 /*page_code*/0, 566 SSD_MIN_SIZE, 567 /*timeout*/60 * 1000); 568 break; 569 } 570 case PROBE_PM_PID: 571 cam_fill_ataio(ataio, 572 1, 573 probedone, 574 /*flags*/CAM_DIR_NONE, 575 0, 576 /*data_ptr*/NULL, 577 /*dxfer_len*/0, 578 10 * 1000); 579 ata_pm_read_cmd(ataio, 0, 15); 580 break; 581 case PROBE_PM_PRV: 582 cam_fill_ataio(ataio, 583 1, 584 probedone, 585 /*flags*/CAM_DIR_NONE, 586 0, 587 /*data_ptr*/NULL, 588 /*dxfer_len*/0, 589 10 * 1000); 590 ata_pm_read_cmd(ataio, 1, 15); 591 break; 592 case PROBE_INVALID: 593 CAM_DEBUG(path, CAM_DEBUG_INFO, 594 ("probestart: invalid action state\n")); 595 default: 596 break; 597 } 598 xpt_action(start_ccb); 599 } 600 #if 0 601 static void 602 proberequestdefaultnegotiation(struct cam_periph *periph) 603 { 604 struct ccb_trans_settings cts; 605 606 xpt_setup_ccb(&cts.ccb_h, periph->path, CAM_PRIORITY_NONE); 607 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 608 cts.type = CTS_TYPE_USER_SETTINGS; 609 xpt_action((union ccb *)&cts); 610 if ((cts.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) { 611 return; 612 } 613 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 614 cts.type = CTS_TYPE_CURRENT_SETTINGS; 615 xpt_action((union ccb *)&cts); 616 } 617 618 /* 619 * Backoff Negotiation Code- only pertinent for SPI devices. 620 */ 621 static int 622 proberequestbackoff(struct cam_periph *periph, struct cam_ed *device) 623 { 624 struct ccb_trans_settings cts; 625 struct ccb_trans_settings_spi *spi; 626 627 memset(&cts, 0, sizeof (cts)); 628 xpt_setup_ccb(&cts.ccb_h, periph->path, CAM_PRIORITY_NONE); 629 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 630 cts.type = CTS_TYPE_CURRENT_SETTINGS; 631 xpt_action((union ccb *)&cts); 632 if ((cts.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) { 633 if (bootverbose) { 634 xpt_print(periph->path, 635 "failed to get current device settings\n"); 636 } 637 return (0); 638 } 639 if (cts.transport != XPORT_SPI) { 640 if (bootverbose) { 641 xpt_print(periph->path, "not SPI transport\n"); 642 } 643 return (0); 644 } 645 spi = &cts.xport_specific.spi; 646 647 /* 648 * We cannot renegotiate sync rate if we don't have one. 649 */ 650 if ((spi->valid & CTS_SPI_VALID_SYNC_RATE) == 0) { 651 if (bootverbose) { 652 xpt_print(periph->path, "no sync rate known\n"); 653 } 654 return (0); 655 } 656 657 /* 658 * We'll assert that we don't have to touch PPR options- the 659 * SIM will see what we do with period and offset and adjust 660 * the PPR options as appropriate. 661 */ 662 663 /* 664 * A sync rate with unknown or zero offset is nonsensical. 665 * A sync period of zero means Async. 666 */ 667 if ((spi->valid & CTS_SPI_VALID_SYNC_OFFSET) == 0 668 || spi->sync_offset == 0 || spi->sync_period == 0) { 669 if (bootverbose) { 670 xpt_print(periph->path, "no sync rate available\n"); 671 } 672 return (0); 673 } 674 675 if (device->flags & CAM_DEV_DV_HIT_BOTTOM) { 676 CAM_DEBUG(periph->path, CAM_DEBUG_INFO, 677 ("hit async: giving up on DV\n")); 678 return (0); 679 } 680 681 682 /* 683 * Jump sync_period up by one, but stop at 5MHz and fall back to Async. 684 * We don't try to remember 'last' settings to see if the SIM actually 685 * gets into the speed we want to set. We check on the SIM telling 686 * us that a requested speed is bad, but otherwise don't try and 687 * check the speed due to the asynchronous and handshake nature 688 * of speed setting. 689 */ 690 spi->valid = CTS_SPI_VALID_SYNC_RATE | CTS_SPI_VALID_SYNC_OFFSET; 691 for (;;) { 692 spi->sync_period++; 693 if (spi->sync_period >= 0xf) { 694 spi->sync_period = 0; 695 spi->sync_offset = 0; 696 CAM_DEBUG(periph->path, CAM_DEBUG_INFO, 697 ("setting to async for DV\n")); 698 /* 699 * Once we hit async, we don't want to try 700 * any more settings. 701 */ 702 device->flags |= CAM_DEV_DV_HIT_BOTTOM; 703 } else if (bootverbose) { 704 CAM_DEBUG(periph->path, CAM_DEBUG_INFO, 705 ("DV: period 0x%x\n", spi->sync_period)); 706 printf("setting period to 0x%x\n", spi->sync_period); 707 } 708 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 709 cts.type = CTS_TYPE_CURRENT_SETTINGS; 710 xpt_action((union ccb *)&cts); 711 if ((cts.ccb_h.status & CAM_STATUS_MASK) == CAM_REQ_CMP) { 712 break; 713 } 714 CAM_DEBUG(periph->path, CAM_DEBUG_INFO, 715 ("DV: failed to set period 0x%x\n", spi->sync_period)); 716 if (spi->sync_period == 0) { 717 return (0); 718 } 719 } 720 return (1); 721 } 722 #endif 723 static void 724 probedone(struct cam_periph *periph, union ccb *done_ccb) 725 { 726 struct ccb_trans_settings cts; 727 struct ata_params *ident_buf; 728 probe_softc *softc; 729 struct cam_path *path; 730 cam_status status; 731 u_int32_t priority; 732 u_int caps; 733 int found = 1; 734 735 CAM_DEBUG(done_ccb->ccb_h.path, CAM_DEBUG_TRACE, ("probedone\n")); 736 737 softc = (probe_softc *)periph->softc; 738 path = done_ccb->ccb_h.path; 739 priority = done_ccb->ccb_h.pinfo.priority; 740 ident_buf = &path->device->ident_data; 741 742 if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) { 743 if (softc->restart) { 744 if (bootverbose) { 745 cam_error_print(done_ccb, 746 CAM_ESF_ALL, CAM_EPF_ALL); 747 } 748 } else if (cam_periph_error(done_ccb, 0, 0, NULL) == ERESTART) 749 return; 750 if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) { 751 /* Don't wedge the queue */ 752 xpt_release_devq(done_ccb->ccb_h.path, /*count*/1, 753 /*run_queue*/TRUE); 754 } 755 status = done_ccb->ccb_h.status & CAM_STATUS_MASK; 756 if (softc->restart) { 757 softc->faults++; 758 if ((done_ccb->ccb_h.status & CAM_STATUS_MASK) == 759 CAM_CMD_TIMEOUT) 760 softc->faults += 4; 761 if (softc->faults < 10) 762 goto done; 763 else 764 softc->restart = 0; 765 766 /* Old PIO2 devices may not support mode setting. */ 767 } else if (softc->action == PROBE_SETMODE && 768 status == CAM_ATA_STATUS_ERROR && 769 ata_max_pmode(ident_buf) <= ATA_PIO2 && 770 (ident_buf->capabilities1 & ATA_SUPPORT_IORDY) == 0) { 771 goto noerror; 772 773 /* 774 * Some old WD SATA disks report supported and enabled 775 * device-initiated interface power management, but return 776 * ABORT on attempt to disable it. 777 */ 778 } else if (softc->action == PROBE_SETPM && 779 status == CAM_ATA_STATUS_ERROR) { 780 goto noerror; 781 } 782 783 /* 784 * If we get to this point, we got an error status back 785 * from the inquiry and the error status doesn't require 786 * automatically retrying the command. Therefore, the 787 * inquiry failed. If we had inquiry information before 788 * for this device, but this latest inquiry command failed, 789 * the device has probably gone away. If this device isn't 790 * already marked unconfigured, notify the peripheral 791 * drivers that this device is no more. 792 */ 793 device_fail: if ((path->device->flags & CAM_DEV_UNCONFIGURED) == 0) 794 xpt_async(AC_LOST_DEVICE, path, NULL); 795 found = 0; 796 goto done; 797 } 798 noerror: 799 if (softc->restart) 800 goto done; 801 switch (softc->action) { 802 case PROBE_RESET: 803 { 804 int sign = (done_ccb->ataio.res.lba_high << 8) + 805 done_ccb->ataio.res.lba_mid; 806 if (bootverbose) 807 xpt_print(path, "SIGNATURE: %04x\n", sign); 808 if (sign == 0x0000 && 809 done_ccb->ccb_h.target_id != 15) { 810 path->device->protocol = PROTO_ATA; 811 PROBE_SET_ACTION(softc, PROBE_IDENTIFY); 812 } else if (sign == 0x9669 && 813 done_ccb->ccb_h.target_id == 15) { 814 /* Report SIM that PM is present. */ 815 bzero(&cts, sizeof(cts)); 816 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 817 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 818 cts.type = CTS_TYPE_CURRENT_SETTINGS; 819 cts.xport_specific.sata.pm_present = 1; 820 cts.xport_specific.sata.valid = CTS_SATA_VALID_PM; 821 xpt_action((union ccb *)&cts); 822 path->device->protocol = PROTO_SATAPM; 823 PROBE_SET_ACTION(softc, PROBE_PM_PID); 824 } else if (sign == 0xeb14 && 825 done_ccb->ccb_h.target_id != 15) { 826 path->device->protocol = PROTO_SCSI; 827 PROBE_SET_ACTION(softc, PROBE_IDENTIFY); 828 } else { 829 if (done_ccb->ccb_h.target_id != 15) { 830 xpt_print(path, 831 "Unexpected signature 0x%04x\n", sign); 832 } 833 goto device_fail; 834 } 835 xpt_release_ccb(done_ccb); 836 xpt_schedule(periph, priority); 837 return; 838 } 839 case PROBE_IDENTIFY: 840 { 841 struct ccb_pathinq cpi; 842 int16_t *ptr; 843 int changed = 1; 844 845 ident_buf = &softc->ident_data; 846 for (ptr = (int16_t *)ident_buf; 847 ptr < (int16_t *)ident_buf + sizeof(struct ata_params)/2; ptr++) { 848 *ptr = le16toh(*ptr); 849 } 850 if (strncmp(ident_buf->model, "FX", 2) && 851 strncmp(ident_buf->model, "NEC", 3) && 852 strncmp(ident_buf->model, "Pioneer", 7) && 853 strncmp(ident_buf->model, "SHARP", 5)) { 854 ata_bswap(ident_buf->model, sizeof(ident_buf->model)); 855 ata_bswap(ident_buf->revision, sizeof(ident_buf->revision)); 856 ata_bswap(ident_buf->serial, sizeof(ident_buf->serial)); 857 } 858 ata_btrim(ident_buf->model, sizeof(ident_buf->model)); 859 ata_bpack(ident_buf->model, ident_buf->model, sizeof(ident_buf->model)); 860 ata_btrim(ident_buf->revision, sizeof(ident_buf->revision)); 861 ata_bpack(ident_buf->revision, ident_buf->revision, sizeof(ident_buf->revision)); 862 ata_btrim(ident_buf->serial, sizeof(ident_buf->serial)); 863 ata_bpack(ident_buf->serial, ident_buf->serial, sizeof(ident_buf->serial)); 864 /* Device may need spin-up before IDENTIFY become valid. */ 865 if ((ident_buf->specconf == 0x37c8 || 866 ident_buf->specconf == 0x738c) && 867 ((ident_buf->config & ATA_RESP_INCOMPLETE) || 868 softc->spinup == 0)) { 869 PROBE_SET_ACTION(softc, PROBE_SPINUP); 870 xpt_release_ccb(done_ccb); 871 xpt_schedule(periph, priority); 872 return; 873 } 874 ident_buf = &path->device->ident_data; 875 if ((periph->path->device->flags & CAM_DEV_UNCONFIGURED) == 0) { 876 /* Check that it is the same device. */ 877 if (bcmp(softc->ident_data.model, ident_buf->model, 878 sizeof(ident_buf->model)) || 879 bcmp(softc->ident_data.revision, ident_buf->revision, 880 sizeof(ident_buf->revision)) || 881 bcmp(softc->ident_data.serial, ident_buf->serial, 882 sizeof(ident_buf->serial))) { 883 /* Device changed. */ 884 xpt_async(AC_LOST_DEVICE, path, NULL); 885 } else { 886 bcopy(&softc->ident_data, ident_buf, sizeof(struct ata_params)); 887 changed = 0; 888 } 889 } 890 if (changed) { 891 bcopy(&softc->ident_data, ident_buf, sizeof(struct ata_params)); 892 /* Clean up from previous instance of this device */ 893 if (path->device->serial_num != NULL) { 894 free(path->device->serial_num, M_CAMXPT); 895 path->device->serial_num = NULL; 896 path->device->serial_num_len = 0; 897 } 898 path->device->serial_num = 899 (u_int8_t *)malloc((sizeof(ident_buf->serial) + 1), 900 M_CAMXPT, M_NOWAIT); 901 if (path->device->serial_num != NULL) { 902 bcopy(ident_buf->serial, 903 path->device->serial_num, 904 sizeof(ident_buf->serial)); 905 path->device->serial_num[sizeof(ident_buf->serial)] 906 = '\0'; 907 path->device->serial_num_len = 908 strlen(path->device->serial_num); 909 } 910 911 path->device->flags |= CAM_DEV_IDENTIFY_DATA_VALID; 912 } 913 if (ident_buf->satacapabilities & ATA_SUPPORT_NCQ) { 914 path->device->mintags = path->device->maxtags = 915 ATA_QUEUE_LEN(ident_buf->queue) + 1; 916 } 917 ata_find_quirk(path->device); 918 if (path->device->mintags != 0 && 919 path->bus->sim->max_tagged_dev_openings != 0) { 920 /* Check if the SIM does not want queued commands. */ 921 bzero(&cpi, sizeof(cpi)); 922 xpt_setup_ccb(&cpi.ccb_h, path, CAM_PRIORITY_NONE); 923 cpi.ccb_h.func_code = XPT_PATH_INQ; 924 xpt_action((union ccb *)&cpi); 925 if (cpi.ccb_h.status == CAM_REQ_CMP && 926 (cpi.hba_inquiry & PI_TAG_ABLE)) { 927 /* Report SIM which tags are allowed. */ 928 bzero(&cts, sizeof(cts)); 929 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 930 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 931 cts.type = CTS_TYPE_CURRENT_SETTINGS; 932 cts.xport_specific.sata.tags = path->device->maxtags; 933 cts.xport_specific.sata.valid = CTS_SATA_VALID_TAGS; 934 xpt_action((union ccb *)&cts); 935 /* Reconfigure queues for tagged queueing. */ 936 xpt_start_tags(path); 937 } 938 } 939 ata_device_transport(path); 940 PROBE_SET_ACTION(softc, PROBE_SETMODE); 941 xpt_release_ccb(done_ccb); 942 xpt_schedule(periph, priority); 943 return; 944 } 945 case PROBE_SPINUP: 946 if (bootverbose) 947 xpt_print(path, "Spin-up done\n"); 948 softc->spinup = 1; 949 PROBE_SET_ACTION(softc, PROBE_IDENTIFY); 950 xpt_release_ccb(done_ccb); 951 xpt_schedule(periph, priority); 952 return; 953 case PROBE_SETMODE: 954 if (path->device->transport != XPORT_SATA) 955 goto notsata; 956 /* Set supported bits. */ 957 bzero(&cts, sizeof(cts)); 958 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 959 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 960 cts.type = CTS_TYPE_CURRENT_SETTINGS; 961 xpt_action((union ccb *)&cts); 962 if (cts.xport_specific.sata.valid & CTS_SATA_VALID_CAPS) 963 caps = cts.xport_specific.sata.caps & CTS_SATA_CAPS_H; 964 else 965 caps = 0; 966 if (ident_buf->satacapabilities != 0xffff) { 967 if (ident_buf->satacapabilities & ATA_SUPPORT_IFPWRMNGTRCV) 968 caps |= CTS_SATA_CAPS_D_PMREQ; 969 if (ident_buf->satacapabilities & ATA_SUPPORT_HAPST) 970 caps |= CTS_SATA_CAPS_D_APST; 971 } 972 /* Mask unwanted bits. */ 973 bzero(&cts, sizeof(cts)); 974 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 975 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 976 cts.type = CTS_TYPE_USER_SETTINGS; 977 xpt_action((union ccb *)&cts); 978 if (cts.xport_specific.sata.valid & CTS_SATA_VALID_CAPS) 979 caps &= cts.xport_specific.sata.caps; 980 else 981 caps = 0; 982 /* Store result to SIM. */ 983 bzero(&cts, sizeof(cts)); 984 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 985 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 986 cts.type = CTS_TYPE_CURRENT_SETTINGS; 987 cts.xport_specific.sata.caps = caps; 988 cts.xport_specific.sata.valid = CTS_SATA_VALID_CAPS; 989 xpt_action((union ccb *)&cts); 990 softc->caps = caps; 991 if (ident_buf->satasupport & ATA_SUPPORT_IFPWRMNGT) { 992 PROBE_SET_ACTION(softc, PROBE_SETPM); 993 xpt_release_ccb(done_ccb); 994 xpt_schedule(periph, priority); 995 return; 996 } 997 /* FALLTHROUGH */ 998 case PROBE_SETPM: 999 if (ident_buf->satacapabilities != 0xffff && 1000 ident_buf->satacapabilities & ATA_SUPPORT_DAPST) { 1001 PROBE_SET_ACTION(softc, PROBE_SETAPST); 1002 xpt_release_ccb(done_ccb); 1003 xpt_schedule(periph, priority); 1004 return; 1005 } 1006 /* FALLTHROUGH */ 1007 case PROBE_SETAPST: 1008 if (ident_buf->satasupport & ATA_SUPPORT_AUTOACTIVATE) { 1009 PROBE_SET_ACTION(softc, PROBE_SETDMAAA); 1010 xpt_release_ccb(done_ccb); 1011 xpt_schedule(periph, priority); 1012 return; 1013 } 1014 /* FALLTHROUGH */ 1015 case PROBE_SETDMAAA: 1016 notsata: 1017 if (path->device->protocol == PROTO_ATA) { 1018 PROBE_SET_ACTION(softc, PROBE_SET_MULTI); 1019 } else { 1020 PROBE_SET_ACTION(softc, PROBE_INQUIRY); 1021 } 1022 xpt_release_ccb(done_ccb); 1023 xpt_schedule(periph, priority); 1024 return; 1025 case PROBE_SET_MULTI: 1026 if (periph->path->device->flags & CAM_DEV_UNCONFIGURED) { 1027 path->device->flags &= ~CAM_DEV_UNCONFIGURED; 1028 xpt_acquire_device(path->device); 1029 done_ccb->ccb_h.func_code = XPT_GDEV_TYPE; 1030 xpt_action(done_ccb); 1031 xpt_async(AC_FOUND_DEVICE, done_ccb->ccb_h.path, 1032 done_ccb); 1033 } 1034 break; 1035 case PROBE_INQUIRY: 1036 case PROBE_FULL_INQUIRY: 1037 { 1038 struct scsi_inquiry_data *inq_buf; 1039 u_int8_t periph_qual, len; 1040 1041 path->device->flags |= CAM_DEV_INQUIRY_DATA_VALID; 1042 inq_buf = &path->device->inq_data; 1043 1044 periph_qual = SID_QUAL(inq_buf); 1045 1046 if (periph_qual != SID_QUAL_LU_CONNECTED) 1047 break; 1048 1049 /* 1050 * We conservatively request only 1051 * SHORT_INQUIRY_LEN bytes of inquiry 1052 * information during our first try 1053 * at sending an INQUIRY. If the device 1054 * has more information to give, 1055 * perform a second request specifying 1056 * the amount of information the device 1057 * is willing to give. 1058 */ 1059 len = inq_buf->additional_length 1060 + offsetof(struct scsi_inquiry_data, additional_length) + 1; 1061 if (softc->action == PROBE_INQUIRY 1062 && len > SHORT_INQUIRY_LENGTH) { 1063 PROBE_SET_ACTION(softc, PROBE_FULL_INQUIRY); 1064 xpt_release_ccb(done_ccb); 1065 xpt_schedule(periph, priority); 1066 return; 1067 } 1068 1069 ata_device_transport(path); 1070 if (periph->path->device->flags & CAM_DEV_UNCONFIGURED) { 1071 path->device->flags &= ~CAM_DEV_UNCONFIGURED; 1072 xpt_acquire_device(path->device); 1073 done_ccb->ccb_h.func_code = XPT_GDEV_TYPE; 1074 xpt_action(done_ccb); 1075 xpt_async(AC_FOUND_DEVICE, done_ccb->ccb_h.path, done_ccb); 1076 } 1077 break; 1078 } 1079 case PROBE_PM_PID: 1080 if ((path->device->flags & CAM_DEV_IDENTIFY_DATA_VALID) == 0) 1081 bzero(ident_buf, sizeof(*ident_buf)); 1082 softc->pm_pid = (done_ccb->ataio.res.lba_high << 24) + 1083 (done_ccb->ataio.res.lba_mid << 16) + 1084 (done_ccb->ataio.res.lba_low << 8) + 1085 done_ccb->ataio.res.sector_count; 1086 ((uint32_t *)ident_buf)[0] = softc->pm_pid; 1087 snprintf(ident_buf->model, sizeof(ident_buf->model), 1088 "Port Multiplier %08x", softc->pm_pid); 1089 PROBE_SET_ACTION(softc, PROBE_PM_PRV); 1090 xpt_release_ccb(done_ccb); 1091 xpt_schedule(periph, priority); 1092 return; 1093 case PROBE_PM_PRV: 1094 softc->pm_prv = (done_ccb->ataio.res.lba_high << 24) + 1095 (done_ccb->ataio.res.lba_mid << 16) + 1096 (done_ccb->ataio.res.lba_low << 8) + 1097 done_ccb->ataio.res.sector_count; 1098 ((uint32_t *)ident_buf)[1] = softc->pm_prv; 1099 snprintf(ident_buf->revision, sizeof(ident_buf->revision), 1100 "%04x", softc->pm_prv); 1101 path->device->flags |= CAM_DEV_IDENTIFY_DATA_VALID; 1102 /* Set supported bits. */ 1103 bzero(&cts, sizeof(cts)); 1104 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 1105 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 1106 cts.type = CTS_TYPE_CURRENT_SETTINGS; 1107 xpt_action((union ccb *)&cts); 1108 if (cts.xport_specific.sata.valid & CTS_SATA_VALID_CAPS) 1109 caps = cts.xport_specific.sata.caps & CTS_SATA_CAPS_H; 1110 else 1111 caps = 0; 1112 /* All PMPs must support PM requests. */ 1113 caps |= CTS_SATA_CAPS_D_PMREQ; 1114 /* Mask unwanted bits. */ 1115 bzero(&cts, sizeof(cts)); 1116 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 1117 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 1118 cts.type = CTS_TYPE_USER_SETTINGS; 1119 xpt_action((union ccb *)&cts); 1120 if (cts.xport_specific.sata.valid & CTS_SATA_VALID_CAPS) 1121 caps &= cts.xport_specific.sata.caps; 1122 else 1123 caps = 0; 1124 /* Store result to SIM. */ 1125 bzero(&cts, sizeof(cts)); 1126 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 1127 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 1128 cts.type = CTS_TYPE_CURRENT_SETTINGS; 1129 cts.xport_specific.sata.caps = caps; 1130 cts.xport_specific.sata.valid = CTS_SATA_VALID_CAPS; 1131 xpt_action((union ccb *)&cts); 1132 softc->caps = caps; 1133 if (periph->path->device->flags & CAM_DEV_UNCONFIGURED) { 1134 path->device->flags &= ~CAM_DEV_UNCONFIGURED; 1135 xpt_acquire_device(path->device); 1136 done_ccb->ccb_h.func_code = XPT_GDEV_TYPE; 1137 xpt_action(done_ccb); 1138 xpt_async(AC_FOUND_DEVICE, done_ccb->ccb_h.path, 1139 done_ccb); 1140 } else { 1141 done_ccb->ccb_h.func_code = XPT_GDEV_TYPE; 1142 xpt_action(done_ccb); 1143 xpt_async(AC_SCSI_AEN, done_ccb->ccb_h.path, done_ccb); 1144 } 1145 break; 1146 case PROBE_INVALID: 1147 CAM_DEBUG(done_ccb->ccb_h.path, CAM_DEBUG_INFO, 1148 ("probedone: invalid action state\n")); 1149 default: 1150 break; 1151 } 1152 done: 1153 if (softc->restart) { 1154 softc->restart = 0; 1155 xpt_release_ccb(done_ccb); 1156 probeschedule(periph); 1157 return; 1158 } 1159 xpt_release_ccb(done_ccb); 1160 while ((done_ccb = (union ccb *)TAILQ_FIRST(&softc->request_ccbs))) { 1161 TAILQ_REMOVE(&softc->request_ccbs, 1162 &done_ccb->ccb_h, periph_links.tqe); 1163 done_ccb->ccb_h.status = found ? CAM_REQ_CMP : CAM_REQ_CMP_ERR; 1164 xpt_done(done_ccb); 1165 } 1166 cam_release_devq(periph->path, 1167 RELSIM_RELEASE_RUNLEVEL, 0, CAM_RL_XPT + 1, FALSE); 1168 cam_periph_invalidate(periph); 1169 cam_periph_release_locked(periph); 1170 } 1171 1172 static void 1173 probecleanup(struct cam_periph *periph) 1174 { 1175 free(periph->softc, M_CAMXPT); 1176 } 1177 1178 static void 1179 ata_find_quirk(struct cam_ed *device) 1180 { 1181 struct ata_quirk_entry *quirk; 1182 caddr_t match; 1183 1184 match = cam_quirkmatch((caddr_t)&device->ident_data, 1185 (caddr_t)ata_quirk_table, 1186 ata_quirk_table_size, 1187 sizeof(*ata_quirk_table), ata_identify_match); 1188 1189 if (match == NULL) 1190 panic("xpt_find_quirk: device didn't match wildcard entry!!"); 1191 1192 quirk = (struct ata_quirk_entry *)match; 1193 device->quirk = quirk; 1194 if (quirk->quirks & CAM_QUIRK_MAXTAGS) 1195 device->mintags = device->maxtags = quirk->maxtags; 1196 } 1197 1198 typedef struct { 1199 union ccb *request_ccb; 1200 struct ccb_pathinq *cpi; 1201 int counter; 1202 } ata_scan_bus_info; 1203 1204 /* 1205 * To start a scan, request_ccb is an XPT_SCAN_BUS ccb. 1206 * As the scan progresses, xpt_scan_bus is used as the 1207 * callback on completion function. 1208 */ 1209 static void 1210 ata_scan_bus(struct cam_periph *periph, union ccb *request_ccb) 1211 { 1212 struct cam_path *path; 1213 ata_scan_bus_info *scan_info; 1214 union ccb *work_ccb, *reset_ccb; 1215 cam_status status; 1216 1217 CAM_DEBUG(request_ccb->ccb_h.path, CAM_DEBUG_TRACE, 1218 ("xpt_scan_bus\n")); 1219 switch (request_ccb->ccb_h.func_code) { 1220 case XPT_SCAN_BUS: 1221 case XPT_SCAN_TGT: 1222 /* Find out the characteristics of the bus */ 1223 work_ccb = xpt_alloc_ccb_nowait(); 1224 if (work_ccb == NULL) { 1225 request_ccb->ccb_h.status = CAM_RESRC_UNAVAIL; 1226 xpt_done(request_ccb); 1227 return; 1228 } 1229 xpt_setup_ccb(&work_ccb->ccb_h, request_ccb->ccb_h.path, 1230 request_ccb->ccb_h.pinfo.priority); 1231 work_ccb->ccb_h.func_code = XPT_PATH_INQ; 1232 xpt_action(work_ccb); 1233 if (work_ccb->ccb_h.status != CAM_REQ_CMP) { 1234 request_ccb->ccb_h.status = work_ccb->ccb_h.status; 1235 xpt_free_ccb(work_ccb); 1236 xpt_done(request_ccb); 1237 return; 1238 } 1239 1240 /* We may need to reset bus first, if we haven't done it yet. */ 1241 if ((work_ccb->cpi.hba_inquiry & 1242 (PI_WIDE_32|PI_WIDE_16|PI_SDTR_ABLE)) && 1243 !(work_ccb->cpi.hba_misc & PIM_NOBUSRESET) && 1244 !timevalisset(&request_ccb->ccb_h.path->bus->last_reset)) { 1245 reset_ccb = xpt_alloc_ccb_nowait(); 1246 if (reset_ccb == NULL) { 1247 request_ccb->ccb_h.status = CAM_RESRC_UNAVAIL; 1248 xpt_free_ccb(work_ccb); 1249 xpt_done(request_ccb); 1250 return; 1251 } 1252 xpt_setup_ccb(&reset_ccb->ccb_h, request_ccb->ccb_h.path, 1253 CAM_PRIORITY_NONE); 1254 reset_ccb->ccb_h.func_code = XPT_RESET_BUS; 1255 xpt_action(reset_ccb); 1256 if (reset_ccb->ccb_h.status != CAM_REQ_CMP) { 1257 request_ccb->ccb_h.status = reset_ccb->ccb_h.status; 1258 xpt_free_ccb(reset_ccb); 1259 xpt_free_ccb(work_ccb); 1260 xpt_done(request_ccb); 1261 return; 1262 } 1263 xpt_free_ccb(reset_ccb); 1264 } 1265 1266 /* Save some state for use while we probe for devices */ 1267 scan_info = (ata_scan_bus_info *) 1268 malloc(sizeof(ata_scan_bus_info), M_CAMXPT, M_NOWAIT); 1269 if (scan_info == NULL) { 1270 request_ccb->ccb_h.status = CAM_RESRC_UNAVAIL; 1271 xpt_free_ccb(work_ccb); 1272 xpt_done(request_ccb); 1273 return; 1274 } 1275 scan_info->request_ccb = request_ccb; 1276 scan_info->cpi = &work_ccb->cpi; 1277 /* If PM supported, probe it first. */ 1278 if (scan_info->cpi->hba_inquiry & PI_SATAPM) 1279 scan_info->counter = scan_info->cpi->max_target; 1280 else 1281 scan_info->counter = 0; 1282 1283 work_ccb = xpt_alloc_ccb_nowait(); 1284 if (work_ccb == NULL) { 1285 free(scan_info, M_CAMXPT); 1286 request_ccb->ccb_h.status = CAM_RESRC_UNAVAIL; 1287 xpt_done(request_ccb); 1288 break; 1289 } 1290 goto scan_next; 1291 case XPT_SCAN_LUN: 1292 work_ccb = request_ccb; 1293 /* Reuse the same CCB to query if a device was really found */ 1294 scan_info = (ata_scan_bus_info *)work_ccb->ccb_h.ppriv_ptr0; 1295 /* If there is PMP... */ 1296 if ((scan_info->cpi->hba_inquiry & PI_SATAPM) && 1297 (scan_info->counter == scan_info->cpi->max_target)) { 1298 if (work_ccb->ccb_h.status == CAM_REQ_CMP) { 1299 /* everything else will be probed by it */ 1300 /* Free the current request path- we're done with it. */ 1301 xpt_free_path(work_ccb->ccb_h.path); 1302 goto done; 1303 } else { 1304 struct ccb_trans_settings cts; 1305 1306 /* Report SIM that PM is absent. */ 1307 bzero(&cts, sizeof(cts)); 1308 xpt_setup_ccb(&cts.ccb_h, 1309 work_ccb->ccb_h.path, CAM_PRIORITY_NONE); 1310 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 1311 cts.type = CTS_TYPE_CURRENT_SETTINGS; 1312 cts.xport_specific.sata.pm_present = 0; 1313 cts.xport_specific.sata.valid = CTS_SATA_VALID_PM; 1314 xpt_action((union ccb *)&cts); 1315 } 1316 } 1317 /* Free the current request path- we're done with it. */ 1318 xpt_free_path(work_ccb->ccb_h.path); 1319 if (scan_info->counter == 1320 ((scan_info->cpi->hba_inquiry & PI_SATAPM) ? 1321 0 : scan_info->cpi->max_target)) { 1322 done: 1323 xpt_free_ccb(work_ccb); 1324 xpt_free_ccb((union ccb *)scan_info->cpi); 1325 request_ccb = scan_info->request_ccb; 1326 free(scan_info, M_CAMXPT); 1327 request_ccb->ccb_h.status = CAM_REQ_CMP; 1328 xpt_done(request_ccb); 1329 break; 1330 } 1331 /* Take next device. Wrap from max (PMP) to 0. */ 1332 scan_info->counter = (scan_info->counter + 1 ) % 1333 (scan_info->cpi->max_target + 1); 1334 scan_next: 1335 status = xpt_create_path(&path, xpt_periph, 1336 scan_info->request_ccb->ccb_h.path_id, 1337 scan_info->counter, 0); 1338 if (status != CAM_REQ_CMP) { 1339 printf("xpt_scan_bus: xpt_create_path failed" 1340 " with status %#x, bus scan halted\n", 1341 status); 1342 xpt_free_ccb(work_ccb); 1343 xpt_free_ccb((union ccb *)scan_info->cpi); 1344 request_ccb = scan_info->request_ccb; 1345 free(scan_info, M_CAMXPT); 1346 request_ccb->ccb_h.status = status; 1347 xpt_done(request_ccb); 1348 break; 1349 } 1350 xpt_setup_ccb(&work_ccb->ccb_h, path, 1351 scan_info->request_ccb->ccb_h.pinfo.priority); 1352 work_ccb->ccb_h.func_code = XPT_SCAN_LUN; 1353 work_ccb->ccb_h.cbfcnp = ata_scan_bus; 1354 work_ccb->ccb_h.ppriv_ptr0 = scan_info; 1355 work_ccb->crcn.flags = scan_info->request_ccb->crcn.flags; 1356 xpt_action(work_ccb); 1357 break; 1358 default: 1359 break; 1360 } 1361 } 1362 1363 static void 1364 ata_scan_lun(struct cam_periph *periph, struct cam_path *path, 1365 cam_flags flags, union ccb *request_ccb) 1366 { 1367 struct ccb_pathinq cpi; 1368 cam_status status; 1369 struct cam_path *new_path; 1370 struct cam_periph *old_periph; 1371 1372 CAM_DEBUG(path, CAM_DEBUG_TRACE, ("xpt_scan_lun\n")); 1373 1374 xpt_setup_ccb(&cpi.ccb_h, path, CAM_PRIORITY_NONE); 1375 cpi.ccb_h.func_code = XPT_PATH_INQ; 1376 xpt_action((union ccb *)&cpi); 1377 1378 if (cpi.ccb_h.status != CAM_REQ_CMP) { 1379 if (request_ccb != NULL) { 1380 request_ccb->ccb_h.status = cpi.ccb_h.status; 1381 xpt_done(request_ccb); 1382 } 1383 return; 1384 } 1385 1386 if (request_ccb == NULL) { 1387 request_ccb = malloc(sizeof(union ccb), M_CAMXPT, M_NOWAIT); 1388 if (request_ccb == NULL) { 1389 xpt_print(path, "xpt_scan_lun: can't allocate CCB, " 1390 "can't continue\n"); 1391 return; 1392 } 1393 new_path = malloc(sizeof(*new_path), M_CAMXPT, M_NOWAIT); 1394 if (new_path == NULL) { 1395 xpt_print(path, "xpt_scan_lun: can't allocate path, " 1396 "can't continue\n"); 1397 free(request_ccb, M_CAMXPT); 1398 return; 1399 } 1400 status = xpt_compile_path(new_path, xpt_periph, 1401 path->bus->path_id, 1402 path->target->target_id, 1403 path->device->lun_id); 1404 1405 if (status != CAM_REQ_CMP) { 1406 xpt_print(path, "xpt_scan_lun: can't compile path, " 1407 "can't continue\n"); 1408 free(request_ccb, M_CAMXPT); 1409 free(new_path, M_CAMXPT); 1410 return; 1411 } 1412 xpt_setup_ccb(&request_ccb->ccb_h, new_path, CAM_PRIORITY_XPT); 1413 request_ccb->ccb_h.cbfcnp = xptscandone; 1414 request_ccb->ccb_h.func_code = XPT_SCAN_LUN; 1415 request_ccb->crcn.flags = flags; 1416 } 1417 1418 if ((old_periph = cam_periph_find(path, "aprobe")) != NULL) { 1419 probe_softc *softc; 1420 1421 softc = (probe_softc *)old_periph->softc; 1422 TAILQ_INSERT_TAIL(&softc->request_ccbs, &request_ccb->ccb_h, 1423 periph_links.tqe); 1424 softc->restart = 1; 1425 } else { 1426 status = cam_periph_alloc(proberegister, NULL, probecleanup, 1427 probestart, "aprobe", 1428 CAM_PERIPH_BIO, 1429 request_ccb->ccb_h.path, NULL, 0, 1430 request_ccb); 1431 1432 if (status != CAM_REQ_CMP) { 1433 xpt_print(path, "xpt_scan_lun: cam_alloc_periph " 1434 "returned an error, can't continue probe\n"); 1435 request_ccb->ccb_h.status = status; 1436 xpt_done(request_ccb); 1437 } 1438 } 1439 } 1440 1441 static void 1442 xptscandone(struct cam_periph *periph, union ccb *done_ccb) 1443 { 1444 xpt_release_path(done_ccb->ccb_h.path); 1445 free(done_ccb->ccb_h.path, M_CAMXPT); 1446 free(done_ccb, M_CAMXPT); 1447 } 1448 1449 static struct cam_ed * 1450 ata_alloc_device(struct cam_eb *bus, struct cam_et *target, lun_id_t lun_id) 1451 { 1452 struct cam_path path; 1453 struct ata_quirk_entry *quirk; 1454 struct cam_ed *device; 1455 struct cam_ed *cur_device; 1456 1457 device = xpt_alloc_device(bus, target, lun_id); 1458 if (device == NULL) 1459 return (NULL); 1460 1461 /* 1462 * Take the default quirk entry until we have inquiry 1463 * data and can determine a better quirk to use. 1464 */ 1465 quirk = &ata_quirk_table[ata_quirk_table_size - 1]; 1466 device->quirk = (void *)quirk; 1467 device->mintags = 0; 1468 device->maxtags = 0; 1469 bzero(&device->inq_data, sizeof(device->inq_data)); 1470 device->inq_flags = 0; 1471 device->queue_flags = 0; 1472 device->serial_num = NULL; 1473 device->serial_num_len = 0; 1474 1475 /* 1476 * XXX should be limited by number of CCBs this bus can 1477 * do. 1478 */ 1479 bus->sim->max_ccbs += device->ccbq.devq_openings; 1480 /* Insertion sort into our target's device list */ 1481 cur_device = TAILQ_FIRST(&target->ed_entries); 1482 while (cur_device != NULL && cur_device->lun_id < lun_id) 1483 cur_device = TAILQ_NEXT(cur_device, links); 1484 if (cur_device != NULL) { 1485 TAILQ_INSERT_BEFORE(cur_device, device, links); 1486 } else { 1487 TAILQ_INSERT_TAIL(&target->ed_entries, device, links); 1488 } 1489 target->generation++; 1490 if (lun_id != CAM_LUN_WILDCARD) { 1491 xpt_compile_path(&path, 1492 NULL, 1493 bus->path_id, 1494 target->target_id, 1495 lun_id); 1496 ata_device_transport(&path); 1497 xpt_release_path(&path); 1498 } 1499 1500 return (device); 1501 } 1502 1503 static void 1504 ata_device_transport(struct cam_path *path) 1505 { 1506 struct ccb_pathinq cpi; 1507 struct ccb_trans_settings cts; 1508 struct scsi_inquiry_data *inq_buf = NULL; 1509 struct ata_params *ident_buf = NULL; 1510 1511 /* Get transport information from the SIM */ 1512 xpt_setup_ccb(&cpi.ccb_h, path, CAM_PRIORITY_NONE); 1513 cpi.ccb_h.func_code = XPT_PATH_INQ; 1514 xpt_action((union ccb *)&cpi); 1515 1516 path->device->transport = cpi.transport; 1517 if ((path->device->flags & CAM_DEV_INQUIRY_DATA_VALID) != 0) 1518 inq_buf = &path->device->inq_data; 1519 if ((path->device->flags & CAM_DEV_IDENTIFY_DATA_VALID) != 0) 1520 ident_buf = &path->device->ident_data; 1521 if (path->device->protocol == PROTO_ATA) { 1522 path->device->protocol_version = ident_buf ? 1523 ata_version(ident_buf->version_major) : cpi.protocol_version; 1524 } else if (path->device->protocol == PROTO_SCSI) { 1525 path->device->protocol_version = inq_buf ? 1526 SID_ANSI_REV(inq_buf) : cpi.protocol_version; 1527 } 1528 path->device->transport_version = ident_buf ? 1529 ata_version(ident_buf->version_major) : cpi.transport_version; 1530 1531 /* Tell the controller what we think */ 1532 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NONE); 1533 cts.ccb_h.func_code = XPT_SET_TRAN_SETTINGS; 1534 cts.type = CTS_TYPE_CURRENT_SETTINGS; 1535 cts.transport = path->device->transport; 1536 cts.transport_version = path->device->transport_version; 1537 cts.protocol = path->device->protocol; 1538 cts.protocol_version = path->device->protocol_version; 1539 cts.proto_specific.valid = 0; 1540 if (ident_buf) { 1541 if (path->device->transport == XPORT_ATA) { 1542 cts.xport_specific.ata.atapi = 1543 ((ident_buf->config & ATA_PROTO_MASK) == ATA_PROTO_ATAPI_16) ? 16 : 1544 ((ident_buf->config & ATA_PROTO_MASK) == ATA_PROTO_ATAPI_12) ? 12 : 0; 1545 cts.xport_specific.ata.valid = CTS_ATA_VALID_ATAPI; 1546 } else { 1547 cts.xport_specific.sata.atapi = 1548 ((ident_buf->config & ATA_PROTO_MASK) == ATA_PROTO_ATAPI_16) ? 16 : 1549 ((ident_buf->config & ATA_PROTO_MASK) == ATA_PROTO_ATAPI_12) ? 12 : 0; 1550 cts.xport_specific.sata.valid = CTS_SATA_VALID_ATAPI; 1551 } 1552 } else 1553 cts.xport_specific.valid = 0; 1554 xpt_action((union ccb *)&cts); 1555 } 1556 1557 static void 1558 ata_action(union ccb *start_ccb) 1559 { 1560 1561 switch (start_ccb->ccb_h.func_code) { 1562 case XPT_SET_TRAN_SETTINGS: 1563 { 1564 ata_set_transfer_settings(&start_ccb->cts, 1565 start_ccb->ccb_h.path->device, 1566 /*async_update*/FALSE); 1567 break; 1568 } 1569 case XPT_SCAN_BUS: 1570 case XPT_SCAN_TGT: 1571 ata_scan_bus(start_ccb->ccb_h.path->periph, start_ccb); 1572 break; 1573 case XPT_SCAN_LUN: 1574 ata_scan_lun(start_ccb->ccb_h.path->periph, 1575 start_ccb->ccb_h.path, start_ccb->crcn.flags, 1576 start_ccb); 1577 break; 1578 case XPT_GET_TRAN_SETTINGS: 1579 { 1580 struct cam_sim *sim; 1581 1582 sim = start_ccb->ccb_h.path->bus->sim; 1583 (*(sim->sim_action))(sim, start_ccb); 1584 break; 1585 } 1586 case XPT_SCSI_IO: 1587 { 1588 struct cam_ed *device; 1589 u_int maxlen = 0; 1590 1591 device = start_ccb->ccb_h.path->device; 1592 if (device->protocol == PROTO_SCSI && 1593 (device->flags & CAM_DEV_IDENTIFY_DATA_VALID)) { 1594 uint16_t p = 1595 device->ident_data.config & ATA_PROTO_MASK; 1596 1597 maxlen = (p == ATA_PROTO_ATAPI_16) ? 16 : 1598 (p == ATA_PROTO_ATAPI_12) ? 12 : 0; 1599 } 1600 if (start_ccb->csio.cdb_len > maxlen) { 1601 start_ccb->ccb_h.status = CAM_REQ_INVALID; 1602 xpt_done(start_ccb); 1603 break; 1604 } 1605 /* FALLTHROUGH */ 1606 } 1607 default: 1608 xpt_action_default(start_ccb); 1609 break; 1610 } 1611 } 1612 1613 static void 1614 ata_set_transfer_settings(struct ccb_trans_settings *cts, struct cam_ed *device, 1615 int async_update) 1616 { 1617 struct ccb_pathinq cpi; 1618 struct ccb_trans_settings cur_cts; 1619 struct ccb_trans_settings_scsi *scsi; 1620 struct ccb_trans_settings_scsi *cur_scsi; 1621 struct cam_sim *sim; 1622 struct scsi_inquiry_data *inq_data; 1623 1624 if (device == NULL) { 1625 cts->ccb_h.status = CAM_PATH_INVALID; 1626 xpt_done((union ccb *)cts); 1627 return; 1628 } 1629 1630 if (cts->protocol == PROTO_UNKNOWN 1631 || cts->protocol == PROTO_UNSPECIFIED) { 1632 cts->protocol = device->protocol; 1633 cts->protocol_version = device->protocol_version; 1634 } 1635 1636 if (cts->protocol_version == PROTO_VERSION_UNKNOWN 1637 || cts->protocol_version == PROTO_VERSION_UNSPECIFIED) 1638 cts->protocol_version = device->protocol_version; 1639 1640 if (cts->protocol != device->protocol) { 1641 xpt_print(cts->ccb_h.path, "Uninitialized Protocol %x:%x?\n", 1642 cts->protocol, device->protocol); 1643 cts->protocol = device->protocol; 1644 } 1645 1646 if (cts->protocol_version > device->protocol_version) { 1647 if (bootverbose) { 1648 xpt_print(cts->ccb_h.path, "Down reving Protocol " 1649 "Version from %d to %d?\n", cts->protocol_version, 1650 device->protocol_version); 1651 } 1652 cts->protocol_version = device->protocol_version; 1653 } 1654 1655 if (cts->transport == XPORT_UNKNOWN 1656 || cts->transport == XPORT_UNSPECIFIED) { 1657 cts->transport = device->transport; 1658 cts->transport_version = device->transport_version; 1659 } 1660 1661 if (cts->transport_version == XPORT_VERSION_UNKNOWN 1662 || cts->transport_version == XPORT_VERSION_UNSPECIFIED) 1663 cts->transport_version = device->transport_version; 1664 1665 if (cts->transport != device->transport) { 1666 xpt_print(cts->ccb_h.path, "Uninitialized Transport %x:%x?\n", 1667 cts->transport, device->transport); 1668 cts->transport = device->transport; 1669 } 1670 1671 if (cts->transport_version > device->transport_version) { 1672 if (bootverbose) { 1673 xpt_print(cts->ccb_h.path, "Down reving Transport " 1674 "Version from %d to %d?\n", cts->transport_version, 1675 device->transport_version); 1676 } 1677 cts->transport_version = device->transport_version; 1678 } 1679 1680 sim = cts->ccb_h.path->bus->sim; 1681 1682 /* 1683 * Nothing more of interest to do unless 1684 * this is a device connected via the 1685 * SCSI protocol. 1686 */ 1687 if (cts->protocol != PROTO_SCSI) { 1688 if (async_update == FALSE) 1689 (*(sim->sim_action))(sim, (union ccb *)cts); 1690 return; 1691 } 1692 1693 inq_data = &device->inq_data; 1694 scsi = &cts->proto_specific.scsi; 1695 xpt_setup_ccb(&cpi.ccb_h, cts->ccb_h.path, CAM_PRIORITY_NONE); 1696 cpi.ccb_h.func_code = XPT_PATH_INQ; 1697 xpt_action((union ccb *)&cpi); 1698 1699 /* SCSI specific sanity checking */ 1700 if ((cpi.hba_inquiry & PI_TAG_ABLE) == 0 1701 || (INQ_DATA_TQ_ENABLED(inq_data)) == 0 1702 || (device->queue_flags & SCP_QUEUE_DQUE) != 0 1703 || (device->mintags == 0)) { 1704 /* 1705 * Can't tag on hardware that doesn't support tags, 1706 * doesn't have it enabled, or has broken tag support. 1707 */ 1708 scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB; 1709 } 1710 1711 if (async_update == FALSE) { 1712 /* 1713 * Perform sanity checking against what the 1714 * controller and device can do. 1715 */ 1716 xpt_setup_ccb(&cur_cts.ccb_h, cts->ccb_h.path, CAM_PRIORITY_NONE); 1717 cur_cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 1718 cur_cts.type = cts->type; 1719 xpt_action((union ccb *)&cur_cts); 1720 if ((cur_cts.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) { 1721 return; 1722 } 1723 cur_scsi = &cur_cts.proto_specific.scsi; 1724 if ((scsi->valid & CTS_SCSI_VALID_TQ) == 0) { 1725 scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB; 1726 scsi->flags |= cur_scsi->flags & CTS_SCSI_FLAGS_TAG_ENB; 1727 } 1728 if ((cur_scsi->valid & CTS_SCSI_VALID_TQ) == 0) 1729 scsi->flags &= ~CTS_SCSI_FLAGS_TAG_ENB; 1730 } 1731 1732 if (cts->type == CTS_TYPE_CURRENT_SETTINGS 1733 && (scsi->valid & CTS_SCSI_VALID_TQ) != 0) { 1734 int device_tagenb; 1735 1736 /* 1737 * If we are transitioning from tags to no-tags or 1738 * vice-versa, we need to carefully freeze and restart 1739 * the queue so that we don't overlap tagged and non-tagged 1740 * commands. We also temporarily stop tags if there is 1741 * a change in transfer negotiation settings to allow 1742 * "tag-less" negotiation. 1743 */ 1744 if ((device->flags & CAM_DEV_TAG_AFTER_COUNT) != 0 1745 || (device->inq_flags & SID_CmdQue) != 0) 1746 device_tagenb = TRUE; 1747 else 1748 device_tagenb = FALSE; 1749 1750 if (((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0 1751 && device_tagenb == FALSE) 1752 || ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) == 0 1753 && device_tagenb == TRUE)) { 1754 1755 if ((scsi->flags & CTS_SCSI_FLAGS_TAG_ENB) != 0) { 1756 /* 1757 * Delay change to use tags until after a 1758 * few commands have gone to this device so 1759 * the controller has time to perform transfer 1760 * negotiations without tagged messages getting 1761 * in the way. 1762 */ 1763 device->tag_delay_count = CAM_TAG_DELAY_COUNT; 1764 device->flags |= CAM_DEV_TAG_AFTER_COUNT; 1765 } else { 1766 xpt_stop_tags(cts->ccb_h.path); 1767 } 1768 } 1769 } 1770 if (async_update == FALSE) 1771 (*(sim->sim_action))(sim, (union ccb *)cts); 1772 } 1773 1774 /* 1775 * Handle any per-device event notifications that require action by the XPT. 1776 */ 1777 static void 1778 ata_dev_async(u_int32_t async_code, struct cam_eb *bus, struct cam_et *target, 1779 struct cam_ed *device, void *async_arg) 1780 { 1781 cam_status status; 1782 struct cam_path newpath; 1783 1784 /* 1785 * We only need to handle events for real devices. 1786 */ 1787 if (target->target_id == CAM_TARGET_WILDCARD 1788 || device->lun_id == CAM_LUN_WILDCARD) 1789 return; 1790 1791 /* 1792 * We need our own path with wildcards expanded to 1793 * handle certain types of events. 1794 */ 1795 if ((async_code == AC_SENT_BDR) 1796 || (async_code == AC_BUS_RESET) 1797 || (async_code == AC_INQ_CHANGED)) 1798 status = xpt_compile_path(&newpath, NULL, 1799 bus->path_id, 1800 target->target_id, 1801 device->lun_id); 1802 else 1803 status = CAM_REQ_CMP_ERR; 1804 1805 if (status == CAM_REQ_CMP) { 1806 if (async_code == AC_INQ_CHANGED) { 1807 /* 1808 * We've sent a start unit command, or 1809 * something similar to a device that 1810 * may have caused its inquiry data to 1811 * change. So we re-scan the device to 1812 * refresh the inquiry data for it. 1813 */ 1814 ata_scan_lun(newpath.periph, &newpath, 1815 CAM_EXPECT_INQ_CHANGE, NULL); 1816 } else { 1817 /* We need to reinitialize device after reset. */ 1818 ata_scan_lun(newpath.periph, &newpath, 1819 0, NULL); 1820 } 1821 xpt_release_path(&newpath); 1822 } else if (async_code == AC_LOST_DEVICE && 1823 (device->flags & CAM_DEV_UNCONFIGURED) == 0) { 1824 device->flags |= CAM_DEV_UNCONFIGURED; 1825 xpt_release_device(device); 1826 } else if (async_code == AC_TRANSFER_NEG) { 1827 struct ccb_trans_settings *settings; 1828 1829 settings = (struct ccb_trans_settings *)async_arg; 1830 ata_set_transfer_settings(settings, device, 1831 /*async_update*/TRUE); 1832 } 1833 } 1834 1835 static void 1836 ata_announce_periph(struct cam_periph *periph) 1837 { 1838 struct ccb_pathinq cpi; 1839 struct ccb_trans_settings cts; 1840 struct cam_path *path = periph->path; 1841 u_int speed; 1842 u_int mb; 1843 1844 mtx_assert(periph->sim->mtx, MA_OWNED); 1845 1846 xpt_setup_ccb(&cts.ccb_h, path, CAM_PRIORITY_NORMAL); 1847 cts.ccb_h.func_code = XPT_GET_TRAN_SETTINGS; 1848 cts.type = CTS_TYPE_CURRENT_SETTINGS; 1849 xpt_action((union ccb*)&cts); 1850 if ((cts.ccb_h.status & CAM_STATUS_MASK) != CAM_REQ_CMP) 1851 return; 1852 /* Ask the SIM for its base transfer speed */ 1853 xpt_setup_ccb(&cpi.ccb_h, path, CAM_PRIORITY_NORMAL); 1854 cpi.ccb_h.func_code = XPT_PATH_INQ; 1855 xpt_action((union ccb *)&cpi); 1856 /* Report connection speed */ 1857 speed = cpi.base_transfer_speed; 1858 if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_ATA) { 1859 struct ccb_trans_settings_ata *ata = 1860 &cts.xport_specific.ata; 1861 1862 if (ata->valid & CTS_ATA_VALID_MODE) 1863 speed = ata_mode2speed(ata->mode); 1864 } 1865 if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_SATA) { 1866 struct ccb_trans_settings_sata *sata = 1867 &cts.xport_specific.sata; 1868 1869 if (sata->valid & CTS_SATA_VALID_REVISION) 1870 speed = ata_revision2speed(sata->revision); 1871 } 1872 mb = speed / 1000; 1873 if (mb > 0) 1874 printf("%s%d: %d.%03dMB/s transfers", 1875 periph->periph_name, periph->unit_number, 1876 mb, speed % 1000); 1877 else 1878 printf("%s%d: %dKB/s transfers", periph->periph_name, 1879 periph->unit_number, speed); 1880 /* Report additional information about connection */ 1881 if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_ATA) { 1882 struct ccb_trans_settings_ata *ata = 1883 &cts.xport_specific.ata; 1884 1885 printf(" ("); 1886 if (ata->valid & CTS_ATA_VALID_MODE) 1887 printf("%s, ", ata_mode2string(ata->mode)); 1888 if ((ata->valid & CTS_ATA_VALID_ATAPI) && ata->atapi != 0) 1889 printf("ATAPI %dbytes, ", ata->atapi); 1890 if (ata->valid & CTS_ATA_VALID_BYTECOUNT) 1891 printf("PIO %dbytes", ata->bytecount); 1892 printf(")"); 1893 } 1894 if (cts.ccb_h.status == CAM_REQ_CMP && cts.transport == XPORT_SATA) { 1895 struct ccb_trans_settings_sata *sata = 1896 &cts.xport_specific.sata; 1897 1898 printf(" ("); 1899 if (sata->valid & CTS_SATA_VALID_REVISION) 1900 printf("SATA %d.x, ", sata->revision); 1901 else 1902 printf("SATA, "); 1903 if (sata->valid & CTS_SATA_VALID_MODE) 1904 printf("%s, ", ata_mode2string(sata->mode)); 1905 if ((sata->valid & CTS_ATA_VALID_ATAPI) && sata->atapi != 0) 1906 printf("ATAPI %dbytes, ", sata->atapi); 1907 if (sata->valid & CTS_SATA_VALID_BYTECOUNT) 1908 printf("PIO %dbytes", sata->bytecount); 1909 printf(")"); 1910 } 1911 printf("\n"); 1912 } 1913 1914