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_proto.h>
28#include <scsi/scsi_common.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 put_unaligned_be16(lun->lun_rtpi, &buf[off]);
291 off += 2;
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 put_unaligned_be16(tg_pt_gp_id, &buf[off]);
320 off += 2;
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 put_unaligned_be16(lu_gp_id, &buf[off]);
347 off += 2;
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 put_unaligned_be16(len, &buf[2]);
435 return 0;
436}
437EXPORT_SYMBOL(spc_emulate_evpd_83);
438
439
440static sense_reason_t
441spc_emulate_evpd_86(struct se_cmd *cmd, unsigned char *buf)
442{
443 struct se_device *dev = cmd->se_dev;
444 struct se_session *sess = cmd->se_sess;
445
446 buf[3] = 0x3c;
447
448
449
450
451 if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
452 if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT ||
453 cmd->se_sess->sess_prot_type == TARGET_DIF_TYPE1_PROT)
454 buf[4] = 0x5;
455 else if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE3_PROT ||
456 cmd->se_sess->sess_prot_type == TARGET_DIF_TYPE3_PROT)
457 buf[4] = 0x4;
458 }
459
460
461 if ((dev->transport->get_device_type(dev) == TYPE_DISK) &&
462 (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) &&
463 (dev->dev_attrib.pi_prot_type || cmd->se_sess->sess_prot_type)) {
464 buf[4] |= (0x3 << 3);
465 }
466
467
468 buf[5] = 0x07;
469
470
471 if (target_check_wce(dev))
472 buf[6] = 0x01;
473
474 spin_lock(&cmd->se_dev->t10_alua.lba_map_lock);
475 if (!list_empty(&dev->t10_alua.lba_map_list))
476 buf[8] = 0x10;
477 spin_unlock(&cmd->se_dev->t10_alua.lba_map_lock);
478 return 0;
479}
480
481
482static sense_reason_t
483spc_emulate_evpd_b0(struct se_cmd *cmd, unsigned char *buf)
484{
485 struct se_device *dev = cmd->se_dev;
486 u32 mtl = 0;
487 int have_tp = 0, opt, min;
488
489
490
491
492
493
494 if (dev->dev_attrib.emulate_tpu || dev->dev_attrib.emulate_tpws)
495 have_tp = 1;
496
497 buf[0] = dev->transport->get_device_type(dev);
498 buf[3] = have_tp ? 0x3c : 0x10;
499
500
501 buf[4] = 0x01;
502
503
504
505 if (dev->dev_attrib.emulate_caw)
506 buf[5] = 0x01;
507
508
509
510
511 if (dev->transport->get_io_min && (min = dev->transport->get_io_min(dev)))
512 put_unaligned_be16(min / dev->dev_attrib.block_size, &buf[6]);
513 else
514 put_unaligned_be16(1, &buf[6]);
515
516
517
518
519
520
521
522 if (cmd->se_tfo->max_data_sg_nents) {
523 mtl = (cmd->se_tfo->max_data_sg_nents * PAGE_SIZE) /
524 dev->dev_attrib.block_size;
525 }
526 put_unaligned_be32(min_not_zero(mtl, dev->dev_attrib.hw_max_sectors), &buf[8]);
527
528
529
530
531 if (dev->transport->get_io_opt && (opt = dev->transport->get_io_opt(dev)))
532 put_unaligned_be32(opt / dev->dev_attrib.block_size, &buf[12]);
533 else
534 put_unaligned_be32(dev->dev_attrib.optimal_sectors, &buf[12]);
535
536
537
538
539 if (!have_tp)
540 goto max_write_same;
541
542
543
544
545 put_unaligned_be32(dev->dev_attrib.max_unmap_lba_count, &buf[20]);
546
547
548
549
550 put_unaligned_be32(dev->dev_attrib.max_unmap_block_desc_count,
551 &buf[24]);
552
553
554
555
556 put_unaligned_be32(dev->dev_attrib.unmap_granularity, &buf[28]);
557
558
559
560
561 put_unaligned_be32(dev->dev_attrib.unmap_granularity_alignment,
562 &buf[32]);
563 if (dev->dev_attrib.unmap_granularity_alignment != 0)
564 buf[32] |= 0x80;
565
566
567
568
569max_write_same:
570 put_unaligned_be64(dev->dev_attrib.max_write_same_len, &buf[36]);
571
572 return 0;
573}
574
575
576static sense_reason_t
577spc_emulate_evpd_b1(struct se_cmd *cmd, unsigned char *buf)
578{
579 struct se_device *dev = cmd->se_dev;
580
581 buf[0] = dev->transport->get_device_type(dev);
582 buf[3] = 0x3c;
583 buf[5] = dev->dev_attrib.is_nonrot ? 1 : 0;
584
585 return 0;
586}
587
588
589static sense_reason_t
590spc_emulate_evpd_b2(struct se_cmd *cmd, unsigned char *buf)
591{
592 struct se_device *dev = cmd->se_dev;
593
594
595
596
597
598
599
600
601
602 buf[0] = dev->transport->get_device_type(dev);
603
604
605
606
607 put_unaligned_be16(0x0004, &buf[2]);
608
609
610
611
612
613
614
615
616
617
618 buf[4] = 0x00;
619
620
621
622
623
624
625 if (dev->dev_attrib.emulate_tpu != 0)
626 buf[5] = 0x80;
627
628
629
630
631
632
633
634 if (dev->dev_attrib.emulate_tpws != 0)
635 buf[5] |= 0x40 | 0x20;
636
637
638
639
640
641
642
643
644 if (((dev->dev_attrib.emulate_tpu != 0) ||
645 (dev->dev_attrib.emulate_tpws != 0)) &&
646 (dev->dev_attrib.unmap_zeroes_data != 0))
647 buf[5] |= 0x04;
648
649 return 0;
650}
651
652
653static sense_reason_t
654spc_emulate_evpd_b3(struct se_cmd *cmd, unsigned char *buf)
655{
656 struct se_device *dev = cmd->se_dev;
657
658 buf[0] = dev->transport->get_device_type(dev);
659 buf[3] = 0x0c;
660 put_unaligned_be32(dev->t10_alua.lba_map_segment_size, &buf[8]);
661 put_unaligned_be32(dev->t10_alua.lba_map_segment_multiplier, &buf[12]);
662
663 return 0;
664}
665
666static sense_reason_t
667spc_emulate_evpd_00(struct se_cmd *cmd, unsigned char *buf);
668
669static struct {
670 uint8_t page;
671 sense_reason_t (*emulate)(struct se_cmd *, unsigned char *);
672} evpd_handlers[] = {
673 { .page = 0x00, .emulate = spc_emulate_evpd_00 },
674 { .page = 0x80, .emulate = spc_emulate_evpd_80 },
675 { .page = 0x83, .emulate = spc_emulate_evpd_83 },
676 { .page = 0x86, .emulate = spc_emulate_evpd_86 },
677 { .page = 0xb0, .emulate = spc_emulate_evpd_b0 },
678 { .page = 0xb1, .emulate = spc_emulate_evpd_b1 },
679 { .page = 0xb2, .emulate = spc_emulate_evpd_b2 },
680 { .page = 0xb3, .emulate = spc_emulate_evpd_b3 },
681};
682
683
684static sense_reason_t
685spc_emulate_evpd_00(struct se_cmd *cmd, unsigned char *buf)
686{
687 int p;
688
689
690
691
692
693
694 if (cmd->se_dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL) {
695 buf[3] = ARRAY_SIZE(evpd_handlers);
696 for (p = 0; p < ARRAY_SIZE(evpd_handlers); ++p)
697 buf[p + 4] = evpd_handlers[p].page;
698 }
699
700 return 0;
701}
702
703static sense_reason_t
704spc_emulate_inquiry(struct se_cmd *cmd)
705{
706 struct se_device *dev = cmd->se_dev;
707 struct se_portal_group *tpg = cmd->se_lun->lun_tpg;
708 unsigned char *rbuf;
709 unsigned char *cdb = cmd->t_task_cdb;
710 unsigned char *buf;
711 sense_reason_t ret;
712 int p;
713 int len = 0;
714
715 buf = kzalloc(SE_INQUIRY_BUF, GFP_KERNEL);
716 if (!buf) {
717 pr_err("Unable to allocate response buffer for INQUIRY\n");
718 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
719 }
720
721 if (dev == rcu_access_pointer(tpg->tpg_virt_lun0->lun_se_dev))
722 buf[0] = 0x3f;
723 else
724 buf[0] = dev->transport->get_device_type(dev);
725
726 if (!(cdb[1] & 0x1)) {
727 if (cdb[2]) {
728 pr_err("INQUIRY with EVPD==0 but PAGE CODE=%02x\n",
729 cdb[2]);
730 ret = TCM_INVALID_CDB_FIELD;
731 goto out;
732 }
733
734 ret = spc_emulate_inquiry_std(cmd, buf);
735 len = buf[4] + 5;
736 goto out;
737 }
738
739 for (p = 0; p < ARRAY_SIZE(evpd_handlers); ++p) {
740 if (cdb[2] == evpd_handlers[p].page) {
741 buf[1] = cdb[2];
742 ret = evpd_handlers[p].emulate(cmd, buf);
743 len = get_unaligned_be16(&buf[2]) + 4;
744 goto out;
745 }
746 }
747
748 pr_err("Unknown VPD Code: 0x%02x\n", cdb[2]);
749 ret = TCM_INVALID_CDB_FIELD;
750
751out:
752 rbuf = transport_kmap_data_sg(cmd);
753 if (rbuf) {
754 memcpy(rbuf, buf, min_t(u32, SE_INQUIRY_BUF, cmd->data_length));
755 transport_kunmap_data_sg(cmd);
756 }
757 kfree(buf);
758
759 if (!ret)
760 target_complete_cmd_with_length(cmd, GOOD, len);
761 return ret;
762}
763
764static int spc_modesense_rwrecovery(struct se_cmd *cmd, u8 pc, u8 *p)
765{
766 p[0] = 0x01;
767 p[1] = 0x0a;
768
769
770 if (pc == 1)
771 goto out;
772
773out:
774 return 12;
775}
776
777static int spc_modesense_control(struct se_cmd *cmd, u8 pc, u8 *p)
778{
779 struct se_device *dev = cmd->se_dev;
780 struct se_session *sess = cmd->se_sess;
781
782 p[0] = 0x0a;
783 p[1] = 0x0a;
784
785
786 if (pc == 1)
787 goto out;
788
789
790 p[2] = (1 << 1);
791 if (target_sense_desc_format(dev))
792
793 p[2] |= (1 << 2);
794
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 p[3] = (dev->dev_attrib.emulate_rest_reord == 1) ? 0x00 : 0x10;
824
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 p[4] = (dev->dev_attrib.emulate_ua_intlck_ctrl == 2) ? 0x30 :
854 (dev->dev_attrib.emulate_ua_intlck_ctrl == 1) ? 0x20 : 0x00;
855
856
857
858
859
860
861
862
863
864
865
866
867 p[5] = (dev->dev_attrib.emulate_tas) ? 0x40 : 0x00;
868
869
870
871
872
873
874
875
876
877
878 if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
879 if (dev->dev_attrib.pi_prot_type || sess->sess_prot_type)
880 p[5] |= 0x80;
881 }
882
883 p[8] = 0xff;
884 p[9] = 0xff;
885 p[11] = 30;
886
887out:
888 return 12;
889}
890
891static int spc_modesense_caching(struct se_cmd *cmd, u8 pc, u8 *p)
892{
893 struct se_device *dev = cmd->se_dev;
894
895 p[0] = 0x08;
896 p[1] = 0x12;
897
898
899 if (pc == 1)
900 goto out;
901
902 if (target_check_wce(dev))
903 p[2] = 0x04;
904 p[12] = 0x20;
905
906out:
907 return 20;
908}
909
910static int spc_modesense_informational_exceptions(struct se_cmd *cmd, u8 pc, unsigned char *p)
911{
912 p[0] = 0x1c;
913 p[1] = 0x0a;
914
915
916 if (pc == 1)
917 goto out;
918
919out:
920 return 12;
921}
922
923static struct {
924 uint8_t page;
925 uint8_t subpage;
926 int (*emulate)(struct se_cmd *, u8, unsigned char *);
927} modesense_handlers[] = {
928 { .page = 0x01, .subpage = 0x00, .emulate = spc_modesense_rwrecovery },
929 { .page = 0x08, .subpage = 0x00, .emulate = spc_modesense_caching },
930 { .page = 0x0a, .subpage = 0x00, .emulate = spc_modesense_control },
931 { .page = 0x1c, .subpage = 0x00, .emulate = spc_modesense_informational_exceptions },
932};
933
934static void spc_modesense_write_protect(unsigned char *buf, int type)
935{
936
937
938
939
940 switch (type) {
941 case TYPE_DISK:
942 case TYPE_TAPE:
943 default:
944 buf[0] |= 0x80;
945 break;
946 }
947}
948
949static void spc_modesense_dpofua(unsigned char *buf, int type)
950{
951 switch (type) {
952 case TYPE_DISK:
953 buf[0] |= 0x10;
954 break;
955 default:
956 break;
957 }
958}
959
960static int spc_modesense_blockdesc(unsigned char *buf, u64 blocks, u32 block_size)
961{
962 *buf++ = 8;
963 put_unaligned_be32(min(blocks, 0xffffffffull), buf);
964 buf += 4;
965 put_unaligned_be32(block_size, buf);
966 return 9;
967}
968
969static int spc_modesense_long_blockdesc(unsigned char *buf, u64 blocks, u32 block_size)
970{
971 if (blocks <= 0xffffffff)
972 return spc_modesense_blockdesc(buf + 3, blocks, block_size) + 3;
973
974 *buf++ = 1;
975 buf += 2;
976 *buf++ = 16;
977 put_unaligned_be64(blocks, buf);
978 buf += 12;
979 put_unaligned_be32(block_size, buf);
980
981 return 17;
982}
983
984static sense_reason_t spc_emulate_modesense(struct se_cmd *cmd)
985{
986 struct se_device *dev = cmd->se_dev;
987 char *cdb = cmd->t_task_cdb;
988 unsigned char buf[SE_MODE_PAGE_BUF], *rbuf;
989 int type = dev->transport->get_device_type(dev);
990 int ten = (cmd->t_task_cdb[0] == MODE_SENSE_10);
991 bool dbd = !!(cdb[1] & 0x08);
992 bool llba = ten ? !!(cdb[1] & 0x10) : false;
993 u8 pc = cdb[2] >> 6;
994 u8 page = cdb[2] & 0x3f;
995 u8 subpage = cdb[3];
996 int length = 0;
997 int ret;
998 int i;
999
1000 memset(buf, 0, SE_MODE_PAGE_BUF);
1001
1002
1003
1004
1005
1006 length = ten ? 3 : 2;
1007
1008
1009 if (cmd->se_lun->lun_access_ro || target_lun_is_rdonly(cmd))
1010 spc_modesense_write_protect(&buf[length], type);
1011
1012
1013
1014
1015
1016
1017 if (target_check_fua(dev))
1018 spc_modesense_dpofua(&buf[length], type);
1019
1020 ++length;
1021
1022
1023
1024
1025
1026
1027
1028 if (!dbd && type == TYPE_DISK) {
1029 u64 blocks = dev->transport->get_blocks(dev);
1030 u32 block_size = dev->dev_attrib.block_size;
1031
1032 if (ten) {
1033 if (llba) {
1034 length += spc_modesense_long_blockdesc(&buf[length],
1035 blocks, block_size);
1036 } else {
1037 length += 3;
1038 length += spc_modesense_blockdesc(&buf[length],
1039 blocks, block_size);
1040 }
1041 } else {
1042 length += spc_modesense_blockdesc(&buf[length], blocks,
1043 block_size);
1044 }
1045 } else {
1046 if (ten)
1047 length += 4;
1048 else
1049 length += 1;
1050 }
1051
1052 if (page == 0x3f) {
1053 if (subpage != 0x00 && subpage != 0xff) {
1054 pr_warn("MODE_SENSE: Invalid subpage code: 0x%02x\n", subpage);
1055 return TCM_INVALID_CDB_FIELD;
1056 }
1057
1058 for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i) {
1059
1060
1061
1062
1063
1064
1065 if ((modesense_handlers[i].subpage & ~subpage) == 0) {
1066 ret = modesense_handlers[i].emulate(cmd, pc, &buf[length]);
1067 if (!ten && length + ret >= 255)
1068 break;
1069 length += ret;
1070 }
1071 }
1072
1073 goto set_length;
1074 }
1075
1076 for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i)
1077 if (modesense_handlers[i].page == page &&
1078 modesense_handlers[i].subpage == subpage) {
1079 length += modesense_handlers[i].emulate(cmd, pc, &buf[length]);
1080 goto set_length;
1081 }
1082
1083
1084
1085
1086
1087 if (page != 0x03)
1088 pr_err("MODE SENSE: unimplemented page/subpage: 0x%02x/0x%02x\n",
1089 page, subpage);
1090
1091 return TCM_UNKNOWN_MODE_PAGE;
1092
1093set_length:
1094 if (ten)
1095 put_unaligned_be16(length - 2, buf);
1096 else
1097 buf[0] = length - 1;
1098
1099 rbuf = transport_kmap_data_sg(cmd);
1100 if (rbuf) {
1101 memcpy(rbuf, buf, min_t(u32, SE_MODE_PAGE_BUF, cmd->data_length));
1102 transport_kunmap_data_sg(cmd);
1103 }
1104
1105 target_complete_cmd_with_length(cmd, GOOD, length);
1106 return 0;
1107}
1108
1109static sense_reason_t spc_emulate_modeselect(struct se_cmd *cmd)
1110{
1111 char *cdb = cmd->t_task_cdb;
1112 bool ten = cdb[0] == MODE_SELECT_10;
1113 int off = ten ? 8 : 4;
1114 bool pf = !!(cdb[1] & 0x10);
1115 u8 page, subpage;
1116 unsigned char *buf;
1117 unsigned char tbuf[SE_MODE_PAGE_BUF];
1118 int length;
1119 sense_reason_t ret = 0;
1120 int i;
1121
1122 if (!cmd->data_length) {
1123 target_complete_cmd(cmd, GOOD);
1124 return 0;
1125 }
1126
1127 if (cmd->data_length < off + 2)
1128 return TCM_PARAMETER_LIST_LENGTH_ERROR;
1129
1130 buf = transport_kmap_data_sg(cmd);
1131 if (!buf)
1132 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
1133
1134 if (!pf) {
1135 ret = TCM_INVALID_CDB_FIELD;
1136 goto out;
1137 }
1138
1139 page = buf[off] & 0x3f;
1140 subpage = buf[off] & 0x40 ? buf[off + 1] : 0;
1141
1142 for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i)
1143 if (modesense_handlers[i].page == page &&
1144 modesense_handlers[i].subpage == subpage) {
1145 memset(tbuf, 0, SE_MODE_PAGE_BUF);
1146 length = modesense_handlers[i].emulate(cmd, 0, tbuf);
1147 goto check_contents;
1148 }
1149
1150 ret = TCM_UNKNOWN_MODE_PAGE;
1151 goto out;
1152
1153check_contents:
1154 if (cmd->data_length < off + length) {
1155 ret = TCM_PARAMETER_LIST_LENGTH_ERROR;
1156 goto out;
1157 }
1158
1159 if (memcmp(buf + off, tbuf, length))
1160 ret = TCM_INVALID_PARAMETER_LIST;
1161
1162out:
1163 transport_kunmap_data_sg(cmd);
1164
1165 if (!ret)
1166 target_complete_cmd(cmd, GOOD);
1167 return ret;
1168}
1169
1170static sense_reason_t spc_emulate_request_sense(struct se_cmd *cmd)
1171{
1172 unsigned char *cdb = cmd->t_task_cdb;
1173 unsigned char *rbuf;
1174 u8 ua_asc = 0, ua_ascq = 0;
1175 unsigned char buf[SE_SENSE_BUF];
1176 bool desc_format = target_sense_desc_format(cmd->se_dev);
1177
1178 memset(buf, 0, SE_SENSE_BUF);
1179
1180 if (cdb[1] & 0x01) {
1181 pr_err("REQUEST_SENSE description emulation not"
1182 " supported\n");
1183 return TCM_INVALID_CDB_FIELD;
1184 }
1185
1186 rbuf = transport_kmap_data_sg(cmd);
1187 if (!rbuf)
1188 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
1189
1190 if (!core_scsi3_ua_clear_for_request_sense(cmd, &ua_asc, &ua_ascq))
1191 scsi_build_sense_buffer(desc_format, buf, UNIT_ATTENTION,
1192 ua_asc, ua_ascq);
1193 else
1194 scsi_build_sense_buffer(desc_format, buf, NO_SENSE, 0x0, 0x0);
1195
1196 memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length));
1197 transport_kunmap_data_sg(cmd);
1198
1199 target_complete_cmd(cmd, GOOD);
1200 return 0;
1201}
1202
1203sense_reason_t spc_emulate_report_luns(struct se_cmd *cmd)
1204{
1205 struct se_dev_entry *deve;
1206 struct se_session *sess = cmd->se_sess;
1207 struct se_node_acl *nacl;
1208 struct scsi_lun slun;
1209 unsigned char *buf;
1210 u32 lun_count = 0, offset = 8;
1211 __be32 len;
1212
1213 buf = transport_kmap_data_sg(cmd);
1214 if (cmd->data_length && !buf)
1215 return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
1216
1217
1218
1219
1220
1221
1222 if (!sess)
1223 goto done;
1224
1225 nacl = sess->se_node_acl;
1226
1227 rcu_read_lock();
1228 hlist_for_each_entry_rcu(deve, &nacl->lun_entry_hlist, link) {
1229
1230
1231
1232
1233
1234 lun_count++;
1235 if (offset >= cmd->data_length)
1236 continue;
1237
1238 int_to_scsilun(deve->mapped_lun, &slun);
1239 memcpy(buf + offset, &slun,
1240 min(8u, cmd->data_length - offset));
1241 offset += 8;
1242 }
1243 rcu_read_unlock();
1244
1245
1246
1247
1248done:
1249
1250
1251
1252 if (lun_count == 0) {
1253 int_to_scsilun(0, &slun);
1254 if (cmd->data_length > 8)
1255 memcpy(buf + offset, &slun,
1256 min(8u, cmd->data_length - offset));
1257 lun_count = 1;
1258 }
1259
1260 if (buf) {
1261 len = cpu_to_be32(lun_count * 8);
1262 memcpy(buf, &len, min_t(int, sizeof len, cmd->data_length));
1263 transport_kunmap_data_sg(cmd);
1264 }
1265
1266 target_complete_cmd_with_length(cmd, GOOD, 8 + lun_count * 8);
1267 return 0;
1268}
1269EXPORT_SYMBOL(spc_emulate_report_luns);
1270
1271static sense_reason_t
1272spc_emulate_testunitready(struct se_cmd *cmd)
1273{
1274 target_complete_cmd(cmd, GOOD);
1275 return 0;
1276}
1277
1278sense_reason_t
1279spc_parse_cdb(struct se_cmd *cmd, unsigned int *size)
1280{
1281 struct se_device *dev = cmd->se_dev;
1282 unsigned char *cdb = cmd->t_task_cdb;
1283
1284 switch (cdb[0]) {
1285 case MODE_SELECT:
1286 *size = cdb[4];
1287 cmd->execute_cmd = spc_emulate_modeselect;
1288 break;
1289 case MODE_SELECT_10:
1290 *size = get_unaligned_be16(&cdb[7]);
1291 cmd->execute_cmd = spc_emulate_modeselect;
1292 break;
1293 case MODE_SENSE:
1294 *size = cdb[4];
1295 cmd->execute_cmd = spc_emulate_modesense;
1296 break;
1297 case MODE_SENSE_10:
1298 *size = get_unaligned_be16(&cdb[7]);
1299 cmd->execute_cmd = spc_emulate_modesense;
1300 break;
1301 case LOG_SELECT:
1302 case LOG_SENSE:
1303 *size = get_unaligned_be16(&cdb[7]);
1304 break;
1305 case PERSISTENT_RESERVE_IN:
1306 *size = get_unaligned_be16(&cdb[7]);
1307 cmd->execute_cmd = target_scsi3_emulate_pr_in;
1308 break;
1309 case PERSISTENT_RESERVE_OUT:
1310 *size = get_unaligned_be32(&cdb[5]);
1311 cmd->execute_cmd = target_scsi3_emulate_pr_out;
1312 break;
1313 case RELEASE:
1314 case RELEASE_10:
1315 if (cdb[0] == RELEASE_10)
1316 *size = get_unaligned_be16(&cdb[7]);
1317 else
1318 *size = cmd->data_length;
1319
1320 cmd->execute_cmd = target_scsi2_reservation_release;
1321 break;
1322 case RESERVE:
1323 case RESERVE_10:
1324
1325
1326
1327
1328 if (cdb[0] == RESERVE_10)
1329 *size = get_unaligned_be16(&cdb[7]);
1330 else
1331 *size = cmd->data_length;
1332
1333 cmd->execute_cmd = target_scsi2_reservation_reserve;
1334 break;
1335 case REQUEST_SENSE:
1336 *size = cdb[4];
1337 cmd->execute_cmd = spc_emulate_request_sense;
1338 break;
1339 case INQUIRY:
1340 *size = get_unaligned_be16(&cdb[3]);
1341
1342
1343
1344
1345
1346 cmd->sam_task_attr = TCM_HEAD_TAG;
1347 cmd->execute_cmd = spc_emulate_inquiry;
1348 break;
1349 case SECURITY_PROTOCOL_IN:
1350 case SECURITY_PROTOCOL_OUT:
1351 *size = get_unaligned_be32(&cdb[6]);
1352 break;
1353 case EXTENDED_COPY:
1354 *size = get_unaligned_be32(&cdb[10]);
1355 cmd->execute_cmd = target_do_xcopy;
1356 break;
1357 case RECEIVE_COPY_RESULTS:
1358 *size = get_unaligned_be32(&cdb[10]);
1359 cmd->execute_cmd = target_do_receive_copy_results;
1360 break;
1361 case READ_ATTRIBUTE:
1362 case WRITE_ATTRIBUTE:
1363 *size = get_unaligned_be32(&cdb[10]);
1364 break;
1365 case RECEIVE_DIAGNOSTIC:
1366 case SEND_DIAGNOSTIC:
1367 *size = get_unaligned_be16(&cdb[3]);
1368 break;
1369 case WRITE_BUFFER:
1370 *size = get_unaligned_be24(&cdb[6]);
1371 break;
1372 case REPORT_LUNS:
1373 cmd->execute_cmd = spc_emulate_report_luns;
1374 *size = get_unaligned_be32(&cdb[6]);
1375
1376
1377
1378
1379 cmd->sam_task_attr = TCM_HEAD_TAG;
1380 break;
1381 case TEST_UNIT_READY:
1382 cmd->execute_cmd = spc_emulate_testunitready;
1383 *size = 0;
1384 break;
1385 case MAINTENANCE_IN:
1386 if (dev->transport->get_device_type(dev) != TYPE_ROM) {
1387
1388
1389
1390
1391 if ((cdb[1] & 0x1f) == MI_REPORT_TARGET_PGS) {
1392 cmd->execute_cmd =
1393 target_emulate_report_target_port_groups;
1394 }
1395 *size = get_unaligned_be32(&cdb[6]);
1396 } else {
1397
1398
1399
1400 *size = get_unaligned_be16(&cdb[8]);
1401 }
1402 break;
1403 case MAINTENANCE_OUT:
1404 if (dev->transport->get_device_type(dev) != TYPE_ROM) {
1405
1406
1407
1408
1409 if (cdb[1] == MO_SET_TARGET_PGS) {
1410 cmd->execute_cmd =
1411 target_emulate_set_target_port_groups;
1412 }
1413 *size = get_unaligned_be32(&cdb[6]);
1414 } else {
1415
1416
1417
1418 *size = get_unaligned_be16(&cdb[8]);
1419 }
1420 break;
1421 default:
1422 return TCM_UNSUPPORTED_SCSI_OPCODE;
1423 }
1424
1425 return 0;
1426}
1427EXPORT_SYMBOL(spc_parse_cdb);
1428