1 /*- 2 * Implementation of the Target Mode 'Black Hole device' for CAM. 3 * 4 * SPDX-License-Identifier: BSD-2-Clause-FreeBSD 5 * 6 * Copyright (c) 1999 Justin T. Gibbs. 7 * All rights reserved. 8 * 9 * Redistribution and use in source and binary forms, with or without 10 * modification, are permitted provided that the following conditions 11 * are met: 12 * 1. Redistributions of source code must retain the above copyright 13 * notice, this list of conditions, and the following disclaimer, 14 * without modification, immediately at the beginning of the file. 15 * 2. The name of the author may not be used to endorse or promote products 16 * derived from this software without specific prior written permission. 17 * 18 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 19 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 20 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 21 * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 22 * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 23 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 24 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 25 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 26 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 27 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 28 * SUCH DAMAGE. 29 */ 30 31 #include <sys/cdefs.h> 32 __FBSDID("$FreeBSD$"); 33 34 #include <sys/param.h> 35 #include <sys/queue.h> 36 #include <sys/systm.h> 37 #include <sys/kernel.h> 38 #include <sys/types.h> 39 #include <sys/bio.h> 40 #include <sys/conf.h> 41 #include <sys/devicestat.h> 42 #include <sys/malloc.h> 43 #include <sys/uio.h> 44 45 #include <cam/cam.h> 46 #include <cam/cam_ccb.h> 47 #include <cam/cam_periph.h> 48 #include <cam/cam_queue.h> 49 #include <cam/cam_xpt_periph.h> 50 #include <cam/cam_debug.h> 51 #include <cam/cam_sim.h> 52 53 #include <cam/scsi/scsi_all.h> 54 #include <cam/scsi/scsi_message.h> 55 56 static MALLOC_DEFINE(M_SCSIBH, "SCSI bh", "SCSI blackhole buffers"); 57 58 typedef enum { 59 TARGBH_STATE_NORMAL, 60 TARGBH_STATE_EXCEPTION, 61 TARGBH_STATE_TEARDOWN 62 } targbh_state; 63 64 typedef enum { 65 TARGBH_FLAG_NONE = 0x00, 66 TARGBH_FLAG_LUN_ENABLED = 0x01 67 } targbh_flags; 68 69 typedef enum { 70 TARGBH_CCB_WORKQ 71 } targbh_ccb_types; 72 73 #define MAX_ACCEPT 8 74 #define MAX_IMMEDIATE 16 75 #define MAX_BUF_SIZE 256 /* Max inquiry/sense/mode page transfer */ 76 77 /* Offsets into our private CCB area for storing accept information */ 78 #define ccb_type ppriv_field0 79 #define ccb_descr ppriv_ptr1 80 81 /* We stick a pointer to the originating accept TIO in each continue I/O CCB */ 82 #define ccb_atio ppriv_ptr1 83 84 TAILQ_HEAD(ccb_queue, ccb_hdr); 85 86 struct targbh_softc { 87 struct ccb_queue pending_queue; 88 struct ccb_queue work_queue; 89 struct ccb_queue unknown_atio_queue; 90 struct devstat device_stats; 91 targbh_state state; 92 targbh_flags flags; 93 u_int init_level; 94 u_int inq_data_len; 95 struct ccb_accept_tio *accept_tio_list; 96 struct ccb_hdr_slist immed_notify_slist; 97 }; 98 99 struct targbh_cmd_desc { 100 struct ccb_accept_tio* atio_link; 101 u_int data_resid; /* How much left to transfer */ 102 u_int data_increment;/* Amount to send before next disconnect */ 103 void* data; /* The data. Can be from backing_store or not */ 104 void* backing_store;/* Backing store allocated for this descriptor*/ 105 u_int max_size; /* Size of backing_store */ 106 u_int32_t timeout; 107 u_int8_t status; /* Status to return to initiator */ 108 }; 109 110 static struct scsi_inquiry_data no_lun_inq_data = 111 { 112 T_NODEVICE | (SID_QUAL_BAD_LU << 5), 0, 113 /* version */2, /* format version */2 114 }; 115 116 static struct scsi_sense_data_fixed no_lun_sense_data = 117 { 118 SSD_CURRENT_ERROR|SSD_ERRCODE_VALID, 119 0, 120 SSD_KEY_NOT_READY, 121 { 0, 0, 0, 0 }, 122 /*extra_len*/offsetof(struct scsi_sense_data_fixed, fru) 123 - offsetof(struct scsi_sense_data_fixed, extra_len), 124 { 0, 0, 0, 0 }, 125 /* Logical Unit Not Supported */ 126 /*ASC*/0x25, /*ASCQ*/0 127 }; 128 129 static const int request_sense_size = offsetof(struct scsi_sense_data_fixed, fru); 130 131 static periph_init_t targbhinit; 132 static void targbhasync(void *callback_arg, u_int32_t code, 133 struct cam_path *path, void *arg); 134 static cam_status targbhenlun(struct cam_periph *periph); 135 static cam_status targbhdislun(struct cam_periph *periph); 136 static periph_ctor_t targbhctor; 137 static periph_dtor_t targbhdtor; 138 static periph_start_t targbhstart; 139 static void targbhdone(struct cam_periph *periph, 140 union ccb *done_ccb); 141 #ifdef NOTYET 142 static int targbherror(union ccb *ccb, u_int32_t cam_flags, 143 u_int32_t sense_flags); 144 #endif 145 static struct targbh_cmd_desc* targbhallocdescr(void); 146 static void targbhfreedescr(struct targbh_cmd_desc *buf); 147 148 static struct periph_driver targbhdriver = 149 { 150 targbhinit, "targbh", 151 TAILQ_HEAD_INITIALIZER(targbhdriver.units), /* generation */ 0 152 }; 153 154 PERIPHDRIVER_DECLARE(targbh, targbhdriver); 155 156 static void 157 targbhinit(void) 158 { 159 cam_status status; 160 161 /* 162 * Install a global async callback. This callback will 163 * receive async callbacks like "new path registered". 164 */ 165 status = xpt_register_async(AC_PATH_REGISTERED | AC_PATH_DEREGISTERED, 166 targbhasync, NULL, NULL); 167 168 if (status != CAM_REQ_CMP) { 169 printf("targbh: Failed to attach master async callback " 170 "due to status 0x%x!\n", status); 171 } 172 } 173 174 static void 175 targbhasync(void *callback_arg, u_int32_t code, 176 struct cam_path *path, void *arg) 177 { 178 struct cam_path *new_path; 179 struct ccb_pathinq *cpi; 180 path_id_t bus_path_id; 181 cam_status status; 182 183 cpi = (struct ccb_pathinq *)arg; 184 if (code == AC_PATH_REGISTERED) 185 bus_path_id = cpi->ccb_h.path_id; 186 else 187 bus_path_id = xpt_path_path_id(path); 188 /* 189 * Allocate a peripheral instance for 190 * this target instance. 191 */ 192 status = xpt_create_path(&new_path, NULL, 193 bus_path_id, 194 CAM_TARGET_WILDCARD, CAM_LUN_WILDCARD); 195 if (status != CAM_REQ_CMP) { 196 printf("targbhasync: Unable to create path " 197 "due to status 0x%x\n", status); 198 return; 199 } 200 201 switch (code) { 202 case AC_PATH_REGISTERED: 203 { 204 /* Only attach to controllers that support target mode */ 205 if ((cpi->target_sprt & PIT_PROCESSOR) == 0) 206 break; 207 208 status = cam_periph_alloc(targbhctor, NULL, targbhdtor, 209 targbhstart, 210 "targbh", CAM_PERIPH_BIO, 211 new_path, targbhasync, 212 AC_PATH_REGISTERED, 213 cpi); 214 break; 215 } 216 case AC_PATH_DEREGISTERED: 217 { 218 struct cam_periph *periph; 219 220 if ((periph = cam_periph_find(new_path, "targbh")) != NULL) 221 cam_periph_invalidate(periph); 222 break; 223 } 224 default: 225 break; 226 } 227 xpt_free_path(new_path); 228 } 229 230 /* Attempt to enable our lun */ 231 static cam_status 232 targbhenlun(struct cam_periph *periph) 233 { 234 union ccb immed_ccb; 235 struct targbh_softc *softc; 236 cam_status status; 237 int i; 238 239 softc = (struct targbh_softc *)periph->softc; 240 241 if ((softc->flags & TARGBH_FLAG_LUN_ENABLED) != 0) 242 return (CAM_REQ_CMP); 243 244 memset(&immed_ccb, 0, sizeof(immed_ccb)); 245 xpt_setup_ccb(&immed_ccb.ccb_h, periph->path, CAM_PRIORITY_NORMAL); 246 immed_ccb.ccb_h.func_code = XPT_EN_LUN; 247 248 /* Don't need support for any vendor specific commands */ 249 immed_ccb.cel.grp6_len = 0; 250 immed_ccb.cel.grp7_len = 0; 251 immed_ccb.cel.enable = 1; 252 xpt_action(&immed_ccb); 253 status = immed_ccb.ccb_h.status; 254 if (status != CAM_REQ_CMP) { 255 xpt_print(periph->path, 256 "targbhenlun - Enable Lun Rejected with status 0x%x\n", 257 status); 258 return (status); 259 } 260 261 softc->flags |= TARGBH_FLAG_LUN_ENABLED; 262 263 /* 264 * Build up a buffer of accept target I/O 265 * operations for incoming selections. 266 */ 267 for (i = 0; i < MAX_ACCEPT; i++) { 268 struct ccb_accept_tio *atio; 269 270 atio = (struct ccb_accept_tio*)malloc(sizeof(*atio), M_SCSIBH, 271 M_ZERO | M_NOWAIT); 272 if (atio == NULL) { 273 status = CAM_RESRC_UNAVAIL; 274 break; 275 } 276 277 atio->ccb_h.ccb_descr = targbhallocdescr(); 278 279 if (atio->ccb_h.ccb_descr == NULL) { 280 free(atio, M_SCSIBH); 281 status = CAM_RESRC_UNAVAIL; 282 break; 283 } 284 285 xpt_setup_ccb(&atio->ccb_h, periph->path, CAM_PRIORITY_NORMAL); 286 atio->ccb_h.func_code = XPT_ACCEPT_TARGET_IO; 287 atio->ccb_h.cbfcnp = targbhdone; 288 ((struct targbh_cmd_desc*)atio->ccb_h.ccb_descr)->atio_link = 289 softc->accept_tio_list; 290 softc->accept_tio_list = atio; 291 xpt_action((union ccb *)atio); 292 status = atio->ccb_h.status; 293 if (status != CAM_REQ_INPROG) 294 break; 295 } 296 297 if (i == 0) { 298 xpt_print(periph->path, 299 "targbhenlun - Could not allocate accept tio CCBs: status " 300 "= 0x%x\n", status); 301 targbhdislun(periph); 302 return (CAM_REQ_CMP_ERR); 303 } 304 305 /* 306 * Build up a buffer of immediate notify CCBs 307 * so the SIM can tell us of asynchronous target mode events. 308 */ 309 for (i = 0; i < MAX_ACCEPT; i++) { 310 struct ccb_immediate_notify *inot; 311 312 inot = (struct ccb_immediate_notify*)malloc(sizeof(*inot), 313 M_SCSIBH, M_ZERO | M_NOWAIT); 314 315 if (inot == NULL) { 316 status = CAM_RESRC_UNAVAIL; 317 break; 318 } 319 320 xpt_setup_ccb(&inot->ccb_h, periph->path, CAM_PRIORITY_NORMAL); 321 inot->ccb_h.func_code = XPT_IMMEDIATE_NOTIFY; 322 inot->ccb_h.cbfcnp = targbhdone; 323 SLIST_INSERT_HEAD(&softc->immed_notify_slist, &inot->ccb_h, 324 periph_links.sle); 325 xpt_action((union ccb *)inot); 326 status = inot->ccb_h.status; 327 if (status != CAM_REQ_INPROG) 328 break; 329 } 330 331 if (i == 0) { 332 xpt_print(periph->path, 333 "targbhenlun - Could not allocate immediate notify " 334 "CCBs: status = 0x%x\n", status); 335 targbhdislun(periph); 336 return (CAM_REQ_CMP_ERR); 337 } 338 339 return (CAM_REQ_CMP); 340 } 341 342 static cam_status 343 targbhdislun(struct cam_periph *periph) 344 { 345 union ccb ccb; 346 struct targbh_softc *softc; 347 struct ccb_accept_tio* atio; 348 struct ccb_hdr *ccb_h; 349 350 softc = (struct targbh_softc *)periph->softc; 351 if ((softc->flags & TARGBH_FLAG_LUN_ENABLED) == 0) 352 return CAM_REQ_CMP; 353 354 memset(&ccb, 0, sizeof(ccb)); 355 356 /* XXX Block for Continue I/O completion */ 357 358 /* Kill off all ACCECPT and IMMEDIATE CCBs */ 359 while ((atio = softc->accept_tio_list) != NULL) { 360 361 softc->accept_tio_list = 362 ((struct targbh_cmd_desc*)atio->ccb_h.ccb_descr)->atio_link; 363 xpt_setup_ccb(&ccb.cab.ccb_h, periph->path, CAM_PRIORITY_NORMAL); 364 ccb.cab.ccb_h.func_code = XPT_ABORT; 365 ccb.cab.abort_ccb = (union ccb *)atio; 366 xpt_action(&ccb); 367 } 368 369 while ((ccb_h = SLIST_FIRST(&softc->immed_notify_slist)) != NULL) { 370 SLIST_REMOVE_HEAD(&softc->immed_notify_slist, periph_links.sle); 371 xpt_setup_ccb(&ccb.cab.ccb_h, periph->path, CAM_PRIORITY_NORMAL); 372 ccb.cab.ccb_h.func_code = XPT_ABORT; 373 ccb.cab.abort_ccb = (union ccb *)ccb_h; 374 xpt_action(&ccb); 375 } 376 377 /* 378 * Dissable this lun. 379 */ 380 xpt_setup_ccb(&ccb.cel.ccb_h, periph->path, CAM_PRIORITY_NORMAL); 381 ccb.cel.ccb_h.func_code = XPT_EN_LUN; 382 ccb.cel.enable = 0; 383 xpt_action(&ccb); 384 385 if (ccb.cel.ccb_h.status != CAM_REQ_CMP) 386 printf("targbhdislun - Disabling lun on controller failed " 387 "with status 0x%x\n", ccb.cel.ccb_h.status); 388 else 389 softc->flags &= ~TARGBH_FLAG_LUN_ENABLED; 390 return (ccb.cel.ccb_h.status); 391 } 392 393 static cam_status 394 targbhctor(struct cam_periph *periph, void *arg) 395 { 396 struct targbh_softc *softc; 397 398 /* Allocate our per-instance private storage */ 399 softc = (struct targbh_softc *)malloc(sizeof(*softc), 400 M_SCSIBH, M_NOWAIT); 401 if (softc == NULL) { 402 printf("targctor: unable to malloc softc\n"); 403 return (CAM_REQ_CMP_ERR); 404 } 405 406 bzero(softc, sizeof(*softc)); 407 TAILQ_INIT(&softc->pending_queue); 408 TAILQ_INIT(&softc->work_queue); 409 softc->accept_tio_list = NULL; 410 SLIST_INIT(&softc->immed_notify_slist); 411 softc->state = TARGBH_STATE_NORMAL; 412 periph->softc = softc; 413 softc->init_level++; 414 415 if (targbhenlun(periph) != CAM_REQ_CMP) 416 cam_periph_invalidate(periph); 417 return (CAM_REQ_CMP); 418 } 419 420 static void 421 targbhdtor(struct cam_periph *periph) 422 { 423 struct targbh_softc *softc; 424 425 softc = (struct targbh_softc *)periph->softc; 426 427 softc->state = TARGBH_STATE_TEARDOWN; 428 429 targbhdislun(periph); 430 431 switch (softc->init_level) { 432 case 0: 433 panic("targdtor - impossible init level"); 434 case 1: 435 /* FALLTHROUGH */ 436 default: 437 /* XXX Wait for callback of targbhdislun() */ 438 cam_periph_sleep(periph, softc, PRIBIO, "targbh", hz/2); 439 free(softc, M_SCSIBH); 440 break; 441 } 442 } 443 444 static void 445 targbhstart(struct cam_periph *periph, union ccb *start_ccb) 446 { 447 struct targbh_softc *softc; 448 struct ccb_hdr *ccbh; 449 struct ccb_accept_tio *atio; 450 struct targbh_cmd_desc *desc; 451 struct ccb_scsiio *csio; 452 ccb_flags flags; 453 454 softc = (struct targbh_softc *)periph->softc; 455 456 ccbh = TAILQ_FIRST(&softc->work_queue); 457 if (ccbh == NULL) { 458 xpt_release_ccb(start_ccb); 459 } else { 460 TAILQ_REMOVE(&softc->work_queue, ccbh, periph_links.tqe); 461 TAILQ_INSERT_HEAD(&softc->pending_queue, ccbh, 462 periph_links.tqe); 463 atio = (struct ccb_accept_tio*)ccbh; 464 desc = (struct targbh_cmd_desc *)atio->ccb_h.ccb_descr; 465 466 /* Is this a tagged request? */ 467 flags = atio->ccb_h.flags & 468 (CAM_DIS_DISCONNECT|CAM_TAG_ACTION_VALID|CAM_DIR_MASK); 469 470 csio = &start_ccb->csio; 471 /* 472 * If we are done with the transaction, tell the 473 * controller to send status and perform a CMD_CMPLT. 474 * If we have associated sense data, see if we can 475 * send that too. 476 */ 477 if (desc->data_resid == desc->data_increment) { 478 flags |= CAM_SEND_STATUS; 479 if (atio->sense_len) { 480 csio->sense_len = atio->sense_len; 481 csio->sense_data = atio->sense_data; 482 flags |= CAM_SEND_SENSE; 483 } 484 } 485 486 cam_fill_ctio(csio, 487 /*retries*/2, 488 targbhdone, 489 flags, 490 (flags & CAM_TAG_ACTION_VALID)? 491 MSG_SIMPLE_Q_TAG : 0, 492 atio->tag_id, 493 atio->init_id, 494 desc->status, 495 /*data_ptr*/desc->data_increment == 0 496 ? NULL : desc->data, 497 /*dxfer_len*/desc->data_increment, 498 /*timeout*/desc->timeout); 499 500 /* Override our wildcard attachment */ 501 start_ccb->ccb_h.target_id = atio->ccb_h.target_id; 502 start_ccb->ccb_h.target_lun = atio->ccb_h.target_lun; 503 504 start_ccb->ccb_h.ccb_type = TARGBH_CCB_WORKQ; 505 start_ccb->ccb_h.ccb_atio = atio; 506 CAM_DEBUG(periph->path, CAM_DEBUG_SUBTRACE, 507 ("Sending a CTIO\n")); 508 xpt_action(start_ccb); 509 /* 510 * If the queue was frozen waiting for the response 511 * to this ATIO (for instance disconnection was disallowed), 512 * then release it now that our response has been queued. 513 */ 514 if ((atio->ccb_h.status & CAM_DEV_QFRZN) != 0) { 515 cam_release_devq(periph->path, 516 /*relsim_flags*/0, 517 /*reduction*/0, 518 /*timeout*/0, 519 /*getcount_only*/0); 520 atio->ccb_h.status &= ~CAM_DEV_QFRZN; 521 } 522 ccbh = TAILQ_FIRST(&softc->work_queue); 523 } 524 if (ccbh != NULL) 525 xpt_schedule(periph, CAM_PRIORITY_NORMAL); 526 } 527 528 static void 529 targbhdone(struct cam_periph *periph, union ccb *done_ccb) 530 { 531 struct targbh_softc *softc; 532 533 softc = (struct targbh_softc *)periph->softc; 534 535 switch (done_ccb->ccb_h.func_code) { 536 case XPT_ACCEPT_TARGET_IO: 537 { 538 struct ccb_accept_tio *atio; 539 struct targbh_cmd_desc *descr; 540 u_int8_t *cdb; 541 int priority; 542 543 atio = &done_ccb->atio; 544 descr = (struct targbh_cmd_desc*)atio->ccb_h.ccb_descr; 545 cdb = atio->cdb_io.cdb_bytes; 546 if (softc->state == TARGBH_STATE_TEARDOWN 547 || atio->ccb_h.status == CAM_REQ_ABORTED) { 548 targbhfreedescr(descr); 549 xpt_free_ccb(done_ccb); 550 return; 551 } 552 553 /* 554 * Determine the type of incoming command and 555 * setup our buffer for a response. 556 */ 557 switch (cdb[0]) { 558 case INQUIRY: 559 { 560 struct scsi_inquiry *inq; 561 562 inq = (struct scsi_inquiry *)cdb; 563 CAM_DEBUG(periph->path, CAM_DEBUG_SUBTRACE, 564 ("Saw an inquiry!\n")); 565 /* 566 * Validate the command. We don't 567 * support any VPD pages, so complain 568 * if EVPD is set. 569 */ 570 if ((inq->byte2 & SI_EVPD) != 0 571 || inq->page_code != 0) { 572 atio->ccb_h.flags &= ~CAM_DIR_MASK; 573 atio->ccb_h.flags |= CAM_DIR_NONE; 574 /* 575 * This needs to have other than a 576 * no_lun_sense_data response. 577 */ 578 bcopy(&no_lun_sense_data, &atio->sense_data, 579 min(sizeof(no_lun_sense_data), 580 sizeof(atio->sense_data))); 581 atio->sense_len = sizeof(no_lun_sense_data); 582 descr->data_resid = 0; 583 descr->data_increment = 0; 584 descr->status = SCSI_STATUS_CHECK_COND; 585 break; 586 } 587 /* 588 * Direction is always relative 589 * to the initator. 590 */ 591 atio->ccb_h.flags &= ~CAM_DIR_MASK; 592 atio->ccb_h.flags |= CAM_DIR_IN; 593 descr->data = &no_lun_inq_data; 594 descr->data_resid = MIN(sizeof(no_lun_inq_data), 595 scsi_2btoul(inq->length)); 596 descr->data_increment = descr->data_resid; 597 descr->timeout = 5 * 1000; 598 descr->status = SCSI_STATUS_OK; 599 break; 600 } 601 case REQUEST_SENSE: 602 { 603 struct scsi_request_sense *rsense; 604 605 rsense = (struct scsi_request_sense *)cdb; 606 /* Refer to static sense data */ 607 atio->ccb_h.flags &= ~CAM_DIR_MASK; 608 atio->ccb_h.flags |= CAM_DIR_IN; 609 descr->data = &no_lun_sense_data; 610 descr->data_resid = request_sense_size; 611 descr->data_resid = MIN(descr->data_resid, 612 SCSI_CDB6_LEN(rsense->length)); 613 descr->data_increment = descr->data_resid; 614 descr->timeout = 5 * 1000; 615 descr->status = SCSI_STATUS_OK; 616 break; 617 } 618 default: 619 /* Constant CA, tell initiator */ 620 /* Direction is always relative to the initator */ 621 atio->ccb_h.flags &= ~CAM_DIR_MASK; 622 atio->ccb_h.flags |= CAM_DIR_NONE; 623 bcopy(&no_lun_sense_data, &atio->sense_data, 624 min(sizeof(no_lun_sense_data), 625 sizeof(atio->sense_data))); 626 atio->sense_len = sizeof (no_lun_sense_data); 627 descr->data_resid = 0; 628 descr->data_increment = 0; 629 descr->timeout = 5 * 1000; 630 descr->status = SCSI_STATUS_CHECK_COND; 631 break; 632 } 633 634 /* Queue us up to receive a Continue Target I/O ccb. */ 635 if ((atio->ccb_h.flags & CAM_DIS_DISCONNECT) != 0) { 636 TAILQ_INSERT_HEAD(&softc->work_queue, &atio->ccb_h, 637 periph_links.tqe); 638 priority = 0; 639 } else { 640 TAILQ_INSERT_TAIL(&softc->work_queue, &atio->ccb_h, 641 periph_links.tqe); 642 priority = CAM_PRIORITY_NORMAL; 643 } 644 xpt_schedule(periph, priority); 645 break; 646 } 647 case XPT_CONT_TARGET_IO: 648 { 649 struct ccb_accept_tio *atio; 650 struct targbh_cmd_desc *desc; 651 652 CAM_DEBUG(periph->path, CAM_DEBUG_SUBTRACE, 653 ("Received completed CTIO\n")); 654 atio = (struct ccb_accept_tio*)done_ccb->ccb_h.ccb_atio; 655 desc = (struct targbh_cmd_desc *)atio->ccb_h.ccb_descr; 656 657 TAILQ_REMOVE(&softc->pending_queue, &atio->ccb_h, 658 periph_links.tqe); 659 660 /* 661 * We could check for CAM_SENT_SENSE bein set here, 662 * but since we're not maintaining any CA/UA state, 663 * there's no point. 664 */ 665 atio->sense_len = 0; 666 done_ccb->ccb_h.flags &= ~CAM_SEND_SENSE; 667 done_ccb->ccb_h.status &= ~CAM_SENT_SENSE; 668 669 /* 670 * Any errors will not change the data we return, 671 * so make sure the queue is not left frozen. 672 * XXX - At some point there may be errors that 673 * leave us in a connected state with the 674 * initiator... 675 */ 676 if ((done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0) { 677 printf("Releasing Queue\n"); 678 cam_release_devq(done_ccb->ccb_h.path, 679 /*relsim_flags*/0, 680 /*reduction*/0, 681 /*timeout*/0, 682 /*getcount_only*/0); 683 done_ccb->ccb_h.status &= ~CAM_DEV_QFRZN; 684 } 685 desc->data_resid -= desc->data_increment; 686 xpt_release_ccb(done_ccb); 687 if (softc->state != TARGBH_STATE_TEARDOWN) { 688 /* 689 * Send the original accept TIO back to the 690 * controller to handle more work. 691 */ 692 CAM_DEBUG(periph->path, CAM_DEBUG_SUBTRACE, 693 ("Returning ATIO to target\n")); 694 /* Restore wildcards */ 695 atio->ccb_h.target_id = CAM_TARGET_WILDCARD; 696 atio->ccb_h.target_lun = CAM_LUN_WILDCARD; 697 xpt_action((union ccb *)atio); 698 break; 699 } else { 700 targbhfreedescr(desc); 701 free(atio, M_SCSIBH); 702 } 703 break; 704 } 705 case XPT_IMMEDIATE_NOTIFY: 706 { 707 int frozen; 708 709 frozen = (done_ccb->ccb_h.status & CAM_DEV_QFRZN) != 0; 710 if (softc->state == TARGBH_STATE_TEARDOWN 711 || done_ccb->ccb_h.status == CAM_REQ_ABORTED) { 712 printf("Freed an immediate notify\n"); 713 xpt_free_ccb(done_ccb); 714 } else { 715 /* Requeue for another immediate event */ 716 xpt_action(done_ccb); 717 } 718 if (frozen != 0) 719 cam_release_devq(periph->path, 720 /*relsim_flags*/0, 721 /*opening reduction*/0, 722 /*timeout*/0, 723 /*getcount_only*/0); 724 break; 725 } 726 default: 727 panic("targbhdone: Unexpected ccb opcode"); 728 break; 729 } 730 } 731 732 #ifdef NOTYET 733 static int 734 targbherror(union ccb *ccb, u_int32_t cam_flags, u_int32_t sense_flags) 735 { 736 return 0; 737 } 738 #endif 739 740 static struct targbh_cmd_desc* 741 targbhallocdescr(void) 742 { 743 struct targbh_cmd_desc* descr; 744 745 /* Allocate the targbh_descr structure */ 746 descr = (struct targbh_cmd_desc *)malloc(sizeof(*descr), 747 M_SCSIBH, M_NOWAIT); 748 if (descr == NULL) 749 return (NULL); 750 751 bzero(descr, sizeof(*descr)); 752 753 /* Allocate buffer backing store */ 754 descr->backing_store = malloc(MAX_BUF_SIZE, M_SCSIBH, M_NOWAIT); 755 if (descr->backing_store == NULL) { 756 free(descr, M_SCSIBH); 757 return (NULL); 758 } 759 descr->max_size = MAX_BUF_SIZE; 760 return (descr); 761 } 762 763 static void 764 targbhfreedescr(struct targbh_cmd_desc *descr) 765 { 766 free(descr->backing_store, M_SCSIBH); 767 free(descr, M_SCSIBH); 768 } 769