1 /*-
2 * Copyright (c) 2014 Alexander Motin <mav@FreeBSD.org>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 * notice, this list of conditions and the following disclaimer,
10 * without modification, immediately at the beginning of the file.
11 * 2. Redistributions in binary form must reproduce the above copyright
12 * notice, this list of conditions and the following disclaimer in the
13 * documentation and/or other materials provided with the distribution.
14 *
15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
20 * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
21 * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
22 * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
23 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
24 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
25 */
26
27 #include <sys/cdefs.h>
28 __FBSDID("$FreeBSD$");
29
30 #include <sys/param.h>
31 #include <sys/systm.h>
32 #include <sys/kernel.h>
33 #include <sys/types.h>
34 #include <sys/lock.h>
35 #include <sys/module.h>
36 #include <sys/mutex.h>
37 #include <sys/condvar.h>
38 #include <sys/malloc.h>
39 #include <sys/conf.h>
40 #include <sys/queue.h>
41 #include <sys/sysctl.h>
42 #include <machine/atomic.h>
43
44 #include <cam/cam.h>
45 #include <cam/scsi/scsi_all.h>
46 #include <cam/scsi/scsi_da.h>
47 #include <cam/ctl/ctl_io.h>
48 #include <cam/ctl/ctl.h>
49 #include <cam/ctl/ctl_frontend.h>
50 #include <cam/ctl/ctl_frontend_internal.h>
51 #include <cam/ctl/ctl_util.h>
52 #include <cam/ctl/ctl_backend.h>
53 #include <cam/ctl/ctl_ioctl.h>
54 #include <cam/ctl/ctl_ha.h>
55 #include <cam/ctl/ctl_private.h>
56 #include <cam/ctl/ctl_debug.h>
57 #include <cam/ctl/ctl_scsi_all.h>
58 #include <cam/ctl/ctl_tpc.h>
59 #include <cam/ctl/ctl_error.h>
60
61 #define TPC_MAX_CSCDS 64
62 #define TPC_MAX_SEGS 64
63 #define TPC_MAX_SEG 0
64 #define TPC_MAX_LIST 8192
65 #define TPC_MAX_INLINE 0
66 #define TPC_MAX_LISTS 255
67 #define TPC_MAX_IO_SIZE (1024 * 1024)
68 #define TPC_MAX_IOCHUNK_SIZE (TPC_MAX_IO_SIZE * 16)
69 #define TPC_MIN_TOKEN_TIMEOUT 1
70 #define TPC_DFL_TOKEN_TIMEOUT 60
71 #define TPC_MAX_TOKEN_TIMEOUT 600
72
73 MALLOC_DEFINE(M_CTL_TPC, "ctltpc", "CTL TPC");
74
75 typedef enum {
76 TPC_ERR_RETRY = 0x000,
77 TPC_ERR_FAIL = 0x001,
78 TPC_ERR_MASK = 0x0ff,
79 TPC_ERR_NO_DECREMENT = 0x100
80 } tpc_error_action;
81
82 struct tpc_list;
83 TAILQ_HEAD(runl, tpc_io);
84 struct tpc_io {
85 union ctl_io *io;
86 uint64_t lun;
87 struct tpc_list *list;
88 struct runl run;
89 TAILQ_ENTRY(tpc_io) rlinks;
90 TAILQ_ENTRY(tpc_io) links;
91 };
92
93 struct tpc_token {
94 uint8_t token[512];
95 uint64_t lun;
96 uint32_t blocksize;
97 uint8_t *params;
98 struct scsi_range_desc *range;
99 int nrange;
100 int active;
101 time_t last_active;
102 uint32_t timeout;
103 TAILQ_ENTRY(tpc_token) links;
104 };
105
106 struct tpc_list {
107 uint8_t service_action;
108 int init_port;
109 uint32_t init_idx;
110 uint32_t list_id;
111 uint8_t flags;
112 uint8_t *params;
113 struct scsi_ec_cscd *cscd;
114 struct scsi_ec_segment *seg[TPC_MAX_SEGS];
115 uint8_t *inl;
116 int ncscd;
117 int nseg;
118 int leninl;
119 struct tpc_token *token;
120 struct scsi_range_desc *range;
121 int nrange;
122 off_t offset_into_rod;
123
124 int curseg;
125 off_t cursectors;
126 off_t curbytes;
127 int curops;
128 int stage;
129 uint8_t *buf;
130 off_t segsectors;
131 off_t segbytes;
132 int tbdio;
133 int error;
134 int abort;
135 int completed;
136 time_t last_active;
137 TAILQ_HEAD(, tpc_io) allio;
138 struct scsi_sense_data sense_data;
139 uint8_t sense_len;
140 uint8_t scsi_status;
141 struct ctl_scsiio *ctsio;
142 struct ctl_lun *lun;
143 int res_token_valid;
144 uint8_t res_token[512];
145 TAILQ_ENTRY(tpc_list) links;
146 };
147
148 static void
tpc_timeout(void * arg)149 tpc_timeout(void *arg)
150 {
151 struct ctl_softc *softc = arg;
152 struct ctl_lun *lun;
153 struct tpc_token *token, *ttoken;
154 struct tpc_list *list, *tlist;
155
156 /* Free completed lists with expired timeout. */
157 STAILQ_FOREACH(lun, &softc->lun_list, links) {
158 mtx_lock(&lun->lun_lock);
159 TAILQ_FOREACH_SAFE(list, &lun->tpc_lists, links, tlist) {
160 if (!list->completed || time_uptime < list->last_active +
161 TPC_DFL_TOKEN_TIMEOUT)
162 continue;
163 TAILQ_REMOVE(&lun->tpc_lists, list, links);
164 free(list, M_CTL);
165 }
166 mtx_unlock(&lun->lun_lock);
167 }
168
169 /* Free inactive ROD tokens with expired timeout. */
170 TAILQ_FOREACH_SAFE(token, &softc->tpc_tokens, links, ttoken) {
171 if (token->active ||
172 time_uptime < token->last_active + token->timeout + 1)
173 continue;
174 TAILQ_REMOVE(&softc->tpc_tokens, token, links);
175 free(token->params, M_CTL);
176 free(token, M_CTL);
177 }
178 callout_schedule(&softc->tpc_timeout, hz);
179 }
180
181 void
ctl_tpc_init(struct ctl_softc * softc)182 ctl_tpc_init(struct ctl_softc *softc)
183 {
184
185 TAILQ_INIT(&softc->tpc_tokens);
186 callout_init_mtx(&softc->tpc_timeout, &softc->ctl_lock, 0);
187 callout_reset(&softc->tpc_timeout, hz, tpc_timeout, softc);
188 }
189
190 void
ctl_tpc_shutdown(struct ctl_softc * softc)191 ctl_tpc_shutdown(struct ctl_softc *softc)
192 {
193 struct tpc_token *token;
194
195 callout_drain(&softc->tpc_timeout);
196
197 /* Free ROD tokens. */
198 mtx_lock(&softc->ctl_lock);
199 while ((token = TAILQ_FIRST(&softc->tpc_tokens)) != NULL) {
200 TAILQ_REMOVE(&softc->tpc_tokens, token, links);
201 free(token->params, M_CTL);
202 free(token, M_CTL);
203 }
204 mtx_unlock(&softc->ctl_lock);
205 }
206
207 void
ctl_tpc_lun_init(struct ctl_lun * lun)208 ctl_tpc_lun_init(struct ctl_lun *lun)
209 {
210
211 TAILQ_INIT(&lun->tpc_lists);
212 }
213
214 void
ctl_tpc_lun_shutdown(struct ctl_lun * lun)215 ctl_tpc_lun_shutdown(struct ctl_lun *lun)
216 {
217 struct ctl_softc *softc = lun->ctl_softc;
218 struct tpc_list *list;
219 struct tpc_token *token, *ttoken;
220
221 /* Free lists for this LUN. */
222 while ((list = TAILQ_FIRST(&lun->tpc_lists)) != NULL) {
223 TAILQ_REMOVE(&lun->tpc_lists, list, links);
224 KASSERT(list->completed,
225 ("Not completed TPC (%p) on shutdown", list));
226 free(list, M_CTL);
227 }
228
229 /* Free ROD tokens for this LUN. */
230 mtx_assert(&softc->ctl_lock, MA_OWNED);
231 TAILQ_FOREACH_SAFE(token, &softc->tpc_tokens, links, ttoken) {
232 if (token->lun != lun->lun || token->active)
233 continue;
234 TAILQ_REMOVE(&softc->tpc_tokens, token, links);
235 free(token->params, M_CTL);
236 free(token, M_CTL);
237 }
238 }
239
240 int
ctl_inquiry_evpd_tpc(struct ctl_scsiio * ctsio,int alloc_len)241 ctl_inquiry_evpd_tpc(struct ctl_scsiio *ctsio, int alloc_len)
242 {
243 struct scsi_vpd_tpc *tpc_ptr;
244 struct scsi_vpd_tpc_descriptor *d_ptr;
245 struct scsi_vpd_tpc_descriptor_bdrl *bdrl_ptr;
246 struct scsi_vpd_tpc_descriptor_sc *sc_ptr;
247 struct scsi_vpd_tpc_descriptor_sc_descr *scd_ptr;
248 struct scsi_vpd_tpc_descriptor_pd *pd_ptr;
249 struct scsi_vpd_tpc_descriptor_sd *sd_ptr;
250 struct scsi_vpd_tpc_descriptor_sdid *sdid_ptr;
251 struct scsi_vpd_tpc_descriptor_rtf *rtf_ptr;
252 struct scsi_vpd_tpc_descriptor_rtf_block *rtfb_ptr;
253 struct scsi_vpd_tpc_descriptor_srt *srt_ptr;
254 struct scsi_vpd_tpc_descriptor_srtd *srtd_ptr;
255 struct scsi_vpd_tpc_descriptor_gco *gco_ptr;
256 struct ctl_lun *lun;
257 int data_len;
258
259 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
260
261 data_len = sizeof(struct scsi_vpd_tpc) +
262 sizeof(struct scsi_vpd_tpc_descriptor_bdrl) +
263 roundup2(sizeof(struct scsi_vpd_tpc_descriptor_sc) +
264 2 * sizeof(struct scsi_vpd_tpc_descriptor_sc_descr) + 11, 4) +
265 sizeof(struct scsi_vpd_tpc_descriptor_pd) +
266 roundup2(sizeof(struct scsi_vpd_tpc_descriptor_sd) + 4, 4) +
267 roundup2(sizeof(struct scsi_vpd_tpc_descriptor_sdid) + 2, 4) +
268 sizeof(struct scsi_vpd_tpc_descriptor_rtf) +
269 sizeof(struct scsi_vpd_tpc_descriptor_rtf_block) +
270 sizeof(struct scsi_vpd_tpc_descriptor_srt) +
271 2*sizeof(struct scsi_vpd_tpc_descriptor_srtd) +
272 sizeof(struct scsi_vpd_tpc_descriptor_gco);
273
274 ctsio->kern_data_ptr = malloc(data_len, M_CTL, M_WAITOK | M_ZERO);
275 tpc_ptr = (struct scsi_vpd_tpc *)ctsio->kern_data_ptr;
276 ctsio->kern_sg_entries = 0;
277
278 if (data_len < alloc_len) {
279 ctsio->residual = alloc_len - data_len;
280 ctsio->kern_data_len = data_len;
281 ctsio->kern_total_len = data_len;
282 } else {
283 ctsio->residual = 0;
284 ctsio->kern_data_len = alloc_len;
285 ctsio->kern_total_len = alloc_len;
286 }
287 ctsio->kern_data_resid = 0;
288 ctsio->kern_rel_offset = 0;
289 ctsio->kern_sg_entries = 0;
290
291 /*
292 * The control device is always connected. The disk device, on the
293 * other hand, may not be online all the time.
294 */
295 if (lun != NULL)
296 tpc_ptr->device = (SID_QUAL_LU_CONNECTED << 5) |
297 lun->be_lun->lun_type;
298 else
299 tpc_ptr->device = (SID_QUAL_LU_OFFLINE << 5) | T_DIRECT;
300 tpc_ptr->page_code = SVPD_SCSI_TPC;
301 scsi_ulto2b(data_len - 4, tpc_ptr->page_length);
302
303 /* Block Device ROD Limits */
304 d_ptr = (struct scsi_vpd_tpc_descriptor *)&tpc_ptr->descr[0];
305 bdrl_ptr = (struct scsi_vpd_tpc_descriptor_bdrl *)d_ptr;
306 scsi_ulto2b(SVPD_TPC_BDRL, bdrl_ptr->desc_type);
307 scsi_ulto2b(sizeof(*bdrl_ptr) - 4, bdrl_ptr->desc_length);
308 scsi_ulto2b(TPC_MAX_SEGS, bdrl_ptr->maximum_ranges);
309 scsi_ulto4b(TPC_MAX_TOKEN_TIMEOUT,
310 bdrl_ptr->maximum_inactivity_timeout);
311 scsi_ulto4b(TPC_DFL_TOKEN_TIMEOUT,
312 bdrl_ptr->default_inactivity_timeout);
313 scsi_u64to8b(0, bdrl_ptr->maximum_token_transfer_size);
314 scsi_u64to8b(0, bdrl_ptr->optimal_transfer_count);
315
316 /* Supported commands */
317 d_ptr = (struct scsi_vpd_tpc_descriptor *)
318 (&d_ptr->parameters[0] + scsi_2btoul(d_ptr->desc_length));
319 sc_ptr = (struct scsi_vpd_tpc_descriptor_sc *)d_ptr;
320 scsi_ulto2b(SVPD_TPC_SC, sc_ptr->desc_type);
321 sc_ptr->list_length = 2 * sizeof(*scd_ptr) + 11;
322 scsi_ulto2b(roundup2(1 + sc_ptr->list_length, 4), sc_ptr->desc_length);
323 scd_ptr = &sc_ptr->descr[0];
324 scd_ptr->opcode = EXTENDED_COPY;
325 scd_ptr->sa_length = 5;
326 scd_ptr->supported_service_actions[0] = EC_EC_LID1;
327 scd_ptr->supported_service_actions[1] = EC_EC_LID4;
328 scd_ptr->supported_service_actions[2] = EC_PT;
329 scd_ptr->supported_service_actions[3] = EC_WUT;
330 scd_ptr->supported_service_actions[4] = EC_COA;
331 scd_ptr = (struct scsi_vpd_tpc_descriptor_sc_descr *)
332 &scd_ptr->supported_service_actions[scd_ptr->sa_length];
333 scd_ptr->opcode = RECEIVE_COPY_STATUS;
334 scd_ptr->sa_length = 6;
335 scd_ptr->supported_service_actions[0] = RCS_RCS_LID1;
336 scd_ptr->supported_service_actions[1] = RCS_RCFD;
337 scd_ptr->supported_service_actions[2] = RCS_RCS_LID4;
338 scd_ptr->supported_service_actions[3] = RCS_RCOP;
339 scd_ptr->supported_service_actions[4] = RCS_RRTI;
340 scd_ptr->supported_service_actions[5] = RCS_RART;
341
342 /* Parameter data. */
343 d_ptr = (struct scsi_vpd_tpc_descriptor *)
344 (&d_ptr->parameters[0] + scsi_2btoul(d_ptr->desc_length));
345 pd_ptr = (struct scsi_vpd_tpc_descriptor_pd *)d_ptr;
346 scsi_ulto2b(SVPD_TPC_PD, pd_ptr->desc_type);
347 scsi_ulto2b(sizeof(*pd_ptr) - 4, pd_ptr->desc_length);
348 scsi_ulto2b(TPC_MAX_CSCDS, pd_ptr->maximum_cscd_descriptor_count);
349 scsi_ulto2b(TPC_MAX_SEGS, pd_ptr->maximum_segment_descriptor_count);
350 scsi_ulto4b(TPC_MAX_LIST, pd_ptr->maximum_descriptor_list_length);
351 scsi_ulto4b(TPC_MAX_INLINE, pd_ptr->maximum_inline_data_length);
352
353 /* Supported Descriptors */
354 d_ptr = (struct scsi_vpd_tpc_descriptor *)
355 (&d_ptr->parameters[0] + scsi_2btoul(d_ptr->desc_length));
356 sd_ptr = (struct scsi_vpd_tpc_descriptor_sd *)d_ptr;
357 scsi_ulto2b(SVPD_TPC_SD, sd_ptr->desc_type);
358 scsi_ulto2b(roundup2(sizeof(*sd_ptr) - 4 + 4, 4), sd_ptr->desc_length);
359 sd_ptr->list_length = 4;
360 sd_ptr->supported_descriptor_codes[0] = EC_SEG_B2B;
361 sd_ptr->supported_descriptor_codes[1] = EC_SEG_VERIFY;
362 sd_ptr->supported_descriptor_codes[2] = EC_SEG_REGISTER_KEY;
363 sd_ptr->supported_descriptor_codes[3] = EC_CSCD_ID;
364
365 /* Supported CSCD Descriptor IDs */
366 d_ptr = (struct scsi_vpd_tpc_descriptor *)
367 (&d_ptr->parameters[0] + scsi_2btoul(d_ptr->desc_length));
368 sdid_ptr = (struct scsi_vpd_tpc_descriptor_sdid *)d_ptr;
369 scsi_ulto2b(SVPD_TPC_SDID, sdid_ptr->desc_type);
370 scsi_ulto2b(roundup2(sizeof(*sdid_ptr) - 4 + 2, 4), sdid_ptr->desc_length);
371 scsi_ulto2b(2, sdid_ptr->list_length);
372 scsi_ulto2b(0xffff, &sdid_ptr->supported_descriptor_ids[0]);
373
374 /* ROD Token Features */
375 d_ptr = (struct scsi_vpd_tpc_descriptor *)
376 (&d_ptr->parameters[0] + scsi_2btoul(d_ptr->desc_length));
377 rtf_ptr = (struct scsi_vpd_tpc_descriptor_rtf *)d_ptr;
378 scsi_ulto2b(SVPD_TPC_RTF, rtf_ptr->desc_type);
379 scsi_ulto2b(sizeof(*rtf_ptr) - 4 + sizeof(*rtfb_ptr), rtf_ptr->desc_length);
380 rtf_ptr->remote_tokens = 0;
381 scsi_ulto4b(TPC_MIN_TOKEN_TIMEOUT, rtf_ptr->minimum_token_lifetime);
382 scsi_ulto4b(UINT32_MAX, rtf_ptr->maximum_token_lifetime);
383 scsi_ulto4b(TPC_MAX_TOKEN_TIMEOUT,
384 rtf_ptr->maximum_token_inactivity_timeout);
385 scsi_ulto2b(sizeof(*rtfb_ptr), rtf_ptr->type_specific_features_length);
386 rtfb_ptr = (struct scsi_vpd_tpc_descriptor_rtf_block *)
387 &rtf_ptr->type_specific_features;
388 rtfb_ptr->type_format = SVPD_TPC_RTF_BLOCK;
389 scsi_ulto2b(sizeof(*rtfb_ptr) - 4, rtfb_ptr->desc_length);
390 scsi_ulto2b(0, rtfb_ptr->optimal_length_granularity);
391 scsi_u64to8b(0, rtfb_ptr->maximum_bytes);
392 scsi_u64to8b(0, rtfb_ptr->optimal_bytes);
393 scsi_u64to8b(TPC_MAX_IOCHUNK_SIZE,
394 rtfb_ptr->optimal_bytes_to_token_per_segment);
395 scsi_u64to8b(TPC_MAX_IOCHUNK_SIZE,
396 rtfb_ptr->optimal_bytes_from_token_per_segment);
397
398 /* Supported ROD Tokens */
399 d_ptr = (struct scsi_vpd_tpc_descriptor *)
400 (&d_ptr->parameters[0] + scsi_2btoul(d_ptr->desc_length));
401 srt_ptr = (struct scsi_vpd_tpc_descriptor_srt *)d_ptr;
402 scsi_ulto2b(SVPD_TPC_SRT, srt_ptr->desc_type);
403 scsi_ulto2b(sizeof(*srt_ptr) - 4 + 2*sizeof(*srtd_ptr), srt_ptr->desc_length);
404 scsi_ulto2b(2*sizeof(*srtd_ptr), srt_ptr->rod_type_descriptors_length);
405 srtd_ptr = (struct scsi_vpd_tpc_descriptor_srtd *)
406 &srt_ptr->rod_type_descriptors;
407 scsi_ulto4b(ROD_TYPE_AUR, srtd_ptr->rod_type);
408 srtd_ptr->flags = SVPD_TPC_SRTD_TIN | SVPD_TPC_SRTD_TOUT;
409 scsi_ulto2b(0, srtd_ptr->preference_indicator);
410 srtd_ptr++;
411 scsi_ulto4b(ROD_TYPE_BLOCK_ZERO, srtd_ptr->rod_type);
412 srtd_ptr->flags = SVPD_TPC_SRTD_TIN;
413 scsi_ulto2b(0, srtd_ptr->preference_indicator);
414
415 /* General Copy Operations */
416 d_ptr = (struct scsi_vpd_tpc_descriptor *)
417 (&d_ptr->parameters[0] + scsi_2btoul(d_ptr->desc_length));
418 gco_ptr = (struct scsi_vpd_tpc_descriptor_gco *)d_ptr;
419 scsi_ulto2b(SVPD_TPC_GCO, gco_ptr->desc_type);
420 scsi_ulto2b(sizeof(*gco_ptr) - 4, gco_ptr->desc_length);
421 scsi_ulto4b(TPC_MAX_LISTS, gco_ptr->total_concurrent_copies);
422 scsi_ulto4b(TPC_MAX_LISTS, gco_ptr->maximum_identified_concurrent_copies);
423 scsi_ulto4b(TPC_MAX_SEG, gco_ptr->maximum_segment_length);
424 gco_ptr->data_segment_granularity = 0;
425 gco_ptr->inline_data_granularity = 0;
426
427 ctl_set_success(ctsio);
428 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
429 ctsio->be_move_done = ctl_config_move_done;
430 ctl_datamove((union ctl_io *)ctsio);
431
432 return (CTL_RETVAL_COMPLETE);
433 }
434
435 int
ctl_receive_copy_operating_parameters(struct ctl_scsiio * ctsio)436 ctl_receive_copy_operating_parameters(struct ctl_scsiio *ctsio)
437 {
438 struct scsi_receive_copy_operating_parameters *cdb;
439 struct scsi_receive_copy_operating_parameters_data *data;
440 int retval;
441 int alloc_len, total_len;
442
443 CTL_DEBUG_PRINT(("ctl_report_supported_tmf\n"));
444
445 cdb = (struct scsi_receive_copy_operating_parameters *)ctsio->cdb;
446
447 retval = CTL_RETVAL_COMPLETE;
448
449 total_len = sizeof(*data) + 4;
450 alloc_len = scsi_4btoul(cdb->length);
451
452 ctsio->kern_data_ptr = malloc(total_len, M_CTL, M_WAITOK | M_ZERO);
453
454 ctsio->kern_sg_entries = 0;
455
456 if (total_len < alloc_len) {
457 ctsio->residual = alloc_len - total_len;
458 ctsio->kern_data_len = total_len;
459 ctsio->kern_total_len = total_len;
460 } else {
461 ctsio->residual = 0;
462 ctsio->kern_data_len = alloc_len;
463 ctsio->kern_total_len = alloc_len;
464 }
465 ctsio->kern_data_resid = 0;
466 ctsio->kern_rel_offset = 0;
467
468 data = (struct scsi_receive_copy_operating_parameters_data *)ctsio->kern_data_ptr;
469 scsi_ulto4b(sizeof(*data) - 4 + 4, data->length);
470 data->snlid = RCOP_SNLID;
471 scsi_ulto2b(TPC_MAX_CSCDS, data->maximum_cscd_descriptor_count);
472 scsi_ulto2b(TPC_MAX_SEGS, data->maximum_segment_descriptor_count);
473 scsi_ulto4b(TPC_MAX_LIST, data->maximum_descriptor_list_length);
474 scsi_ulto4b(TPC_MAX_SEG, data->maximum_segment_length);
475 scsi_ulto4b(TPC_MAX_INLINE, data->maximum_inline_data_length);
476 scsi_ulto4b(0, data->held_data_limit);
477 scsi_ulto4b(0, data->maximum_stream_device_transfer_size);
478 scsi_ulto2b(TPC_MAX_LISTS, data->total_concurrent_copies);
479 data->maximum_concurrent_copies = TPC_MAX_LISTS;
480 data->data_segment_granularity = 0;
481 data->inline_data_granularity = 0;
482 data->held_data_granularity = 0;
483 data->implemented_descriptor_list_length = 4;
484 data->list_of_implemented_descriptor_type_codes[0] = EC_SEG_B2B;
485 data->list_of_implemented_descriptor_type_codes[1] = EC_SEG_VERIFY;
486 data->list_of_implemented_descriptor_type_codes[2] = EC_SEG_REGISTER_KEY;
487 data->list_of_implemented_descriptor_type_codes[3] = EC_CSCD_ID;
488
489 ctl_set_success(ctsio);
490 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
491 ctsio->be_move_done = ctl_config_move_done;
492 ctl_datamove((union ctl_io *)ctsio);
493 return (retval);
494 }
495
496 static struct tpc_list *
tpc_find_list(struct ctl_lun * lun,uint32_t list_id,uint32_t init_idx)497 tpc_find_list(struct ctl_lun *lun, uint32_t list_id, uint32_t init_idx)
498 {
499 struct tpc_list *list;
500
501 mtx_assert(&lun->lun_lock, MA_OWNED);
502 TAILQ_FOREACH(list, &lun->tpc_lists, links) {
503 if ((list->flags & EC_LIST_ID_USAGE_MASK) !=
504 EC_LIST_ID_USAGE_NONE && list->list_id == list_id &&
505 list->init_idx == init_idx)
506 break;
507 }
508 return (list);
509 }
510
511 int
ctl_receive_copy_status_lid1(struct ctl_scsiio * ctsio)512 ctl_receive_copy_status_lid1(struct ctl_scsiio *ctsio)
513 {
514 struct ctl_lun *lun;
515 struct scsi_receive_copy_status_lid1 *cdb;
516 struct scsi_receive_copy_status_lid1_data *data;
517 struct tpc_list *list;
518 struct tpc_list list_copy;
519 int retval;
520 int alloc_len, total_len;
521 uint32_t list_id;
522
523 CTL_DEBUG_PRINT(("ctl_receive_copy_status_lid1\n"));
524
525 cdb = (struct scsi_receive_copy_status_lid1 *)ctsio->cdb;
526 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
527
528 retval = CTL_RETVAL_COMPLETE;
529
530 list_id = cdb->list_identifier;
531 mtx_lock(&lun->lun_lock);
532 list = tpc_find_list(lun, list_id,
533 ctl_get_resindex(&ctsio->io_hdr.nexus));
534 if (list == NULL) {
535 mtx_unlock(&lun->lun_lock);
536 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
537 /*command*/ 1, /*field*/ 2, /*bit_valid*/ 0,
538 /*bit*/ 0);
539 ctl_done((union ctl_io *)ctsio);
540 return (retval);
541 }
542 list_copy = *list;
543 if (list->completed) {
544 TAILQ_REMOVE(&lun->tpc_lists, list, links);
545 free(list, M_CTL);
546 }
547 mtx_unlock(&lun->lun_lock);
548
549 total_len = sizeof(*data);
550 alloc_len = scsi_4btoul(cdb->length);
551
552 ctsio->kern_data_ptr = malloc(total_len, M_CTL, M_WAITOK | M_ZERO);
553
554 ctsio->kern_sg_entries = 0;
555
556 if (total_len < alloc_len) {
557 ctsio->residual = alloc_len - total_len;
558 ctsio->kern_data_len = total_len;
559 ctsio->kern_total_len = total_len;
560 } else {
561 ctsio->residual = 0;
562 ctsio->kern_data_len = alloc_len;
563 ctsio->kern_total_len = alloc_len;
564 }
565 ctsio->kern_data_resid = 0;
566 ctsio->kern_rel_offset = 0;
567
568 data = (struct scsi_receive_copy_status_lid1_data *)ctsio->kern_data_ptr;
569 scsi_ulto4b(sizeof(*data) - 4, data->available_data);
570 if (list_copy.completed) {
571 if (list_copy.error || list_copy.abort)
572 data->copy_command_status = RCS_CCS_ERROR;
573 else
574 data->copy_command_status = RCS_CCS_COMPLETED;
575 } else
576 data->copy_command_status = RCS_CCS_INPROG;
577 scsi_ulto2b(list_copy.curseg, data->segments_processed);
578 if (list_copy.curbytes <= UINT32_MAX) {
579 data->transfer_count_units = RCS_TC_BYTES;
580 scsi_ulto4b(list_copy.curbytes, data->transfer_count);
581 } else {
582 data->transfer_count_units = RCS_TC_MBYTES;
583 scsi_ulto4b(list_copy.curbytes >> 20, data->transfer_count);
584 }
585
586 ctl_set_success(ctsio);
587 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
588 ctsio->be_move_done = ctl_config_move_done;
589 ctl_datamove((union ctl_io *)ctsio);
590 return (retval);
591 }
592
593 int
ctl_receive_copy_failure_details(struct ctl_scsiio * ctsio)594 ctl_receive_copy_failure_details(struct ctl_scsiio *ctsio)
595 {
596 struct ctl_lun *lun;
597 struct scsi_receive_copy_failure_details *cdb;
598 struct scsi_receive_copy_failure_details_data *data;
599 struct tpc_list *list;
600 struct tpc_list list_copy;
601 int retval;
602 int alloc_len, total_len;
603 uint32_t list_id;
604
605 CTL_DEBUG_PRINT(("ctl_receive_copy_failure_details\n"));
606
607 cdb = (struct scsi_receive_copy_failure_details *)ctsio->cdb;
608 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
609
610 retval = CTL_RETVAL_COMPLETE;
611
612 list_id = cdb->list_identifier;
613 mtx_lock(&lun->lun_lock);
614 list = tpc_find_list(lun, list_id,
615 ctl_get_resindex(&ctsio->io_hdr.nexus));
616 if (list == NULL || !list->completed) {
617 mtx_unlock(&lun->lun_lock);
618 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
619 /*command*/ 1, /*field*/ 2, /*bit_valid*/ 0,
620 /*bit*/ 0);
621 ctl_done((union ctl_io *)ctsio);
622 return (retval);
623 }
624 list_copy = *list;
625 TAILQ_REMOVE(&lun->tpc_lists, list, links);
626 free(list, M_CTL);
627 mtx_unlock(&lun->lun_lock);
628
629 total_len = sizeof(*data) + list_copy.sense_len;
630 alloc_len = scsi_4btoul(cdb->length);
631
632 ctsio->kern_data_ptr = malloc(total_len, M_CTL, M_WAITOK | M_ZERO);
633
634 ctsio->kern_sg_entries = 0;
635
636 if (total_len < alloc_len) {
637 ctsio->residual = alloc_len - total_len;
638 ctsio->kern_data_len = total_len;
639 ctsio->kern_total_len = total_len;
640 } else {
641 ctsio->residual = 0;
642 ctsio->kern_data_len = alloc_len;
643 ctsio->kern_total_len = alloc_len;
644 }
645 ctsio->kern_data_resid = 0;
646 ctsio->kern_rel_offset = 0;
647
648 data = (struct scsi_receive_copy_failure_details_data *)ctsio->kern_data_ptr;
649 if (list_copy.completed && (list_copy.error || list_copy.abort)) {
650 scsi_ulto4b(sizeof(*data) - 4 + list_copy.sense_len,
651 data->available_data);
652 data->copy_command_status = RCS_CCS_ERROR;
653 } else
654 scsi_ulto4b(0, data->available_data);
655 scsi_ulto2b(list_copy.sense_len, data->sense_data_length);
656 memcpy(data->sense_data, &list_copy.sense_data, list_copy.sense_len);
657
658 ctl_set_success(ctsio);
659 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
660 ctsio->be_move_done = ctl_config_move_done;
661 ctl_datamove((union ctl_io *)ctsio);
662 return (retval);
663 }
664
665 int
ctl_receive_copy_status_lid4(struct ctl_scsiio * ctsio)666 ctl_receive_copy_status_lid4(struct ctl_scsiio *ctsio)
667 {
668 struct ctl_lun *lun;
669 struct scsi_receive_copy_status_lid4 *cdb;
670 struct scsi_receive_copy_status_lid4_data *data;
671 struct tpc_list *list;
672 struct tpc_list list_copy;
673 int retval;
674 int alloc_len, total_len;
675 uint32_t list_id;
676
677 CTL_DEBUG_PRINT(("ctl_receive_copy_status_lid4\n"));
678
679 cdb = (struct scsi_receive_copy_status_lid4 *)ctsio->cdb;
680 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
681
682 retval = CTL_RETVAL_COMPLETE;
683
684 list_id = scsi_4btoul(cdb->list_identifier);
685 mtx_lock(&lun->lun_lock);
686 list = tpc_find_list(lun, list_id,
687 ctl_get_resindex(&ctsio->io_hdr.nexus));
688 if (list == NULL) {
689 mtx_unlock(&lun->lun_lock);
690 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
691 /*command*/ 1, /*field*/ 2, /*bit_valid*/ 0,
692 /*bit*/ 0);
693 ctl_done((union ctl_io *)ctsio);
694 return (retval);
695 }
696 list_copy = *list;
697 if (list->completed) {
698 TAILQ_REMOVE(&lun->tpc_lists, list, links);
699 free(list, M_CTL);
700 }
701 mtx_unlock(&lun->lun_lock);
702
703 total_len = sizeof(*data) + list_copy.sense_len;
704 alloc_len = scsi_4btoul(cdb->length);
705
706 ctsio->kern_data_ptr = malloc(total_len, M_CTL, M_WAITOK | M_ZERO);
707
708 ctsio->kern_sg_entries = 0;
709
710 if (total_len < alloc_len) {
711 ctsio->residual = alloc_len - total_len;
712 ctsio->kern_data_len = total_len;
713 ctsio->kern_total_len = total_len;
714 } else {
715 ctsio->residual = 0;
716 ctsio->kern_data_len = alloc_len;
717 ctsio->kern_total_len = alloc_len;
718 }
719 ctsio->kern_data_resid = 0;
720 ctsio->kern_rel_offset = 0;
721
722 data = (struct scsi_receive_copy_status_lid4_data *)ctsio->kern_data_ptr;
723 scsi_ulto4b(sizeof(*data) - 4 + list_copy.sense_len,
724 data->available_data);
725 data->response_to_service_action = list_copy.service_action;
726 if (list_copy.completed) {
727 if (list_copy.error)
728 data->copy_command_status = RCS_CCS_ERROR;
729 else if (list_copy.abort)
730 data->copy_command_status = RCS_CCS_ABORTED;
731 else
732 data->copy_command_status = RCS_CCS_COMPLETED;
733 } else
734 data->copy_command_status = RCS_CCS_INPROG_FG;
735 scsi_ulto2b(list_copy.curops, data->operation_counter);
736 scsi_ulto4b(UINT32_MAX, data->estimated_status_update_delay);
737 data->transfer_count_units = RCS_TC_BYTES;
738 scsi_u64to8b(list_copy.curbytes, data->transfer_count);
739 scsi_ulto2b(list_copy.curseg, data->segments_processed);
740 data->length_of_the_sense_data_field = list_copy.sense_len;
741 data->sense_data_length = list_copy.sense_len;
742 memcpy(data->sense_data, &list_copy.sense_data, list_copy.sense_len);
743
744 ctl_set_success(ctsio);
745 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
746 ctsio->be_move_done = ctl_config_move_done;
747 ctl_datamove((union ctl_io *)ctsio);
748 return (retval);
749 }
750
751 int
ctl_copy_operation_abort(struct ctl_scsiio * ctsio)752 ctl_copy_operation_abort(struct ctl_scsiio *ctsio)
753 {
754 struct ctl_lun *lun;
755 struct scsi_copy_operation_abort *cdb;
756 struct tpc_list *list;
757 int retval;
758 uint32_t list_id;
759
760 CTL_DEBUG_PRINT(("ctl_copy_operation_abort\n"));
761
762 cdb = (struct scsi_copy_operation_abort *)ctsio->cdb;
763 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
764
765 retval = CTL_RETVAL_COMPLETE;
766
767 list_id = scsi_4btoul(cdb->list_identifier);
768 mtx_lock(&lun->lun_lock);
769 list = tpc_find_list(lun, list_id,
770 ctl_get_resindex(&ctsio->io_hdr.nexus));
771 if (list == NULL) {
772 mtx_unlock(&lun->lun_lock);
773 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
774 /*command*/ 1, /*field*/ 2, /*bit_valid*/ 0,
775 /*bit*/ 0);
776 ctl_done((union ctl_io *)ctsio);
777 return (retval);
778 }
779 list->abort = 1;
780 mtx_unlock(&lun->lun_lock);
781
782 ctl_set_success(ctsio);
783 ctl_done((union ctl_io *)ctsio);
784 return (retval);
785 }
786
787 static uint64_t
tpc_resolve(struct tpc_list * list,uint16_t idx,uint32_t * ss,uint32_t * pb,uint32_t * pbo)788 tpc_resolve(struct tpc_list *list, uint16_t idx, uint32_t *ss,
789 uint32_t *pb, uint32_t *pbo)
790 {
791
792 if (idx == 0xffff) {
793 if (ss && list->lun->be_lun)
794 *ss = list->lun->be_lun->blocksize;
795 if (pb && list->lun->be_lun)
796 *pb = list->lun->be_lun->blocksize <<
797 list->lun->be_lun->pblockexp;
798 if (pbo && list->lun->be_lun)
799 *pbo = list->lun->be_lun->blocksize *
800 list->lun->be_lun->pblockoff;
801 return (list->lun->lun);
802 }
803 if (idx >= list->ncscd)
804 return (UINT64_MAX);
805 return (tpcl_resolve(list->lun->ctl_softc,
806 list->init_port, &list->cscd[idx], ss, pb, pbo));
807 }
808
809 static int
tpc_process_b2b(struct tpc_list * list)810 tpc_process_b2b(struct tpc_list *list)
811 {
812 struct scsi_ec_segment_b2b *seg;
813 struct scsi_ec_cscd_dtsp *sdstp, *ddstp;
814 struct tpc_io *tior, *tiow;
815 struct runl run, *prun;
816 uint64_t sl, dl;
817 off_t srclba, dstlba, numbytes, donebytes, roundbytes;
818 int numlba;
819 uint32_t srcblock, dstblock, pb, pbo, adj;
820
821 if (list->stage == 1) {
822 while ((tior = TAILQ_FIRST(&list->allio)) != NULL) {
823 TAILQ_REMOVE(&list->allio, tior, links);
824 ctl_free_io(tior->io);
825 free(tior, M_CTL);
826 }
827 free(list->buf, M_CTL);
828 if (list->abort) {
829 ctl_set_task_aborted(list->ctsio);
830 return (CTL_RETVAL_ERROR);
831 } else if (list->error) {
832 ctl_set_sense(list->ctsio, /*current_error*/ 1,
833 /*sense_key*/ SSD_KEY_COPY_ABORTED,
834 /*asc*/ 0x0d, /*ascq*/ 0x01, SSD_ELEM_NONE);
835 return (CTL_RETVAL_ERROR);
836 }
837 list->cursectors += list->segsectors;
838 list->curbytes += list->segbytes;
839 return (CTL_RETVAL_COMPLETE);
840 }
841
842 TAILQ_INIT(&list->allio);
843 seg = (struct scsi_ec_segment_b2b *)list->seg[list->curseg];
844 sl = tpc_resolve(list, scsi_2btoul(seg->src_cscd), &srcblock, NULL, NULL);
845 dl = tpc_resolve(list, scsi_2btoul(seg->dst_cscd), &dstblock, &pb, &pbo);
846 if (sl >= CTL_MAX_LUNS || dl >= CTL_MAX_LUNS) {
847 ctl_set_sense(list->ctsio, /*current_error*/ 1,
848 /*sense_key*/ SSD_KEY_COPY_ABORTED,
849 /*asc*/ 0x08, /*ascq*/ 0x04, SSD_ELEM_NONE);
850 return (CTL_RETVAL_ERROR);
851 }
852 if (pbo > 0)
853 pbo = pb - pbo;
854 sdstp = &list->cscd[scsi_2btoul(seg->src_cscd)].dtsp;
855 if (scsi_3btoul(sdstp->block_length) != 0)
856 srcblock = scsi_3btoul(sdstp->block_length);
857 ddstp = &list->cscd[scsi_2btoul(seg->dst_cscd)].dtsp;
858 if (scsi_3btoul(ddstp->block_length) != 0)
859 dstblock = scsi_3btoul(ddstp->block_length);
860 numlba = scsi_2btoul(seg->number_of_blocks);
861 if (seg->flags & EC_SEG_DC)
862 numbytes = (off_t)numlba * dstblock;
863 else
864 numbytes = (off_t)numlba * srcblock;
865 srclba = scsi_8btou64(seg->src_lba);
866 dstlba = scsi_8btou64(seg->dst_lba);
867
868 // printf("Copy %ju bytes from %ju @ %ju to %ju @ %ju\n",
869 // (uintmax_t)numbytes, sl, scsi_8btou64(seg->src_lba),
870 // dl, scsi_8btou64(seg->dst_lba));
871
872 if (numbytes == 0)
873 return (CTL_RETVAL_COMPLETE);
874
875 if (numbytes % srcblock != 0 || numbytes % dstblock != 0) {
876 ctl_set_sense(list->ctsio, /*current_error*/ 1,
877 /*sense_key*/ SSD_KEY_COPY_ABORTED,
878 /*asc*/ 0x26, /*ascq*/ 0x0A, SSD_ELEM_NONE);
879 return (CTL_RETVAL_ERROR);
880 }
881
882 list->buf = malloc(numbytes, M_CTL, M_WAITOK);
883 list->segbytes = numbytes;
884 list->segsectors = numbytes / dstblock;
885 donebytes = 0;
886 TAILQ_INIT(&run);
887 prun = &run;
888 list->tbdio = 1;
889 while (donebytes < numbytes) {
890 roundbytes = numbytes - donebytes;
891 if (roundbytes > TPC_MAX_IO_SIZE) {
892 roundbytes = TPC_MAX_IO_SIZE;
893 roundbytes -= roundbytes % dstblock;
894 if (pb > dstblock) {
895 adj = (dstlba * dstblock + roundbytes - pbo) % pb;
896 if (roundbytes > adj)
897 roundbytes -= adj;
898 }
899 }
900
901 tior = malloc(sizeof(*tior), M_CTL, M_WAITOK | M_ZERO);
902 TAILQ_INIT(&tior->run);
903 tior->list = list;
904 TAILQ_INSERT_TAIL(&list->allio, tior, links);
905 tior->io = tpcl_alloc_io();
906 ctl_scsi_read_write(tior->io,
907 /*data_ptr*/ &list->buf[donebytes],
908 /*data_len*/ roundbytes,
909 /*read_op*/ 1,
910 /*byte2*/ 0,
911 /*minimum_cdb_size*/ 0,
912 /*lba*/ srclba,
913 /*num_blocks*/ roundbytes / srcblock,
914 /*tag_type*/ CTL_TAG_SIMPLE,
915 /*control*/ 0);
916 tior->io->io_hdr.retries = 3;
917 tior->lun = sl;
918 tior->io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr = tior;
919
920 tiow = malloc(sizeof(*tior), M_CTL, M_WAITOK | M_ZERO);
921 TAILQ_INIT(&tiow->run);
922 tiow->list = list;
923 TAILQ_INSERT_TAIL(&list->allio, tiow, links);
924 tiow->io = tpcl_alloc_io();
925 ctl_scsi_read_write(tiow->io,
926 /*data_ptr*/ &list->buf[donebytes],
927 /*data_len*/ roundbytes,
928 /*read_op*/ 0,
929 /*byte2*/ 0,
930 /*minimum_cdb_size*/ 0,
931 /*lba*/ dstlba,
932 /*num_blocks*/ roundbytes / dstblock,
933 /*tag_type*/ CTL_TAG_SIMPLE,
934 /*control*/ 0);
935 tiow->io->io_hdr.retries = 3;
936 tiow->lun = dl;
937 tiow->io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr = tiow;
938
939 TAILQ_INSERT_TAIL(&tior->run, tiow, rlinks);
940 TAILQ_INSERT_TAIL(prun, tior, rlinks);
941 prun = &tior->run;
942 donebytes += roundbytes;
943 srclba += roundbytes / srcblock;
944 dstlba += roundbytes / dstblock;
945 }
946
947 while ((tior = TAILQ_FIRST(&run)) != NULL) {
948 TAILQ_REMOVE(&run, tior, rlinks);
949 if (tpcl_queue(tior->io, tior->lun) != CTL_RETVAL_COMPLETE)
950 panic("tpcl_queue() error");
951 }
952
953 list->stage++;
954 return (CTL_RETVAL_QUEUED);
955 }
956
957 static int
tpc_process_verify(struct tpc_list * list)958 tpc_process_verify(struct tpc_list *list)
959 {
960 struct scsi_ec_segment_verify *seg;
961 struct tpc_io *tio;
962 uint64_t sl;
963
964 if (list->stage == 1) {
965 while ((tio = TAILQ_FIRST(&list->allio)) != NULL) {
966 TAILQ_REMOVE(&list->allio, tio, links);
967 ctl_free_io(tio->io);
968 free(tio, M_CTL);
969 }
970 if (list->abort) {
971 ctl_set_task_aborted(list->ctsio);
972 return (CTL_RETVAL_ERROR);
973 } else if (list->error) {
974 ctl_set_sense(list->ctsio, /*current_error*/ 1,
975 /*sense_key*/ SSD_KEY_COPY_ABORTED,
976 /*asc*/ 0x0d, /*ascq*/ 0x01, SSD_ELEM_NONE);
977 return (CTL_RETVAL_ERROR);
978 } else
979 return (CTL_RETVAL_COMPLETE);
980 }
981
982 TAILQ_INIT(&list->allio);
983 seg = (struct scsi_ec_segment_verify *)list->seg[list->curseg];
984 sl = tpc_resolve(list, scsi_2btoul(seg->src_cscd), NULL, NULL, NULL);
985 if (sl >= CTL_MAX_LUNS) {
986 ctl_set_sense(list->ctsio, /*current_error*/ 1,
987 /*sense_key*/ SSD_KEY_COPY_ABORTED,
988 /*asc*/ 0x08, /*ascq*/ 0x04, SSD_ELEM_NONE);
989 return (CTL_RETVAL_ERROR);
990 }
991
992 // printf("Verify %ju\n", sl);
993
994 if ((seg->tur & 0x01) == 0)
995 return (CTL_RETVAL_COMPLETE);
996
997 list->tbdio = 1;
998 tio = malloc(sizeof(*tio), M_CTL, M_WAITOK | M_ZERO);
999 TAILQ_INIT(&tio->run);
1000 tio->list = list;
1001 TAILQ_INSERT_TAIL(&list->allio, tio, links);
1002 tio->io = tpcl_alloc_io();
1003 ctl_scsi_tur(tio->io, /*tag_type*/ CTL_TAG_SIMPLE, /*control*/ 0);
1004 tio->io->io_hdr.retries = 3;
1005 tio->lun = sl;
1006 tio->io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr = tio;
1007 list->stage++;
1008 if (tpcl_queue(tio->io, tio->lun) != CTL_RETVAL_COMPLETE)
1009 panic("tpcl_queue() error");
1010 return (CTL_RETVAL_QUEUED);
1011 }
1012
1013 static int
tpc_process_register_key(struct tpc_list * list)1014 tpc_process_register_key(struct tpc_list *list)
1015 {
1016 struct scsi_ec_segment_register_key *seg;
1017 struct tpc_io *tio;
1018 uint64_t dl;
1019 int datalen;
1020
1021 if (list->stage == 1) {
1022 while ((tio = TAILQ_FIRST(&list->allio)) != NULL) {
1023 TAILQ_REMOVE(&list->allio, tio, links);
1024 ctl_free_io(tio->io);
1025 free(tio, M_CTL);
1026 }
1027 free(list->buf, M_CTL);
1028 if (list->abort) {
1029 ctl_set_task_aborted(list->ctsio);
1030 return (CTL_RETVAL_ERROR);
1031 } else if (list->error) {
1032 ctl_set_sense(list->ctsio, /*current_error*/ 1,
1033 /*sense_key*/ SSD_KEY_COPY_ABORTED,
1034 /*asc*/ 0x0d, /*ascq*/ 0x01, SSD_ELEM_NONE);
1035 return (CTL_RETVAL_ERROR);
1036 } else
1037 return (CTL_RETVAL_COMPLETE);
1038 }
1039
1040 TAILQ_INIT(&list->allio);
1041 seg = (struct scsi_ec_segment_register_key *)list->seg[list->curseg];
1042 dl = tpc_resolve(list, scsi_2btoul(seg->dst_cscd), NULL, NULL, NULL);
1043 if (dl >= CTL_MAX_LUNS) {
1044 ctl_set_sense(list->ctsio, /*current_error*/ 1,
1045 /*sense_key*/ SSD_KEY_COPY_ABORTED,
1046 /*asc*/ 0x08, /*ascq*/ 0x04, SSD_ELEM_NONE);
1047 return (CTL_RETVAL_ERROR);
1048 }
1049
1050 // printf("Register Key %ju\n", dl);
1051
1052 list->tbdio = 1;
1053 tio = malloc(sizeof(*tio), M_CTL, M_WAITOK | M_ZERO);
1054 TAILQ_INIT(&tio->run);
1055 tio->list = list;
1056 TAILQ_INSERT_TAIL(&list->allio, tio, links);
1057 tio->io = tpcl_alloc_io();
1058 datalen = sizeof(struct scsi_per_res_out_parms);
1059 list->buf = malloc(datalen, M_CTL, M_WAITOK);
1060 ctl_scsi_persistent_res_out(tio->io,
1061 list->buf, datalen, SPRO_REGISTER, -1,
1062 scsi_8btou64(seg->res_key), scsi_8btou64(seg->sa_res_key),
1063 /*tag_type*/ CTL_TAG_SIMPLE, /*control*/ 0);
1064 tio->io->io_hdr.retries = 3;
1065 tio->lun = dl;
1066 tio->io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr = tio;
1067 list->stage++;
1068 if (tpcl_queue(tio->io, tio->lun) != CTL_RETVAL_COMPLETE)
1069 panic("tpcl_queue() error");
1070 return (CTL_RETVAL_QUEUED);
1071 }
1072
1073 static off_t
tpc_ranges_length(struct scsi_range_desc * range,int nrange)1074 tpc_ranges_length(struct scsi_range_desc *range, int nrange)
1075 {
1076 off_t length = 0;
1077 int r;
1078
1079 for (r = 0; r < nrange; r++)
1080 length += scsi_4btoul(range[r].length);
1081 return (length);
1082 }
1083
1084 static int
tpc_skip_ranges(struct scsi_range_desc * range,int nrange,off_t skip,int * srange,off_t * soffset)1085 tpc_skip_ranges(struct scsi_range_desc *range, int nrange, off_t skip,
1086 int *srange, off_t *soffset)
1087 {
1088 off_t off;
1089 int r;
1090
1091 r = 0;
1092 off = 0;
1093 while (r < nrange) {
1094 if (skip - off < scsi_4btoul(range[r].length)) {
1095 *srange = r;
1096 *soffset = skip - off;
1097 return (0);
1098 }
1099 off += scsi_4btoul(range[r].length);
1100 r++;
1101 }
1102 return (-1);
1103 }
1104
1105 static int
tpc_process_wut(struct tpc_list * list)1106 tpc_process_wut(struct tpc_list *list)
1107 {
1108 struct tpc_io *tio, *tior, *tiow;
1109 struct runl run, *prun;
1110 int drange, srange;
1111 off_t doffset, soffset;
1112 off_t srclba, dstlba, numbytes, donebytes, roundbytes;
1113 uint32_t srcblock, dstblock, pb, pbo, adj;
1114
1115 if (list->stage > 0) {
1116 /* Cleanup after previous rounds. */
1117 while ((tio = TAILQ_FIRST(&list->allio)) != NULL) {
1118 TAILQ_REMOVE(&list->allio, tio, links);
1119 ctl_free_io(tio->io);
1120 free(tio, M_CTL);
1121 }
1122 free(list->buf, M_CTL);
1123 if (list->abort) {
1124 ctl_set_task_aborted(list->ctsio);
1125 return (CTL_RETVAL_ERROR);
1126 } else if (list->error) {
1127 ctl_set_sense(list->ctsio, /*current_error*/ 1,
1128 /*sense_key*/ SSD_KEY_COPY_ABORTED,
1129 /*asc*/ 0x0d, /*ascq*/ 0x01, SSD_ELEM_NONE);
1130 return (CTL_RETVAL_ERROR);
1131 }
1132 list->cursectors += list->segsectors;
1133 list->curbytes += list->segbytes;
1134 }
1135
1136 /* Check where we are on destination ranges list. */
1137 if (tpc_skip_ranges(list->range, list->nrange, list->cursectors,
1138 &drange, &doffset) != 0)
1139 return (CTL_RETVAL_COMPLETE);
1140 dstblock = list->lun->be_lun->blocksize;
1141 pb = dstblock << list->lun->be_lun->pblockexp;
1142 if (list->lun->be_lun->pblockoff > 0)
1143 pbo = pb - dstblock * list->lun->be_lun->pblockoff;
1144 else
1145 pbo = 0;
1146
1147 /* Check where we are on source ranges list. */
1148 srcblock = list->token->blocksize;
1149 if (tpc_skip_ranges(list->token->range, list->token->nrange,
1150 list->offset_into_rod + list->cursectors * dstblock / srcblock,
1151 &srange, &soffset) != 0) {
1152 ctl_set_sense(list->ctsio, /*current_error*/ 1,
1153 /*sense_key*/ SSD_KEY_COPY_ABORTED,
1154 /*asc*/ 0x0d, /*ascq*/ 0x04, SSD_ELEM_NONE);
1155 return (CTL_RETVAL_ERROR);
1156 }
1157
1158 srclba = scsi_8btou64(list->token->range[srange].lba) + soffset;
1159 dstlba = scsi_8btou64(list->range[drange].lba) + doffset;
1160 numbytes = srcblock *
1161 (scsi_4btoul(list->token->range[srange].length) - soffset);
1162 numbytes = omin(numbytes, dstblock *
1163 (scsi_4btoul(list->range[drange].length) - doffset));
1164 if (numbytes > TPC_MAX_IOCHUNK_SIZE) {
1165 numbytes = TPC_MAX_IOCHUNK_SIZE;
1166 numbytes -= numbytes % dstblock;
1167 if (pb > dstblock) {
1168 adj = (dstlba * dstblock + numbytes - pbo) % pb;
1169 if (numbytes > adj)
1170 numbytes -= adj;
1171 }
1172 }
1173
1174 if (numbytes % srcblock != 0 || numbytes % dstblock != 0) {
1175 ctl_set_sense(list->ctsio, /*current_error*/ 1,
1176 /*sense_key*/ SSD_KEY_COPY_ABORTED,
1177 /*asc*/ 0x26, /*ascq*/ 0x0A, SSD_ELEM_NONE);
1178 return (CTL_RETVAL_ERROR);
1179 }
1180
1181 list->buf = malloc(numbytes, M_CTL, M_WAITOK |
1182 (list->token == NULL ? M_ZERO : 0));
1183 list->segbytes = numbytes;
1184 list->segsectors = numbytes / dstblock;
1185 //printf("Copy chunk of %ju sectors from %ju to %ju\n", list->segsectors,
1186 // srclba, dstlba);
1187 donebytes = 0;
1188 TAILQ_INIT(&run);
1189 prun = &run;
1190 list->tbdio = 1;
1191 TAILQ_INIT(&list->allio);
1192 while (donebytes < numbytes) {
1193 roundbytes = numbytes - donebytes;
1194 if (roundbytes > TPC_MAX_IO_SIZE) {
1195 roundbytes = TPC_MAX_IO_SIZE;
1196 roundbytes -= roundbytes % dstblock;
1197 if (pb > dstblock) {
1198 adj = (dstlba * dstblock + roundbytes - pbo) % pb;
1199 if (roundbytes > adj)
1200 roundbytes -= adj;
1201 }
1202 }
1203
1204 tior = malloc(sizeof(*tior), M_CTL, M_WAITOK | M_ZERO);
1205 TAILQ_INIT(&tior->run);
1206 tior->list = list;
1207 TAILQ_INSERT_TAIL(&list->allio, tior, links);
1208 tior->io = tpcl_alloc_io();
1209 ctl_scsi_read_write(tior->io,
1210 /*data_ptr*/ &list->buf[donebytes],
1211 /*data_len*/ roundbytes,
1212 /*read_op*/ 1,
1213 /*byte2*/ 0,
1214 /*minimum_cdb_size*/ 0,
1215 /*lba*/ srclba,
1216 /*num_blocks*/ roundbytes / srcblock,
1217 /*tag_type*/ CTL_TAG_SIMPLE,
1218 /*control*/ 0);
1219 tior->io->io_hdr.retries = 3;
1220 tior->lun = list->token->lun;
1221 tior->io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr = tior;
1222
1223 tiow = malloc(sizeof(*tiow), M_CTL, M_WAITOK | M_ZERO);
1224 TAILQ_INIT(&tiow->run);
1225 tiow->list = list;
1226 TAILQ_INSERT_TAIL(&list->allio, tiow, links);
1227 tiow->io = tpcl_alloc_io();
1228 ctl_scsi_read_write(tiow->io,
1229 /*data_ptr*/ &list->buf[donebytes],
1230 /*data_len*/ roundbytes,
1231 /*read_op*/ 0,
1232 /*byte2*/ 0,
1233 /*minimum_cdb_size*/ 0,
1234 /*lba*/ dstlba,
1235 /*num_blocks*/ roundbytes / dstblock,
1236 /*tag_type*/ CTL_TAG_SIMPLE,
1237 /*control*/ 0);
1238 tiow->io->io_hdr.retries = 3;
1239 tiow->lun = list->lun->lun;
1240 tiow->io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr = tiow;
1241
1242 TAILQ_INSERT_TAIL(&tior->run, tiow, rlinks);
1243 TAILQ_INSERT_TAIL(prun, tior, rlinks);
1244 prun = &tior->run;
1245 donebytes += roundbytes;
1246 srclba += roundbytes / srcblock;
1247 dstlba += roundbytes / dstblock;
1248 }
1249
1250 while ((tior = TAILQ_FIRST(&run)) != NULL) {
1251 TAILQ_REMOVE(&run, tior, rlinks);
1252 if (tpcl_queue(tior->io, tior->lun) != CTL_RETVAL_COMPLETE)
1253 panic("tpcl_queue() error");
1254 }
1255
1256 list->stage++;
1257 return (CTL_RETVAL_QUEUED);
1258 }
1259
1260 static int
tpc_process_zero_wut(struct tpc_list * list)1261 tpc_process_zero_wut(struct tpc_list *list)
1262 {
1263 struct tpc_io *tio, *tiow;
1264 struct runl run, *prun;
1265 int r;
1266 uint32_t dstblock, len;
1267
1268 if (list->stage > 0) {
1269 complete:
1270 /* Cleanup after previous rounds. */
1271 while ((tio = TAILQ_FIRST(&list->allio)) != NULL) {
1272 TAILQ_REMOVE(&list->allio, tio, links);
1273 ctl_free_io(tio->io);
1274 free(tio, M_CTL);
1275 }
1276 free(list->buf, M_CTL);
1277 if (list->abort) {
1278 ctl_set_task_aborted(list->ctsio);
1279 return (CTL_RETVAL_ERROR);
1280 } else if (list->error) {
1281 ctl_set_sense(list->ctsio, /*current_error*/ 1,
1282 /*sense_key*/ SSD_KEY_COPY_ABORTED,
1283 /*asc*/ 0x0d, /*ascq*/ 0x01, SSD_ELEM_NONE);
1284 return (CTL_RETVAL_ERROR);
1285 }
1286 list->cursectors += list->segsectors;
1287 list->curbytes += list->segbytes;
1288 return (CTL_RETVAL_COMPLETE);
1289 }
1290
1291 dstblock = list->lun->be_lun->blocksize;
1292 list->buf = malloc(dstblock, M_CTL, M_WAITOK | M_ZERO);
1293 TAILQ_INIT(&run);
1294 prun = &run;
1295 list->tbdio = 1;
1296 TAILQ_INIT(&list->allio);
1297 list->segsectors = 0;
1298 for (r = 0; r < list->nrange; r++) {
1299 len = scsi_4btoul(list->range[r].length);
1300 if (len == 0)
1301 continue;
1302
1303 tiow = malloc(sizeof(*tiow), M_CTL, M_WAITOK | M_ZERO);
1304 TAILQ_INIT(&tiow->run);
1305 tiow->list = list;
1306 TAILQ_INSERT_TAIL(&list->allio, tiow, links);
1307 tiow->io = tpcl_alloc_io();
1308 ctl_scsi_write_same(tiow->io,
1309 /*data_ptr*/ list->buf,
1310 /*data_len*/ dstblock,
1311 /*byte2*/ 0,
1312 /*lba*/ scsi_8btou64(list->range[r].lba),
1313 /*num_blocks*/ len,
1314 /*tag_type*/ CTL_TAG_SIMPLE,
1315 /*control*/ 0);
1316 tiow->io->io_hdr.retries = 3;
1317 tiow->lun = list->lun->lun;
1318 tiow->io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr = tiow;
1319
1320 TAILQ_INSERT_TAIL(prun, tiow, rlinks);
1321 prun = &tiow->run;
1322 list->segsectors += len;
1323 }
1324 list->segbytes = list->segsectors * dstblock;
1325
1326 if (TAILQ_EMPTY(&run))
1327 goto complete;
1328
1329 while ((tiow = TAILQ_FIRST(&run)) != NULL) {
1330 TAILQ_REMOVE(&run, tiow, rlinks);
1331 if (tpcl_queue(tiow->io, tiow->lun) != CTL_RETVAL_COMPLETE)
1332 panic("tpcl_queue() error");
1333 }
1334
1335 list->stage++;
1336 return (CTL_RETVAL_QUEUED);
1337 }
1338
1339 static void
tpc_process(struct tpc_list * list)1340 tpc_process(struct tpc_list *list)
1341 {
1342 struct ctl_lun *lun = list->lun;
1343 struct ctl_softc *softc = lun->ctl_softc;
1344 struct scsi_ec_segment *seg;
1345 struct ctl_scsiio *ctsio = list->ctsio;
1346 int retval = CTL_RETVAL_COMPLETE;
1347
1348 if (list->service_action == EC_WUT) {
1349 if (list->token != NULL)
1350 retval = tpc_process_wut(list);
1351 else
1352 retval = tpc_process_zero_wut(list);
1353 if (retval == CTL_RETVAL_QUEUED)
1354 return;
1355 if (retval == CTL_RETVAL_ERROR) {
1356 list->error = 1;
1357 goto done;
1358 }
1359 } else {
1360 //printf("ZZZ %d cscd, %d segs\n", list->ncscd, list->nseg);
1361 while (list->curseg < list->nseg) {
1362 seg = list->seg[list->curseg];
1363 switch (seg->type_code) {
1364 case EC_SEG_B2B:
1365 retval = tpc_process_b2b(list);
1366 break;
1367 case EC_SEG_VERIFY:
1368 retval = tpc_process_verify(list);
1369 break;
1370 case EC_SEG_REGISTER_KEY:
1371 retval = tpc_process_register_key(list);
1372 break;
1373 default:
1374 ctl_set_sense(ctsio, /*current_error*/ 1,
1375 /*sense_key*/ SSD_KEY_COPY_ABORTED,
1376 /*asc*/ 0x26, /*ascq*/ 0x09, SSD_ELEM_NONE);
1377 goto done;
1378 }
1379 if (retval == CTL_RETVAL_QUEUED)
1380 return;
1381 if (retval == CTL_RETVAL_ERROR) {
1382 list->error = 1;
1383 goto done;
1384 }
1385 list->curseg++;
1386 list->stage = 0;
1387 }
1388 }
1389
1390 ctl_set_success(ctsio);
1391
1392 done:
1393 //printf("ZZZ done\n");
1394 free(list->params, M_CTL);
1395 list->params = NULL;
1396 if (list->token) {
1397 mtx_lock(&softc->ctl_lock);
1398 if (--list->token->active == 0)
1399 list->token->last_active = time_uptime;
1400 mtx_unlock(&softc->ctl_lock);
1401 list->token = NULL;
1402 }
1403 mtx_lock(&lun->lun_lock);
1404 if ((list->flags & EC_LIST_ID_USAGE_MASK) == EC_LIST_ID_USAGE_NONE) {
1405 TAILQ_REMOVE(&lun->tpc_lists, list, links);
1406 free(list, M_CTL);
1407 } else {
1408 list->completed = 1;
1409 list->last_active = time_uptime;
1410 list->sense_data = ctsio->sense_data;
1411 list->sense_len = ctsio->sense_len;
1412 list->scsi_status = ctsio->scsi_status;
1413 }
1414 mtx_unlock(&lun->lun_lock);
1415
1416 ctl_done((union ctl_io *)ctsio);
1417 }
1418
1419 /*
1420 * For any sort of check condition, busy, etc., we just retry. We do not
1421 * decrement the retry count for unit attention type errors. These are
1422 * normal, and we want to save the retry count for "real" errors. Otherwise,
1423 * we could end up with situations where a command will succeed in some
1424 * situations and fail in others, depending on whether a unit attention is
1425 * pending. Also, some of our error recovery actions, most notably the
1426 * LUN reset action, will cause a unit attention.
1427 *
1428 * We can add more detail here later if necessary.
1429 */
1430 static tpc_error_action
tpc_checkcond_parse(union ctl_io * io)1431 tpc_checkcond_parse(union ctl_io *io)
1432 {
1433 tpc_error_action error_action;
1434 int error_code, sense_key, asc, ascq;
1435
1436 /*
1437 * Default to retrying the command.
1438 */
1439 error_action = TPC_ERR_RETRY;
1440
1441 scsi_extract_sense_len(&io->scsiio.sense_data,
1442 io->scsiio.sense_len,
1443 &error_code,
1444 &sense_key,
1445 &asc,
1446 &ascq,
1447 /*show_errors*/ 1);
1448
1449 switch (error_code) {
1450 case SSD_DEFERRED_ERROR:
1451 case SSD_DESC_DEFERRED_ERROR:
1452 error_action |= TPC_ERR_NO_DECREMENT;
1453 break;
1454 case SSD_CURRENT_ERROR:
1455 case SSD_DESC_CURRENT_ERROR:
1456 default:
1457 switch (sense_key) {
1458 case SSD_KEY_UNIT_ATTENTION:
1459 error_action |= TPC_ERR_NO_DECREMENT;
1460 break;
1461 case SSD_KEY_HARDWARE_ERROR:
1462 /*
1463 * This is our generic "something bad happened"
1464 * error code. It often isn't recoverable.
1465 */
1466 if ((asc == 0x44) && (ascq == 0x00))
1467 error_action = TPC_ERR_FAIL;
1468 break;
1469 case SSD_KEY_NOT_READY:
1470 /*
1471 * If the LUN is powered down, there likely isn't
1472 * much point in retrying right now.
1473 */
1474 if ((asc == 0x04) && (ascq == 0x02))
1475 error_action = TPC_ERR_FAIL;
1476 /*
1477 * If the LUN is offline, there probably isn't much
1478 * point in retrying, either.
1479 */
1480 if ((asc == 0x04) && (ascq == 0x03))
1481 error_action = TPC_ERR_FAIL;
1482 break;
1483 }
1484 }
1485 return (error_action);
1486 }
1487
1488 static tpc_error_action
tpc_error_parse(union ctl_io * io)1489 tpc_error_parse(union ctl_io *io)
1490 {
1491 tpc_error_action error_action = TPC_ERR_RETRY;
1492
1493 switch (io->io_hdr.io_type) {
1494 case CTL_IO_SCSI:
1495 switch (io->io_hdr.status & CTL_STATUS_MASK) {
1496 case CTL_SCSI_ERROR:
1497 switch (io->scsiio.scsi_status) {
1498 case SCSI_STATUS_CHECK_COND:
1499 error_action = tpc_checkcond_parse(io);
1500 break;
1501 default:
1502 break;
1503 }
1504 break;
1505 default:
1506 break;
1507 }
1508 break;
1509 case CTL_IO_TASK:
1510 break;
1511 default:
1512 panic("%s: invalid ctl_io type %d\n", __func__,
1513 io->io_hdr.io_type);
1514 break;
1515 }
1516 return (error_action);
1517 }
1518
1519 void
tpc_done(union ctl_io * io)1520 tpc_done(union ctl_io *io)
1521 {
1522 struct tpc_io *tio, *tior;
1523
1524 /*
1525 * Very minimal retry logic. We basically retry if we got an error
1526 * back, and the retry count is greater than 0. If we ever want
1527 * more sophisticated initiator type behavior, the CAM error
1528 * recovery code in ../common might be helpful.
1529 */
1530 tio = io->io_hdr.ctl_private[CTL_PRIV_FRONTEND].ptr;
1531 if (((io->io_hdr.status & CTL_STATUS_MASK) != CTL_SUCCESS)
1532 && (io->io_hdr.retries > 0)) {
1533 ctl_io_status old_status;
1534 tpc_error_action error_action;
1535
1536 error_action = tpc_error_parse(io);
1537 switch (error_action & TPC_ERR_MASK) {
1538 case TPC_ERR_FAIL:
1539 break;
1540 case TPC_ERR_RETRY:
1541 default:
1542 if ((error_action & TPC_ERR_NO_DECREMENT) == 0)
1543 io->io_hdr.retries--;
1544 old_status = io->io_hdr.status;
1545 io->io_hdr.status = CTL_STATUS_NONE;
1546 io->io_hdr.flags &= ~CTL_FLAG_ABORT;
1547 io->io_hdr.flags &= ~CTL_FLAG_SENT_2OTHER_SC;
1548 if (tpcl_queue(io, tio->lun) != CTL_RETVAL_COMPLETE) {
1549 printf("%s: error returned from ctl_queue()!\n",
1550 __func__);
1551 io->io_hdr.status = old_status;
1552 } else
1553 return;
1554 }
1555 }
1556
1557 if ((io->io_hdr.status & CTL_STATUS_MASK) != CTL_SUCCESS)
1558 tio->list->error = 1;
1559 else
1560 atomic_add_int(&tio->list->curops, 1);
1561 if (!tio->list->error && !tio->list->abort) {
1562 while ((tior = TAILQ_FIRST(&tio->run)) != NULL) {
1563 TAILQ_REMOVE(&tio->run, tior, rlinks);
1564 atomic_add_int(&tio->list->tbdio, 1);
1565 if (tpcl_queue(tior->io, tior->lun) != CTL_RETVAL_COMPLETE)
1566 panic("tpcl_queue() error");
1567 }
1568 }
1569 if (atomic_fetchadd_int(&tio->list->tbdio, -1) == 1)
1570 tpc_process(tio->list);
1571 }
1572
1573 int
ctl_extended_copy_lid1(struct ctl_scsiio * ctsio)1574 ctl_extended_copy_lid1(struct ctl_scsiio *ctsio)
1575 {
1576 struct scsi_extended_copy *cdb;
1577 struct scsi_extended_copy_lid1_data *data;
1578 struct ctl_lun *lun;
1579 struct tpc_list *list, *tlist;
1580 uint8_t *ptr;
1581 char *value;
1582 int len, off, lencscd, lenseg, leninl, nseg;
1583
1584 CTL_DEBUG_PRINT(("ctl_extended_copy_lid1\n"));
1585
1586 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
1587 cdb = (struct scsi_extended_copy *)ctsio->cdb;
1588 len = scsi_4btoul(cdb->length);
1589
1590 if (len < sizeof(struct scsi_extended_copy_lid1_data) ||
1591 len > sizeof(struct scsi_extended_copy_lid1_data) +
1592 TPC_MAX_LIST + TPC_MAX_INLINE) {
1593 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 1,
1594 /*field*/ 9, /*bit_valid*/ 0, /*bit*/ 0);
1595 goto done;
1596 }
1597
1598 /*
1599 * If we've got a kernel request that hasn't been malloced yet,
1600 * malloc it and tell the caller the data buffer is here.
1601 */
1602 if ((ctsio->io_hdr.flags & CTL_FLAG_ALLOCATED) == 0) {
1603 ctsio->kern_data_ptr = malloc(len, M_CTL, M_WAITOK);
1604 ctsio->kern_data_len = len;
1605 ctsio->kern_total_len = len;
1606 ctsio->kern_data_resid = 0;
1607 ctsio->kern_rel_offset = 0;
1608 ctsio->kern_sg_entries = 0;
1609 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
1610 ctsio->be_move_done = ctl_config_move_done;
1611 ctl_datamove((union ctl_io *)ctsio);
1612
1613 return (CTL_RETVAL_COMPLETE);
1614 }
1615
1616 data = (struct scsi_extended_copy_lid1_data *)ctsio->kern_data_ptr;
1617 lencscd = scsi_2btoul(data->cscd_list_length);
1618 lenseg = scsi_4btoul(data->segment_list_length);
1619 leninl = scsi_4btoul(data->inline_data_length);
1620 if (len < sizeof(struct scsi_extended_copy_lid1_data) +
1621 lencscd + lenseg + leninl ||
1622 leninl > TPC_MAX_INLINE) {
1623 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 0,
1624 /*field*/ 2, /*bit_valid*/ 0, /*bit*/ 0);
1625 goto done;
1626 }
1627 if (lencscd > TPC_MAX_CSCDS * sizeof(struct scsi_ec_cscd)) {
1628 ctl_set_sense(ctsio, /*current_error*/ 1,
1629 /*sense_key*/ SSD_KEY_ILLEGAL_REQUEST,
1630 /*asc*/ 0x26, /*ascq*/ 0x06, SSD_ELEM_NONE);
1631 goto done;
1632 }
1633 if (lencscd + lenseg > TPC_MAX_LIST) {
1634 ctl_set_param_len_error(ctsio);
1635 goto done;
1636 }
1637
1638 list = malloc(sizeof(struct tpc_list), M_CTL, M_WAITOK | M_ZERO);
1639 list->service_action = cdb->service_action;
1640 value = ctl_get_opt(&lun->be_lun->options, "insecure_tpc");
1641 if (value != NULL && strcmp(value, "on") == 0)
1642 list->init_port = -1;
1643 else
1644 list->init_port = ctsio->io_hdr.nexus.targ_port;
1645 list->init_idx = ctl_get_resindex(&ctsio->io_hdr.nexus);
1646 list->list_id = data->list_identifier;
1647 list->flags = data->flags;
1648 list->params = ctsio->kern_data_ptr;
1649 list->cscd = (struct scsi_ec_cscd *)&data->data[0];
1650 ptr = &data->data[lencscd];
1651 for (nseg = 0, off = 0; off < lenseg; nseg++) {
1652 if (nseg >= TPC_MAX_SEGS) {
1653 free(list, M_CTL);
1654 ctl_set_sense(ctsio, /*current_error*/ 1,
1655 /*sense_key*/ SSD_KEY_ILLEGAL_REQUEST,
1656 /*asc*/ 0x26, /*ascq*/ 0x08, SSD_ELEM_NONE);
1657 goto done;
1658 }
1659 list->seg[nseg] = (struct scsi_ec_segment *)(ptr + off);
1660 off += sizeof(struct scsi_ec_segment) +
1661 scsi_2btoul(list->seg[nseg]->descr_length);
1662 }
1663 list->inl = &data->data[lencscd + lenseg];
1664 list->ncscd = lencscd / sizeof(struct scsi_ec_cscd);
1665 list->nseg = nseg;
1666 list->leninl = leninl;
1667 list->ctsio = ctsio;
1668 list->lun = lun;
1669 mtx_lock(&lun->lun_lock);
1670 if ((list->flags & EC_LIST_ID_USAGE_MASK) != EC_LIST_ID_USAGE_NONE) {
1671 tlist = tpc_find_list(lun, list->list_id, list->init_idx);
1672 if (tlist != NULL && !tlist->completed) {
1673 mtx_unlock(&lun->lun_lock);
1674 free(list, M_CTL);
1675 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
1676 /*command*/ 0, /*field*/ 0, /*bit_valid*/ 0,
1677 /*bit*/ 0);
1678 goto done;
1679 }
1680 if (tlist != NULL) {
1681 TAILQ_REMOVE(&lun->tpc_lists, tlist, links);
1682 free(tlist, M_CTL);
1683 }
1684 }
1685 TAILQ_INSERT_TAIL(&lun->tpc_lists, list, links);
1686 mtx_unlock(&lun->lun_lock);
1687
1688 tpc_process(list);
1689 return (CTL_RETVAL_COMPLETE);
1690
1691 done:
1692 if (ctsio->io_hdr.flags & CTL_FLAG_ALLOCATED) {
1693 free(ctsio->kern_data_ptr, M_CTL);
1694 ctsio->io_hdr.flags &= ~CTL_FLAG_ALLOCATED;
1695 }
1696 ctl_done((union ctl_io *)ctsio);
1697 return (CTL_RETVAL_COMPLETE);
1698 }
1699
1700 int
ctl_extended_copy_lid4(struct ctl_scsiio * ctsio)1701 ctl_extended_copy_lid4(struct ctl_scsiio *ctsio)
1702 {
1703 struct scsi_extended_copy *cdb;
1704 struct scsi_extended_copy_lid4_data *data;
1705 struct ctl_lun *lun;
1706 struct tpc_list *list, *tlist;
1707 uint8_t *ptr;
1708 char *value;
1709 int len, off, lencscd, lenseg, leninl, nseg;
1710
1711 CTL_DEBUG_PRINT(("ctl_extended_copy_lid4\n"));
1712
1713 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
1714 cdb = (struct scsi_extended_copy *)ctsio->cdb;
1715 len = scsi_4btoul(cdb->length);
1716
1717 if (len < sizeof(struct scsi_extended_copy_lid4_data) ||
1718 len > sizeof(struct scsi_extended_copy_lid4_data) +
1719 TPC_MAX_LIST + TPC_MAX_INLINE) {
1720 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 1,
1721 /*field*/ 9, /*bit_valid*/ 0, /*bit*/ 0);
1722 goto done;
1723 }
1724
1725 /*
1726 * If we've got a kernel request that hasn't been malloced yet,
1727 * malloc it and tell the caller the data buffer is here.
1728 */
1729 if ((ctsio->io_hdr.flags & CTL_FLAG_ALLOCATED) == 0) {
1730 ctsio->kern_data_ptr = malloc(len, M_CTL, M_WAITOK);
1731 ctsio->kern_data_len = len;
1732 ctsio->kern_total_len = len;
1733 ctsio->kern_data_resid = 0;
1734 ctsio->kern_rel_offset = 0;
1735 ctsio->kern_sg_entries = 0;
1736 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
1737 ctsio->be_move_done = ctl_config_move_done;
1738 ctl_datamove((union ctl_io *)ctsio);
1739
1740 return (CTL_RETVAL_COMPLETE);
1741 }
1742
1743 data = (struct scsi_extended_copy_lid4_data *)ctsio->kern_data_ptr;
1744 lencscd = scsi_2btoul(data->cscd_list_length);
1745 lenseg = scsi_2btoul(data->segment_list_length);
1746 leninl = scsi_2btoul(data->inline_data_length);
1747 if (len < sizeof(struct scsi_extended_copy_lid4_data) +
1748 lencscd + lenseg + leninl ||
1749 leninl > TPC_MAX_INLINE) {
1750 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 0,
1751 /*field*/ 2, /*bit_valid*/ 0, /*bit*/ 0);
1752 goto done;
1753 }
1754 if (lencscd > TPC_MAX_CSCDS * sizeof(struct scsi_ec_cscd)) {
1755 ctl_set_sense(ctsio, /*current_error*/ 1,
1756 /*sense_key*/ SSD_KEY_ILLEGAL_REQUEST,
1757 /*asc*/ 0x26, /*ascq*/ 0x06, SSD_ELEM_NONE);
1758 goto done;
1759 }
1760 if (lencscd + lenseg > TPC_MAX_LIST) {
1761 ctl_set_param_len_error(ctsio);
1762 goto done;
1763 }
1764
1765 list = malloc(sizeof(struct tpc_list), M_CTL, M_WAITOK | M_ZERO);
1766 list->service_action = cdb->service_action;
1767 value = ctl_get_opt(&lun->be_lun->options, "insecure_tpc");
1768 if (value != NULL && strcmp(value, "on") == 0)
1769 list->init_port = -1;
1770 else
1771 list->init_port = ctsio->io_hdr.nexus.targ_port;
1772 list->init_idx = ctl_get_resindex(&ctsio->io_hdr.nexus);
1773 list->list_id = scsi_4btoul(data->list_identifier);
1774 list->flags = data->flags;
1775 list->params = ctsio->kern_data_ptr;
1776 list->cscd = (struct scsi_ec_cscd *)&data->data[0];
1777 ptr = &data->data[lencscd];
1778 for (nseg = 0, off = 0; off < lenseg; nseg++) {
1779 if (nseg >= TPC_MAX_SEGS) {
1780 free(list, M_CTL);
1781 ctl_set_sense(ctsio, /*current_error*/ 1,
1782 /*sense_key*/ SSD_KEY_ILLEGAL_REQUEST,
1783 /*asc*/ 0x26, /*ascq*/ 0x08, SSD_ELEM_NONE);
1784 goto done;
1785 }
1786 list->seg[nseg] = (struct scsi_ec_segment *)(ptr + off);
1787 off += sizeof(struct scsi_ec_segment) +
1788 scsi_2btoul(list->seg[nseg]->descr_length);
1789 }
1790 list->inl = &data->data[lencscd + lenseg];
1791 list->ncscd = lencscd / sizeof(struct scsi_ec_cscd);
1792 list->nseg = nseg;
1793 list->leninl = leninl;
1794 list->ctsio = ctsio;
1795 list->lun = lun;
1796 mtx_lock(&lun->lun_lock);
1797 if ((list->flags & EC_LIST_ID_USAGE_MASK) != EC_LIST_ID_USAGE_NONE) {
1798 tlist = tpc_find_list(lun, list->list_id, list->init_idx);
1799 if (tlist != NULL && !tlist->completed) {
1800 mtx_unlock(&lun->lun_lock);
1801 free(list, M_CTL);
1802 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
1803 /*command*/ 0, /*field*/ 0, /*bit_valid*/ 0,
1804 /*bit*/ 0);
1805 goto done;
1806 }
1807 if (tlist != NULL) {
1808 TAILQ_REMOVE(&lun->tpc_lists, tlist, links);
1809 free(tlist, M_CTL);
1810 }
1811 }
1812 TAILQ_INSERT_TAIL(&lun->tpc_lists, list, links);
1813 mtx_unlock(&lun->lun_lock);
1814
1815 tpc_process(list);
1816 return (CTL_RETVAL_COMPLETE);
1817
1818 done:
1819 if (ctsio->io_hdr.flags & CTL_FLAG_ALLOCATED) {
1820 free(ctsio->kern_data_ptr, M_CTL);
1821 ctsio->io_hdr.flags &= ~CTL_FLAG_ALLOCATED;
1822 }
1823 ctl_done((union ctl_io *)ctsio);
1824 return (CTL_RETVAL_COMPLETE);
1825 }
1826
1827 static void
tpc_create_token(struct ctl_lun * lun,struct ctl_port * port,off_t len,struct scsi_token * token)1828 tpc_create_token(struct ctl_lun *lun, struct ctl_port *port, off_t len,
1829 struct scsi_token *token)
1830 {
1831 static int id = 0;
1832 struct scsi_vpd_id_descriptor *idd = NULL;
1833 struct scsi_ec_cscd_id *cscd;
1834 struct scsi_read_capacity_data_long *dtsd;
1835 int targid_len;
1836
1837 scsi_ulto4b(ROD_TYPE_AUR, token->type);
1838 scsi_ulto2b(0x01f8, token->length);
1839 scsi_u64to8b(atomic_fetchadd_int(&id, 1), &token->body[0]);
1840 if (lun->lun_devid)
1841 idd = scsi_get_devid_desc((struct scsi_vpd_id_descriptor *)
1842 lun->lun_devid->data, lun->lun_devid->len,
1843 scsi_devid_is_lun_naa);
1844 if (idd == NULL && lun->lun_devid)
1845 idd = scsi_get_devid_desc((struct scsi_vpd_id_descriptor *)
1846 lun->lun_devid->data, lun->lun_devid->len,
1847 scsi_devid_is_lun_eui64);
1848 if (idd != NULL) {
1849 cscd = (struct scsi_ec_cscd_id *)&token->body[8];
1850 cscd->type_code = EC_CSCD_ID;
1851 cscd->luidt_pdt = T_DIRECT;
1852 memcpy(&cscd->codeset, idd, 4 + idd->length);
1853 scsi_ulto3b(lun->be_lun->blocksize, cscd->dtsp.block_length);
1854 }
1855 scsi_u64to8b(0, &token->body[40]); /* XXX: Should be 128bit value. */
1856 scsi_u64to8b(len, &token->body[48]);
1857
1858 /* ROD token device type specific data (RC16 without first field) */
1859 dtsd = (struct scsi_read_capacity_data_long *)&token->body[88 - 8];
1860 scsi_ulto4b(lun->be_lun->blocksize, dtsd->length);
1861 dtsd->prot_lbppbe = lun->be_lun->pblockexp & SRC16_LBPPBE;
1862 scsi_ulto2b(lun->be_lun->pblockoff & SRC16_LALBA_A, dtsd->lalba_lbp);
1863 if (lun->be_lun->flags & CTL_LUN_FLAG_UNMAP)
1864 dtsd->lalba_lbp[0] |= SRC16_LBPME | SRC16_LBPRZ;
1865
1866 if (port->target_devid) {
1867 targid_len = port->target_devid->len;
1868 memcpy(&token->body[120], port->target_devid->data, targid_len);
1869 } else
1870 targid_len = 32;
1871 arc4rand(&token->body[120 + targid_len], 384 - targid_len, 0);
1872 };
1873
1874 int
ctl_populate_token(struct ctl_scsiio * ctsio)1875 ctl_populate_token(struct ctl_scsiio *ctsio)
1876 {
1877 struct scsi_populate_token *cdb;
1878 struct scsi_populate_token_data *data;
1879 struct ctl_softc *softc;
1880 struct ctl_lun *lun;
1881 struct ctl_port *port;
1882 struct tpc_list *list, *tlist;
1883 struct tpc_token *token;
1884 int len, lendesc;
1885
1886 CTL_DEBUG_PRINT(("ctl_populate_token\n"));
1887
1888 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
1889 softc = lun->ctl_softc;
1890 port = softc->ctl_ports[ctl_port_idx(ctsio->io_hdr.nexus.targ_port)];
1891 cdb = (struct scsi_populate_token *)ctsio->cdb;
1892 len = scsi_4btoul(cdb->length);
1893
1894 if (len < sizeof(struct scsi_populate_token_data) ||
1895 len > sizeof(struct scsi_populate_token_data) +
1896 TPC_MAX_SEGS * sizeof(struct scsi_range_desc)) {
1897 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 1,
1898 /*field*/ 9, /*bit_valid*/ 0, /*bit*/ 0);
1899 goto done;
1900 }
1901
1902 /*
1903 * If we've got a kernel request that hasn't been malloced yet,
1904 * malloc it and tell the caller the data buffer is here.
1905 */
1906 if ((ctsio->io_hdr.flags & CTL_FLAG_ALLOCATED) == 0) {
1907 ctsio->kern_data_ptr = malloc(len, M_CTL, M_WAITOK);
1908 ctsio->kern_data_len = len;
1909 ctsio->kern_total_len = len;
1910 ctsio->kern_data_resid = 0;
1911 ctsio->kern_rel_offset = 0;
1912 ctsio->kern_sg_entries = 0;
1913 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
1914 ctsio->be_move_done = ctl_config_move_done;
1915 ctl_datamove((union ctl_io *)ctsio);
1916
1917 return (CTL_RETVAL_COMPLETE);
1918 }
1919
1920 data = (struct scsi_populate_token_data *)ctsio->kern_data_ptr;
1921 lendesc = scsi_2btoul(data->range_descriptor_length);
1922 if (len < sizeof(struct scsi_populate_token_data) + lendesc) {
1923 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 0,
1924 /*field*/ 2, /*bit_valid*/ 0, /*bit*/ 0);
1925 goto done;
1926 }
1927 /*
1928 printf("PT(list=%u) flags=%x to=%d rt=%x len=%x\n",
1929 scsi_4btoul(cdb->list_identifier),
1930 data->flags, scsi_4btoul(data->inactivity_timeout),
1931 scsi_4btoul(data->rod_type),
1932 scsi_2btoul(data->range_descriptor_length));
1933 */
1934 if ((data->flags & EC_PT_RTV) &&
1935 scsi_4btoul(data->rod_type) != ROD_TYPE_AUR) {
1936 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 0,
1937 /*field*/ 8, /*bit_valid*/ 0, /*bit*/ 0);
1938 goto done;
1939 }
1940
1941 list = malloc(sizeof(struct tpc_list), M_CTL, M_WAITOK | M_ZERO);
1942 list->service_action = cdb->service_action;
1943 list->init_port = ctsio->io_hdr.nexus.targ_port;
1944 list->init_idx = ctl_get_resindex(&ctsio->io_hdr.nexus);
1945 list->list_id = scsi_4btoul(cdb->list_identifier);
1946 list->flags = data->flags;
1947 list->ctsio = ctsio;
1948 list->lun = lun;
1949 mtx_lock(&lun->lun_lock);
1950 tlist = tpc_find_list(lun, list->list_id, list->init_idx);
1951 if (tlist != NULL && !tlist->completed) {
1952 mtx_unlock(&lun->lun_lock);
1953 free(list, M_CTL);
1954 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
1955 /*command*/ 0, /*field*/ 0, /*bit_valid*/ 0,
1956 /*bit*/ 0);
1957 goto done;
1958 }
1959 if (tlist != NULL) {
1960 TAILQ_REMOVE(&lun->tpc_lists, tlist, links);
1961 free(tlist, M_CTL);
1962 }
1963 TAILQ_INSERT_TAIL(&lun->tpc_lists, list, links);
1964 mtx_unlock(&lun->lun_lock);
1965
1966 token = malloc(sizeof(*token), M_CTL, M_WAITOK | M_ZERO);
1967 token->lun = lun->lun;
1968 token->blocksize = lun->be_lun->blocksize;
1969 token->params = ctsio->kern_data_ptr;
1970 token->range = &data->desc[0];
1971 token->nrange = scsi_2btoul(data->range_descriptor_length) /
1972 sizeof(struct scsi_range_desc);
1973 list->cursectors = tpc_ranges_length(token->range, token->nrange);
1974 list->curbytes = (off_t)list->cursectors * lun->be_lun->blocksize;
1975 tpc_create_token(lun, port, list->curbytes,
1976 (struct scsi_token *)token->token);
1977 token->active = 0;
1978 token->last_active = time_uptime;
1979 token->timeout = scsi_4btoul(data->inactivity_timeout);
1980 if (token->timeout == 0)
1981 token->timeout = TPC_DFL_TOKEN_TIMEOUT;
1982 else if (token->timeout < TPC_MIN_TOKEN_TIMEOUT)
1983 token->timeout = TPC_MIN_TOKEN_TIMEOUT;
1984 else if (token->timeout > TPC_MAX_TOKEN_TIMEOUT) {
1985 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
1986 /*command*/ 0, /*field*/ 4, /*bit_valid*/ 0,
1987 /*bit*/ 0);
1988 }
1989 memcpy(list->res_token, token->token, sizeof(list->res_token));
1990 list->res_token_valid = 1;
1991 list->curseg = 0;
1992 list->completed = 1;
1993 list->last_active = time_uptime;
1994 mtx_lock(&softc->ctl_lock);
1995 TAILQ_INSERT_TAIL(&softc->tpc_tokens, token, links);
1996 mtx_unlock(&softc->ctl_lock);
1997 ctl_set_success(ctsio);
1998 ctl_done((union ctl_io *)ctsio);
1999 return (CTL_RETVAL_COMPLETE);
2000
2001 done:
2002 if (ctsio->io_hdr.flags & CTL_FLAG_ALLOCATED) {
2003 free(ctsio->kern_data_ptr, M_CTL);
2004 ctsio->io_hdr.flags &= ~CTL_FLAG_ALLOCATED;
2005 }
2006 ctl_done((union ctl_io *)ctsio);
2007 return (CTL_RETVAL_COMPLETE);
2008 }
2009
2010 int
ctl_write_using_token(struct ctl_scsiio * ctsio)2011 ctl_write_using_token(struct ctl_scsiio *ctsio)
2012 {
2013 struct scsi_write_using_token *cdb;
2014 struct scsi_write_using_token_data *data;
2015 struct ctl_softc *softc;
2016 struct ctl_lun *lun;
2017 struct tpc_list *list, *tlist;
2018 struct tpc_token *token;
2019 int len, lendesc;
2020
2021 CTL_DEBUG_PRINT(("ctl_write_using_token\n"));
2022
2023 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
2024 softc = lun->ctl_softc;
2025 cdb = (struct scsi_write_using_token *)ctsio->cdb;
2026 len = scsi_4btoul(cdb->length);
2027
2028 if (len < sizeof(struct scsi_populate_token_data) ||
2029 len > sizeof(struct scsi_populate_token_data) +
2030 TPC_MAX_SEGS * sizeof(struct scsi_range_desc)) {
2031 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 1,
2032 /*field*/ 9, /*bit_valid*/ 0, /*bit*/ 0);
2033 goto done;
2034 }
2035
2036 /*
2037 * If we've got a kernel request that hasn't been malloced yet,
2038 * malloc it and tell the caller the data buffer is here.
2039 */
2040 if ((ctsio->io_hdr.flags & CTL_FLAG_ALLOCATED) == 0) {
2041 ctsio->kern_data_ptr = malloc(len, M_CTL, M_WAITOK);
2042 ctsio->kern_data_len = len;
2043 ctsio->kern_total_len = len;
2044 ctsio->kern_data_resid = 0;
2045 ctsio->kern_rel_offset = 0;
2046 ctsio->kern_sg_entries = 0;
2047 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
2048 ctsio->be_move_done = ctl_config_move_done;
2049 ctl_datamove((union ctl_io *)ctsio);
2050
2051 return (CTL_RETVAL_COMPLETE);
2052 }
2053
2054 data = (struct scsi_write_using_token_data *)ctsio->kern_data_ptr;
2055 lendesc = scsi_2btoul(data->range_descriptor_length);
2056 if (len < sizeof(struct scsi_populate_token_data) + lendesc) {
2057 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1, /*command*/ 0,
2058 /*field*/ 2, /*bit_valid*/ 0, /*bit*/ 0);
2059 goto done;
2060 }
2061 /*
2062 printf("WUT(list=%u) flags=%x off=%ju len=%x\n",
2063 scsi_4btoul(cdb->list_identifier),
2064 data->flags, scsi_8btou64(data->offset_into_rod),
2065 scsi_2btoul(data->range_descriptor_length));
2066 */
2067 list = malloc(sizeof(struct tpc_list), M_CTL, M_WAITOK | M_ZERO);
2068 list->service_action = cdb->service_action;
2069 list->init_port = ctsio->io_hdr.nexus.targ_port;
2070 list->init_idx = ctl_get_resindex(&ctsio->io_hdr.nexus);
2071 list->list_id = scsi_4btoul(cdb->list_identifier);
2072 list->flags = data->flags;
2073 list->params = ctsio->kern_data_ptr;
2074 list->range = &data->desc[0];
2075 list->nrange = scsi_2btoul(data->range_descriptor_length) /
2076 sizeof(struct scsi_range_desc);
2077 list->offset_into_rod = scsi_8btou64(data->offset_into_rod);
2078 list->ctsio = ctsio;
2079 list->lun = lun;
2080 mtx_lock(&lun->lun_lock);
2081 tlist = tpc_find_list(lun, list->list_id, list->init_idx);
2082 if (tlist != NULL && !tlist->completed) {
2083 mtx_unlock(&lun->lun_lock);
2084 free(list, M_CTL);
2085 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
2086 /*command*/ 0, /*field*/ 0, /*bit_valid*/ 0,
2087 /*bit*/ 0);
2088 goto done;
2089 }
2090 if (tlist != NULL) {
2091 TAILQ_REMOVE(&lun->tpc_lists, tlist, links);
2092 free(tlist, M_CTL);
2093 }
2094 TAILQ_INSERT_TAIL(&lun->tpc_lists, list, links);
2095 mtx_unlock(&lun->lun_lock);
2096
2097 /* Block device zero ROD token -> no token. */
2098 if (scsi_4btoul(data->rod_token) == ROD_TYPE_BLOCK_ZERO) {
2099 tpc_process(list);
2100 return (CTL_RETVAL_COMPLETE);
2101 }
2102
2103 mtx_lock(&softc->ctl_lock);
2104 TAILQ_FOREACH(token, &softc->tpc_tokens, links) {
2105 if (memcmp(token->token, data->rod_token,
2106 sizeof(data->rod_token)) == 0)
2107 break;
2108 }
2109 if (token != NULL) {
2110 token->active++;
2111 list->token = token;
2112 if (data->flags & EC_WUT_DEL_TKN)
2113 token->timeout = 0;
2114 }
2115 mtx_unlock(&softc->ctl_lock);
2116 if (token == NULL) {
2117 mtx_lock(&lun->lun_lock);
2118 TAILQ_REMOVE(&lun->tpc_lists, list, links);
2119 mtx_unlock(&lun->lun_lock);
2120 free(list, M_CTL);
2121 ctl_set_sense(ctsio, /*current_error*/ 1,
2122 /*sense_key*/ SSD_KEY_ILLEGAL_REQUEST,
2123 /*asc*/ 0x23, /*ascq*/ 0x04, SSD_ELEM_NONE);
2124 goto done;
2125 }
2126
2127 tpc_process(list);
2128 return (CTL_RETVAL_COMPLETE);
2129
2130 done:
2131 if (ctsio->io_hdr.flags & CTL_FLAG_ALLOCATED) {
2132 free(ctsio->kern_data_ptr, M_CTL);
2133 ctsio->io_hdr.flags &= ~CTL_FLAG_ALLOCATED;
2134 }
2135 ctl_done((union ctl_io *)ctsio);
2136 return (CTL_RETVAL_COMPLETE);
2137 }
2138
2139 int
ctl_receive_rod_token_information(struct ctl_scsiio * ctsio)2140 ctl_receive_rod_token_information(struct ctl_scsiio *ctsio)
2141 {
2142 struct ctl_lun *lun;
2143 struct scsi_receive_rod_token_information *cdb;
2144 struct scsi_receive_copy_status_lid4_data *data;
2145 struct tpc_list *list;
2146 struct tpc_list list_copy;
2147 uint8_t *ptr;
2148 int retval;
2149 int alloc_len, total_len, token_len;
2150 uint32_t list_id;
2151
2152 CTL_DEBUG_PRINT(("ctl_receive_rod_token_information\n"));
2153
2154 cdb = (struct scsi_receive_rod_token_information *)ctsio->cdb;
2155 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
2156
2157 retval = CTL_RETVAL_COMPLETE;
2158
2159 list_id = scsi_4btoul(cdb->list_identifier);
2160 mtx_lock(&lun->lun_lock);
2161 list = tpc_find_list(lun, list_id,
2162 ctl_get_resindex(&ctsio->io_hdr.nexus));
2163 if (list == NULL) {
2164 mtx_unlock(&lun->lun_lock);
2165 ctl_set_invalid_field(ctsio, /*sks_valid*/ 1,
2166 /*command*/ 1, /*field*/ 2, /*bit_valid*/ 0,
2167 /*bit*/ 0);
2168 ctl_done((union ctl_io *)ctsio);
2169 return (retval);
2170 }
2171 list_copy = *list;
2172 if (list->completed) {
2173 TAILQ_REMOVE(&lun->tpc_lists, list, links);
2174 free(list, M_CTL);
2175 }
2176 mtx_unlock(&lun->lun_lock);
2177
2178 token_len = list_copy.res_token_valid ? 2 + sizeof(list_copy.res_token) : 0;
2179 total_len = sizeof(*data) + list_copy.sense_len + 4 + token_len;
2180 alloc_len = scsi_4btoul(cdb->length);
2181
2182 ctsio->kern_data_ptr = malloc(total_len, M_CTL, M_WAITOK | M_ZERO);
2183
2184 ctsio->kern_sg_entries = 0;
2185
2186 if (total_len < alloc_len) {
2187 ctsio->residual = alloc_len - total_len;
2188 ctsio->kern_data_len = total_len;
2189 ctsio->kern_total_len = total_len;
2190 } else {
2191 ctsio->residual = 0;
2192 ctsio->kern_data_len = alloc_len;
2193 ctsio->kern_total_len = alloc_len;
2194 }
2195 ctsio->kern_data_resid = 0;
2196 ctsio->kern_rel_offset = 0;
2197
2198 data = (struct scsi_receive_copy_status_lid4_data *)ctsio->kern_data_ptr;
2199 scsi_ulto4b(sizeof(*data) - 4 + list_copy.sense_len +
2200 4 + token_len, data->available_data);
2201 data->response_to_service_action = list_copy.service_action;
2202 if (list_copy.completed) {
2203 if (list_copy.error)
2204 data->copy_command_status = RCS_CCS_ERROR;
2205 else if (list_copy.abort)
2206 data->copy_command_status = RCS_CCS_ABORTED;
2207 else
2208 data->copy_command_status = RCS_CCS_COMPLETED;
2209 } else
2210 data->copy_command_status = RCS_CCS_INPROG_FG;
2211 scsi_ulto2b(list_copy.curops, data->operation_counter);
2212 scsi_ulto4b(UINT32_MAX, data->estimated_status_update_delay);
2213 data->transfer_count_units = RCS_TC_LBAS;
2214 scsi_u64to8b(list_copy.cursectors, data->transfer_count);
2215 scsi_ulto2b(list_copy.curseg, data->segments_processed);
2216 data->length_of_the_sense_data_field = list_copy.sense_len;
2217 data->sense_data_length = list_copy.sense_len;
2218 memcpy(data->sense_data, &list_copy.sense_data, list_copy.sense_len);
2219
2220 ptr = &data->sense_data[data->length_of_the_sense_data_field];
2221 scsi_ulto4b(token_len, &ptr[0]);
2222 if (list_copy.res_token_valid) {
2223 scsi_ulto2b(0, &ptr[4]);
2224 memcpy(&ptr[6], list_copy.res_token, sizeof(list_copy.res_token));
2225 }
2226 /*
2227 printf("RRTI(list=%u) valid=%d\n",
2228 scsi_4btoul(cdb->list_identifier), list_copy.res_token_valid);
2229 */
2230 ctl_set_success(ctsio);
2231 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
2232 ctsio->be_move_done = ctl_config_move_done;
2233 ctl_datamove((union ctl_io *)ctsio);
2234 return (retval);
2235 }
2236
2237 int
ctl_report_all_rod_tokens(struct ctl_scsiio * ctsio)2238 ctl_report_all_rod_tokens(struct ctl_scsiio *ctsio)
2239 {
2240 struct ctl_softc *softc;
2241 struct ctl_lun *lun;
2242 struct scsi_report_all_rod_tokens *cdb;
2243 struct scsi_report_all_rod_tokens_data *data;
2244 struct tpc_token *token;
2245 int retval;
2246 int alloc_len, total_len, tokens, i;
2247
2248 CTL_DEBUG_PRINT(("ctl_receive_rod_token_information\n"));
2249
2250 cdb = (struct scsi_report_all_rod_tokens *)ctsio->cdb;
2251 lun = (struct ctl_lun *)ctsio->io_hdr.ctl_private[CTL_PRIV_LUN].ptr;
2252 softc = lun->ctl_softc;
2253
2254 retval = CTL_RETVAL_COMPLETE;
2255
2256 tokens = 0;
2257 mtx_lock(&softc->ctl_lock);
2258 TAILQ_FOREACH(token, &softc->tpc_tokens, links)
2259 tokens++;
2260 mtx_unlock(&softc->ctl_lock);
2261 if (tokens > 512)
2262 tokens = 512;
2263
2264 total_len = sizeof(*data) + tokens * 96;
2265 alloc_len = scsi_4btoul(cdb->length);
2266
2267 ctsio->kern_data_ptr = malloc(total_len, M_CTL, M_WAITOK | M_ZERO);
2268
2269 ctsio->kern_sg_entries = 0;
2270
2271 if (total_len < alloc_len) {
2272 ctsio->residual = alloc_len - total_len;
2273 ctsio->kern_data_len = total_len;
2274 ctsio->kern_total_len = total_len;
2275 } else {
2276 ctsio->residual = 0;
2277 ctsio->kern_data_len = alloc_len;
2278 ctsio->kern_total_len = alloc_len;
2279 }
2280 ctsio->kern_data_resid = 0;
2281 ctsio->kern_rel_offset = 0;
2282
2283 data = (struct scsi_report_all_rod_tokens_data *)ctsio->kern_data_ptr;
2284 i = 0;
2285 mtx_lock(&softc->ctl_lock);
2286 TAILQ_FOREACH(token, &softc->tpc_tokens, links) {
2287 if (i >= tokens)
2288 break;
2289 memcpy(&data->rod_management_token_list[i * 96],
2290 token->token, 96);
2291 i++;
2292 }
2293 mtx_unlock(&softc->ctl_lock);
2294 scsi_ulto4b(sizeof(*data) - 4 + i * 96, data->available_data);
2295 /*
2296 printf("RART tokens=%d\n", i);
2297 */
2298 ctl_set_success(ctsio);
2299 ctsio->io_hdr.flags |= CTL_FLAG_ALLOCATED;
2300 ctsio->be_move_done = ctl_config_move_done;
2301 ctl_datamove((union ctl_io *)ctsio);
2302 return (retval);
2303 }
2304
2305