xref: /freebsd/share/examples/scsi_target/scsi_cmds.c (revision 4c1cc94ee3a9b67edaf137632327b86b00258b9a)
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;
2614c1cc94eSNate 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