[ceph.git] / ceph / src / spdk / dpdk / examples / vhost_scsi / scsi.c

/* SPDX-License-Identifier: BSD-3-Clause
 * Copyright(c) 2010-2017 Intel Corporation
 */

/**
 * This work is largely based on the "vhost-user-scsi" implementation by
 * SPDK(https://github.com/spdk/spdk).
 */

#include <stdio.h>
#include <stdint.h>
#include <unistd.h>
#include <assert.h>
#include <ctype.h>
#include <string.h>
#include <stddef.h>

#include <rte_atomic.h>
#include <rte_cycles.h>
#include <rte_log.h>
#include <rte_malloc.h>
#include <rte_byteorder.h>
#include <rte_string_fns.h>

#include "vhost_scsi.h"
#include "scsi_spec.h"

#define INQ_OFFSET(field) (offsetof(struct scsi_cdb_inquiry_data, field) + \
			  sizeof(((struct scsi_cdb_inquiry_data *)0x0)->field))

static void
vhost_strcpy_pad(void *dst, const char *src, size_t size, int pad)
{
	size_t len;

	len = strlen(src);
	if (len < size) {
		memcpy(dst, src, len);
		memset((char *)dst + len, pad, size - len);
	} else {
		memcpy(dst, src, size);
	}
}

static int
vhost_hex2bin(char ch)
{
	if ((ch >= '0') && (ch <= '9'))
		return ch - '0';
	ch = tolower(ch);
	if ((ch >= 'a') && (ch <= 'f'))
		return ch - 'a' + 10;
	return (int)ch;
}

static void
vhost_bdev_scsi_set_naa_ieee_extended(const char *name, uint8_t *buf)
{
	int i, value, count = 0;
	uint64_t *temp64, local_value;

	for (i = 0; (i < 16) && (name[i] != '\0'); i++) {
		value = vhost_hex2bin(name[i]);
		if (i % 2)
			buf[count++] |= value << 4;
		else
			buf[count] = value;
	}

	local_value = *(uint64_t *)buf;
	/*
	 * see spc3r23 7.6.3.6.2,
	 *  NAA IEEE Extended identifer format
	 */
	local_value &= 0x0fff000000ffffffull;
	/* NAA 02, and 00 03 47 for IEEE Intel */
	local_value |= 0x2000000347000000ull;

	temp64 = (uint64_t *)buf;
	*temp64 = rte_cpu_to_be_64(local_value);
}

static void
scsi_task_build_sense_data(struct vhost_scsi_task *task, int sk,
			   int asc, int ascq)
{
	uint8_t *cp;
	int resp_code;

	resp_code = 0x70; /* Current + Fixed format */

	/* Sense Data */
	cp = (uint8_t *)task->resp->sense;

	/* VALID(7) RESPONSE CODE(6-0) */
	cp[0] = 0x80 | resp_code;
	/* Obsolete */
	cp[1] = 0;
	/* FILEMARK(7) EOM(6) ILI(5) SENSE KEY(3-0) */
	cp[2] = sk & 0xf;
	/* INFORMATION */
	memset(&cp[3], 0, 4);

	/* ADDITIONAL SENSE LENGTH */
	cp[7] = 10;

	/* COMMAND-SPECIFIC INFORMATION */
	memset(&cp[8], 0, 4);
	/* ADDITIONAL SENSE CODE */
	cp[12] = asc;
	/* ADDITIONAL SENSE CODE QUALIFIER */
	cp[13] = ascq;
	/* FIELD REPLACEABLE UNIT CODE */
	cp[14] = 0;

	/* SKSV(7) SENSE KEY SPECIFIC(6-0,7-0,7-0) */
	cp[15] = 0;
	cp[16] = 0;
	cp[17] = 0;

	/* SenseLength */
	task->resp->sense_len = 18;
}

static void
scsi_task_set_status(struct vhost_scsi_task *task, int sc, int sk,
		     int asc, int ascq)
{
	if (sc == SCSI_STATUS_CHECK_CONDITION)
		scsi_task_build_sense_data(task, sk, asc, ascq);
	task->resp->status = sc;
}

static int
vhost_bdev_scsi_inquiry_command(struct vhost_block_dev *bdev,
				struct vhost_scsi_task *task)
{
	int hlen = 0;
	uint32_t alloc_len = 0;
	uint16_t len = 0;
	uint16_t *temp16;
	int pc;
	int pd;
	int evpd;
	int i;
	uint8_t *buf;
	struct scsi_cdb_inquiry *inq;

	inq = (struct scsi_cdb_inquiry *)task->req->cdb;

	assert(task->iovs_cnt == 1);

	/* At least 36Bytes for inquiry command */
	if (task->data_len < 0x24)
		goto inq_error;

	pd = SPC_PERIPHERAL_DEVICE_TYPE_DISK;
	pc = inq->page_code;
	evpd = inq->evpd & 0x1;

	if (!evpd && pc)
		goto inq_error;

	if (evpd) {
		struct scsi_vpd_page *vpage = (struct scsi_vpd_page *)
					      task->iovs[0].iov_base;

		/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
		vpage->peripheral = pd;
		/* PAGE CODE */
		vpage->page_code = pc;

		switch (pc) {
		case SPC_VPD_SUPPORTED_VPD_PAGES:
			hlen = 4;
			vpage->params[0] = SPC_VPD_SUPPORTED_VPD_PAGES;
			vpage->params[1] = SPC_VPD_UNIT_SERIAL_NUMBER;
			vpage->params[2] = SPC_VPD_DEVICE_IDENTIFICATION;
			len = 3;
			/* PAGE LENGTH */
			vpage->alloc_len = rte_cpu_to_be_16(len);
			break;
		case SPC_VPD_UNIT_SERIAL_NUMBER:
			hlen = 4;
			strlcpy((char *)vpage->params, bdev->name,
					sizeof(vpage->params));
			vpage->alloc_len = rte_cpu_to_be_16(32);
			break;
		case SPC_VPD_DEVICE_IDENTIFICATION:
			buf = vpage->params;
			struct scsi_desig_desc *desig;

			hlen = 4;
			/* NAA designator */
			desig = (struct scsi_desig_desc *)buf;
			desig->code_set = SPC_VPD_CODE_SET_BINARY;
			desig->protocol_id = SPC_PROTOCOL_IDENTIFIER_ISCSI;
			desig->type = SPC_VPD_IDENTIFIER_TYPE_NAA;
			desig->association = SPC_VPD_ASSOCIATION_LOGICAL_UNIT;
			desig->reserved0 = 0;
			desig->piv = 1;
			desig->reserved1 = 0;
			desig->len = 8;
			vhost_bdev_scsi_set_naa_ieee_extended(bdev->name,
							      desig->desig);
			len = sizeof(struct scsi_desig_desc) + 8;

			buf += sizeof(struct scsi_desig_desc) + desig->len;

			/* T10 Vendor ID designator */
			desig = (struct scsi_desig_desc *)buf;
			desig->code_set = SPC_VPD_CODE_SET_ASCII;
			desig->protocol_id = SPC_PROTOCOL_IDENTIFIER_ISCSI;
			desig->type = SPC_VPD_IDENTIFIER_TYPE_T10_VENDOR_ID;
			desig->association = SPC_VPD_ASSOCIATION_LOGICAL_UNIT;
			desig->reserved0 = 0;
			desig->piv = 1;
			desig->reserved1 = 0;
			desig->len = 8 + 16 + 32;
			strlcpy((char *)desig->desig, "INTEL", 8);
			vhost_strcpy_pad((char *)&desig->desig[8],
					 bdev->product_name, 16, ' ');
			strlcpy((char *)&desig->desig[24], bdev->name, 32);
			len += sizeof(struct scsi_desig_desc) + 8 + 16 + 32;

			buf += sizeof(struct scsi_desig_desc) + desig->len;

			/* SCSI Device Name designator */
			desig = (struct scsi_desig_desc *)buf;
			desig->code_set = SPC_VPD_CODE_SET_UTF8;
			desig->protocol_id = SPC_PROTOCOL_IDENTIFIER_ISCSI;
			desig->type = SPC_VPD_IDENTIFIER_TYPE_SCSI_NAME;
			desig->association = SPC_VPD_ASSOCIATION_TARGET_DEVICE;
			desig->reserved0 = 0;
			desig->piv = 1;
			desig->reserved1 = 0;
			desig->len = strlcpy((char *)desig->desig, bdev->name,
					     255);
			len += sizeof(struct scsi_desig_desc) + desig->len;

			buf += sizeof(struct scsi_desig_desc) + desig->len;
			vpage->alloc_len = rte_cpu_to_be_16(len);
			break;
		default:
			goto inq_error;
		}

	} else {
		struct scsi_cdb_inquiry_data *inqdata =
			(struct scsi_cdb_inquiry_data *)task->iovs[0].iov_base;
		/* Standard INQUIRY data */
		/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
		inqdata->peripheral = pd;

		/* RMB(7) */
		inqdata->rmb = 0;

		/* VERSION */
		/* See SPC3/SBC2/MMC4/SAM2 for more details */
		inqdata->version = SPC_VERSION_SPC3;

		/* NORMACA(5) HISUP(4) RESPONSE DATA FORMAT(3-0) */
		/* format 2 */ /* hierarchical support */
		inqdata->response = 2 | 1 << 4;

		hlen = 5;

		/* SCCS(7) ACC(6) TPGS(5-4) 3PC(3) PROTECT(0) */
		/* Not support TPGS */
		inqdata->flags = 0;

		/* MULTIP */
		inqdata->flags2 = 0x10;

		/* WBUS16(5) SYNC(4) LINKED(3) CMDQUE(1) VS(0) */
		/* CMDQUE */
		inqdata->flags3 = 0x2;

		/* T10 VENDOR IDENTIFICATION */
		strlcpy((char *)inqdata->t10_vendor_id, "INTEL",
			sizeof(inqdata->t10_vendor_id));

		/* PRODUCT IDENTIFICATION */
		strlcpy((char *)inqdata->product_id, bdev->product_name,
			RTE_DIM(inqdata->product_id));

		/* PRODUCT REVISION LEVEL */
		strlcpy((char *)inqdata->product_rev, "0001",
			sizeof(inqdata->product_rev));

		/* Standard inquiry data ends here. Only populate
		 * remaining fields if alloc_len indicates enough
		 * space to hold it.
		 */
		len = INQ_OFFSET(product_rev) - 5;

		if (alloc_len >= INQ_OFFSET(vendor)) {
			/* Vendor specific */
			memset(inqdata->vendor, 0x20, 20);
			len += sizeof(inqdata->vendor);
		}

		if (alloc_len >= INQ_OFFSET(ius)) {
			/* CLOCKING(3-2) QAS(1) IUS(0) */
			inqdata->ius = 0;
			len += sizeof(inqdata->ius);
		}

		if (alloc_len >= INQ_OFFSET(reserved)) {
			/* Reserved */
			inqdata->reserved = 0;
			len += sizeof(inqdata->reserved);
		}

		/* VERSION DESCRIPTOR 1-8 */
		if (alloc_len >= INQ_OFFSET(reserved) + 2) {
			temp16 = (uint16_t *)&inqdata->desc[0];
			*temp16 = rte_cpu_to_be_16(0x0960);
			len += 2;
		}

		if (alloc_len >= INQ_OFFSET(reserved) + 4) {
			/* SPC-3 (no version claimed) */
			temp16 = (uint16_t *)&inqdata->desc[2];
			*temp16 = rte_cpu_to_be_16(0x0300);
			len += 2;
		}

		if (alloc_len >= INQ_OFFSET(reserved) + 6) {
			/* SBC-2 (no version claimed) */
			temp16 = (uint16_t *)&inqdata->desc[4];
			*temp16 = rte_cpu_to_be_16(0x0320);
			len += 2;
		}

		if (alloc_len >= INQ_OFFSET(reserved) + 8) {
			/* SAM-2 (no version claimed) */
			temp16 = (uint16_t *)&inqdata->desc[6];
			*temp16 = rte_cpu_to_be_16(0x0040);
			len += 2;
		}

		if (alloc_len > INQ_OFFSET(reserved) + 8) {
			i = alloc_len - (INQ_OFFSET(reserved) + 8);
			if (i > 30)
				i = 30;
			memset(&inqdata->desc[8], 0, i);
			len += i;
		}

		/* ADDITIONAL LENGTH */
		inqdata->add_len = len;
	}

	/* STATUS GOOD */
	scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
	return hlen + len;

inq_error:
	scsi_task_set_status(task, SCSI_STATUS_CHECK_CONDITION,
				     SCSI_SENSE_ILLEGAL_REQUEST,
				     SCSI_ASC_INVALID_FIELD_IN_CDB,
				     SCSI_ASCQ_CAUSE_NOT_REPORTABLE);
	return 0;
}

static int
vhost_bdev_scsi_readwrite(struct vhost_block_dev *bdev,
			  struct vhost_scsi_task *task,
			  uint64_t lba, __rte_unused uint32_t xfer_len)
{
	uint32_t i;
	uint64_t offset;
	uint32_t nbytes = 0;

	offset = lba * bdev->blocklen;

	for (i = 0; i < task->iovs_cnt; i++) {
		if (task->dxfer_dir == SCSI_DIR_TO_DEV)
			memcpy(bdev->data + offset, task->iovs[i].iov_base,
			       task->iovs[i].iov_len);
		else
			memcpy(task->iovs[i].iov_base, bdev->data + offset,
			       task->iovs[i].iov_len);
		offset += task->iovs[i].iov_len;
		nbytes += task->iovs[i].iov_len;
	}

	return nbytes;
}

static int
vhost_bdev_scsi_process_block(struct vhost_block_dev *bdev,
			      struct vhost_scsi_task *task)
{
	uint64_t lba, *temp64;
	uint32_t xfer_len, *temp32;
	uint16_t *temp16;
	uint8_t *cdb = (uint8_t *)task->req->cdb;

	switch (cdb[0]) {
	case SBC_READ_6:
	case SBC_WRITE_6:
		lba = (uint64_t)cdb[1] << 16;
		lba |= (uint64_t)cdb[2] << 8;
		lba |= (uint64_t)cdb[3];
		xfer_len = cdb[4];
		if (xfer_len == 0)
			xfer_len = 256;
		return vhost_bdev_scsi_readwrite(bdev, task, lba, xfer_len);

	case SBC_READ_10:
	case SBC_WRITE_10:
		temp32 = (uint32_t *)&cdb[2];
		lba = rte_be_to_cpu_32(*temp32);
		temp16 = (uint16_t *)&cdb[7];
		xfer_len = rte_be_to_cpu_16(*temp16);
		return vhost_bdev_scsi_readwrite(bdev, task, lba, xfer_len);

	case SBC_READ_12:
	case SBC_WRITE_12:
		temp32 = (uint32_t *)&cdb[2];
		lba = rte_be_to_cpu_32(*temp32);
		temp32 = (uint32_t *)&cdb[6];
		xfer_len = rte_be_to_cpu_32(*temp32);
		return vhost_bdev_scsi_readwrite(bdev, task, lba, xfer_len);

	case SBC_READ_16:
	case SBC_WRITE_16:
		temp64 = (uint64_t *)&cdb[2];
		lba = rte_be_to_cpu_64(*temp64);
		temp32 = (uint32_t *)&cdb[10];
		xfer_len = rte_be_to_cpu_32(*temp32);
		return vhost_bdev_scsi_readwrite(bdev, task, lba, xfer_len);

	case SBC_READ_CAPACITY_10: {
		uint8_t buffer[8];

		if (bdev->blockcnt - 1 > 0xffffffffULL)
			memset(buffer, 0xff, 4);
		else {
			temp32 = (uint32_t *)buffer;
			*temp32 = rte_cpu_to_be_32(bdev->blockcnt - 1);
		}
		temp32 = (uint32_t *)&buffer[4];
		*temp32 = rte_cpu_to_be_32(bdev->blocklen);
		memcpy(task->iovs[0].iov_base, buffer, sizeof(buffer));
		task->resp->status = SCSI_STATUS_GOOD;
		return sizeof(buffer);
	}

	case SBC_SYNCHRONIZE_CACHE_10:
	case SBC_SYNCHRONIZE_CACHE_16:
		task->resp->status = SCSI_STATUS_GOOD;
		return 0;
	}

	scsi_task_set_status(task, SCSI_STATUS_CHECK_CONDITION,
			     SCSI_SENSE_ILLEGAL_REQUEST,
			     SCSI_ASC_INVALID_FIELD_IN_CDB,
			     SCSI_ASCQ_CAUSE_NOT_REPORTABLE);
	return 0;
}

int
vhost_bdev_process_scsi_commands(struct vhost_block_dev *bdev,
				 struct vhost_scsi_task *task)
{
	int len;
	uint8_t *data;
	uint64_t *temp64, fmt_lun = 0;
	uint32_t *temp32;
	const uint8_t *lun;
	uint8_t *cdb = (uint8_t *)task->req->cdb;

	lun = (const uint8_t *)task->req->lun;
	/* only 1 LUN supported */
	if (lun[0] != 1 || lun[1] >= 1)
		return -1;

	switch (cdb[0]) {
	case SPC_INQUIRY:
		len = vhost_bdev_scsi_inquiry_command(bdev, task);
		task->data_len = len;
		break;
	case SPC_REPORT_LUNS:
		data = (uint8_t *)task->iovs[0].iov_base;
		fmt_lun |= (0x0ULL & 0x00ffULL) << 48;
		temp64 = (uint64_t *)&data[8];
		*temp64 = rte_cpu_to_be_64(fmt_lun);
		temp32 = (uint32_t *)data;
		*temp32 = rte_cpu_to_be_32(8);
		task->data_len = 16;
		scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
		break;
	case SPC_MODE_SELECT_6:
	case SPC_MODE_SELECT_10:
		/* don't support it now */
		scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
		break;
	case SPC_MODE_SENSE_6:
	case SPC_MODE_SENSE_10:
		/* don't support it now */
		scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
		break;
	case SPC_TEST_UNIT_READY:
		scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
		break;
	default:
		len = vhost_bdev_scsi_process_block(bdev, task);
		task->data_len = len;
	}

	return 0;
}
Commit	Line	Data
11fdf7f2 TL	1	/* SPDX-License-Identifier: BSD-3-Clause
	2	* Copyright(c) 2010-2017 Intel Corporation
	3	*/
	4
	5	/**
	6	* This work is largely based on the "vhost-user-scsi" implementation by
	7	* SPDK(https://github.com/spdk/spdk).
	8	*/
	9
	10	#include <stdio.h>
	11	#include <stdint.h>
	12	#include <unistd.h>
	13	#include <assert.h>
	14	#include <ctype.h>
	15	#include <string.h>
	16	#include <stddef.h>
	17
	18	#include <rte_atomic.h>
	19	#include <rte_cycles.h>
	20	#include <rte_log.h>
	21	#include <rte_malloc.h>
	22	#include <rte_byteorder.h>
	23	#include <rte_string_fns.h>
	24
	25	#include "vhost_scsi.h"
	26	#include "scsi_spec.h"
	27
	28	#define INQ_OFFSET(field) (offsetof(struct scsi_cdb_inquiry_data, field) + \
	29	sizeof(((struct scsi_cdb_inquiry_data *)0x0)->field))
	30
	31	static void
	32	vhost_strcpy_pad(void dst, const char src, size_t size, int pad)
	33	{
	34	size_t len;
	35
	36	len = strlen(src);
	37	if (len < size) {
	38	memcpy(dst, src, len);
	39	memset((char *)dst + len, pad, size - len);
	40	} else {
	41	memcpy(dst, src, size);
	42	}
	43	}
	44
	45	static int
	46	vhost_hex2bin(char ch)
	47	{
	48	if ((ch >= '0') && (ch <= '9'))
	49	return ch - '0';
	50	ch = tolower(ch);
	51	if ((ch >= 'a') && (ch <= 'f'))
	52	return ch - 'a' + 10;
	53	return (int)ch;
	54	}
	55
	56	static void
	57	vhost_bdev_scsi_set_naa_ieee_extended(const char name, uint8_t buf)
	58	{
	59	int i, value, count = 0;
	60	uint64_t *temp64, local_value;
	61
	62	for (i = 0; (i < 16) && (name[i] != '\0'); i++) {
	63	value = vhost_hex2bin(name[i]);
	64	if (i % 2)
65	buf[count++] \|= value << 4;
66	else
67	buf[count] = value;
68	}
69
70	local_value = (uint64_t )buf;
71	/*
72	* see spc3r23 7.6.3.6.2,
73	* NAA IEEE Extended identifer format
74	*/
75	local_value &= 0x0fff000000ffffffull;
76	/* NAA 02, and 00 03 47 for IEEE Intel */
77	local_value \|= 0x2000000347000000ull;
78
79	temp64 = (uint64_t *)buf;
80	*temp64 = rte_cpu_to_be_64(local_value);
81	}
82
83	static void
84	scsi_task_build_sense_data(struct vhost_scsi_task *task, int sk,
85	int asc, int ascq)
86	{
87	uint8_t *cp;
88	int resp_code;
89
90	resp_code = 0x70; /* Current + Fixed format */
91
92	/* Sense Data */
93	cp = (uint8_t *)task->resp->sense;
94
95	/* VALID(7) RESPONSE CODE(6-0) */
96	cp[0] = 0x80 \| resp_code;
97	/* Obsolete */
98	cp[1] = 0;
99	/* FILEMARK(7) EOM(6) ILI(5) SENSE KEY(3-0) */
100	cp[2] = sk & 0xf;
101	/* INFORMATION */
102	memset(&cp[3], 0, 4);
103
104	/* ADDITIONAL SENSE LENGTH */
105	cp[7] = 10;
106
107	/* COMMAND-SPECIFIC INFORMATION */
108	memset(&cp[8], 0, 4);
109	/* ADDITIONAL SENSE CODE */
110	cp[12] = asc;
111	/* ADDITIONAL SENSE CODE QUALIFIER */
112	cp[13] = ascq;
113	/* FIELD REPLACEABLE UNIT CODE */
114	cp[14] = 0;
115
116	/* SKSV(7) SENSE KEY SPECIFIC(6-0,7-0,7-0) */
117	cp[15] = 0;
118	cp[16] = 0;
119	cp[17] = 0;
120
121	/* SenseLength */
122	task->resp->sense_len = 18;
123	}
124
125	static void
126	scsi_task_set_status(struct vhost_scsi_task *task, int sc, int sk,
127	int asc, int ascq)
128	{
129	if (sc == SCSI_STATUS_CHECK_CONDITION)
130	scsi_task_build_sense_data(task, sk, asc, ascq);
131	task->resp->status = sc;
132	}
133
134	static int
135	vhost_bdev_scsi_inquiry_command(struct vhost_block_dev *bdev,
136	struct vhost_scsi_task *task)
137	{
138	int hlen = 0;
139	uint32_t alloc_len = 0;
140	uint16_t len = 0;
141	uint16_t *temp16;
142	int pc;
143	int pd;
144	int evpd;
145	int i;
146	uint8_t *buf;
147	struct scsi_cdb_inquiry *inq;
148
149	inq = (struct scsi_cdb_inquiry *)task->req->cdb;
150
151	assert(task->iovs_cnt == 1);
152
153	/* At least 36Bytes for inquiry command */
154	if (task->data_len < 0x24)
155	goto inq_error;
156
157	pd = SPC_PERIPHERAL_DEVICE_TYPE_DISK;
158	pc = inq->page_code;
159	evpd = inq->evpd & 0x1;
160
161	if (!evpd && pc)
162	goto inq_error;
163
164	if (evpd) {
165	struct scsi_vpd_page vpage = (struct scsi_vpd_page )
166	task->iovs[0].iov_base;
167
168	/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
169	vpage->peripheral = pd;
170	/* PAGE CODE */
171	vpage->page_code = pc;
172
173	switch (pc) {
174	case SPC_VPD_SUPPORTED_VPD_PAGES:
175	hlen = 4;
176	vpage->params[0] = SPC_VPD_SUPPORTED_VPD_PAGES;
177	vpage->params[1] = SPC_VPD_UNIT_SERIAL_NUMBER;
178	vpage->params[2] = SPC_VPD_DEVICE_IDENTIFICATION;
179	len = 3;
180	/* PAGE LENGTH */
181	vpage->alloc_len = rte_cpu_to_be_16(len);
182	break;
183	case SPC_VPD_UNIT_SERIAL_NUMBER:
184	hlen = 4;
185	strlcpy((char *)vpage->params, bdev->name,
186	sizeof(vpage->params));
187	vpage->alloc_len = rte_cpu_to_be_16(32);
188	break;
189	case SPC_VPD_DEVICE_IDENTIFICATION:
190	buf = vpage->params;
191	struct scsi_desig_desc *desig;
192
193	hlen = 4;
194	/* NAA designator */
195	desig = (struct scsi_desig_desc *)buf;
196	desig->code_set = SPC_VPD_CODE_SET_BINARY;
197	desig->protocol_id = SPC_PROTOCOL_IDENTIFIER_ISCSI;
198	desig->type = SPC_VPD_IDENTIFIER_TYPE_NAA;
199	desig->association = SPC_VPD_ASSOCIATION_LOGICAL_UNIT;
200	desig->reserved0 = 0;
201	desig->piv = 1;
202	desig->reserved1 = 0;
203	desig->len = 8;
204	vhost_bdev_scsi_set_naa_ieee_extended(bdev->name,
205	desig->desig);
206	len = sizeof(struct scsi_desig_desc) + 8;
207
208	buf += sizeof(struct scsi_desig_desc) + desig->len;
209
210	/* T10 Vendor ID designator */
211	desig = (struct scsi_desig_desc *)buf;
212	desig->code_set = SPC_VPD_CODE_SET_ASCII;
213	desig->protocol_id = SPC_PROTOCOL_IDENTIFIER_ISCSI;
214	desig->type = SPC_VPD_IDENTIFIER_TYPE_T10_VENDOR_ID;
215	desig->association = SPC_VPD_ASSOCIATION_LOGICAL_UNIT;
216	desig->reserved0 = 0;
217	desig->piv = 1;
218	desig->reserved1 = 0;
219	desig->len = 8 + 16 + 32;
220	strlcpy((char *)desig->desig, "INTEL", 8);
221	vhost_strcpy_pad((char *)&desig->desig[8],
222	bdev->product_name, 16, ' ');
223	strlcpy((char *)&desig->desig[24], bdev->name, 32);
224	len += sizeof(struct scsi_desig_desc) + 8 + 16 + 32;
225
226	buf += sizeof(struct scsi_desig_desc) + desig->len;
227
228	/* SCSI Device Name designator */
229	desig = (struct scsi_desig_desc *)buf;
230	desig->code_set = SPC_VPD_CODE_SET_UTF8;
231	desig->protocol_id = SPC_PROTOCOL_IDENTIFIER_ISCSI;
232	desig->type = SPC_VPD_IDENTIFIER_TYPE_SCSI_NAME;
233	desig->association = SPC_VPD_ASSOCIATION_TARGET_DEVICE;
234	desig->reserved0 = 0;
235	desig->piv = 1;
236	desig->reserved1 = 0;
9f95a23c TL	237	desig->len = strlcpy((char *)desig->desig, bdev->name,
9f95a23c TL	238	255);
11fdf7f2 TL	239	len += sizeof(struct scsi_desig_desc) + desig->len;
	240
	241	buf += sizeof(struct scsi_desig_desc) + desig->len;
	242	vpage->alloc_len = rte_cpu_to_be_16(len);
	243	break;
	244	default:
	245	goto inq_error;
	246	}
	247
	248	} else {
	249	struct scsi_cdb_inquiry_data *inqdata =
	250	(struct scsi_cdb_inquiry_data *)task->iovs[0].iov_base;
	251	/* Standard INQUIRY data */
	252	/* PERIPHERAL QUALIFIER(7-5) PERIPHERAL DEVICE TYPE(4-0) */
	253	inqdata->peripheral = pd;
	254
	255	/* RMB(7) */
	256	inqdata->rmb = 0;
	257
	258	/* VERSION */
	259	/* See SPC3/SBC2/MMC4/SAM2 for more details */
	260	inqdata->version = SPC_VERSION_SPC3;
	261
	262	/* NORMACA(5) HISUP(4) RESPONSE DATA FORMAT(3-0) */
	263	/* format 2 / / hierarchical support */
	264	inqdata->response = 2 \| 1 << 4;
	265
	266	hlen = 5;
	267
	268	/* SCCS(7) ACC(6) TPGS(5-4) 3PC(3) PROTECT(0) */
	269	/* Not support TPGS */
	270	inqdata->flags = 0;
	271
	272	/* MULTIP */
	273	inqdata->flags2 = 0x10;
	274
	275	/* WBUS16(5) SYNC(4) LINKED(3) CMDQUE(1) VS(0) */
	276	/* CMDQUE */
	277	inqdata->flags3 = 0x2;
	278
	279	/* T10 VENDOR IDENTIFICATION */
	280	strlcpy((char *)inqdata->t10_vendor_id, "INTEL",
	281	sizeof(inqdata->t10_vendor_id));
	282
	283	/* PRODUCT IDENTIFICATION */
9f95a23c TL	284	strlcpy((char *)inqdata->product_id, bdev->product_name,
9f95a23c TL	285	RTE_DIM(inqdata->product_id));
11fdf7f2 TL	286
	287	/* PRODUCT REVISION LEVEL */
	288	strlcpy((char *)inqdata->product_rev, "0001",
	289	sizeof(inqdata->product_rev));
	290
	291	/* Standard inquiry data ends here. Only populate
	292	* remaining fields if alloc_len indicates enough
	293	* space to hold it.
	294	*/
	295	len = INQ_OFFSET(product_rev) - 5;
	296
	297	if (alloc_len >= INQ_OFFSET(vendor)) {
	298	/* Vendor specific */
	299	memset(inqdata->vendor, 0x20, 20);
	300	len += sizeof(inqdata->vendor);
	301	}
	302
	303	if (alloc_len >= INQ_OFFSET(ius)) {
	304	/* CLOCKING(3-2) QAS(1) IUS(0) */
	305	inqdata->ius = 0;
	306	len += sizeof(inqdata->ius);
	307	}
	308
	309	if (alloc_len >= INQ_OFFSET(reserved)) {
	310	/* Reserved */
	311	inqdata->reserved = 0;
	312	len += sizeof(inqdata->reserved);
	313	}
	314
	315	/* VERSION DESCRIPTOR 1-8 */
	316	if (alloc_len >= INQ_OFFSET(reserved) + 2) {
	317	temp16 = (uint16_t *)&inqdata->desc[0];
	318	*temp16 = rte_cpu_to_be_16(0x0960);
	319	len += 2;
	320	}
	321
	322	if (alloc_len >= INQ_OFFSET(reserved) + 4) {
	323	/* SPC-3 (no version claimed) */
	324	temp16 = (uint16_t *)&inqdata->desc[2];
	325	*temp16 = rte_cpu_to_be_16(0x0300);
	326	len += 2;
	327	}
	328
	329	if (alloc_len >= INQ_OFFSET(reserved) + 6) {
	330	/* SBC-2 (no version claimed) */
	331	temp16 = (uint16_t *)&inqdata->desc[4];
	332	*temp16 = rte_cpu_to_be_16(0x0320);
	333	len += 2;
	334	}
	335
	336	if (alloc_len >= INQ_OFFSET(reserved) + 8) {
	337	/* SAM-2 (no version claimed) */
	338	temp16 = (uint16_t *)&inqdata->desc[6];
	339	*temp16 = rte_cpu_to_be_16(0x0040);
	340	len += 2;
	341	}
	342
	343	if (alloc_len > INQ_OFFSET(reserved) + 8) {
	344	i = alloc_len - (INQ_OFFSET(reserved) + 8);
	345	if (i > 30)
	346	i = 30;
	347	memset(&inqdata->desc[8], 0, i);
	348	len += i;
	349	}
350
351	/* ADDITIONAL LENGTH */
352	inqdata->add_len = len;
353	}
354
355	/* STATUS GOOD */
356	scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
357	return hlen + len;
358
359	inq_error:
360	scsi_task_set_status(task, SCSI_STATUS_CHECK_CONDITION,
361	SCSI_SENSE_ILLEGAL_REQUEST,
362	SCSI_ASC_INVALID_FIELD_IN_CDB,
363	SCSI_ASCQ_CAUSE_NOT_REPORTABLE);
364	return 0;
365	}
366
367	static int
368	vhost_bdev_scsi_readwrite(struct vhost_block_dev *bdev,
369	struct vhost_scsi_task *task,
370	uint64_t lba, __rte_unused uint32_t xfer_len)
371	{
372	uint32_t i;
373	uint64_t offset;
374	uint32_t nbytes = 0;
375
376	offset = lba * bdev->blocklen;
377
378	for (i = 0; i < task->iovs_cnt; i++) {
379	if (task->dxfer_dir == SCSI_DIR_TO_DEV)
380	memcpy(bdev->data + offset, task->iovs[i].iov_base,
381	task->iovs[i].iov_len);
382	else
383	memcpy(task->iovs[i].iov_base, bdev->data + offset,
384	task->iovs[i].iov_len);
385	offset += task->iovs[i].iov_len;
386	nbytes += task->iovs[i].iov_len;
387	}
388
389	return nbytes;
390	}
391
392	static int
393	vhost_bdev_scsi_process_block(struct vhost_block_dev *bdev,
394	struct vhost_scsi_task *task)
395	{
396	uint64_t lba, *temp64;
397	uint32_t xfer_len, *temp32;
398	uint16_t *temp16;
399	uint8_t cdb = (uint8_t )task->req->cdb;
400
401	switch (cdb[0]) {
402	case SBC_READ_6:
403	case SBC_WRITE_6:
404	lba = (uint64_t)cdb[1] << 16;
405	lba \|= (uint64_t)cdb[2] << 8;
406	lba \|= (uint64_t)cdb[3];
407	xfer_len = cdb[4];
408	if (xfer_len == 0)
409	xfer_len = 256;
410	return vhost_bdev_scsi_readwrite(bdev, task, lba, xfer_len);
411
412	case SBC_READ_10:
413	case SBC_WRITE_10:
414	temp32 = (uint32_t *)&cdb[2];
415	lba = rte_be_to_cpu_32(*temp32);
416	temp16 = (uint16_t *)&cdb[7];
417	xfer_len = rte_be_to_cpu_16(*temp16);
418	return vhost_bdev_scsi_readwrite(bdev, task, lba, xfer_len);
419
420	case SBC_READ_12:
421	case SBC_WRITE_12:
422	temp32 = (uint32_t *)&cdb[2];
423	lba = rte_be_to_cpu_32(*temp32);
424	temp32 = (uint32_t *)&cdb[6];
425	xfer_len = rte_be_to_cpu_32(*temp32);
426	return vhost_bdev_scsi_readwrite(bdev, task, lba, xfer_len);
427
428	case SBC_READ_16:
429	case SBC_WRITE_16:
430	temp64 = (uint64_t *)&cdb[2];
431	lba = rte_be_to_cpu_64(*temp64);
432	temp32 = (uint32_t *)&cdb[10];
433	xfer_len = rte_be_to_cpu_32(*temp32);
434	return vhost_bdev_scsi_readwrite(bdev, task, lba, xfer_len);
435
436	case SBC_READ_CAPACITY_10: {
437	uint8_t buffer[8];
438
439	if (bdev->blockcnt - 1 > 0xffffffffULL)
440	memset(buffer, 0xff, 4);
441	else {
442	temp32 = (uint32_t *)buffer;
443	*temp32 = rte_cpu_to_be_32(bdev->blockcnt - 1);
444	}
445	temp32 = (uint32_t *)&buffer[4];
446	*temp32 = rte_cpu_to_be_32(bdev->blocklen);
447	memcpy(task->iovs[0].iov_base, buffer, sizeof(buffer));
448	task->resp->status = SCSI_STATUS_GOOD;
449	return sizeof(buffer);
450	}
451
452	case SBC_SYNCHRONIZE_CACHE_10:
453	case SBC_SYNCHRONIZE_CACHE_16:
454	task->resp->status = SCSI_STATUS_GOOD;
455	return 0;
456	}
457
458	scsi_task_set_status(task, SCSI_STATUS_CHECK_CONDITION,
459	SCSI_SENSE_ILLEGAL_REQUEST,
460	SCSI_ASC_INVALID_FIELD_IN_CDB,
461	SCSI_ASCQ_CAUSE_NOT_REPORTABLE);
462	return 0;
463	}
464
465	int
466	vhost_bdev_process_scsi_commands(struct vhost_block_dev *bdev,
467	struct vhost_scsi_task *task)
468	{
469	int len;
470	uint8_t *data;
471	uint64_t *temp64, fmt_lun = 0;
472	uint32_t *temp32;
473	const uint8_t *lun;
474	uint8_t cdb = (uint8_t )task->req->cdb;
475
476	lun = (const uint8_t *)task->req->lun;
477	/* only 1 LUN supported */
478	if (lun[0] != 1 \|\| lun[1] >= 1)
479	return -1;
480
481	switch (cdb[0]) {
482	case SPC_INQUIRY:
483	len = vhost_bdev_scsi_inquiry_command(bdev, task);
484	task->data_len = len;
485	break;
486	case SPC_REPORT_LUNS:
487	data = (uint8_t *)task->iovs[0].iov_base;
488	fmt_lun \|= (0x0ULL & 0x00ffULL) << 48;
489	temp64 = (uint64_t *)&data[8];
490	*temp64 = rte_cpu_to_be_64(fmt_lun);
491	temp32 = (uint32_t *)data;
492	*temp32 = rte_cpu_to_be_32(8);
493	task->data_len = 16;
494	scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
495	break;
496	case SPC_MODE_SELECT_6:
497	case SPC_MODE_SELECT_10:
498	/* don't support it now */
499	scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
500	break;
501	case SPC_MODE_SENSE_6:
502	case SPC_MODE_SENSE_10:
503	/* don't support it now */
504	scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
505	break;
506	case SPC_TEST_UNIT_READY:
507	scsi_task_set_status(task, SCSI_STATUS_GOOD, 0, 0, 0);
508	break;
509	default:
510	len = vhost_bdev_scsi_process_block(bdev, task);
511	task->data_len = len;
512	}
513
514	return 0;
515	}