1c38b150aSNate Lawson /* 2c38b150aSNate Lawson * SCSI Disk Emulator 3c38b150aSNate Lawson * 4c38b150aSNate Lawson * Copyright (c) 2002 Nate Lawson. 5c38b150aSNate Lawson * All rights reserved. 6c38b150aSNate Lawson * 7c38b150aSNate Lawson * Redistribution and use in source and binary forms, with or without 8c38b150aSNate Lawson * modification, are permitted provided that the following conditions 9c38b150aSNate Lawson * are met: 10c38b150aSNate Lawson * 1. Redistributions of source code must retain the above copyright 11c38b150aSNate Lawson * notice, this list of conditions, and the following disclaimer, 12c38b150aSNate Lawson * without modification, immediately at the beginning of the file. 13c38b150aSNate Lawson * 2. The name of the author may not be used to endorse or promote products 14c38b150aSNate Lawson * derived from this software without specific prior written permission. 15c38b150aSNate Lawson * 16c38b150aSNate Lawson * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND 17c38b150aSNate Lawson * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 18c38b150aSNate Lawson * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 19c38b150aSNate Lawson * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR 20c38b150aSNate Lawson * ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL 21c38b150aSNate Lawson * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS 22c38b150aSNate Lawson * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 23c38b150aSNate Lawson * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 24c38b150aSNate Lawson * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 25c38b150aSNate Lawson * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 26c38b150aSNate Lawson * SUCH DAMAGE. 27c38b150aSNate Lawson * 28c38b150aSNate Lawson * $FreeBSD$ 29c38b150aSNate Lawson */ 30c38b150aSNate Lawson 31c38b150aSNate Lawson #include <stdio.h> 32c38b150aSNate Lawson #include <stddef.h> 33c38b150aSNate Lawson #include <stdarg.h> 34c38b150aSNate Lawson #include <stdlib.h> 35c38b150aSNate Lawson #include <string.h> 36c38b150aSNate Lawson #include <err.h> 37c38b150aSNate Lawson #include <aio.h> 38c38b150aSNate Lawson #include <assert.h> 39068d70baSHidetoshi Shimokawa #include <sys/param.h> 40c38b150aSNate Lawson #include <sys/types.h> 41c38b150aSNate Lawson 42c38b150aSNate Lawson #include <cam/cam.h> 43c38b150aSNate Lawson #include <cam/cam_ccb.h> 44c38b150aSNate Lawson #include <cam/scsi/scsi_all.h> 45c38b150aSNate Lawson #include <cam/scsi/scsi_targetio.h> 46c38b150aSNate Lawson #include "scsi_target.h" 47c38b150aSNate Lawson 48c38b150aSNate Lawson typedef int targ_start_func(struct ccb_accept_tio *, struct ccb_scsiio *); 49c38b150aSNate Lawson typedef void targ_done_func(struct ccb_accept_tio *, struct ccb_scsiio *, 50c38b150aSNate Lawson io_ops); 51c38b150aSNate Lawson 52c38b150aSNate Lawson struct targ_cdb_handlers { 53c38b150aSNate Lawson u_int8_t cmd; 54c38b150aSNate Lawson targ_start_func *start; 55c38b150aSNate Lawson targ_done_func *done; 56c38b150aSNate Lawson #define ILLEGAL_CDB 0xFF 57c38b150aSNate Lawson }; 58c38b150aSNate Lawson 59c38b150aSNate Lawson static targ_start_func tcmd_inquiry; 60c38b150aSNate Lawson static targ_start_func tcmd_req_sense; 61c38b150aSNate Lawson static targ_start_func tcmd_rd_cap; 62068d70baSHidetoshi Shimokawa #ifdef READ_16 63068d70baSHidetoshi Shimokawa static targ_start_func tcmd_rd_cap16; 64068d70baSHidetoshi Shimokawa #endif 65c38b150aSNate Lawson static targ_start_func tcmd_rdwr; 66c38b150aSNate Lawson static targ_start_func tcmd_rdwr_decode; 67c38b150aSNate Lawson static targ_done_func tcmd_rdwr_done; 68c38b150aSNate Lawson static targ_start_func tcmd_null_ok; 69c38b150aSNate Lawson static targ_start_func tcmd_illegal_req; 70c38b150aSNate Lawson static int start_io(struct ccb_accept_tio *atio, 71c38b150aSNate Lawson struct ccb_scsiio *ctio, int dir); 72c38b150aSNate Lawson static int init_inquiry(u_int16_t req_flags, u_int16_t sim_flags); 73c38b150aSNate Lawson static struct initiator_state * 74c38b150aSNate Lawson tcmd_get_istate(u_int init_id); 75c38b150aSNate Lawson static void cdb_debug(u_int8_t *cdb, const char *msg, ...); 76c38b150aSNate Lawson 77c38b150aSNate Lawson static struct targ_cdb_handlers cdb_handlers[] = { 78c38b150aSNate Lawson { READ_10, tcmd_rdwr, tcmd_rdwr_done }, 79c38b150aSNate Lawson { WRITE_10, tcmd_rdwr, tcmd_rdwr_done }, 80c38b150aSNate Lawson { READ_6, tcmd_rdwr, tcmd_rdwr_done }, 81c38b150aSNate Lawson { WRITE_6, tcmd_rdwr, tcmd_rdwr_done }, 82c38b150aSNate Lawson { INQUIRY, tcmd_inquiry, NULL }, 83c38b150aSNate Lawson { REQUEST_SENSE, tcmd_req_sense, NULL }, 84c38b150aSNate Lawson { READ_CAPACITY, tcmd_rd_cap, NULL }, 85c38b150aSNate Lawson { TEST_UNIT_READY, tcmd_null_ok, NULL }, 86c38b150aSNate Lawson { START_STOP_UNIT, tcmd_null_ok, NULL }, 87c38b150aSNate Lawson { SYNCHRONIZE_CACHE, tcmd_null_ok, NULL }, 88c38b150aSNate Lawson { MODE_SENSE_6, tcmd_illegal_req, NULL }, 89c38b150aSNate Lawson { MODE_SELECT_6, tcmd_illegal_req, NULL }, 90068d70baSHidetoshi Shimokawa #ifdef READ_16 91068d70baSHidetoshi Shimokawa { READ_16, tcmd_rdwr, tcmd_rdwr_done }, 92068d70baSHidetoshi Shimokawa { WRITE_16, tcmd_rdwr, tcmd_rdwr_done }, 93068d70baSHidetoshi Shimokawa { SERVICE_ACTION_IN, tcmd_rd_cap16, NULL }, 94068d70baSHidetoshi Shimokawa #endif 95c38b150aSNate Lawson { ILLEGAL_CDB, NULL, NULL } 96c38b150aSNate Lawson }; 97c38b150aSNate Lawson 98c38b150aSNate Lawson static struct scsi_inquiry_data inq_data; 99c38b150aSNate Lawson static struct initiator_state istates[MAX_INITIATORS]; 100c38b150aSNate Lawson extern int debug; 101068d70baSHidetoshi Shimokawa extern uint64_t volume_size; 102c38b150aSNate Lawson extern size_t sector_size; 103c38b150aSNate Lawson extern size_t buf_size; 104c38b150aSNate Lawson 105c38b150aSNate Lawson cam_status 106c38b150aSNate Lawson tcmd_init(u_int16_t req_inq_flags, u_int16_t sim_inq_flags) 107c38b150aSNate Lawson { 108c38b150aSNate Lawson struct initiator_state *istate; 109c38b150aSNate Lawson int i, ret; 110c38b150aSNate Lawson 111c38b150aSNate Lawson /* Initialize our inquiry data */ 112c38b150aSNate Lawson ret = init_inquiry(req_inq_flags, sim_inq_flags); 113c38b150aSNate Lawson if (ret != 0) 114c38b150aSNate Lawson return (ret); 115c38b150aSNate Lawson 116c38b150aSNate Lawson /* We start out life with a UA to indicate power-on/reset. */ 117c38b150aSNate Lawson for (i = 0; i < MAX_INITIATORS; i++) { 118c38b150aSNate Lawson istate = tcmd_get_istate(i); 119c38b150aSNate Lawson bzero(istate, sizeof(*istate)); 120c38b150aSNate Lawson istate->pending_ua = UA_POWER_ON; 121c38b150aSNate Lawson } 122c38b150aSNate Lawson 123c38b150aSNate Lawson return (0); 124c38b150aSNate Lawson } 125c38b150aSNate Lawson 126c38b150aSNate Lawson /* Caller allocates CTIO, sets its init_id 127c38b150aSNate Lawson return 0 if done, 1 if more processing needed 128c38b150aSNate Lawson on 0, caller sets SEND_STATUS */ 129c38b150aSNate Lawson int 130c38b150aSNate Lawson tcmd_handle(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio, io_ops event) 131c38b150aSNate Lawson { 132c38b150aSNate Lawson static struct targ_cdb_handlers *last_cmd; 133c38b150aSNate Lawson struct initiator_state *istate; 134c38b150aSNate Lawson struct atio_descr *a_descr; 135c38b150aSNate Lawson int ret; 136c38b150aSNate Lawson 137031bacf8SNate Lawson if (debug) { 138c38b150aSNate Lawson warnx("tcmd_handle atio %p ctio %p atioflags %#x", atio, ctio, 139c38b150aSNate Lawson atio->ccb_h.flags); 140031bacf8SNate Lawson } 141c38b150aSNate Lawson ret = 0; 142c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 143c38b150aSNate Lawson 144c38b150aSNate Lawson /* Do a full lookup if one-behind cache failed */ 145c38b150aSNate Lawson if (last_cmd == NULL || last_cmd->cmd != a_descr->cdb[0]) { 146c38b150aSNate Lawson struct targ_cdb_handlers *h; 147c38b150aSNate Lawson 148c38b150aSNate Lawson for (h = cdb_handlers; h->cmd != ILLEGAL_CDB; h++) { 149c38b150aSNate Lawson if (a_descr->cdb[0] == h->cmd) 150c38b150aSNate Lawson break; 151c38b150aSNate Lawson } 152c38b150aSNate Lawson last_cmd = h; 153c38b150aSNate Lawson } 154c38b150aSNate Lawson if (last_cmd->cmd == ILLEGAL_CDB) { 155c38b150aSNate Lawson if (event != ATIO_WORK) { 156c38b150aSNate Lawson warnx("no done func for %#x???", a_descr->cdb[0]); 157c38b150aSNate Lawson abort(); 158c38b150aSNate Lawson } 159c38b150aSNate Lawson /* Not found, return illegal request */ 160c38b150aSNate Lawson warnx("cdb %#x not handled", a_descr->cdb[0]); 161c38b150aSNate Lawson tcmd_illegal_req(atio, ctio); 162c38b150aSNate Lawson send_ccb((union ccb *)ctio, /*priority*/1); 163c38b150aSNate Lawson return (0); 164c38b150aSNate Lawson } 165c38b150aSNate Lawson 166c38b150aSNate Lawson /* call completion and exit */ 167c38b150aSNate Lawson if (event != ATIO_WORK) { 168c38b150aSNate Lawson if (last_cmd->done != NULL) 169c38b150aSNate Lawson last_cmd->done(atio, ctio, event); 170c38b150aSNate Lawson else 171c38b150aSNate Lawson free_ccb((union ccb *)ctio); 172c38b150aSNate Lawson return (1); 173c38b150aSNate Lawson } 174c38b150aSNate Lawson 175c38b150aSNate Lawson istate = tcmd_get_istate(ctio->init_id); 176c38b150aSNate Lawson if (istate == NULL) { 177c38b150aSNate Lawson tcmd_illegal_req(atio, ctio); 178c38b150aSNate Lawson send_ccb((union ccb *)ctio, /*priority*/1); 179c38b150aSNate Lawson return (0); 180c38b150aSNate Lawson } 181c38b150aSNate Lawson 182c38b150aSNate Lawson if (istate->pending_ca == 0 && istate->pending_ua != 0 && 183c38b150aSNate Lawson a_descr->cdb[0] != INQUIRY) { 184c38b150aSNate Lawson tcmd_sense(ctio->init_id, ctio, SSD_KEY_UNIT_ATTENTION, 185c38b150aSNate Lawson 0x29, istate->pending_ua == UA_POWER_ON ? 1 : 2); 186c38b150aSNate Lawson istate->pending_ca = CA_UNIT_ATTN; 187c38b150aSNate Lawson if (debug) { 188c38b150aSNate Lawson cdb_debug(a_descr->cdb, "UA active for %u: ", 189c38b150aSNate Lawson atio->init_id); 190c38b150aSNate Lawson } 191c38b150aSNate Lawson send_ccb((union ccb *)ctio, /*priority*/1); 192c38b150aSNate Lawson return (0); 193c38b150aSNate Lawson } 194c38b150aSNate Lawson 195c38b150aSNate Lawson /* Store current CA and UA for later */ 196c38b150aSNate Lawson istate->orig_ua = istate->pending_ua; 197c38b150aSNate Lawson istate->orig_ca = istate->pending_ca; 198c38b150aSNate Lawson 199c38b150aSNate Lawson /* 200c38b150aSNate Lawson * As per SAM2, any command that occurs 201c38b150aSNate Lawson * after a CA is reported, clears the CA. We must 202c38b150aSNate Lawson * also clear the UA condition, if any, that caused 203c38b150aSNate Lawson * the CA to occur assuming the UA is not for a 204c38b150aSNate Lawson * persistent condition. 205c38b150aSNate Lawson */ 206c38b150aSNate Lawson istate->pending_ca = CA_NONE; 207c38b150aSNate Lawson if (istate->orig_ca == CA_UNIT_ATTN) 208c38b150aSNate Lawson istate->pending_ua = UA_NONE; 209c38b150aSNate Lawson 210c38b150aSNate Lawson /* If we have a valid handler, call start or completion function */ 211c38b150aSNate Lawson if (last_cmd->cmd != ILLEGAL_CDB) { 212c38b150aSNate Lawson ret = last_cmd->start(atio, ctio); 213c38b150aSNate Lawson /* XXX hack */ 214c38b150aSNate Lawson if (last_cmd->start != tcmd_rdwr) { 215c38b150aSNate Lawson a_descr->init_req += ctio->dxfer_len; 216c38b150aSNate Lawson send_ccb((union ccb *)ctio, /*priority*/1); 217c38b150aSNate Lawson } 218c38b150aSNate Lawson } 219c38b150aSNate Lawson 220c38b150aSNate Lawson return (ret); 221c38b150aSNate Lawson } 222c38b150aSNate Lawson 223c38b150aSNate Lawson static struct initiator_state * 224c38b150aSNate Lawson tcmd_get_istate(u_int init_id) 225c38b150aSNate Lawson { 226c38b150aSNate Lawson if (init_id >= MAX_INITIATORS) { 227c38b150aSNate Lawson warnx("illegal init_id %d, max %d", init_id, MAX_INITIATORS - 1); 228c38b150aSNate Lawson return (NULL); 229c38b150aSNate Lawson } else { 230c38b150aSNate Lawson return (&istates[init_id]); 231c38b150aSNate Lawson } 232c38b150aSNate Lawson } 233c38b150aSNate Lawson 234c38b150aSNate Lawson void 235c38b150aSNate Lawson tcmd_sense(u_int init_id, struct ccb_scsiio *ctio, u_int8_t flags, 236c38b150aSNate Lawson u_int8_t asc, u_int8_t ascq) 237c38b150aSNate Lawson { 238c38b150aSNate Lawson struct initiator_state *istate; 239c38b150aSNate Lawson struct scsi_sense_data *sense; 240c38b150aSNate Lawson 241c38b150aSNate Lawson /* Set our initiator's istate */ 242c38b150aSNate Lawson istate = tcmd_get_istate(init_id); 243c38b150aSNate Lawson if (istate == NULL) 244c38b150aSNate Lawson return; 245c38b150aSNate Lawson istate->pending_ca |= CA_CMD_SENSE; /* XXX set instead of or? */ 246c38b150aSNate Lawson sense = &istate->sense_data; 247c38b150aSNate Lawson bzero(sense, sizeof(*sense)); 248c38b150aSNate Lawson sense->error_code = SSD_CURRENT_ERROR; 249c38b150aSNate Lawson sense->flags = flags; 250c38b150aSNate Lawson sense->add_sense_code = asc; 251c38b150aSNate Lawson sense->add_sense_code_qual = ascq; 252c38b150aSNate Lawson sense->extra_len = 253c38b150aSNate Lawson offsetof(struct scsi_sense_data, sense_key_spec[2]) - 254c38b150aSNate Lawson offsetof(struct scsi_sense_data, extra_len); 255c38b150aSNate Lawson 256c38b150aSNate Lawson /* Fill out the supplied CTIO */ 257c38b150aSNate Lawson if (ctio != NULL) { 258c38b150aSNate Lawson bcopy(sense, &ctio->sense_data, sizeof(*sense)); 259c4b3637bSHidetoshi Shimokawa ctio->sense_len = sizeof(*sense); /* XXX */ 260c38b150aSNate Lawson ctio->ccb_h.flags &= ~CAM_DIR_MASK; 261c38b150aSNate Lawson ctio->ccb_h.flags |= CAM_DIR_NONE | /* CAM_SEND_SENSE | */ 262c38b150aSNate Lawson CAM_SEND_STATUS; 263c38b150aSNate Lawson ctio->dxfer_len = 0; 264c38b150aSNate Lawson ctio->scsi_status = SCSI_STATUS_CHECK_COND; 265c38b150aSNate Lawson } 266c38b150aSNate Lawson } 267c38b150aSNate Lawson 268c38b150aSNate Lawson void 269c38b150aSNate Lawson tcmd_ua(u_int init_id, ua_types new_ua) 270c38b150aSNate Lawson { 271c38b150aSNate Lawson struct initiator_state *istate; 272c38b150aSNate Lawson u_int start, end; 273c38b150aSNate Lawson 274c38b150aSNate Lawson if (init_id == CAM_TARGET_WILDCARD) { 275c38b150aSNate Lawson start = 0; 276c38b150aSNate Lawson end = MAX_INITIATORS - 1; 277c38b150aSNate Lawson } else { 278c38b150aSNate Lawson start = end = init_id; 279c38b150aSNate Lawson } 280c38b150aSNate Lawson 281c38b150aSNate Lawson for (; start <= end; start++) { 282c38b150aSNate Lawson istate = tcmd_get_istate(start); 283c38b150aSNate Lawson if (istate == NULL) 284c38b150aSNate Lawson break; 285c38b150aSNate Lawson istate->pending_ua = new_ua; 286c38b150aSNate Lawson } 287c38b150aSNate Lawson } 288c38b150aSNate Lawson 289c38b150aSNate Lawson static int 290c38b150aSNate Lawson tcmd_inquiry(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio) 291c38b150aSNate Lawson { 292c38b150aSNate Lawson struct scsi_inquiry *inq; 293c38b150aSNate Lawson struct atio_descr *a_descr; 294c38b150aSNate Lawson struct initiator_state *istate; 295c38b150aSNate Lawson struct scsi_sense_data *sense; 296c38b150aSNate Lawson 297c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 298c38b150aSNate Lawson inq = (struct scsi_inquiry *)a_descr->cdb; 299c38b150aSNate Lawson 300c38b150aSNate Lawson if (debug) 301c38b150aSNate Lawson cdb_debug(a_descr->cdb, "INQUIRY from %u: ", atio->init_id); 302c38b150aSNate Lawson /* 303c38b150aSNate Lawson * Validate the command. We don't support any VPD pages, so 304c38b150aSNate Lawson * complain if EVPD or CMDDT is set. 305c38b150aSNate Lawson */ 306c38b150aSNate Lawson istate = tcmd_get_istate(ctio->init_id); 307c38b150aSNate Lawson sense = &istate->sense_data; 308c38b150aSNate Lawson if ((inq->byte2 & SI_EVPD) != 0) { 309c38b150aSNate Lawson tcmd_illegal_req(atio, ctio); 310c38b150aSNate Lawson sense->sense_key_spec[0] = SSD_SCS_VALID | SSD_FIELDPTR_CMD | 311c38b150aSNate Lawson SSD_BITPTR_VALID | /*bit value*/1; 312c38b150aSNate Lawson sense->sense_key_spec[1] = 0; 313c38b150aSNate Lawson sense->sense_key_spec[2] = 314c38b150aSNate Lawson offsetof(struct scsi_inquiry, byte2); 315c38b150aSNate Lawson } else if (inq->page_code != 0) { 316c38b150aSNate Lawson tcmd_illegal_req(atio, ctio); 317c38b150aSNate Lawson sense->sense_key_spec[0] = SSD_SCS_VALID | SSD_FIELDPTR_CMD; 318c38b150aSNate Lawson sense->sense_key_spec[1] = 0; 319c38b150aSNate Lawson sense->sense_key_spec[2] = 320c38b150aSNate Lawson offsetof(struct scsi_inquiry, page_code); 321c38b150aSNate Lawson } else { 322c38b150aSNate Lawson bcopy(&inq_data, ctio->data_ptr, sizeof(inq_data)); 323c38b150aSNate Lawson ctio->dxfer_len = inq_data.additional_length + 4; 324c38b150aSNate Lawson ctio->dxfer_len = min(ctio->dxfer_len, 325c38b150aSNate Lawson SCSI_CDB6_LEN(inq->length)); 326c38b150aSNate Lawson ctio->ccb_h.flags |= CAM_DIR_IN | CAM_SEND_STATUS; 327c38b150aSNate Lawson ctio->scsi_status = SCSI_STATUS_OK; 328c38b150aSNate Lawson } 329c38b150aSNate Lawson return (0); 330c38b150aSNate Lawson } 331c38b150aSNate Lawson 332c38b150aSNate Lawson /* Initialize the inquiry response structure with the requested flags */ 333c38b150aSNate Lawson static int 334c38b150aSNate Lawson init_inquiry(u_int16_t req_flags, u_int16_t sim_flags) 335c38b150aSNate Lawson { 336c38b150aSNate Lawson struct scsi_inquiry_data *inq; 337c38b150aSNate Lawson 338c38b150aSNate Lawson inq = &inq_data; 339c38b150aSNate Lawson bzero(inq, sizeof(*inq)); 340c38b150aSNate Lawson inq->device = T_DIRECT | (SID_QUAL_LU_CONNECTED << 5); 341c4b3637bSHidetoshi Shimokawa #ifdef SCSI_REV_SPC 342c38b150aSNate Lawson inq->version = SCSI_REV_SPC; /* was 2 */ 343c4b3637bSHidetoshi Shimokawa #else 344c4b3637bSHidetoshi Shimokawa inq->version = SCSI_REV_3; /* was 2 */ 345c4b3637bSHidetoshi Shimokawa #endif 346c38b150aSNate Lawson 347c38b150aSNate Lawson /* 348c38b150aSNate Lawson * XXX cpi.hba_inquiry doesn't support Addr16 so we give the 349c38b150aSNate Lawson * user what they want if they ask for it. 350c38b150aSNate Lawson */ 351c38b150aSNate Lawson if ((req_flags & SID_Addr16) != 0) { 352c38b150aSNate Lawson sim_flags |= SID_Addr16; 353c38b150aSNate Lawson warnx("Not sure SIM supports Addr16 but enabling it anyway"); 354c38b150aSNate Lawson } 355c38b150aSNate Lawson 356c38b150aSNate Lawson /* Advertise only what the SIM can actually support */ 357c38b150aSNate Lawson req_flags &= sim_flags; 358c38b150aSNate Lawson scsi_ulto2b(req_flags, &inq->reserved[1]); 359c38b150aSNate Lawson 360c38b150aSNate Lawson inq->response_format = 2; /* SCSI2 Inquiry Format */ 361c38b150aSNate Lawson inq->additional_length = SHORT_INQUIRY_LENGTH - 362c38b150aSNate Lawson offsetof(struct scsi_inquiry_data, additional_length); 363c38b150aSNate Lawson bcopy("FreeBSD ", inq->vendor, SID_VENDOR_SIZE); 364c38b150aSNate Lawson bcopy("Emulated Disk ", inq->product, SID_PRODUCT_SIZE); 365c38b150aSNate Lawson bcopy("0.1 ", inq->revision, SID_REVISION_SIZE); 366c38b150aSNate Lawson return (0); 367c38b150aSNate Lawson } 368c38b150aSNate Lawson 369c38b150aSNate Lawson static int 370c38b150aSNate Lawson tcmd_req_sense(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio) 371c38b150aSNate Lawson { 372c38b150aSNate Lawson struct scsi_request_sense *rsense; 373c38b150aSNate Lawson struct scsi_sense_data *sense; 374c38b150aSNate Lawson struct initiator_state *istate; 375c38b150aSNate Lawson size_t dlen; 376c38b150aSNate Lawson struct atio_descr *a_descr; 377c38b150aSNate Lawson 378c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 379c38b150aSNate Lawson rsense = (struct scsi_request_sense *)a_descr->cdb; 380c38b150aSNate Lawson 381c38b150aSNate Lawson istate = tcmd_get_istate(ctio->init_id); 382c38b150aSNate Lawson sense = &istate->sense_data; 383c38b150aSNate Lawson 384c38b150aSNate Lawson if (debug) { 385c38b150aSNate Lawson cdb_debug(a_descr->cdb, "REQ SENSE from %u: ", atio->init_id); 386c38b150aSNate Lawson warnx("Sending sense: %#x %#x %#x", sense->flags, 387c38b150aSNate Lawson sense->add_sense_code, sense->add_sense_code_qual); 388c38b150aSNate Lawson } 389c38b150aSNate Lawson 390c38b150aSNate Lawson if (istate->orig_ca == 0) { 391c38b150aSNate Lawson tcmd_sense(ctio->init_id, NULL, SSD_KEY_NO_SENSE, 0, 0); 392c38b150aSNate Lawson warnx("REQUEST SENSE from %u but no pending CA!", 393c38b150aSNate Lawson ctio->init_id); 394c38b150aSNate Lawson } 395c38b150aSNate Lawson 396c38b150aSNate Lawson bcopy(sense, ctio->data_ptr, sizeof(struct scsi_sense_data)); 397c38b150aSNate Lawson dlen = offsetof(struct scsi_sense_data, extra_len) + 398c38b150aSNate Lawson sense->extra_len + 1; 399c38b150aSNate Lawson ctio->dxfer_len = min(dlen, SCSI_CDB6_LEN(rsense->length)); 400c38b150aSNate Lawson ctio->ccb_h.flags |= CAM_DIR_IN | CAM_SEND_STATUS; 401c38b150aSNate Lawson ctio->scsi_status = SCSI_STATUS_OK; 402c38b150aSNate Lawson return (0); 403c38b150aSNate Lawson } 404c38b150aSNate Lawson 405c38b150aSNate Lawson static int 406c38b150aSNate Lawson tcmd_rd_cap(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio) 407c38b150aSNate Lawson { 408c38b150aSNate Lawson struct scsi_read_capacity_data *srp; 409c38b150aSNate Lawson struct atio_descr *a_descr; 410068d70baSHidetoshi Shimokawa uint32_t vsize; 411c38b150aSNate Lawson 412c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 413c38b150aSNate Lawson srp = (struct scsi_read_capacity_data *)ctio->data_ptr; 414c38b150aSNate Lawson 415068d70baSHidetoshi Shimokawa if (volume_size > 0xffffffff) 416068d70baSHidetoshi Shimokawa vsize = 0xffffffff; 417068d70baSHidetoshi Shimokawa else 418068d70baSHidetoshi Shimokawa vsize = (uint32_t)(volume_size - 1); 419068d70baSHidetoshi Shimokawa 420c38b150aSNate Lawson if (debug) { 421c38b150aSNate Lawson cdb_debug(a_descr->cdb, "READ CAP from %u (%u, %u): ", 422068d70baSHidetoshi Shimokawa atio->init_id, vsize, sector_size); 423c38b150aSNate Lawson } 424c38b150aSNate Lawson 425c38b150aSNate Lawson bzero(srp, sizeof(*srp)); 426068d70baSHidetoshi Shimokawa scsi_ulto4b(vsize, srp->addr); 427c38b150aSNate Lawson scsi_ulto4b(sector_size, srp->length); 428c38b150aSNate Lawson 429c38b150aSNate Lawson ctio->dxfer_len = sizeof(*srp); 430c38b150aSNate Lawson ctio->ccb_h.flags |= CAM_DIR_IN | CAM_SEND_STATUS; 431c38b150aSNate Lawson ctio->scsi_status = SCSI_STATUS_OK; 432c38b150aSNate Lawson return (0); 433c38b150aSNate Lawson } 434c38b150aSNate Lawson 435068d70baSHidetoshi Shimokawa #ifdef READ_16 436068d70baSHidetoshi Shimokawa static int 437068d70baSHidetoshi Shimokawa tcmd_rd_cap16(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio) 438068d70baSHidetoshi Shimokawa { 439068d70baSHidetoshi Shimokawa struct scsi_read_capacity_16 *scsi_cmd; 440068d70baSHidetoshi Shimokawa struct scsi_read_capacity_data_long *srp; 441068d70baSHidetoshi Shimokawa struct atio_descr *a_descr; 442068d70baSHidetoshi Shimokawa 443068d70baSHidetoshi Shimokawa a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 444068d70baSHidetoshi Shimokawa scsi_cmd = (struct scsi_read_capacity_16 *)a_descr->cdb; 445068d70baSHidetoshi Shimokawa srp = (struct scsi_read_capacity_data_long *)ctio->data_ptr; 446068d70baSHidetoshi Shimokawa 447068d70baSHidetoshi Shimokawa if (scsi_cmd->service_action != SRC16_SERVICE_ACTION) { 448068d70baSHidetoshi Shimokawa tcmd_illegal_req(atio, ctio); 449068d70baSHidetoshi Shimokawa return (0); 450068d70baSHidetoshi Shimokawa } 451068d70baSHidetoshi Shimokawa 452068d70baSHidetoshi Shimokawa if (debug) { 453068d70baSHidetoshi Shimokawa cdb_debug(a_descr->cdb, "READ CAP16 from %u (%u, %u): ", 454068d70baSHidetoshi Shimokawa atio->init_id, volume_size - 1, sector_size); 455068d70baSHidetoshi Shimokawa } 456068d70baSHidetoshi Shimokawa 457068d70baSHidetoshi Shimokawa bzero(srp, sizeof(*srp)); 458068d70baSHidetoshi Shimokawa scsi_u64to8b(volume_size - 1, srp->addr); 459068d70baSHidetoshi Shimokawa scsi_ulto4b(sector_size, srp->length); 460068d70baSHidetoshi Shimokawa 461068d70baSHidetoshi Shimokawa ctio->dxfer_len = sizeof(*srp); 462068d70baSHidetoshi Shimokawa ctio->ccb_h.flags |= CAM_DIR_IN | CAM_SEND_STATUS; 463068d70baSHidetoshi Shimokawa ctio->scsi_status = SCSI_STATUS_OK; 464068d70baSHidetoshi Shimokawa return (0); 465068d70baSHidetoshi Shimokawa } 466068d70baSHidetoshi Shimokawa #endif 467068d70baSHidetoshi Shimokawa 468c38b150aSNate Lawson static int 469c38b150aSNate Lawson tcmd_rdwr(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio) 470c38b150aSNate Lawson { 471c38b150aSNate Lawson struct atio_descr *a_descr; 472c38b150aSNate Lawson struct ctio_descr *c_descr; 473c38b150aSNate Lawson int ret; 474c38b150aSNate Lawson 475c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 476c38b150aSNate Lawson c_descr = (struct ctio_descr *)ctio->ccb_h.targ_descr; 477c38b150aSNate Lawson 478c38b150aSNate Lawson /* Command needs to be decoded */ 479c38b150aSNate Lawson if ((a_descr->flags & CAM_DIR_MASK) == CAM_DIR_RESV) { 480c38b150aSNate Lawson if (debug) 481c38b150aSNate Lawson warnx("Calling rdwr_decode"); 482c38b150aSNate Lawson ret = tcmd_rdwr_decode(atio, ctio); 483c38b150aSNate Lawson if (ret == 0) { 484c38b150aSNate Lawson send_ccb((union ccb *)ctio, /*priority*/1); 485c38b150aSNate Lawson return (0); 486c38b150aSNate Lawson } 487c38b150aSNate Lawson } 488c38b150aSNate Lawson ctio->ccb_h.flags |= a_descr->flags; 489c38b150aSNate Lawson 490c38b150aSNate Lawson /* Call appropriate work function */ 491c38b150aSNate Lawson if ((a_descr->flags & CAM_DIR_IN) != 0) { 492c38b150aSNate Lawson ret = start_io(atio, ctio, CAM_DIR_IN); 493c38b150aSNate Lawson if (debug) 494068d70baSHidetoshi Shimokawa #if __FreeBSD_version >= 500000 495068d70baSHidetoshi Shimokawa warnx("Starting DIR_IN @%jd:%u", 496068d70baSHidetoshi Shimokawa #else 497068d70baSHidetoshi Shimokawa warnx("Starting DIR_IN @%lld:%u", 498068d70baSHidetoshi Shimokawa #endif 499068d70baSHidetoshi Shimokawa c_descr->offset, a_descr->targ_req); 500c38b150aSNate Lawson } else { 501c38b150aSNate Lawson ret = start_io(atio, ctio, CAM_DIR_OUT); 502c38b150aSNate Lawson if (debug) 503068d70baSHidetoshi Shimokawa #if __FreeBSD_version >= 500000 504068d70baSHidetoshi Shimokawa warnx("Starting DIR_OUT @%jd:%u", 505068d70baSHidetoshi Shimokawa #else 506068d70baSHidetoshi Shimokawa warnx("Starting DIR_OUT @%lld:%u", 507068d70baSHidetoshi Shimokawa #endif 508068d70baSHidetoshi Shimokawa c_descr->offset, a_descr->init_req); 509c38b150aSNate Lawson } 510c38b150aSNate Lawson 511c38b150aSNate Lawson return (ret); 512c38b150aSNate Lawson } 513c38b150aSNate Lawson 514c38b150aSNate Lawson static int 515c38b150aSNate Lawson tcmd_rdwr_decode(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio) 516c38b150aSNate Lawson { 517068d70baSHidetoshi Shimokawa uint64_t blkno; 518068d70baSHidetoshi Shimokawa uint32_t count; 519c38b150aSNate Lawson struct atio_descr *a_descr; 520c38b150aSNate Lawson u_int8_t *cdb; 521c38b150aSNate Lawson 522c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 523c38b150aSNate Lawson cdb = a_descr->cdb; 524c38b150aSNate Lawson if (debug) 525c38b150aSNate Lawson cdb_debug(cdb, "R/W from %u: ", atio->init_id); 526c38b150aSNate Lawson 527068d70baSHidetoshi Shimokawa switch (cdb[0]) { 528068d70baSHidetoshi Shimokawa case READ_6: 529068d70baSHidetoshi Shimokawa case WRITE_6: 530068d70baSHidetoshi Shimokawa { 531c38b150aSNate Lawson struct scsi_rw_6 *rw_6 = (struct scsi_rw_6 *)cdb; 532c38b150aSNate Lawson blkno = scsi_3btoul(rw_6->addr); 533c38b150aSNate Lawson count = rw_6->length; 534068d70baSHidetoshi Shimokawa break; 535068d70baSHidetoshi Shimokawa } 536068d70baSHidetoshi Shimokawa case READ_10: 537068d70baSHidetoshi Shimokawa case WRITE_10: 538068d70baSHidetoshi Shimokawa { 539c38b150aSNate Lawson struct scsi_rw_10 *rw_10 = (struct scsi_rw_10 *)cdb; 540c38b150aSNate Lawson blkno = scsi_4btoul(rw_10->addr); 541c38b150aSNate Lawson count = scsi_2btoul(rw_10->length); 542068d70baSHidetoshi Shimokawa break; 543068d70baSHidetoshi Shimokawa } 544068d70baSHidetoshi Shimokawa #ifdef READ_16 545068d70baSHidetoshi Shimokawa case READ_16: 546068d70baSHidetoshi Shimokawa case WRITE_16: 547068d70baSHidetoshi Shimokawa { 548068d70baSHidetoshi Shimokawa struct scsi_rw_16 *rw_16 = (struct scsi_rw_16 *)cdb; 549068d70baSHidetoshi Shimokawa blkno = scsi_8btou64(rw_16->addr); 550068d70baSHidetoshi Shimokawa count = scsi_4btoul(rw_16->length); 551068d70baSHidetoshi Shimokawa break; 552068d70baSHidetoshi Shimokawa } 553068d70baSHidetoshi Shimokawa #endif 554068d70baSHidetoshi Shimokawa default: 555068d70baSHidetoshi Shimokawa tcmd_illegal_req(atio, ctio); 556068d70baSHidetoshi Shimokawa return (0); 557c38b150aSNate Lawson } 558c38b150aSNate Lawson if (blkno + count > volume_size) { 559c38b150aSNate Lawson warnx("Attempt to access past end of volume"); 560c38b150aSNate Lawson tcmd_sense(ctio->init_id, ctio, 561c38b150aSNate Lawson SSD_KEY_ILLEGAL_REQUEST, 0x21, 0); 562c38b150aSNate Lawson return (0); 563c38b150aSNate Lawson } 564c38b150aSNate Lawson 565c38b150aSNate Lawson /* Get an (overall) data length and set direction */ 566c38b150aSNate Lawson a_descr->base_off = ((off_t)blkno) * sector_size; 567c38b150aSNate Lawson a_descr->total_len = count * sector_size; 568c38b150aSNate Lawson if (a_descr->total_len == 0) { 569c38b150aSNate Lawson if (debug) 570068d70baSHidetoshi Shimokawa #if __FreeBSD_version >= 500000 571068d70baSHidetoshi Shimokawa warnx("r/w 0 blocks @ blkno %ju", blkno); 572068d70baSHidetoshi Shimokawa #else 573068d70baSHidetoshi Shimokawa warnx("r/w 0 blocks @ blkno %llu", blkno); 574068d70baSHidetoshi Shimokawa #endif 575c38b150aSNate Lawson tcmd_null_ok(atio, ctio); 576c38b150aSNate Lawson return (0); 577c38b150aSNate Lawson } else if (cdb[0] == WRITE_6 || cdb[0] == WRITE_10) { 578c38b150aSNate Lawson a_descr->flags |= CAM_DIR_OUT; 579c38b150aSNate Lawson if (debug) 580068d70baSHidetoshi Shimokawa #if __FreeBSD_version >= 500000 581068d70baSHidetoshi Shimokawa warnx("write %u blocks @ blkno %ju", count, blkno); 582068d70baSHidetoshi Shimokawa #else 583068d70baSHidetoshi Shimokawa warnx("write %u blocks @ blkno %llu", count, blkno); 584068d70baSHidetoshi Shimokawa #endif 585c38b150aSNate Lawson } else { 586c38b150aSNate Lawson a_descr->flags |= CAM_DIR_IN; 587c38b150aSNate Lawson if (debug) 588068d70baSHidetoshi Shimokawa #if __FreeBSD_version >= 500000 589068d70baSHidetoshi Shimokawa warnx("read %u blocks @ blkno %ju", count, blkno); 590068d70baSHidetoshi Shimokawa #else 591068d70baSHidetoshi Shimokawa warnx("read %u blocks @ blkno %llu", count, blkno); 592068d70baSHidetoshi Shimokawa #endif 593c38b150aSNate Lawson } 594c38b150aSNate Lawson return (1); 595c38b150aSNate Lawson } 596c38b150aSNate Lawson 597c38b150aSNate Lawson static int 598c38b150aSNate Lawson start_io(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio, int dir) 599c38b150aSNate Lawson { 600c38b150aSNate Lawson struct atio_descr *a_descr; 601c38b150aSNate Lawson struct ctio_descr *c_descr; 602c38b150aSNate Lawson int ret; 603c38b150aSNate Lawson 604c38b150aSNate Lawson /* Set up common structures */ 605c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 606c38b150aSNate Lawson c_descr = (struct ctio_descr *)ctio->ccb_h.targ_descr; 607c38b150aSNate Lawson 608c38b150aSNate Lawson if (dir == CAM_DIR_IN) { 609c38b150aSNate Lawson c_descr->offset = a_descr->base_off + a_descr->targ_req; 610c38b150aSNate Lawson ctio->dxfer_len = a_descr->total_len - a_descr->targ_req; 611c38b150aSNate Lawson } else { 612c38b150aSNate Lawson c_descr->offset = a_descr->base_off + a_descr->init_req; 613c38b150aSNate Lawson ctio->dxfer_len = a_descr->total_len - a_descr->init_req; 614c38b150aSNate Lawson } 615c38b150aSNate Lawson ctio->dxfer_len = min(ctio->dxfer_len, buf_size); 616c38b150aSNate Lawson assert(ctio->dxfer_len >= 0); 617c38b150aSNate Lawson 618c38b150aSNate Lawson c_descr->aiocb.aio_offset = c_descr->offset; 619c38b150aSNate Lawson c_descr->aiocb.aio_nbytes = ctio->dxfer_len; 620c38b150aSNate Lawson 621c38b150aSNate Lawson /* If DIR_IN, start read from target, otherwise begin CTIO xfer. */ 622c38b150aSNate Lawson ret = 1; 623c38b150aSNate Lawson if (dir == CAM_DIR_IN) { 624c38b150aSNate Lawson if (aio_read(&c_descr->aiocb) < 0) 625c38b150aSNate Lawson err(1, "aio_read"); /* XXX */ 626c38b150aSNate Lawson a_descr->targ_req += ctio->dxfer_len; 627c38b150aSNate Lawson if (a_descr->targ_req == a_descr->total_len) { 628c38b150aSNate Lawson ctio->ccb_h.flags |= CAM_SEND_STATUS; 629c38b150aSNate Lawson ctio->scsi_status = SCSI_STATUS_OK; 630c38b150aSNate Lawson ret = 0; 631c38b150aSNate Lawson } 632c38b150aSNate Lawson } else { 633c38b150aSNate Lawson if (a_descr->targ_ack == a_descr->total_len) 634c38b150aSNate Lawson tcmd_null_ok(atio, ctio); 635c38b150aSNate Lawson a_descr->init_req += ctio->dxfer_len; 636c38b150aSNate Lawson if (a_descr->init_req == a_descr->total_len && 637c38b150aSNate Lawson ctio->dxfer_len > 0) { 638c38b150aSNate Lawson /* 639c38b150aSNate Lawson * If data phase done, remove atio from workq. 640c38b150aSNate Lawson * The completion handler will call work_atio to 641c38b150aSNate Lawson * send the final status. 642c38b150aSNate Lawson */ 643c38b150aSNate Lawson ret = 0; 644c38b150aSNate Lawson } 645c38b150aSNate Lawson send_ccb((union ccb *)ctio, /*priority*/1); 646c38b150aSNate Lawson } 647c38b150aSNate Lawson 648c38b150aSNate Lawson return (ret); 649c38b150aSNate Lawson } 650c38b150aSNate Lawson 651c38b150aSNate Lawson static void 652c38b150aSNate Lawson tcmd_rdwr_done(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio, 653c38b150aSNate Lawson io_ops event) 654c38b150aSNate Lawson { 655c38b150aSNate Lawson struct atio_descr *a_descr; 656c38b150aSNate Lawson struct ctio_descr *c_descr; 657c38b150aSNate Lawson 658c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 659c38b150aSNate Lawson c_descr = (struct ctio_descr *)ctio->ccb_h.targ_descr; 660c38b150aSNate Lawson 661c38b150aSNate Lawson switch (event) { 662c38b150aSNate Lawson case AIO_DONE: 663c38b150aSNate Lawson if (aio_return(&c_descr->aiocb) < 0) { 664c38b150aSNate Lawson warn("aio_return error"); 665c38b150aSNate Lawson /* XXX */ 666c38b150aSNate Lawson tcmd_sense(ctio->init_id, ctio, 667c38b150aSNate Lawson SSD_KEY_MEDIUM_ERROR, 0, 0); 668c38b150aSNate Lawson send_ccb((union ccb *)ctio, /*priority*/1); 669c38b150aSNate Lawson break; 670c38b150aSNate Lawson } 671c38b150aSNate Lawson a_descr->targ_ack += ctio->dxfer_len; 672c38b150aSNate Lawson if ((a_descr->flags & CAM_DIR_IN) != 0) { 673c38b150aSNate Lawson if (debug) 674c38b150aSNate Lawson warnx("sending CTIO for AIO read"); 675c38b150aSNate Lawson a_descr->init_req += ctio->dxfer_len; 676c38b150aSNate Lawson send_ccb((union ccb *)ctio, /*priority*/1); 677c38b150aSNate Lawson } else { 678c38b150aSNate Lawson /* Use work function to send final status */ 679c38b150aSNate Lawson if (a_descr->init_req == a_descr->total_len) 680c38b150aSNate Lawson work_atio(atio); 681c38b150aSNate Lawson if (debug) 682c38b150aSNate Lawson warnx("AIO done freeing CTIO"); 683c38b150aSNate Lawson free_ccb((union ccb *)ctio); 684c38b150aSNate Lawson } 685c38b150aSNate Lawson break; 686c38b150aSNate Lawson case CTIO_DONE: 687c38b150aSNate Lawson if (ctio->ccb_h.status != CAM_REQ_CMP) { 688c38b150aSNate Lawson /* XXX */ 689c38b150aSNate Lawson errx(1, "CTIO failed, status %#x", ctio->ccb_h.status); 690c38b150aSNate Lawson } 691c38b150aSNate Lawson a_descr->init_ack += ctio->dxfer_len; 692c38b150aSNate Lawson if ((a_descr->flags & CAM_DIR_MASK) == CAM_DIR_OUT && 693c38b150aSNate Lawson ctio->dxfer_len > 0) { 694c38b150aSNate Lawson if (debug) 695c38b150aSNate Lawson warnx("sending AIO for CTIO write"); 696c38b150aSNate Lawson a_descr->targ_req += ctio->dxfer_len; 697c38b150aSNate Lawson if (aio_write(&c_descr->aiocb) < 0) 698c38b150aSNate Lawson err(1, "aio_write"); /* XXX */ 699c38b150aSNate Lawson } else { 700c38b150aSNate Lawson if (debug) 701c38b150aSNate Lawson warnx("CTIO done freeing CTIO"); 702c38b150aSNate Lawson free_ccb((union ccb *)ctio); 703c38b150aSNate Lawson } 704c38b150aSNate Lawson break; 705c38b150aSNate Lawson default: 706c38b150aSNate Lawson warnx("Unknown completion code %d", event); 707c38b150aSNate Lawson abort(); 708c38b150aSNate Lawson /* NOTREACHED */ 709c38b150aSNate Lawson } 710c38b150aSNate Lawson } 711c38b150aSNate Lawson 712c38b150aSNate Lawson /* Simple ok message used by TUR, SYNC_CACHE, etc. */ 713c38b150aSNate Lawson static int 714c38b150aSNate Lawson tcmd_null_ok(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio) 715c38b150aSNate Lawson { 716c38b150aSNate Lawson if (debug) { 717c38b150aSNate Lawson struct atio_descr *a_descr; 718c38b150aSNate Lawson 719c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 720c38b150aSNate Lawson cdb_debug(a_descr->cdb, "Sending null ok to %u : ", atio->init_id); 721c38b150aSNate Lawson } 722c38b150aSNate Lawson 723c38b150aSNate Lawson ctio->dxfer_len = 0; 724c38b150aSNate Lawson ctio->ccb_h.flags &= ~CAM_DIR_MASK; 725c38b150aSNate Lawson ctio->ccb_h.flags |= CAM_DIR_NONE | CAM_SEND_STATUS; 726c38b150aSNate Lawson ctio->scsi_status = SCSI_STATUS_OK; 727c38b150aSNate Lawson return (0); 728c38b150aSNate Lawson } 729c38b150aSNate Lawson 730c38b150aSNate Lawson /* Simple illegal request message used by MODE SENSE, etc. */ 731c38b150aSNate Lawson static int 732c38b150aSNate Lawson tcmd_illegal_req(struct ccb_accept_tio *atio, struct ccb_scsiio *ctio) 733c38b150aSNate Lawson { 734c38b150aSNate Lawson if (debug) { 735c38b150aSNate Lawson struct atio_descr *a_descr; 736c38b150aSNate Lawson 737c38b150aSNate Lawson a_descr = (struct atio_descr *)atio->ccb_h.targ_descr; 738c38b150aSNate Lawson cdb_debug(a_descr->cdb, "Sending ill req to %u: ", atio->init_id); 739c38b150aSNate Lawson } 740c38b150aSNate Lawson 741c38b150aSNate Lawson tcmd_sense(atio->init_id, ctio, SSD_KEY_ILLEGAL_REQUEST, 742c38b150aSNate Lawson /*asc*/0x24, /*ascq*/0); 743c38b150aSNate Lawson return (0); 744c38b150aSNate Lawson } 745c38b150aSNate Lawson 746c38b150aSNate Lawson static void 747c38b150aSNate Lawson cdb_debug(u_int8_t *cdb, const char *msg, ...) 748c38b150aSNate Lawson { 749c38b150aSNate Lawson char msg_buf[512]; 750c38b150aSNate Lawson int len; 751c38b150aSNate Lawson va_list ap; 752c38b150aSNate Lawson 753c38b150aSNate Lawson va_start(ap, msg); 754c38b150aSNate Lawson vsnprintf(msg_buf, sizeof(msg_buf), msg, ap); 755c38b150aSNate Lawson va_end(ap); 756c38b150aSNate Lawson len = strlen(msg_buf); 757c38b150aSNate Lawson scsi_cdb_string(cdb, msg_buf + len, sizeof(msg_buf) - len); 758c38b150aSNate Lawson warnx("%s", msg_buf); 759c38b150aSNate Lawson } 760