target_core_spc.c 37.3 KB
Newer Older
1 2 3
/*
 * SCSI Primary Commands (SPC) parsing and emulation.
 *
4
 * (c) Copyright 2002-2013 Datera, Inc.
5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34
 *
 * Nicholas A. Bellinger <nab@kernel.org>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License as published by
 * the Free Software Foundation; either version 2 of the License, or
 * (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 */

#include <linux/kernel.h>
#include <linux/module.h>
#include <asm/unaligned.h>

#include <scsi/scsi.h>
#include <scsi/scsi_tcq.h>

#include <target/target_core_base.h>
#include <target/target_core_backend.h>
#include <target/target_core_fabric.h>

#include "target_core_internal.h"
35
#include "target_core_alua.h"
36 37
#include "target_core_pr.h"
#include "target_core_ua.h"
38
#include "target_core_xcopy.h"
39

40
static void spc_fill_alua_data(struct se_lun *lun, unsigned char *buf)
41 42 43 44 45 46 47 48 49
{
	struct t10_alua_tg_pt_gp *tg_pt_gp;

	/*
	 * Set SCCS for MAINTENANCE_IN + REPORT_TARGET_PORT_GROUPS.
	 */
	buf[5]	= 0x80;

	/*
50
	 * Set TPGS field for explicit and/or implicit ALUA access type
51 52 53 54
	 * and opteration.
	 *
	 * See spc4r17 section 6.4.2 Table 135
	 */
55 56
	spin_lock(&lun->lun_tg_pt_gp_lock);
	tg_pt_gp = lun->lun_tg_pt_gp;
57 58
	if (tg_pt_gp)
		buf[5] |= tg_pt_gp->tg_pt_gp_alua_access_type;
59
	spin_unlock(&lun->lun_tg_pt_gp_lock);
60 61
}

62 63
sense_reason_t
spc_emulate_inquiry_std(struct se_cmd *cmd, unsigned char *buf)
64 65 66
{
	struct se_lun *lun = cmd->se_lun;
	struct se_device *dev = cmd->se_dev;
67
	struct se_session *sess = cmd->se_sess;
68 69 70 71 72

	/* Set RMB (removable media) for tape devices */
	if (dev->transport->get_device_type(dev) == TYPE_TAPE)
		buf[1] = 0x80;

73
	buf[2] = 0x05; /* SPC-3 */
74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89

	/*
	 * NORMACA and HISUP = 0, RESPONSE DATA FORMAT = 2
	 *
	 * SPC4 says:
	 *   A RESPONSE DATA FORMAT field set to 2h indicates that the
	 *   standard INQUIRY data is in the format defined in this
	 *   standard. Response data format values less than 2h are
	 *   obsolete. Response data format values greater than 2h are
	 *   reserved.
	 */
	buf[3] = 2;

	/*
	 * Enable SCCS and TPGS fields for Emulated ALUA
	 */
90
	spc_fill_alua_data(lun, buf);
91

92 93 94 95 96
	/*
	 * Set Third-Party Copy (3PC) bit to indicate support for EXTENDED_COPY
	 */
	if (dev->dev_attrib.emulate_3pc)
		buf[5] |= 0x8;
97
	/*
98
	 * Set Protection (PROTECT) bit when DIF has been enabled on the
99 100 101
	 * device, and the fabric supports VERIFY + PASS.  Also report
	 * PROTECT=1 if sess_prot_type has been configured to allow T10-PI
	 * to unprotected devices.
102
	 */
103
	if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
104
		if (dev->dev_attrib.pi_prot_type || cmd->se_sess->sess_prot_type)
105 106
			buf[5] |= 0x1;
	}
107

108 109
	buf[7] = 0x2; /* CmdQue=1 */

110 111 112 113 114 115
	memcpy(&buf[8], "LIO-ORG ", 8);
	memset(&buf[16], 0x20, 16);
	memcpy(&buf[16], dev->t10_wwn.model,
	       min_t(size_t, strlen(dev->t10_wwn.model), 16));
	memcpy(&buf[32], dev->t10_wwn.revision,
	       min_t(size_t, strlen(dev->t10_wwn.revision), 4));
116 117 118 119
	buf[4] = 31; /* Set additional length to 31 */

	return 0;
}
120
EXPORT_SYMBOL(spc_emulate_inquiry_std);
121 122

/* unit serial number */
123 124
static sense_reason_t
spc_emulate_evpd_80(struct se_cmd *cmd, unsigned char *buf)
125 126
{
	struct se_device *dev = cmd->se_dev;
127
	u16 len;
128

129
	if (dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL) {
130
		len = sprintf(&buf[4], "%s", dev->t10_wwn.unit_serial);
131 132 133 134 135 136
		len++; /* Extra Byte for NULL Terminator */
		buf[3] = len;
	}
	return 0;
}

137 138
void spc_parse_naa_6h_vendor_specific(struct se_device *dev,
				      unsigned char *buf)
139
{
140
	unsigned char *p = &dev->t10_wwn.unit_serial[0];
141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171
	int cnt;
	bool next = true;

	/*
	 * Generate up to 36 bits of VENDOR SPECIFIC IDENTIFIER starting on
	 * byte 3 bit 3-0 for NAA IEEE Registered Extended DESIGNATOR field
	 * format, followed by 64 bits of VENDOR SPECIFIC IDENTIFIER EXTENSION
	 * to complete the payload.  These are based from VPD=0x80 PRODUCT SERIAL
	 * NUMBER set via vpd_unit_serial in target_core_configfs.c to ensure
	 * per device uniqeness.
	 */
	for (cnt = 0; *p && cnt < 13; p++) {
		int val = hex_to_bin(*p);

		if (val < 0)
			continue;

		if (next) {
			next = false;
			buf[cnt++] |= val;
		} else {
			next = true;
			buf[cnt] = val << 4;
		}
	}
}

/*
 * Device identification VPD, for a complete list of
 * DESIGNATOR TYPEs see spc4r17 Table 459.
 */
172
sense_reason_t
173
spc_emulate_evpd_83(struct se_cmd *cmd, unsigned char *buf)
174 175 176 177 178 179
{
	struct se_device *dev = cmd->se_dev;
	struct se_lun *lun = cmd->se_lun;
	struct se_portal_group *tpg = NULL;
	struct t10_alua_lu_gp_member *lu_gp_mem;
	struct t10_alua_tg_pt_gp *tg_pt_gp;
180
	unsigned char *prod = &dev->t10_wwn.model[0];
181 182 183 184 185 186 187 188 189 190 191 192 193 194
	u32 prod_len;
	u32 unit_serial_len, off = 0;
	u16 len = 0, id_len;

	off = 4;

	/*
	 * NAA IEEE Registered Extended Assigned designator format, see
	 * spc4r17 section 7.7.3.6.5
	 *
	 * We depend upon a target_core_mod/ConfigFS provided
	 * /sys/kernel/config/target/core/$HBA/$DEV/wwn/vpd_unit_serial
	 * value in order to return the NAA id.
	 */
195
	if (!(dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL))
196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238 239 240 241 242
		goto check_t10_vend_desc;

	/* CODE SET == Binary */
	buf[off++] = 0x1;

	/* Set ASSOCIATION == addressed logical unit: 0)b */
	buf[off] = 0x00;

	/* Identifier/Designator type == NAA identifier */
	buf[off++] |= 0x3;
	off++;

	/* Identifier/Designator length */
	buf[off++] = 0x10;

	/*
	 * Start NAA IEEE Registered Extended Identifier/Designator
	 */
	buf[off++] = (0x6 << 4);

	/*
	 * Use OpenFabrics IEEE Company ID: 00 14 05
	 */
	buf[off++] = 0x01;
	buf[off++] = 0x40;
	buf[off] = (0x5 << 4);

	/*
	 * Return ConfigFS Unit Serial Number information for
	 * VENDOR_SPECIFIC_IDENTIFIER and
	 * VENDOR_SPECIFIC_IDENTIFIER_EXTENTION
	 */
	spc_parse_naa_6h_vendor_specific(dev, &buf[off]);

	len = 20;
	off = (len + 4);

check_t10_vend_desc:
	/*
	 * T10 Vendor Identifier Page, see spc4r17 section 7.7.3.4
	 */
	id_len = 8; /* For Vendor field */
	prod_len = 4; /* For VPD Header */
	prod_len += 8; /* For Vendor field */
	prod_len += strlen(prod);
	prod_len++; /* For : */

243 244
	if (dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL) {
		unit_serial_len = strlen(&dev->t10_wwn.unit_serial[0]);
245 246 247
		unit_serial_len++; /* For NULL Terminator */

		id_len += sprintf(&buf[off+12], "%s:%s", prod,
248
				&dev->t10_wwn.unit_serial[0]);
249 250 251 252 253 254 255 256 257 258 259 260
	}
	buf[off] = 0x2; /* ASCII */
	buf[off+1] = 0x1; /* T10 Vendor ID */
	buf[off+2] = 0x0;
	memcpy(&buf[off+4], "LIO-ORG", 8);
	/* Extra Byte for NULL Terminator */
	id_len++;
	/* Identifier Length */
	buf[off+3] = id_len;
	/* Header size for Designation descriptor */
	len += (id_len + 4);
	off += (id_len + 4);
261 262

	if (1) {
263
		struct t10_alua_lu_gp *lu_gp;
264
		u32 padding, scsi_name_len, scsi_target_len;
265 266 267 268
		u16 lu_gp_id = 0;
		u16 tg_pt_gp_id = 0;
		u16 tpgt;

269
		tpg = lun->lun_tpg;
270 271 272 273 274 275 276
		/*
		 * Relative target port identifer, see spc4r17
		 * section 7.7.3.7
		 *
		 * Get the PROTOCOL IDENTIFIER as defined by spc4r17
		 * section 7.5.1 Table 362
		 */
277
		buf[off] = tpg->proto_id << 4;
278 279 280 281 282 283 284 285 286 287 288
		buf[off++] |= 0x1; /* CODE SET == Binary */
		buf[off] = 0x80; /* Set PIV=1 */
		/* Set ASSOCIATION == target port: 01b */
		buf[off] |= 0x10;
		/* DESIGNATOR TYPE == Relative target port identifer */
		buf[off++] |= 0x4;
		off++; /* Skip over Reserved */
		buf[off++] = 4; /* DESIGNATOR LENGTH */
		/* Skip over Obsolete field in RTPI payload
		 * in Table 472 */
		off += 2;
289 290
		buf[off++] = ((lun->lun_rtpi >> 8) & 0xff);
		buf[off++] = (lun->lun_rtpi & 0xff);
291 292 293 294 295 296 297 298
		len += 8; /* Header size + Designation descriptor */
		/*
		 * Target port group identifier, see spc4r17
		 * section 7.7.3.8
		 *
		 * Get the PROTOCOL IDENTIFIER as defined by spc4r17
		 * section 7.5.1 Table 362
		 */
299 300
		spin_lock(&lun->lun_tg_pt_gp_lock);
		tg_pt_gp = lun->lun_tg_pt_gp;
301
		if (!tg_pt_gp) {
302
			spin_unlock(&lun->lun_tg_pt_gp_lock);
303 304 305
			goto check_lu_gp;
		}
		tg_pt_gp_id = tg_pt_gp->tg_pt_gp_id;
306
		spin_unlock(&lun->lun_tg_pt_gp_lock);
307

308
		buf[off] = tpg->proto_id << 4;
309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355
		buf[off++] |= 0x1; /* CODE SET == Binary */
		buf[off] = 0x80; /* Set PIV=1 */
		/* Set ASSOCIATION == target port: 01b */
		buf[off] |= 0x10;
		/* DESIGNATOR TYPE == Target port group identifier */
		buf[off++] |= 0x5;
		off++; /* Skip over Reserved */
		buf[off++] = 4; /* DESIGNATOR LENGTH */
		off += 2; /* Skip over Reserved Field */
		buf[off++] = ((tg_pt_gp_id >> 8) & 0xff);
		buf[off++] = (tg_pt_gp_id & 0xff);
		len += 8; /* Header size + Designation descriptor */
		/*
		 * Logical Unit Group identifier, see spc4r17
		 * section 7.7.3.8
		 */
check_lu_gp:
		lu_gp_mem = dev->dev_alua_lu_gp_mem;
		if (!lu_gp_mem)
			goto check_scsi_name;

		spin_lock(&lu_gp_mem->lu_gp_mem_lock);
		lu_gp = lu_gp_mem->lu_gp;
		if (!lu_gp) {
			spin_unlock(&lu_gp_mem->lu_gp_mem_lock);
			goto check_scsi_name;
		}
		lu_gp_id = lu_gp->lu_gp_id;
		spin_unlock(&lu_gp_mem->lu_gp_mem_lock);

		buf[off++] |= 0x1; /* CODE SET == Binary */
		/* DESIGNATOR TYPE == Logical Unit Group identifier */
		buf[off++] |= 0x6;
		off++; /* Skip over Reserved */
		buf[off++] = 4; /* DESIGNATOR LENGTH */
		off += 2; /* Skip over Reserved Field */
		buf[off++] = ((lu_gp_id >> 8) & 0xff);
		buf[off++] = (lu_gp_id & 0xff);
		len += 8; /* Header size + Designation descriptor */
		/*
		 * SCSI name string designator, see spc4r17
		 * section 7.7.3.11
		 *
		 * Get the PROTOCOL IDENTIFIER as defined by spc4r17
		 * section 7.5.1 Table 362
		 */
check_scsi_name:
356
		buf[off] = tpg->proto_id << 4;
357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381
		buf[off++] |= 0x3; /* CODE SET == UTF-8 */
		buf[off] = 0x80; /* Set PIV=1 */
		/* Set ASSOCIATION == target port: 01b */
		buf[off] |= 0x10;
		/* DESIGNATOR TYPE == SCSI name string */
		buf[off++] |= 0x8;
		off += 2; /* Skip over Reserved and length */
		/*
		 * SCSI name string identifer containing, $FABRIC_MOD
		 * dependent information.  For LIO-Target and iSCSI
		 * Target Port, this means "<iSCSI name>,t,0x<TPGT> in
		 * UTF-8 encoding.
		 */
		tpgt = tpg->se_tpg_tfo->tpg_get_tag(tpg);
		scsi_name_len = sprintf(&buf[off], "%s,t,0x%04x",
					tpg->se_tpg_tfo->tpg_get_wwn(tpg), tpgt);
		scsi_name_len += 1 /* Include  NULL terminator */;
		/*
		 * The null-terminated, null-padded (see 4.4.2) SCSI
		 * NAME STRING field contains a UTF-8 format string.
		 * The number of bytes in the SCSI NAME STRING field
		 * (i.e., the value in the DESIGNATOR LENGTH field)
		 * shall be no larger than 256 and shall be a multiple
		 * of four.
		 */
382
		padding = ((-scsi_name_len) & 3);
383 384
		if (padding)
			scsi_name_len += padding;
385 386
		if (scsi_name_len > 256)
			scsi_name_len = 256;
387 388 389 390 391

		buf[off-1] = scsi_name_len;
		off += scsi_name_len;
		/* Header size + Designation descriptor */
		len += (scsi_name_len + 4);
392 393 394 395

		/*
		 * Target device designator
		 */
396
		buf[off] = tpg->proto_id << 4;
397 398 399 400 401 402 403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418 419 420 421 422 423
		buf[off++] |= 0x3; /* CODE SET == UTF-8 */
		buf[off] = 0x80; /* Set PIV=1 */
		/* Set ASSOCIATION == target device: 10b */
		buf[off] |= 0x20;
		/* DESIGNATOR TYPE == SCSI name string */
		buf[off++] |= 0x8;
		off += 2; /* Skip over Reserved and length */
		/*
		 * SCSI name string identifer containing, $FABRIC_MOD
		 * dependent information.  For LIO-Target and iSCSI
		 * Target Port, this means "<iSCSI name>" in
		 * UTF-8 encoding.
		 */
		scsi_target_len = sprintf(&buf[off], "%s",
					  tpg->se_tpg_tfo->tpg_get_wwn(tpg));
		scsi_target_len += 1 /* Include  NULL terminator */;
		/*
		 * The null-terminated, null-padded (see 4.4.2) SCSI
		 * NAME STRING field contains a UTF-8 format string.
		 * The number of bytes in the SCSI NAME STRING field
		 * (i.e., the value in the DESIGNATOR LENGTH field)
		 * shall be no larger than 256 and shall be a multiple
		 * of four.
		 */
		padding = ((-scsi_target_len) & 3);
		if (padding)
			scsi_target_len += padding;
424 425
		if (scsi_target_len > 256)
			scsi_target_len = 256;
426 427 428 429 430 431

		buf[off-1] = scsi_target_len;
		off += scsi_target_len;

		/* Header size + Designation descriptor */
		len += (scsi_target_len + 4);
432 433 434 435 436
	}
	buf[2] = ((len >> 8) & 0xff);
	buf[3] = (len & 0xff); /* Page Length for VPD 0x83 */
	return 0;
}
437
EXPORT_SYMBOL(spc_emulate_evpd_83);
438 439

/* Extended INQUIRY Data VPD Page */
440 441
static sense_reason_t
spc_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
	/*
	 * Set GRD_CHK + REF_CHK for TYPE1 protection, or GRD_CHK
	 * only for TYPE3 protection.
	 */
451
	if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
452 453
		if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT ||
		    cmd->se_sess->sess_prot_type == TARGET_DIF_TYPE1_PROT)
454
			buf[4] = 0x5;
455 456
		else if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE3_PROT ||
			cmd->se_sess->sess_prot_type == TARGET_DIF_TYPE3_PROT)
457 458
			buf[4] = 0x4;
	}
459

460 461 462 463
	/* Set HEADSUP, ORDSUP, SIMPSUP */
	buf[5] = 0x07;

	/* If WriteCache emulation is enabled, set V_SUP */
464
	if (target_check_wce(dev))
465
		buf[6] = 0x01;
466 467 468 469 470
	/* If an LBA map is present set R_SUP */
	spin_lock(&cmd->se_dev->t10_alua.lba_map_lock);
	if (!list_empty(&dev->t10_alua.lba_map_list))
		buf[8] = 0x10;
	spin_unlock(&cmd->se_dev->t10_alua.lba_map_lock);
471 472 473 474
	return 0;
}

/* Block Limits VPD page */
475 476
static sense_reason_t
spc_emulate_evpd_b0(struct se_cmd *cmd, unsigned char *buf)
477 478 479
{
	struct se_device *dev = cmd->se_dev;
	int have_tp = 0;
480
	int opt, min;
481 482 483 484 485 486

	/*
	 * Following spc3r22 section 6.5.3 Block Limits VPD page, when
	 * emulate_tpu=1 or emulate_tpws=1 we will be expect a
	 * different page length for Thin Provisioning.
	 */
487
	if (dev->dev_attrib.emulate_tpu || dev->dev_attrib.emulate_tpws)
488 489 490 491 492 493 494
		have_tp = 1;

	buf[0] = dev->transport->get_device_type(dev);
	buf[3] = have_tp ? 0x3c : 0x10;

	/* Set WSNZ to 1 */
	buf[4] = 0x01;
495 496 497 498 499
	/*
	 * Set MAXIMUM COMPARE AND WRITE LENGTH
	 */
	if (dev->dev_attrib.emulate_caw)
		buf[5] = 0x01;
500 501 502 503

	/*
	 * Set OPTIMAL TRANSFER LENGTH GRANULARITY
	 */
504 505 506 507
	if (dev->transport->get_io_min && (min = dev->transport->get_io_min(dev)))
		put_unaligned_be16(min / dev->dev_attrib.block_size, &buf[6]);
	else
		put_unaligned_be16(1, &buf[6]);
508 509 510 511

	/*
	 * Set MAXIMUM TRANSFER LENGTH
	 */
512
	put_unaligned_be32(dev->dev_attrib.hw_max_sectors, &buf[8]);
513 514 515 516

	/*
	 * Set OPTIMAL TRANSFER LENGTH
	 */
517 518 519 520
	if (dev->transport->get_io_opt && (opt = dev->transport->get_io_opt(dev)))
		put_unaligned_be32(opt / dev->dev_attrib.block_size, &buf[12]);
	else
		put_unaligned_be32(dev->dev_attrib.optimal_sectors, &buf[12]);
521 522 523 524 525

	/*
	 * Exit now if we don't support TP.
	 */
	if (!have_tp)
526
		goto max_write_same;
527 528 529 530

	/*
	 * Set MAXIMUM UNMAP LBA COUNT
	 */
531
	put_unaligned_be32(dev->dev_attrib.max_unmap_lba_count, &buf[20]);
532 533 534 535

	/*
	 * Set MAXIMUM UNMAP BLOCK DESCRIPTOR COUNT
	 */
536
	put_unaligned_be32(dev->dev_attrib.max_unmap_block_desc_count,
537 538 539 540 541
			   &buf[24]);

	/*
	 * Set OPTIMAL UNMAP GRANULARITY
	 */
542
	put_unaligned_be32(dev->dev_attrib.unmap_granularity, &buf[28]);
543 544 545 546

	/*
	 * UNMAP GRANULARITY ALIGNMENT
	 */
547
	put_unaligned_be32(dev->dev_attrib.unmap_granularity_alignment,
548
			   &buf[32]);
549
	if (dev->dev_attrib.unmap_granularity_alignment != 0)
550 551
		buf[32] |= 0x80; /* Set the UGAVALID bit */

552 553 554 555 556 557
	/*
	 * MAXIMUM WRITE SAME LENGTH
	 */
max_write_same:
	put_unaligned_be64(dev->dev_attrib.max_write_same_len, &buf[36]);

558 559 560 561
	return 0;
}

/* Block Device Characteristics VPD page */
562 563
static sense_reason_t
spc_emulate_evpd_b1(struct se_cmd *cmd, unsigned char *buf)
564 565 566 567 568
{
	struct se_device *dev = cmd->se_dev;

	buf[0] = dev->transport->get_device_type(dev);
	buf[3] = 0x3c;
569
	buf[5] = dev->dev_attrib.is_nonrot ? 1 : 0;
570 571 572 573 574

	return 0;
}

/* Thin Provisioning VPD */
575 576
static sense_reason_t
spc_emulate_evpd_b2(struct se_cmd *cmd, unsigned char *buf)
577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597 598 599 600 601 602 603 604 605 606 607 608 609 610
{
	struct se_device *dev = cmd->se_dev;

	/*
	 * From spc3r22 section 6.5.4 Thin Provisioning VPD page:
	 *
	 * The PAGE LENGTH field is defined in SPC-4. If the DP bit is set to
	 * zero, then the page length shall be set to 0004h.  If the DP bit
	 * is set to one, then the page length shall be set to the value
	 * defined in table 162.
	 */
	buf[0] = dev->transport->get_device_type(dev);

	/*
	 * Set Hardcoded length mentioned above for DP=0
	 */
	put_unaligned_be16(0x0004, &buf[2]);

	/*
	 * The THRESHOLD EXPONENT field indicates the threshold set size in
	 * LBAs as a power of 2 (i.e., the threshold set size is equal to
	 * 2(threshold exponent)).
	 *
	 * Note that this is currently set to 0x00 as mkp says it will be
	 * changing again.  We can enable this once it has settled in T10
	 * and is actually used by Linux/SCSI ML code.
	 */
	buf[4] = 0x00;

	/*
	 * A TPU bit set to one indicates that the device server supports
	 * the UNMAP command (see 5.25). A TPU bit set to zero indicates
	 * that the device server does not support the UNMAP command.
	 */
611
	if (dev->dev_attrib.emulate_tpu != 0)
612 613 614 615 616 617 618 619
		buf[5] = 0x80;

	/*
	 * A TPWS bit set to one indicates that the device server supports
	 * the use of the WRITE SAME (16) command (see 5.42) to unmap LBAs.
	 * A TPWS bit set to zero indicates that the device server does not
	 * support the use of the WRITE SAME (16) command to unmap LBAs.
	 */
620
	if (dev->dev_attrib.emulate_tpws != 0)
621
		buf[5] |= 0x40 | 0x20;
622 623 624 625

	return 0;
}

626 627 628 629 630 631 632 633 634
/* Referrals VPD page */
static sense_reason_t
spc_emulate_evpd_b3(struct se_cmd *cmd, unsigned char *buf)
{
	struct se_device *dev = cmd->se_dev;

	buf[0] = dev->transport->get_device_type(dev);
	buf[3] = 0x0c;
	put_unaligned_be32(dev->t10_alua.lba_map_segment_size, &buf[8]);
635
	put_unaligned_be32(dev->t10_alua.lba_map_segment_multiplier, &buf[12]);
636 637 638 639

	return 0;
}

640 641
static sense_reason_t
spc_emulate_evpd_00(struct se_cmd *cmd, unsigned char *buf);
642 643 644

static struct {
	uint8_t		page;
645
	sense_reason_t	(*emulate)(struct se_cmd *, unsigned char *);
646 647 648 649 650 651 652 653
} evpd_handlers[] = {
	{ .page = 0x00, .emulate = spc_emulate_evpd_00 },
	{ .page = 0x80, .emulate = spc_emulate_evpd_80 },
	{ .page = 0x83, .emulate = spc_emulate_evpd_83 },
	{ .page = 0x86, .emulate = spc_emulate_evpd_86 },
	{ .page = 0xb0, .emulate = spc_emulate_evpd_b0 },
	{ .page = 0xb1, .emulate = spc_emulate_evpd_b1 },
	{ .page = 0xb2, .emulate = spc_emulate_evpd_b2 },
654
	{ .page = 0xb3, .emulate = spc_emulate_evpd_b3 },
655 656 657
};

/* supported vital product data pages */
658 659
static sense_reason_t
spc_emulate_evpd_00(struct se_cmd *cmd, unsigned char *buf)
660 661 662 663 664 665 666 667
{
	int p;

	/*
	 * Only report the INQUIRY EVPD=1 pages after a valid NAA
	 * Registered Extended LUN WWN has been set via ConfigFS
	 * during device creation/restart.
	 */
668
	if (cmd->se_dev->dev_flags & DF_EMULATED_VPD_UNIT_SERIAL) {
669 670 671 672 673 674 675 676
		buf[3] = ARRAY_SIZE(evpd_handlers);
		for (p = 0; p < ARRAY_SIZE(evpd_handlers); ++p)
			buf[p + 4] = evpd_handlers[p].page;
	}

	return 0;
}

677 678
static sense_reason_t
spc_emulate_inquiry(struct se_cmd *cmd)
679 680
{
	struct se_device *dev = cmd->se_dev;
681
	struct se_portal_group *tpg = cmd->se_lun->lun_tpg;
682
	unsigned char *rbuf;
683
	unsigned char *cdb = cmd->t_task_cdb;
684
	unsigned char *buf;
685 686
	sense_reason_t ret;
	int p;
687
	int len = 0;
688

689 690 691 692 693
	buf = kzalloc(SE_INQUIRY_BUF, GFP_KERNEL);
	if (!buf) {
		pr_err("Unable to allocate response buffer for INQUIRY\n");
		return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
	}
694

695
	if (dev == tpg->tpg_virt_lun0->lun_se_dev)
696 697 698 699 700 701 702 703
		buf[0] = 0x3f; /* Not connected */
	else
		buf[0] = dev->transport->get_device_type(dev);

	if (!(cdb[1] & 0x1)) {
		if (cdb[2]) {
			pr_err("INQUIRY with EVPD==0 but PAGE CODE=%02x\n",
			       cdb[2]);
704
			ret = TCM_INVALID_CDB_FIELD;
705 706 707 708
			goto out;
		}

		ret = spc_emulate_inquiry_std(cmd, buf);
709
		len = buf[4] + 5;
710 711 712 713 714 715 716
		goto out;
	}

	for (p = 0; p < ARRAY_SIZE(evpd_handlers); ++p) {
		if (cdb[2] == evpd_handlers[p].page) {
			buf[1] = cdb[2];
			ret = evpd_handlers[p].emulate(cmd, buf);
717
			len = get_unaligned_be16(&buf[2]) + 4;
718 719 720 721 722
			goto out;
		}
	}

	pr_err("Unknown VPD Code: 0x%02x\n", cdb[2]);
723
	ret = TCM_INVALID_CDB_FIELD;
724 725

out:
726
	rbuf = transport_kmap_data_sg(cmd);
727
	if (rbuf) {
728
		memcpy(rbuf, buf, min_t(u32, SE_INQUIRY_BUF, cmd->data_length));
729 730
		transport_kunmap_data_sg(cmd);
	}
731
	kfree(buf);
732 733

	if (!ret)
734
		target_complete_cmd_with_length(cmd, GOOD, len);
735 736 737
	return ret;
}

738
static int spc_modesense_rwrecovery(struct se_cmd *cmd, u8 pc, u8 *p)
739 740 741 742
{
	p[0] = 0x01;
	p[1] = 0x0a;

743 744 745 746 747
	/* No changeable values for now */
	if (pc == 1)
		goto out;

out:
748 749 750
	return 12;
}

751
static int spc_modesense_control(struct se_cmd *cmd, u8 pc, u8 *p)
752
{
753 754 755
	struct se_device *dev = cmd->se_dev;
	struct se_session *sess = cmd->se_sess;

756 757
	p[0] = 0x0a;
	p[1] = 0x0a;
758 759 760 761 762

	/* No changeable values for now */
	if (pc == 1)
		goto out;

763 764 765 766 767 768 769 770 771 772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791
	p[2] = 2;
	/*
	 * From spc4r23, 7.4.7 Control mode page
	 *
	 * The QUEUE ALGORITHM MODIFIER field (see table 368) specifies
	 * restrictions on the algorithm used for reordering commands
	 * having the SIMPLE task attribute (see SAM-4).
	 *
	 *                    Table 368 -- QUEUE ALGORITHM MODIFIER field
	 *                         Code      Description
	 *                          0h       Restricted reordering
	 *                          1h       Unrestricted reordering allowed
	 *                          2h to 7h    Reserved
	 *                          8h to Fh    Vendor specific
	 *
	 * A value of zero in the QUEUE ALGORITHM MODIFIER field specifies that
	 * the device server shall order the processing sequence of commands
	 * having the SIMPLE task attribute such that data integrity is maintained
	 * for that I_T nexus (i.e., if the transmission of new SCSI transport protocol
	 * requests is halted at any time, the final value of all data observable
	 * on the medium shall be the same as if all the commands had been processed
	 * with the ORDERED task attribute).
	 *
	 * A value of one in the QUEUE ALGORITHM MODIFIER field specifies that the
	 * device server may reorder the processing sequence of commands having the
	 * SIMPLE task attribute in any manner. Any data integrity exposures related to
	 * command sequence order shall be explicitly handled by the application client
	 * through the selection of appropriate ommands and task attributes.
	 */
792
	p[3] = (dev->dev_attrib.emulate_rest_reord == 1) ? 0x00 : 0x10;
793 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
	/*
	 * From spc4r17, section 7.4.6 Control mode Page
	 *
	 * Unit Attention interlocks control (UN_INTLCK_CTRL) to code 00b
	 *
	 * 00b: The logical unit shall clear any unit attention condition
	 * reported in the same I_T_L_Q nexus transaction as a CHECK CONDITION
	 * status and shall not establish a unit attention condition when a com-
	 * mand is completed with BUSY, TASK SET FULL, or RESERVATION CONFLICT
	 * status.
	 *
	 * 10b: The logical unit shall not clear any unit attention condition
	 * reported in the same I_T_L_Q nexus transaction as a CHECK CONDITION
	 * status and shall not establish a unit attention condition when
	 * a command is completed with BUSY, TASK SET FULL, or RESERVATION
	 * CONFLICT status.
	 *
	 * 11b a The logical unit shall not clear any unit attention condition
	 * reported in the same I_T_L_Q nexus transaction as a CHECK CONDITION
	 * status and shall establish a unit attention condition for the
	 * initiator port associated with the I_T nexus on which the BUSY,
	 * TASK SET FULL, or RESERVATION CONFLICT status is being returned.
	 * Depending on the status, the additional sense code shall be set to
	 * PREVIOUS BUSY STATUS, PREVIOUS TASK SET FULL STATUS, or PREVIOUS
	 * RESERVATION CONFLICT STATUS. Until it is cleared by a REQUEST SENSE
	 * command, a unit attention condition shall be established only once
	 * for a BUSY, TASK SET FULL, or RESERVATION CONFLICT status regardless
	 * to the number of commands completed with one of those status codes.
	 */
822 823
	p[4] = (dev->dev_attrib.emulate_ua_intlck_ctrl == 2) ? 0x30 :
	       (dev->dev_attrib.emulate_ua_intlck_ctrl == 1) ? 0x20 : 0x00;
824 825 826 827 828 829 830 831 832 833 834 835
	/*
	 * From spc4r17, section 7.4.6 Control mode Page
	 *
	 * Task Aborted Status (TAS) bit set to zero.
	 *
	 * A task aborted status (TAS) bit set to zero specifies that aborted
	 * tasks shall be terminated by the device server without any response
	 * to the application client. A TAS bit set to one specifies that tasks
	 * aborted by the actions of an I_T nexus other than the I_T nexus on
	 * which the command was received shall be completed with TASK ABORTED
	 * status (see SAM-4).
	 */
836
	p[5] = (dev->dev_attrib.emulate_tas) ? 0x40 : 0x00;
837 838 839 840 841 842 843 844 845 846
	/*
	 * From spc4r30, section 7.5.7 Control mode page
	 *
	 * Application Tag Owner (ATO) bit set to one.
	 *
	 * If the ATO bit is set to one the device server shall not modify the
	 * LOGICAL BLOCK APPLICATION TAG field and, depending on the protection
	 * type, shall not modify the contents of the LOGICAL BLOCK REFERENCE
	 * TAG field.
	 */
847
	if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) {
848
		if (dev->dev_attrib.pi_prot_type || sess->sess_prot_type)
849 850
			p[5] |= 0x80;
	}
851

852 853 854 855
	p[8] = 0xff;
	p[9] = 0xff;
	p[11] = 30;

856
out:
857 858 859
	return 12;
}

860
static int spc_modesense_caching(struct se_cmd *cmd, u8 pc, u8 *p)
861
{
862 863
	struct se_device *dev = cmd->se_dev;

864 865
	p[0] = 0x08;
	p[1] = 0x12;
866 867 868 869 870

	/* No changeable values for now */
	if (pc == 1)
		goto out;

871
	if (target_check_wce(dev))
872 873 874
		p[2] = 0x04; /* Write Cache Enable */
	p[12] = 0x20; /* Disabled Read Ahead */

875
out:
876 877 878
	return 20;
}

879
static int spc_modesense_informational_exceptions(struct se_cmd *cmd, u8 pc, unsigned char *p)
880 881 882 883 884 885 886 887 888 889 890 891
{
	p[0] = 0x1c;
	p[1] = 0x0a;

	/* No changeable values for now */
	if (pc == 1)
		goto out;

out:
	return 12;
}

892 893 894
static struct {
	uint8_t		page;
	uint8_t		subpage;
895
	int		(*emulate)(struct se_cmd *, u8, unsigned char *);
896 897 898 899
} modesense_handlers[] = {
	{ .page = 0x01, .subpage = 0x00, .emulate = spc_modesense_rwrecovery },
	{ .page = 0x08, .subpage = 0x00, .emulate = spc_modesense_caching },
	{ .page = 0x0a, .subpage = 0x00, .emulate = spc_modesense_control },
900
	{ .page = 0x1c, .subpage = 0x00, .emulate = spc_modesense_informational_exceptions },
901 902
};

903 904 905 906 907 908 909 910 911 912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928
static void spc_modesense_write_protect(unsigned char *buf, int type)
{
	/*
	 * I believe that the WP bit (bit 7) in the mode header is the same for
	 * all device types..
	 */
	switch (type) {
	case TYPE_DISK:
	case TYPE_TAPE:
	default:
		buf[0] |= 0x80; /* WP bit */
		break;
	}
}

static void spc_modesense_dpofua(unsigned char *buf, int type)
{
	switch (type) {
	case TYPE_DISK:
		buf[0] |= 0x10; /* DPOFUA bit */
		break;
	default:
		break;
	}
}

929 930 931 932 933 934 935 936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952
static int spc_modesense_blockdesc(unsigned char *buf, u64 blocks, u32 block_size)
{
	*buf++ = 8;
	put_unaligned_be32(min(blocks, 0xffffffffull), buf);
	buf += 4;
	put_unaligned_be32(block_size, buf);
	return 9;
}

static int spc_modesense_long_blockdesc(unsigned char *buf, u64 blocks, u32 block_size)
{
	if (blocks <= 0xffffffff)
		return spc_modesense_blockdesc(buf + 3, blocks, block_size) + 3;

	*buf++ = 1;		/* LONGLBA */
	buf += 2;
	*buf++ = 16;
	put_unaligned_be64(blocks, buf);
	buf += 12;
	put_unaligned_be32(block_size, buf);

	return 17;
}

953
static sense_reason_t spc_emulate_modesense(struct se_cmd *cmd)
954 955 956
{
	struct se_device *dev = cmd->se_dev;
	char *cdb = cmd->t_task_cdb;
957
	unsigned char buf[SE_MODE_PAGE_BUF], *rbuf;
958 959
	int type = dev->transport->get_device_type(dev);
	int ten = (cmd->t_task_cdb[0] == MODE_SENSE_10);
960 961 962 963 964
	bool dbd = !!(cdb[1] & 0x08);
	bool llba = ten ? !!(cdb[1] & 0x10) : false;
	u8 pc = cdb[2] >> 6;
	u8 page = cdb[2] & 0x3f;
	u8 subpage = cdb[3];
965
	int length = 0;
966 967
	int ret;
	int i;
968
	bool read_only = target_lun_is_rdonly(cmd);;
969

970 971
	memset(buf, 0, SE_MODE_PAGE_BUF);

972 973 974 975 976
	/*
	 * Skip over MODE DATA LENGTH + MEDIUM TYPE fields to byte 3 for
	 * MODE_SENSE_10 and byte 2 for MODE_SENSE (6).
	 */
	length = ten ? 3 : 2;
977 978

	/* DEVICE-SPECIFIC PARAMETER */
979
	if ((cmd->se_lun->lun_access & TRANSPORT_LUNFLAGS_READ_ONLY) || read_only)
980 981
		spc_modesense_write_protect(&buf[length], type);

982 983 984 985 986 987
	/*
	 * SBC only allows us to enable FUA and DPO together.  Fortunately
	 * DPO is explicitly specified as a hint, so a noop is a perfectly
	 * valid implementation.
	 */
	if (target_check_fua(dev))
988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014
		spc_modesense_dpofua(&buf[length], type);

	++length;

	/* BLOCK DESCRIPTOR */

	/*
	 * For now we only include a block descriptor for disk (SBC)
	 * devices; other command sets use a slightly different format.
	 */
	if (!dbd && type == TYPE_DISK) {
		u64 blocks = dev->transport->get_blocks(dev);
		u32 block_size = dev->dev_attrib.block_size;

		if (ten) {
			if (llba) {
				length += spc_modesense_long_blockdesc(&buf[length],
								       blocks, block_size);
			} else {
				length += 3;
				length += spc_modesense_blockdesc(&buf[length],
								  blocks, block_size);
			}
		} else {
			length += spc_modesense_blockdesc(&buf[length], blocks,
							  block_size);
		}
1015
	} else {
1016 1017 1018 1019
		if (ten)
			length += 4;
		else
			length += 1;
1020 1021
	}

1022 1023
	if (page == 0x3f) {
		if (subpage != 0x00 && subpage != 0xff) {
1024 1025
			pr_warn("MODE_SENSE: Invalid subpage code: 0x%02x\n", subpage);
			return TCM_INVALID_CDB_FIELD;
1026 1027 1028 1029 1030 1031 1032 1033 1034 1035
		}

		for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i) {
			/*
			 * Tricky way to say all subpage 00h for
			 * subpage==0, all subpages for subpage==0xff
			 * (and we just checked above that those are
			 * the only two possibilities).
			 */
			if ((modesense_handlers[i].subpage & ~subpage) == 0) {
1036
				ret = modesense_handlers[i].emulate(cmd, pc, &buf[length]);
1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048
				if (!ten && length + ret >= 255)
					break;
				length += ret;
			}
		}

		goto set_length;
	}

	for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i)
		if (modesense_handlers[i].page == page &&
		    modesense_handlers[i].subpage == subpage) {
1049
			length += modesense_handlers[i].emulate(cmd, pc, &buf[length]);
1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060
			goto set_length;
		}

	/*
	 * We don't intend to implement:
	 *  - obsolete page 03h "format parameters" (checked by Solaris)
	 */
	if (page != 0x03)
		pr_err("MODE SENSE: unimplemented page/subpage: 0x%02x/0x%02x\n",
		       page, subpage);

1061
	return TCM_UNKNOWN_MODE_PAGE;
1062 1063 1064 1065 1066 1067 1068

set_length:
	if (ten)
		put_unaligned_be16(length - 2, buf);
	else
		buf[0] = length - 1;

1069 1070 1071 1072
	rbuf = transport_kmap_data_sg(cmd);
	if (rbuf) {
		memcpy(rbuf, buf, min_t(u32, SE_MODE_PAGE_BUF, cmd->data_length));
		transport_kunmap_data_sg(cmd);
1073
	}
1074

1075
	target_complete_cmd_with_length(cmd, GOOD, length);
1076 1077 1078
	return 0;
}

1079
static sense_reason_t spc_emulate_modeselect(struct se_cmd *cmd)
1080 1081 1082 1083 1084 1085 1086 1087 1088
{
	char *cdb = cmd->t_task_cdb;
	bool ten = cdb[0] == MODE_SELECT_10;
	int off = ten ? 8 : 4;
	bool pf = !!(cdb[1] & 0x10);
	u8 page, subpage;
	unsigned char *buf;
	unsigned char tbuf[SE_MODE_PAGE_BUF];
	int length;
1089
	sense_reason_t ret = 0;
1090 1091
	int i;

1092 1093 1094 1095 1096 1097 1098 1099
	if (!cmd->data_length) {
		target_complete_cmd(cmd, GOOD);
		return 0;
	}

	if (cmd->data_length < off + 2)
		return TCM_PARAMETER_LIST_LENGTH_ERROR;

1100
	buf = transport_kmap_data_sg(cmd);
1101 1102
	if (!buf)
		return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
1103 1104

	if (!pf) {
1105
		ret = TCM_INVALID_CDB_FIELD;
1106 1107 1108 1109 1110 1111 1112 1113 1114 1115
		goto out;
	}

	page = buf[off] & 0x3f;
	subpage = buf[off] & 0x40 ? buf[off + 1] : 0;

	for (i = 0; i < ARRAY_SIZE(modesense_handlers); ++i)
		if (modesense_handlers[i].page == page &&
		    modesense_handlers[i].subpage == subpage) {
			memset(tbuf, 0, SE_MODE_PAGE_BUF);
1116
			length = modesense_handlers[i].emulate(cmd, 0, tbuf);
1117 1118 1119
			goto check_contents;
		}

1120
	ret = TCM_UNKNOWN_MODE_PAGE;
1121 1122 1123
	goto out;

check_contents:
1124 1125 1126 1127 1128
	if (cmd->data_length < off + length) {
		ret = TCM_PARAMETER_LIST_LENGTH_ERROR;
		goto out;
	}

1129 1130
	if (memcmp(buf + off, tbuf, length))
		ret = TCM_INVALID_PARAMETER_LIST;
1131 1132 1133 1134 1135 1136 1137 1138 1139

out:
	transport_kunmap_data_sg(cmd);

	if (!ret)
		target_complete_cmd(cmd, GOOD);
	return ret;
}

1140
static sense_reason_t spc_emulate_request_sense(struct se_cmd *cmd)
1141 1142
{
	unsigned char *cdb = cmd->t_task_cdb;
1143
	unsigned char *rbuf;
1144
	u8 ua_asc = 0, ua_ascq = 0;
1145 1146 1147
	unsigned char buf[SE_SENSE_BUF];

	memset(buf, 0, SE_SENSE_BUF);
1148 1149 1150 1151

	if (cdb[1] & 0x01) {
		pr_err("REQUEST_SENSE description emulation not"
			" supported\n");
1152
		return TCM_INVALID_CDB_FIELD;
1153 1154
	}

1155
	rbuf = transport_kmap_data_sg(cmd);
1156 1157 1158 1159
	if (!rbuf)
		return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;

	if (!core_scsi3_ua_clear_for_request_sense(cmd, &ua_asc, &ua_ascq)) {
1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173 1174 1175 1176 1177 1178 1179 1180 1181 1182 1183 1184 1185
		/*
		 * CURRENT ERROR, UNIT ATTENTION
		 */
		buf[0] = 0x70;
		buf[SPC_SENSE_KEY_OFFSET] = UNIT_ATTENTION;

		/*
		 * The Additional Sense Code (ASC) from the UNIT ATTENTION
		 */
		buf[SPC_ASC_KEY_OFFSET] = ua_asc;
		buf[SPC_ASCQ_KEY_OFFSET] = ua_ascq;
		buf[7] = 0x0A;
	} else {
		/*
		 * CURRENT ERROR, NO SENSE
		 */
		buf[0] = 0x70;
		buf[SPC_SENSE_KEY_OFFSET] = NO_SENSE;

		/*
		 * NO ADDITIONAL SENSE INFORMATION
		 */
		buf[SPC_ASC_KEY_OFFSET] = 0x00;
		buf[7] = 0x0A;
	}

1186 1187
	memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length));
	transport_kunmap_data_sg(cmd);
1188

1189 1190 1191 1192
	target_complete_cmd(cmd, GOOD);
	return 0;
}

1193
sense_reason_t spc_emulate_report_luns(struct se_cmd *cmd)
1194 1195 1196
{
	struct se_dev_entry *deve;
	struct se_session *sess = cmd->se_sess;
1197
	struct se_node_acl *nacl;
1198
	unsigned char *buf;
1199
	u32 lun_count = 0, offset = 8;
1200 1201 1202 1203

	if (cmd->data_length < 16) {
		pr_warn("REPORT LUNS allocation length %u too small\n",
			cmd->data_length);
1204
		return TCM_INVALID_CDB_FIELD;
1205 1206 1207 1208
	}

	buf = transport_kmap_data_sg(cmd);
	if (!buf)
1209
		return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220

	/*
	 * If no struct se_session pointer is present, this struct se_cmd is
	 * coming via a target_core_mod PASSTHROUGH op, and not through
	 * a $FABRIC_MOD.  In that case, report LUN=0 only.
	 */
	if (!sess) {
		int_to_scsilun(0, (struct scsi_lun *)&buf[offset]);
		lun_count = 1;
		goto done;
	}
1221
	nacl = sess->se_node_acl;
1222

1223 1224
	rcu_read_lock();
	hlist_for_each_entry_rcu(deve, &nacl->lun_entry_hlist, link) {
1225 1226 1227 1228 1229 1230 1231 1232 1233 1234 1235 1236
		/*
		 * We determine the correct LUN LIST LENGTH even once we
		 * have reached the initial allocation length.
		 * See SPC2-R20 7.19.
		 */
		lun_count++;
		if ((offset + 8) > cmd->data_length)
			continue;

		int_to_scsilun(deve->mapped_lun, (struct scsi_lun *)&buf[offset]);
		offset += 8;
	}
1237
	rcu_read_unlock();
1238 1239 1240 1241 1242 1243 1244 1245 1246 1247 1248 1249

	/*
	 * See SPC3 r07, page 159.
	 */
done:
	lun_count *= 8;
	buf[0] = ((lun_count >> 24) & 0xff);
	buf[1] = ((lun_count >> 16) & 0xff);
	buf[2] = ((lun_count >> 8) & 0xff);
	buf[3] = (lun_count & 0xff);
	transport_kunmap_data_sg(cmd);

1250
	target_complete_cmd_with_length(cmd, GOOD, 8 + lun_count * 8);
1251 1252
	return 0;
}
1253
EXPORT_SYMBOL(spc_emulate_report_luns);
1254

1255 1256
static sense_reason_t
spc_emulate_testunitready(struct se_cmd *cmd)
1257 1258 1259 1260 1261
{
	target_complete_cmd(cmd, GOOD);
	return 0;
}

1262 1263
sense_reason_t
spc_parse_cdb(struct se_cmd *cmd, unsigned int *size)
1264
{
1265
	struct se_device *dev = cmd->se_dev;
1266 1267 1268 1269 1270
	unsigned char *cdb = cmd->t_task_cdb;

	switch (cdb[0]) {
	case MODE_SELECT:
		*size = cdb[4];
1271
		cmd->execute_cmd = spc_emulate_modeselect;
1272 1273 1274
		break;
	case MODE_SELECT_10:
		*size = (cdb[7] << 8) + cdb[8];
1275
		cmd->execute_cmd = spc_emulate_modeselect;
1276 1277 1278
		break;
	case MODE_SENSE:
		*size = cdb[4];
1279
		cmd->execute_cmd = spc_emulate_modesense;
1280 1281 1282
		break;
	case MODE_SENSE_10:
		*size = (cdb[7] << 8) + cdb[8];
1283
		cmd->execute_cmd = spc_emulate_modesense;
1284 1285 1286 1287 1288 1289 1290
		break;
	case LOG_SELECT:
	case LOG_SENSE:
		*size = (cdb[7] << 8) + cdb[8];
		break;
	case PERSISTENT_RESERVE_IN:
		*size = (cdb[7] << 8) + cdb[8];
1291
		cmd->execute_cmd = target_scsi3_emulate_pr_in;
1292 1293 1294
		break;
	case PERSISTENT_RESERVE_OUT:
		*size = (cdb[7] << 8) + cdb[8];
1295
		cmd->execute_cmd = target_scsi3_emulate_pr_out;
1296 1297 1298 1299 1300 1301 1302 1303
		break;
	case RELEASE:
	case RELEASE_10:
		if (cdb[0] == RELEASE_10)
			*size = (cdb[7] << 8) | cdb[8];
		else
			*size = cmd->data_length;

1304
		cmd->execute_cmd = target_scsi2_reservation_release;
1305 1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316
		break;
	case RESERVE:
	case RESERVE_10:
		/*
		 * The SPC-2 RESERVE does not contain a size in the SCSI CDB.
		 * Assume the passthrough or $FABRIC_MOD will tell us about it.
		 */
		if (cdb[0] == RESERVE_10)
			*size = (cdb[7] << 8) | cdb[8];
		else
			*size = cmd->data_length;

1317
		cmd->execute_cmd = target_scsi2_reservation_reserve;
1318 1319 1320
		break;
	case REQUEST_SENSE:
		*size = cdb[4];
1321
		cmd->execute_cmd = spc_emulate_request_sense;
1322 1323 1324 1325 1326
		break;
	case INQUIRY:
		*size = (cdb[3] << 8) + cdb[4];

		/*
1327
		 * Do implicit HEAD_OF_QUEUE processing for INQUIRY.
1328 1329
		 * See spc4r17 section 5.3
		 */
C
Christoph Hellwig 已提交
1330
		cmd->sam_task_attr = TCM_HEAD_TAG;
1331
		cmd->execute_cmd = spc_emulate_inquiry;
1332 1333 1334 1335 1336 1337
		break;
	case SECURITY_PROTOCOL_IN:
	case SECURITY_PROTOCOL_OUT:
		*size = (cdb[6] << 24) | (cdb[7] << 16) | (cdb[8] << 8) | cdb[9];
		break;
	case EXTENDED_COPY:
1338 1339 1340
		*size = get_unaligned_be32(&cdb[10]);
		cmd->execute_cmd = target_do_xcopy;
		break;
1341
	case RECEIVE_COPY_RESULTS:
1342 1343 1344 1345
		*size = get_unaligned_be32(&cdb[10]);
		cmd->execute_cmd = target_do_receive_copy_results;
		break;
	case READ_ATTRIBUTE:
1346 1347 1348 1349 1350 1351 1352 1353 1354 1355 1356 1357
	case WRITE_ATTRIBUTE:
		*size = (cdb[10] << 24) | (cdb[11] << 16) |
		       (cdb[12] << 8) | cdb[13];
		break;
	case RECEIVE_DIAGNOSTIC:
	case SEND_DIAGNOSTIC:
		*size = (cdb[3] << 8) | cdb[4];
		break;
	case WRITE_BUFFER:
		*size = (cdb[6] << 16) + (cdb[7] << 8) + cdb[8];
		break;
	case REPORT_LUNS:
1358
		cmd->execute_cmd = spc_emulate_report_luns;
1359 1360
		*size = (cdb[6] << 24) | (cdb[7] << 16) | (cdb[8] << 8) | cdb[9];
		/*
1361
		 * Do implicit HEAD_OF_QUEUE processing for REPORT_LUNS
1362 1363
		 * See spc4r17 section 5.3
		 */
C
Christoph Hellwig 已提交
1364
		cmd->sam_task_attr = TCM_HEAD_TAG;
1365 1366
		break;
	case TEST_UNIT_READY:
1367
		cmd->execute_cmd = spc_emulate_testunitready;
1368
		*size = 0;
1369
		break;
1370 1371 1372 1373 1374 1375
	case MAINTENANCE_IN:
		if (dev->transport->get_device_type(dev) != TYPE_ROM) {
			/*
			 * MAINTENANCE_IN from SCC-2
			 * Check for emulated MI_REPORT_TARGET_PGS
			 */
C
Christoph Hellwig 已提交
1376
			if ((cdb[1] & 0x1f) == MI_REPORT_TARGET_PGS) {
1377 1378 1379 1380 1381 1382 1383 1384 1385 1386 1387 1388 1389 1390 1391 1392 1393
				cmd->execute_cmd =
					target_emulate_report_target_port_groups;
			}
			*size = get_unaligned_be32(&cdb[6]);
		} else {
			/*
			 * GPCMD_SEND_KEY from multi media commands
			 */
			*size = get_unaligned_be16(&cdb[8]);
		}
		break;
	case MAINTENANCE_OUT:
		if (dev->transport->get_device_type(dev) != TYPE_ROM) {
			/*
			 * MAINTENANCE_OUT from SCC-2
			 * Check for emulated MO_SET_TARGET_PGS.
			 */
C
Christoph Hellwig 已提交
1394
			if (cdb[1] == MO_SET_TARGET_PGS) {
1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405
				cmd->execute_cmd =
					target_emulate_set_target_port_groups;
			}
			*size = get_unaligned_be32(&cdb[6]);
		} else {
			/*
			 * GPCMD_SEND_KEY from multi media commands
			 */
			*size = get_unaligned_be16(&cdb[8]);
		}
		break;
1406 1407 1408 1409
	default:
		pr_warn("TARGET_CORE[%s]: Unsupported SCSI Opcode"
			" 0x%02x, sending CHECK_CONDITION.\n",
			cmd->se_tfo->get_fabric_name(), cdb[0]);
1410
		return TCM_UNSUPPORTED_SCSI_OPCODE;
1411 1412 1413 1414 1415
	}

	return 0;
}
EXPORT_SYMBOL(spc_parse_cdb);