1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23#include <linux/kernel.h>
24#include <linux/module.h>
25#include <asm/unaligned.h>
26
27#include <scsi/scsi.h>
28#include <scsi/scsi_eh.h>
29#include <scsi/scsi_tcq.h>
30
31#include <target/target_core_base.h>
32#include <target/target_core_backend.h>
33#include <target/target_core_fabric.h>
34
35#include "target_core_internal.h"
36#include "target_core_alua.h"
37#include "target_core_pr.h"
38#include "target_core_ua.h"
39#include "target_core_xcopy.h"
40
41static void spc_fill_alua_data(struct se_lun *lun, unsigned char *buf)
42{
43 struct t10_alua_tg_pt_gp *tg_pt_gp;
44
45
46
47
48 buf[5] = 0x80;
49
50
51
52
53
54
55
56 spin_lock(&lun->lun_tg_pt_gp_lock);
57 tg_pt_gp = lun->lun_tg_pt_gp;
58 if (tg_pt_gp)
59 buf[5] |= tg_pt_gp->tg_pt_gp_alua_access_type;
60 spin_unlock(&lun->lun_tg_pt_gp_lock);
61}
62
63sense_reason_t
64spc_emulate_inquiry_std(struct se_cmd *cmd, unsigned char *buf)
65{
66 struct se_lun *lun = cmd->se_lun;
67 struct se_device *dev = cmd->se_dev;
68 struct se_session *sess = cmd->se_sess;
69
70
71 if (dev->transport->get_device_type(dev) == TYPE_TAPE)
72 buf[1] = 0x80;
73
74 buf[2] = 0x05;
75
76
77
78
79
80
81
82
83
84
85
86 buf[3] = 2;
87
88
89
90
91 spc_fill_alua_data(lun, buf);
92
93
94
95
96 if (dev->dev_attrib.emulate_3pc)
97 buf[5] |= 0x8;
98
99
100
101
102
103
104 if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
105 if (dev->dev_attrib.pi_prot_type || cmd->se_sess->sess_prot_type)
106 buf[5] |= 0x1;
107 }
108
109 buf[7] = 0x2;
110
111 memcpy(&buf[8], "LIO-ORG ", 8);
112 memset(&buf[16], 0x20, 16);
113 memcpy(&buf[16], dev->t10_wwn.model,
114 min_t(size_t, strlen(dev->t10_wwn.model), 16));
115 memcpy(&buf[32], dev->t10_wwn.revision,
116 min_t(size_t, strlen(dev->t10_wwn.revision), 4));
117 buf[4] = 31;
118
119 return 0;
120}
121EXPORT_SYMBOL(spc_emulate_inquiry_std);
122
123
124static sense_reason_t
125spc_emulate_evpd_80(struct se_cmd *cmd, unsigned char *buf)
126{
127 struct se_device *dev = cmd->se_dev;
128 u16 len;
129
130 if (dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL) {
131 len = sprintf(&buf[4], "%s", dev->t10_wwn.unit_serial);
132 len++;
133 buf[3] = len;
134 }
135 return 0;
136}
137
138void spc_parse_naa_6h_vendor_specific(struct se_device *dev,
139 unsigned char *buf)
140{
141 unsigned char *p = &dev->t10_wwn.unit_serial[0];
142 int cnt;
143 bool next = true;
144
145
146
147
148
149
150
151
152
153 for (cnt = 0; *p && cnt < 13; p++) {
154 int val = hex_to_bin(*p);
155
156 if (val < 0)
157 continue;
158
159 if (next) {
160 next = false;
161 buf[cnt++] |= val;
162 } else {
163 next = true;
164 buf[cnt] = val << 4;
165 }
166 }
167}
168
169
170
171
172
173sense_reason_t
174spc_emulate_evpd_83(struct se_cmd *cmd, unsigned char *buf)
175{
176 struct se_device *dev = cmd->se_dev;
177 struct se_lun *lun = cmd->se_lun;
178 struct se_portal_group *tpg = NULL;
179 struct t10_alua_lu_gp_member *lu_gp_mem;
180 struct t10_alua_tg_pt_gp *tg_pt_gp;
181 unsigned char *prod = &dev->t10_wwn.model[0];
182 u32 prod_len;
183 u32 unit_serial_len, off = 0;
184 u16 len = 0, id_len;
185
186 off = 4;
187
188
189
190
191
192
193
194
195
196 if (!(dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL))
197 goto check_t10_vend_desc;
198
199
200 buf[off++] = 0x1;
201
202
203 buf[off] = 0x00;
204
205
206 buf[off++] |= 0x3;
207 off++;
208
209
210 buf[off++] = 0x10;
211
212
213
214
215 buf[off++] = (0x6 << 4);
216
217
218
219
220 buf[off++] = 0x01;
221 buf[off++] = 0x40;
222 buf[off] = (0x5 << 4);
223
224
225
226
227
228
229 spc_parse_naa_6h_vendor_specific(dev, &buf[off]);
230
231 len = 20;
232 off = (len + 4);
233
234check_t10_vend_desc:
235
236
237
238 id_len = 8;
239 prod_len = 4;
240 prod_len += 8;
241 prod_len += strlen(prod);
242 prod_len++;
243
244 if (dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL) {
245 unit_serial_len = strlen(&dev->t10_wwn.unit_serial[0]);
246 unit_serial_len++;
247
248 id_len += sprintf(&buf[off+12], "%s:%s", prod,
249 &dev->t10_wwn.unit_serial[0]);
250 }
251 buf[off] = 0x2;
252 buf[off+1] = 0x1;
253 buf[off+2] = 0x0;
254 memcpy(&buf[off+4], "LIO-ORG", 8);
255
256 id_len++;
257
258 buf[off+3] = id_len;
259
260 len += (id_len + 4);
261 off += (id_len + 4);
262
263 if (1) {
264 struct t10_alua_lu_gp *lu_gp;
265 u32 padding, scsi_name_len, scsi_target_len;
266 u16 lu_gp_id = 0;
267 u16 tg_pt_gp_id = 0;
268 u16 tpgt;
269
270 tpg = lun->lun_tpg;
271
272
273
274
275
276
277
278 buf[off] = tpg->proto_id << 4;
279 buf[off++] |= 0x1;
280 buf[off] = 0x80;
281
282 buf[off] |= 0x10;
283
284 buf[off++] |= 0x4;
285 off++;
286 buf[off++] = 4;
287
288
289 off += 2;
290 buf[off++] = ((lun->lun_rtpi >> 8) & 0xff);
291 buf[off++] = (lun->lun_rtpi & 0xff);
292 len += 8;
293
294
295
296
297
298
299
300 spin_lock(&lun->lun_tg_pt_gp_lock);
301 tg_pt_gp = lun->lun_tg_pt_gp;
302 if (!tg_pt_gp) {
303 spin_unlock(&lun->lun_tg_pt_gp_lock);
304 goto check_lu_gp;
305 }
306 tg_pt_gp_id = tg_pt_gp->tg_pt_gp_id;
307 spin_unlock(&lun->lun_tg_pt_gp_lock);
308
309 buf[off] = tpg->proto_id << 4;
310 buf[off++] |= 0x1;
311 buf[off] = 0x80;
312
313 buf[off] |= 0x10;
314
315 buf[off++] |= 0x5;
316 off++;
317 buf[off++] = 4;
318 off += 2;
319 buf[off++] = ((tg_pt_gp_id >> 8) & 0xff);
320 buf[off++] = (tg_pt_gp_id & 0xff);
321 len += 8;
322
323
324
325
326check_lu_gp:
327 lu_gp_mem = dev->dev_alua_lu_gp_mem;
328 if (!lu_gp_mem)
329 goto check_scsi_name;
330
331 spin_lock(&lu_gp_mem->lu_gp_mem_lock);
332 lu_gp = lu_gp_mem->lu_gp;
333 if (!lu_gp) {
334 spin_unlock(&lu_gp_mem->lu_gp_mem_lock);
335 goto check_scsi_name;
336 }
337 lu_gp_id = lu_gp->lu_gp_id;
338 spin_unlock(&lu_gp_mem->lu_gp_mem_lock);
339
340 buf[off++] |= 0x1;
341
342 buf[off++] |= 0x6;
343 off++;
344 buf[off++] = 4;
345 off += 2;
346 buf[off++] = ((lu_gp_id >> 8) & 0xff);
347 buf[off++] = (lu_gp_id & 0xff);
348 len += 8;
349
350
351
352
353
354
355
356check_scsi_name:
357 buf[off] = tpg->proto_id << 4;
358 buf[off++] |= 0x3;
359 buf[off] = 0x80;
360
361 buf[off] |= 0x10;
362
363 buf[off++] |= 0x8;
364 off += 2;
365
366
367
368
369
370
371 tpgt = tpg->se_tpg_tfo->tpg_get_tag(tpg);
372 scsi_name_len = sprintf(&buf[off], "%s,t,0x%04x",
373 tpg->se_tpg_tfo->tpg_get_wwn(tpg), tpgt);
374 scsi_name_len += 1 ;
375
376
377
378
379
380
381
382
383 padding = ((-scsi_name_len) & 3);
384 if (padding)
385 scsi_name_len += padding;
386 if (scsi_name_len > 256)
387 scsi_name_len = 256;
388
389 buf[off-1] = scsi_name_len;
390 off += scsi_name_len;
391
392 len += (scsi_name_len + 4);
393
394
395
396
397 buf[off] = tpg->proto_id << 4;
398 buf[off++] |= 0x3;
399 buf[off] = 0x80;
400
401 buf[off] |= 0x20;
402
403 buf[off++] |= 0x8;
404 off += 2;
405
406
407
408
409
410
411 scsi_target_len = sprintf(&buf[off], "%s",
412 tpg->se_tpg_tfo->tpg_get_wwn(tpg));
413 scsi_target_len += 1 ;
414
415
416
417
418
419
420
421
422 padding = ((-scsi_target_len) & 3);
423 if (padding)
424 scsi_target_len += padding;
425 if (scsi_target_len > 256)
426 scsi_target_len = 256;
427
428 buf[off-1] = scsi_target_len;
429 off += scsi_target_len;
430
431
432 len += (scsi_target_len + 4);
433 }
434 buf[2] = ((len >> 8) & 0xff);
435 buf[3] = (len & 0xff);
436 return 0;
437}
438EXPORT_SYMBOL(spc_emulate_evpd_83);
439
440
441static sense_reason_t
442spc_emulate_evpd_86(struct se_cmd *cmd, unsigned char *buf)
443{
444 struct se_device *dev = cmd->se_dev;
445 struct se_session *sess = cmd->se_sess;
446
447 buf[3] = 0x3c;
448
449
450
451
452 if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
453 if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT ||
454 cmd->se_sess->sess_prot_type == TARGET_DIF_TYPE1_PROT)
455 buf[4] = 0x5;
456 else if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE3_PROT ||
457 cmd->se_sess->sess_prot_type == TARGET_DIF_TYPE3_PROT)
458 buf[4] = 0x4;
459 }
460
461
462 if ((dev->transport->get_device_type(dev) == TYPE_DISK) &&
463 (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) &&
464 (dev->dev_attrib.pi_prot_type || cmd->se_sess->sess_prot_type)) {
465 buf[4] |= (0x3 << 3);
466 }
467
468
469 buf[5] = 0x07;
470
471
472 if (target_check_wce(dev))
473 buf[6] = 0x01;
474
475 spin_lock(&cmd->se_dev->t10_alua.lba_map_lock);
476 if (!list_empty(&dev->t10_alua.lba_map_list))
477 buf[8] = 0x10;
478 spin_unlock(&cmd->se_dev->t10_alua.lba_map_lock);
479 return 0;
480}
481
482
483static sense_reason_t
484spc_emulate_evpd_b0(struct se_cmd *cmd, unsigned char *buf)
485{
486 struct se_device *dev = cmd->se_dev;
487 u32 mtl = 0;
488 int have_tp = 0, opt, min;
489
490
491
492
493
494
495 if (dev->dev_attrib.emulate_tpu || dev->dev_attrib.emulate_tpws)
496 have_tp = 1;
497
498 buf[0] = dev->transport->get_device_type(dev);
499 buf[3] = have_tp ? 0x3c : 0x10;
500
501
502 buf[4] = 0x01;
503
504
505
506 if (dev->dev_attrib.emulate_caw)
507 buf[5] = 0x01;
508
509
510
511
512 if (dev->transport->get_io_min && (min = dev->transport->get_io_min(dev)))
513 put_unaligned_be16(min / dev->dev_attrib.block_size, &buf[6]);
514 else
515 put_unaligned_be16(1, &buf[6]);
516
517
518
519
520
521
522
523 if (cmd->se_tfo->max_data_sg_nents) {
524 mtl = (cmd->se_tfo->max_data_sg_nents * PAGE_SIZE) /
525 dev->dev_attrib.block_size;
526 }
527 put_unaligned_be32(min_not_zero(mtl, dev->dev_attrib.hw_max_sectors), &buf[8]);
528
529
530
531
532 if (dev->transport->get_io_opt && (opt = dev->transport->get_io_opt(dev)))
533 put_unaligned_be32(opt / dev->dev_attrib.block_size, &buf[12]);
534 else
535 put_unaligned_be32(dev->dev_attrib.optimal_sectors, &buf[12]);
536
537
538
539
540 if (!have_tp)
541 goto max_write_same;
542
543
544
545
546 put_unaligned_be32(dev->dev_attrib.max_unmap_lba_count, &buf[20]);
547
548
549
550
551 put_unaligned_be32(dev->dev_attrib.max_unmap_block_desc_count,
552 &buf[24]);
553
554
555
556
557 put_unaligned_be32(dev->dev_attrib.unmap_granularity, &buf[28]);
558
559
560
561
562 put_unaligned_be32(dev->dev_attrib.unmap_granularity_alignment,
563 &buf[32]);
564 if (dev->dev_attrib.unmap_granularity_alignment != 0)
565 buf[32] |= 0x80;
566
567
568
569
570max_write_same:
571 put_unaligned_be64(dev->dev_attrib.max_write_same_len, &buf[36]);
572
573 return 0;
574}
575
576
577static sense_reason_t
578spc_emulate_evpd_b1(struct se_cmd *cmd, unsigned char *buf)
579{
580 struct se_device *dev = cmd->se_dev;
581
582 buf[0] = dev->transport->get_device_type(dev);
583 buf[3] = 0x3c;
584 buf[5] = dev->dev_attrib.is_nonrot ? 1 : 0;
585
586 return 0;
587}
588
589
590static sense_reason_t
591spc_emulate_evpd_b2(struct se_cmd *cmd, unsigned char *buf)
592{
593 struct se_device *dev = cmd->se_dev;
594
595
596
597
598
599
600
601
602
603 buf[0] = dev->transport->get_device_type(dev);
604
605
606
607
608 put_unaligned_be16(0x0004, &buf[2]);
609
610
611
612
613
614
615
616
617
618
619 buf[4] = 0x00;
620
621
622
623
624
625
626 if (dev->dev_attrib.emulate_tpu != 0)
627 buf[5] = 0x80;
628
629
630
631
632
633
634
635 if (dev->dev_attrib.emulate_tpws != 0)
636 buf[5] |= 0x40 | 0x20;
637
638
639
640
641
642
643
644
645 if (((dev->dev_attrib.emulate_tpu != 0) ||
646 (dev->dev_attrib.emulate_tpws != 0)) &&
647 (dev->dev_attrib.unmap_zeroes_data != 0))
648 buf[5] |= 0x04;
649
650 return 0;
651}
652
653
654static sense_reason_t
655spc_emulate_evpd_b3(struct se_cmd *cmd, unsigned char *buf)
656{
657 struct se_device *dev = cmd->se_dev;
658
659 buf[0] = dev->transport->get_device_type(dev);
660 buf[3] = 0x0c;
661 put_unaligned_be32(dev->t10_alua.lba_map_segment_size, &buf[8]);
662 put_unaligned_be32(dev->t10_alua.lba_map_segment_multiplier, &buf[12]);
663
664 return 0;
665}
666
667static sense_reason_t
668spc_emulate_evpd_00(struct se_cmd *cmd, unsigned char *buf);
669
670static struct {
671 uint8_t page;
672 sense_reason_t (*emulate)(struct se_cmd *, unsigned char *);
673} evpd_handlers[] = {
674 { .page = 0x00, .emulate = spc_emulate_evpd_00 },
675 { .page = 0x80, .emulate = spc_emulate_evpd_80 },
676 { .page = 0x83, .emulate = spc_emulate_evpd_83 },
677 { .page = 0x86, .emulate = spc_emulate_evpd_86 },
678 { .page = 0xb0, .emulate = spc_emulate_evpd_b0 },
679 { .page = 0xb1, .emulate = spc_emulate_evpd_b1 },
680 { .page = 0xb2, .emulate = spc_emulate_evpd_b2 },
681 { .page = 0xb3, .emulate = spc_emulate_evpd_b3 },
682};
683
684
685static sense_reason_t
686spc_emulate_evpd_00(struct se_cmd *cmd, unsigned char *buf)
687{
688 int p;
689
690
691
692
693
694
695 if (cmd->se_dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL) {
696 buf[3] = ARRAY_SIZE(evpd_handlers);
697 for (p = 0; p < ARRAY_SIZE(evpd_handlers); ++p)
698 buf[p + 4] = evpd_handlers[p].page;
699 }
700
701 return 0;
702}
703
704static sense_reason_t
705spc_emulate_inquiry(struct se_cmd *cmd)
706{
707 struct se_device *dev = cmd->se_dev;
708 struct se_portal_group *tpg = cmd->se_lun->lun_tpg;
709 unsigned char *rbuf;
710 unsigned char *cdb = cmd->t_task_cdb;
711 unsigned char *buf;
712 sense_reason_t ret;
713 int p;
714 int len = 0;
715
716 buf = kzalloc(SE_INQUIRY_BUF, GFP_KERNEL);
717 if (!buf) {
718 pr_err("Unable to allocate response buffer for INQUIRY\n");
719 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
720 }
721
722 if (dev == rcu_access_pointer(tpg->tpg_virt_lun0->lun_se_dev))
723 buf[0] = 0x3f;
724 else
725 buf[0] = dev->transport->get_device_type(dev);
726
727 if (!(cdb[1] & 0x1)) {
728 if (cdb[2]) {
729 pr_err("INQUIRY with EVPD==0 but PAGE CODE=%02x\n",
730 cdb[2]);
731 ret = TCM_INVALID_CDB_FIELD;
732 goto out;
733 }
734
735 ret = spc_emulate_inquiry_std(cmd, buf);
736 len = buf[4] + 5;
737 goto out;
738 }
739
740 for (p = 0; p < ARRAY_SIZE(evpd_handlers); ++p) {
741 if (cdb[2] == evpd_handlers[p].page) {
742 buf[1] = cdb[2];
743 ret = evpd_handlers[p].emulate(cmd, buf);
744 len = get_unaligned_be16(&buf[2]) + 4;
745 goto out;
746 }
747 }
748
749 pr_err("Unknown VPD Code: 0x%02x\n", cdb[2]);
750 ret = TCM_INVALID_CDB_FIELD;
751
752out:
753 rbuf = transport_kmap_data_sg(cmd);
754 if (rbuf) {
755 memcpy(rbuf, buf, min_t(u32, SE_INQUIRY_BUF, cmd->data_length));
756 transport_kunmap_data_sg(cmd);
757 }
758 kfree(buf);
759
760 if (!ret)
761 target_complete_cmd_with_length(cmd, GOOD, len);
762 return ret;
763}
764
765static int spc_modesense_rwrecovery(struct se_cmd *cmd, u8 pc, u8 *p)
766{
767 p[0] = 0x01;
768 p[1] = 0x0a;
769
770
771 if (pc == 1)
772 goto out;
773
774out:
775 return 12;
776}
777
778static int spc_modesense_control(struct se_cmd *cmd, u8 pc, u8 *p)
779{
780 struct se_device *dev = cmd->se_dev;
781 struct se_session *sess = cmd->se_sess;
782
783 p[0] = 0x0a;
784 p[1] = 0x0a;
785
786
787 if (pc == 1)
788 goto out;
789
790
791 p[2] = (1 << 1);
792 if (target_sense_desc_format(dev))
793
794 p[2] |= (1 << 2);
795
796
797
798
799
800
801
802
803
804
805
806
807
808
809
810
811
812
813
814
815
816
817
818
819
820
821
822
823
824 p[3] = (dev->dev_attrib.emulate_rest_reord == 1) ? 0x00 : 0x10;
825
826
827
828
829
830
831
832
833
834
835
836
837
838
839
840
841
842
843
844
845
846
847
848
849
850
851
852
853
854 p[4] = (dev->dev_attrib.emulate_ua_intlck_ctrl == 2) ? 0x30 :
855 (dev->dev_attrib.emulate_ua_intlck_ctrl == 1) ? 0x20 : 0x00;
856
857
858
859
860
861
862
863
864
865
866
867
868 p[5] = (dev->dev_attrib.emulate_tas) ? 0x40 : 0x00;
869
870
871
872
873
874
875
876
877
878
879 if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
880 if (dev->dev_attrib.pi_prot_type || sess->sess_prot_type)
881 p[5] |= 0x80;
882 }
883
884 p[8] = 0xff;
885 p[9] = 0xff;
886 p[11] = 30;
887
888out:
889 return 12;
890}
891
892static int spc_modesense_caching(struct se_cmd *cmd, u8 pc, u8 *p)
893{
894 struct se_device *dev = cmd->se_dev;
895
896 p[0] = 0x08;
897 p[1] = 0x12;
898
899
900 if (pc == 1)
901 goto out;
902
903 if (target_check_wce(dev))
904 p[2] = 0x04;
905 p[12] = 0x20;
906
907out:
908 return 20;
909}
910
911static int spc_modesense_informational_exceptions(struct se_cmd *cmd, u8 pc, unsigned char *p)
912{
913 p[0] = 0x1c;
914 p[1] = 0x0a;
915
916
917 if (pc == 1)
918 goto out;
919
920out:
921 return 12;
922}
923
924static struct {
925 uint8_t page;
926 uint8_t subpage;
927 int (*emulate)(struct se_cmd *, u8, unsigned char *);
928} modesense_handlers[] = {
929 { .page = 0x01, .subpage = 0x00, .emulate = spc_modesense_rwrecovery },
930 { .page = 0x08, .subpage = 0x00, .emulate = spc_modesense_caching },
931 { .page = 0x0a, .subpage = 0x00, .emulate = spc_modesense_control },
932 { .page = 0x1c, .subpage = 0x00, .emulate = spc_modesense_informational_exceptions },
933};
934
935static void spc_modesense_write_protect(unsigned char *buf, int type)
936{
937
938
939
940
941 switch (type) {
942 case TYPE_DISK:
943 case TYPE_TAPE:
944 default:
945 buf[0] |= 0x80;
946 break;
947 }
948}
949
950static void spc_modesense_dpofua(unsigned char *buf, int type)
951{
952 switch (type) {
953 case TYPE_DISK:
954 buf[0] |= 0x10;
955 break;
956 default:
957 break;
958 }
959}
960
961static int spc_modesense_blockdesc(unsigned char *buf, u64 blocks, u32 block_size)
962{
963 *buf++ = 8;
964 put_unaligned_be32(min(blocks, 0xffffffffull), buf);
965 buf += 4;
966 put_unaligned_be32(block_size, buf);
967 return 9;
968}
969
970static int spc_modesense_long_blockdesc(unsigned char *buf, u64 blocks, u32 block_size)
971{
972 if (blocks <= 0xffffffff)
973 return spc_modesense_blockdesc(buf + 3, blocks, block_size) + 3;
974
975 *buf++ = 1;
976 buf += 2;
977 *buf++ = 16;
978 put_unaligned_be64(blocks, buf);
979 buf += 12;
980 put_unaligned_be32(block_size, buf);
981
982 return 17;
983}
984
985static sense_reason_t spc_emulate_modesense(struct se_cmd *cmd)
986{
987 struct se_device *dev = cmd->se_dev;
988 char *cdb = cmd->t_task_cdb;
989 unsigned char buf[SE_MODE_PAGE_BUF], *rbuf;
990 int type = dev->transport->get_device_type(dev);
991 int ten = (cmd->t_task_cdb[0] == MODE_SENSE_10);
992 bool dbd = !!(cdb[1] & 0x08);
993 bool llba = ten ? !!(cdb[1] & 0x10) : false;
994 u8 pc = cdb[2] >> 6;
995 u8 page = cdb[2] & 0x3f;
996 u8 subpage = cdb[3];
997 int length = 0;
998 int ret;
999 int i;
1000
1001 memset(buf, 0, SE_MODE_PAGE_BUF);
1002
1003
1004
1005
1006
1007 length = ten ? 3 : 2;
1008
1009
1010 if (cmd->se_lun->lun_access_ro || target_lun_is_rdonly(cmd))
1011 spc_modesense_write_protect(&buf[length], type);
1012
1013
1014
1015
1016
1017
1018 if (target_check_fua(dev))
1019 spc_modesense_dpofua(&buf[length], type);
1020
1021 ++length;
1022
1023
1024
1025
1026
1027
1028
1029 if (!dbd && type == TYPE_DISK) {
1030 u64 blocks = dev->transport->get_blocks(dev);
1031 u32 block_size = dev->dev_attrib.block_size;
1032
1033 if (ten) {
1034 if (llba) {
1035 length += spc_modesense_long_blockdesc(&buf[length],
1036 blocks, block_size);
1037 } else {
1038 length += 3;
1039 length += spc_modesense_blockdesc(&buf[length],
1040 blocks, block_size);
1041 }
1042 } else {
1043 length += spc_modesense_blockdesc(&buf[length], blocks,
1044 block_size);
1045 }
1046 } else {
1047 if (ten)
1048 length += 4;
1049 else
1050 length += 1;
1051 }
1052
1053 if (page == 0x3f) {
1054 if (subpage != 0x00 && subpage != 0xff) {
1055 pr_warn("MODE_SENSE: Invalid subpage code: 0x%02x\n", subpage);
1056 return TCM_INVALID_CDB_FIELD;
1057 }
1058
1059 for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i) {
1060
1061
1062
1063
1064
1065
1066 if ((modesense_handlers[i].subpage & ~subpage) == 0) {
1067 ret = modesense_handlers[i].emulate(cmd, pc, &buf[length]);
1068 if (!ten && length + ret >= 255)
1069 break;
1070 length += ret;
1071 }
1072 }
1073
1074 goto set_length;
1075 }
1076
1077 for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i)
1078 if (modesense_handlers[i].page == page &&
1079 modesense_handlers[i].subpage == subpage) {
1080 length += modesense_handlers[i].emulate(cmd, pc, &buf[length]);
1081 goto set_length;
1082 }
1083
1084
1085
1086
1087
1088 if (page != 0x03)
1089 pr_err("MODE SENSE: unimplemented page/subpage: 0x%02x/0x%02x\n",
1090 page, subpage);
1091
1092 return TCM_UNKNOWN_MODE_PAGE;
1093
1094set_length:
1095 if (ten)
1096 put_unaligned_be16(length - 2, buf);
1097 else
1098 buf[0] = length - 1;
1099
1100 rbuf = transport_kmap_data_sg(cmd);
1101 if (rbuf) {
1102 memcpy(rbuf, buf, min_t(u32, SE_MODE_PAGE_BUF, cmd->data_length));
1103 transport_kunmap_data_sg(cmd);
1104 }
1105
1106 target_complete_cmd_with_length(cmd, GOOD, length);
1107 return 0;
1108}
1109
1110static sense_reason_t spc_emulate_modeselect(struct se_cmd *cmd)
1111{
1112 char *cdb = cmd->t_task_cdb;
1113 bool ten = cdb[0] == MODE_SELECT_10;
1114 int off = ten ? 8 : 4;
1115 bool pf = !!(cdb[1] & 0x10);
1116 u8 page, subpage;
1117 unsigned char *buf;
1118 unsigned char tbuf[SE_MODE_PAGE_BUF];
1119 int length;
1120 sense_reason_t ret = 0;
1121 int i;
1122
1123 if (!cmd->data_length) {
1124 target_complete_cmd(cmd, GOOD);
1125 return 0;
1126 }
1127
1128 if (cmd->data_length < off + 2)
1129 return TCM_PARAMETER_LIST_LENGTH_ERROR;
1130
1131 buf = transport_kmap_data_sg(cmd);
1132 if (!buf)
1133 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
1134
1135 if (!pf) {
1136 ret = TCM_INVALID_CDB_FIELD;
1137 goto out;
1138 }
1139
1140 page = buf[off] & 0x3f;
1141 subpage = buf[off] & 0x40 ? buf[off + 1] : 0;
1142
1143 for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i)
1144 if (modesense_handlers[i].page == page &&
1145 modesense_handlers[i].subpage == subpage) {
1146 memset(tbuf, 0, SE_MODE_PAGE_BUF);
1147 length = modesense_handlers[i].emulate(cmd, 0, tbuf);
1148 goto check_contents;
1149 }
1150
1151 ret = TCM_UNKNOWN_MODE_PAGE;
1152 goto out;
1153
1154check_contents:
1155 if (cmd->data_length < off + length) {
1156 ret = TCM_PARAMETER_LIST_LENGTH_ERROR;
1157 goto out;
1158 }
1159
1160 if (memcmp(buf + off, tbuf, length))
1161 ret = TCM_INVALID_PARAMETER_LIST;
1162
1163out:
1164 transport_kunmap_data_sg(cmd);
1165
1166 if (!ret)
1167 target_complete_cmd(cmd, GOOD);
1168 return ret;
1169}
1170
1171static sense_reason_t spc_emulate_request_sense(struct se_cmd *cmd)
1172{
1173 unsigned char *cdb = cmd->t_task_cdb;
1174 unsigned char *rbuf;
1175 u8 ua_asc = 0, ua_ascq = 0;
1176 unsigned char buf[SE_SENSE_BUF];
1177 bool desc_format = target_sense_desc_format(cmd->se_dev);
1178
1179 memset(buf, 0, SE_SENSE_BUF);
1180
1181 if (cdb[1] & 0x01) {
1182 pr_err("REQUEST_SENSE description emulation not"
1183 " supported\n");
1184 return TCM_INVALID_CDB_FIELD;
1185 }
1186
1187 rbuf = transport_kmap_data_sg(cmd);
1188 if (!rbuf)
1189 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
1190
1191 if (!core_scsi3_ua_clear_for_request_sense(cmd, &ua_asc, &ua_ascq))
1192 scsi_build_sense_buffer(desc_format, buf, UNIT_ATTENTION,
1193 ua_asc, ua_ascq);
1194 else
1195 scsi_build_sense_buffer(desc_format, buf, NO_SENSE, 0x0, 0x0);
1196
1197 memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length));
1198 transport_kunmap_data_sg(cmd);
1199
1200 target_complete_cmd(cmd, GOOD);
1201 return 0;
1202}
1203
1204sense_reason_t spc_emulate_report_luns(struct se_cmd *cmd)
1205{
1206 struct se_dev_entry *deve;
1207 struct se_session *sess = cmd->se_sess;
1208 struct se_node_acl *nacl;
1209 struct scsi_lun slun;
1210 unsigned char *buf;
1211 u32 lun_count = 0, offset = 8;
1212 __be32 len;
1213
1214 buf = transport_kmap_data_sg(cmd);
1215 if (cmd->data_length && !buf)
1216 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
1217
1218
1219
1220
1221
1222
1223 if (!sess)
1224 goto done;
1225
1226 nacl = sess->se_node_acl;
1227
1228 rcu_read_lock();
1229 hlist_for_each_entry_rcu(deve, &nacl->lun_entry_hlist, link) {
1230
1231
1232
1233
1234
1235 lun_count++;
1236 if (offset >= cmd->data_length)
1237 continue;
1238
1239 int_to_scsilun(deve->mapped_lun, &slun);
1240 memcpy(buf + offset, &slun,
1241 min(8u, cmd->data_length - offset));
1242 offset += 8;
1243 }
1244 rcu_read_unlock();
1245
1246
1247
1248
1249done:
1250
1251
1252
1253 if (lun_count == 0) {
1254 int_to_scsilun(0, &slun);
1255 if (cmd->data_length > 8)
1256 memcpy(buf + offset, &slun,
1257 min(8u, cmd->data_length - offset));
1258 lun_count = 1;
1259 }
1260
1261 if (buf) {
1262 len = cpu_to_be32(lun_count * 8);
1263 memcpy(buf, &len, min_t(int, sizeof len, cmd->data_length));
1264 transport_kunmap_data_sg(cmd);
1265 }
1266
1267 target_complete_cmd_with_length(cmd, GOOD, 8 + lun_count * 8);
1268 return 0;
1269}
1270EXPORT_SYMBOL(spc_emulate_report_luns);
1271
1272static sense_reason_t
1273spc_emulate_testunitready(struct se_cmd *cmd)
1274{
1275 target_complete_cmd(cmd, GOOD);
1276 return 0;
1277}
1278
1279sense_reason_t
1280spc_parse_cdb(struct se_cmd *cmd, unsigned int *size)
1281{
1282 struct se_device *dev = cmd->se_dev;
1283 unsigned char *cdb = cmd->t_task_cdb;
1284
1285 switch (cdb[0]) {
1286 case MODE_SELECT:
1287 *size = cdb[4];
1288 cmd->execute_cmd = spc_emulate_modeselect;
1289 break;
1290 case MODE_SELECT_10:
1291 *size = (cdb[7] << 8) + cdb[8];
1292 cmd->execute_cmd = spc_emulate_modeselect;
1293 break;
1294 case MODE_SENSE:
1295 *size = cdb[4];
1296 cmd->execute_cmd = spc_emulate_modesense;
1297 break;
1298 case MODE_SENSE_10:
1299 *size = (cdb[7] << 8) + cdb[8];
1300 cmd->execute_cmd = spc_emulate_modesense;
1301 break;
1302 case LOG_SELECT:
1303 case LOG_SENSE:
1304 *size = (cdb[7] << 8) + cdb[8];
1305 break;
1306 case PERSISTENT_RESERVE_IN:
1307 *size = (cdb[7] << 8) + cdb[8];
1308 cmd->execute_cmd = target_scsi3_emulate_pr_in;
1309 break;
1310 case PERSISTENT_RESERVE_OUT:
1311 *size = (cdb[7] << 8) + cdb[8];
1312 cmd->execute_cmd = target_scsi3_emulate_pr_out;
1313 break;
1314 case RELEASE:
1315 case RELEASE_10:
1316 if (cdb[0] == RELEASE_10)
1317 *size = (cdb[7] << 8) | cdb[8];
1318 else
1319 *size = cmd->data_length;
1320
1321 cmd->execute_cmd = target_scsi2_reservation_release;
1322 break;
1323 case RESERVE:
1324 case RESERVE_10:
1325
1326
1327
1328
1329 if (cdb[0] == RESERVE_10)
1330 *size = (cdb[7] << 8) | cdb[8];
1331 else
1332 *size = cmd->data_length;
1333
1334 cmd->execute_cmd = target_scsi2_reservation_reserve;
1335 break;
1336 case REQUEST_SENSE:
1337 *size = cdb[4];
1338 cmd->execute_cmd = spc_emulate_request_sense;
1339 break;
1340 case INQUIRY:
1341 *size = (cdb[3] << 8) + cdb[4];
1342
1343
1344
1345
1346
1347 cmd->sam_task_attr = TCM_HEAD_TAG;
1348 cmd->execute_cmd = spc_emulate_inquiry;
1349 break;
1350 case SECURITY_PROTOCOL_IN:
1351 case SECURITY_PROTOCOL_OUT:
1352 *size = (cdb[6] << 24) | (cdb[7] << 16) | (cdb[8] << 8) | cdb[9];
1353 break;
1354 case EXTENDED_COPY:
1355 *size = get_unaligned_be32(&cdb[10]);
1356 cmd->execute_cmd = target_do_xcopy;
1357 break;
1358 case RECEIVE_COPY_RESULTS:
1359 *size = get_unaligned_be32(&cdb[10]);
1360 cmd->execute_cmd = target_do_receive_copy_results;
1361 break;
1362 case READ_ATTRIBUTE:
1363 case WRITE_ATTRIBUTE:
1364 *size = (cdb[10] << 24) | (cdb[11] << 16) |
1365 (cdb[12] << 8) | cdb[13];
1366 break;
1367 case RECEIVE_DIAGNOSTIC:
1368 case SEND_DIAGNOSTIC:
1369 *size = (cdb[3] << 8) | cdb[4];
1370 break;
1371 case WRITE_BUFFER:
1372 *size = (cdb[6] << 16) + (cdb[7] << 8) + cdb[8];
1373 break;
1374 case REPORT_LUNS:
1375 cmd->execute_cmd = spc_emulate_report_luns;
1376 *size = (cdb[6] << 24) | (cdb[7] << 16) | (cdb[8] << 8) | cdb[9];
1377
1378
1379
1380
1381 cmd->sam_task_attr = TCM_HEAD_TAG;
1382 break;
1383 case TEST_UNIT_READY:
1384 cmd->execute_cmd = spc_emulate_testunitready;
1385 *size = 0;
1386 break;
1387 case MAINTENANCE_IN:
1388 if (dev->transport->get_device_type(dev) != TYPE_ROM) {
1389
1390
1391
1392
1393 if ((cdb[1] & 0x1f) == MI_REPORT_TARGET_PGS) {
1394 cmd->execute_cmd =
1395 target_emulate_report_target_port_groups;
1396 }
1397 *size = get_unaligned_be32(&cdb[6]);
1398 } else {
1399
1400
1401
1402 *size = get_unaligned_be16(&cdb[8]);
1403 }
1404 break;
1405 case MAINTENANCE_OUT:
1406 if (dev->transport->get_device_type(dev) != TYPE_ROM) {
1407
1408
1409
1410
1411 if (cdb[1] == MO_SET_TARGET_PGS) {
1412 cmd->execute_cmd =
1413 target_emulate_set_target_port_groups;
1414 }
1415 *size = get_unaligned_be32(&cdb[6]);
1416 } else {
1417
1418
1419
1420 *size = get_unaligned_be16(&cdb[8]);
1421 }
1422 break;
1423 default:
1424 return TCM_UNSUPPORTED_SCSI_OPCODE;
1425 }
1426
1427 return 0;
1428}
1429EXPORT_SYMBOL(spc_parse_cdb);
1430