target_core_sbc.c revision 09ceadc70383a4105c0372f9e83da2c0cb0a8017
1d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig/*
2d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * SCSI Block Commands (SBC) parsing and emulation.
3d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig *
4fd9a11d7076e1d534a760032d2b8f3b59e10f9b5Nicholas Bellinger * (c) Copyright 2002-2012 RisingTide Systems LLC.
5d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig *
6d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Nicholas A. Bellinger <nab@kernel.org>
7d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig *
8d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * This program is free software; you can redistribute it and/or modify
9d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * it under the terms of the GNU General Public License as published by
10d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * the Free Software Foundation; either version 2 of the License, or
11d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * (at your option) any later version.
12d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig *
13d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * This program is distributed in the hope that it will be useful,
14d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * but WITHOUT ANY WARRANTY; without even the implied warranty of
15d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * GNU General Public License for more details.
17d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig *
18d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * You should have received a copy of the GNU General Public License
19d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * along with this program; if not, write to the Free Software
20d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
21d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */
22d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
23d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include <linux/kernel.h>
24d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include <linux/module.h>
25d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include <linux/ratelimit.h>
26d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include <asm/unaligned.h>
27d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include <scsi/scsi.h>
28d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
29d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include <target/target_core_base.h>
30d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include <target/target_core_backend.h>
31d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include <target/target_core_fabric.h>
32d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
33d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include "target_core_internal.h"
34d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig#include "target_core_ua.h"
35d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
36d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
37de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigstatic sense_reason_t
38de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigsbc_emulate_readcapacity(struct se_cmd *cmd)
391fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig{
401fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	struct se_device *dev = cmd->se_dev;
411fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	unsigned long long blocks_long = dev->transport->get_blocks(dev);
42a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini	unsigned char *rbuf;
43a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini	unsigned char buf[8];
441fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	u32 blocks;
451fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
461fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	if (blocks_long >= 0x00000000ffffffff)
471fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		blocks = 0xffffffff;
481fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	else
491fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		blocks = (u32)blocks_long;
501fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
511fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[0] = (blocks >> 24) & 0xff;
521fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[1] = (blocks >> 16) & 0xff;
531fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[2] = (blocks >> 8) & 0xff;
541fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[3] = blocks & 0xff;
550fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	buf[4] = (dev->dev_attrib.block_size >> 24) & 0xff;
560fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	buf[5] = (dev->dev_attrib.block_size >> 16) & 0xff;
570fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	buf[6] = (dev->dev_attrib.block_size >> 8) & 0xff;
580fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	buf[7] = dev->dev_attrib.block_size & 0xff;
591fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
60a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini	rbuf = transport_kmap_data_sg(cmd);
618b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger	if (rbuf) {
628b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger		memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length));
638b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger		transport_kunmap_data_sg(cmd);
648b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger	}
651fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
661fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	target_complete_cmd(cmd, GOOD);
671fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	return 0;
681fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig}
691fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
70de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigstatic sense_reason_t
71de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigsbc_emulate_readcapacity_16(struct se_cmd *cmd)
721fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig{
731fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	struct se_device *dev = cmd->se_dev;
74a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini	unsigned char *rbuf;
75a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini	unsigned char buf[32];
761fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	unsigned long long blocks = dev->transport->get_blocks(dev);
771fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
78a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini	memset(buf, 0, sizeof(buf));
791fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[0] = (blocks >> 56) & 0xff;
801fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[1] = (blocks >> 48) & 0xff;
811fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[2] = (blocks >> 40) & 0xff;
821fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[3] = (blocks >> 32) & 0xff;
831fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[4] = (blocks >> 24) & 0xff;
841fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[5] = (blocks >> 16) & 0xff;
851fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[6] = (blocks >> 8) & 0xff;
861fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	buf[7] = blocks & 0xff;
870fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	buf[8] = (dev->dev_attrib.block_size >> 24) & 0xff;
880fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	buf[9] = (dev->dev_attrib.block_size >> 16) & 0xff;
890fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	buf[10] = (dev->dev_attrib.block_size >> 8) & 0xff;
900fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	buf[11] = dev->dev_attrib.block_size & 0xff;
911fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	/*
921fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	 * Set Thin Provisioning Enable bit following sbc3r22 in section
931fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	 * READ CAPACITY (16) byte 14 if emulate_tpu or emulate_tpws is enabled.
941fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	 */
950fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	if (dev->dev_attrib.emulate_tpu || dev->dev_attrib.emulate_tpws)
961fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		buf[14] = 0x80;
971fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
98a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini	rbuf = transport_kmap_data_sg(cmd);
998b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger	if (rbuf) {
1008b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger		memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length));
1018b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger		transport_kunmap_data_sg(cmd);
1028b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger	}
1031fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
1041fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	target_complete_cmd(cmd, GOOD);
1051fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	return 0;
1061fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig}
1071fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
108972b29c8f86093f44e1d781588bd5c5faae3d8e3Roland Dreiersector_t sbc_get_write_same_sectors(struct se_cmd *cmd)
1091fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig{
1101fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	u32 num_blocks;
1111fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
1121fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	if (cmd->t_task_cdb[0] == WRITE_SAME)
1131fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		num_blocks = get_unaligned_be16(&cmd->t_task_cdb[7]);
1141fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	else if (cmd->t_task_cdb[0] == WRITE_SAME_16)
1151fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		num_blocks = get_unaligned_be32(&cmd->t_task_cdb[10]);
1161fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	else /* WRITE_SAME_32 via VARIABLE_LENGTH_CMD */
1171fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		num_blocks = get_unaligned_be32(&cmd->t_task_cdb[28]);
1181fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
1191fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	/*
1201fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	 * Use the explicit range when non zero is supplied, otherwise calculate
1211fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	 * the remaining range based on ->get_blocks() - starting LBA.
1221fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	 */
1236f974e8ce7b3f661910a49c7c2ba095631f341e9Christoph Hellwig	if (num_blocks)
1246f974e8ce7b3f661910a49c7c2ba095631f341e9Christoph Hellwig		return num_blocks;
1251fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
1266f974e8ce7b3f661910a49c7c2ba095631f341e9Christoph Hellwig	return cmd->se_dev->transport->get_blocks(cmd->se_dev) -
1276f974e8ce7b3f661910a49c7c2ba095631f341e9Christoph Hellwig		cmd->t_task_lba + 1;
1281fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig}
129972b29c8f86093f44e1d781588bd5c5faae3d8e3Roland DreierEXPORT_SYMBOL(sbc_get_write_same_sectors);
1301fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
131de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigstatic sense_reason_t
1321920ed61fbbbb38919edfb2427b0b1fd4e4ad8d9Nicholas Bellingersbc_emulate_noop(struct se_cmd *cmd)
1331a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl{
1341a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl	target_complete_cmd(cmd, GOOD);
1351a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl	return 0;
1361a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl}
1371a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl
138d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 sbc_get_size(struct se_cmd *cmd, u32 sectors)
139d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
1400fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	return cmd->se_dev->dev_attrib.block_size * sectors;
141d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
142d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
143d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic int sbc_check_valid_sectors(struct se_cmd *cmd)
144d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
145d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	struct se_device *dev = cmd->se_dev;
146d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	unsigned long long end_lba;
147d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	u32 sectors;
148d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
1490fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig	sectors = cmd->data_length / dev->dev_attrib.block_size;
150d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	end_lba = dev->transport->get_blocks(dev) + 1;
151d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
152d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	if (cmd->t_task_lba + sectors > end_lba) {
153d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		pr_err("target: lba %llu, sectors %u exceeds end lba %llu\n",
154d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->t_task_lba, sectors, end_lba);
155d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		return -EINVAL;
156d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	}
157d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
158d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return 0;
159d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
160d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
161d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_6(unsigned char *cdb)
162d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
163d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	/*
164d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * Use 8-bit sector value.  SBC-3 says:
165d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 *
166d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 *   A TRANSFER LENGTH field set to zero specifies that 256
167d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 *   logical blocks shall be written.  Any other value
168d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 *   specifies the number of logical blocks that shall be
169d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 *   written.
170d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 */
171d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return cdb[4] ? : 256;
172d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
173d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
174d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_10(unsigned char *cdb)
175d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
176d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return (u32)(cdb[7] << 8) + cdb[8];
177d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
178d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
179d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_12(unsigned char *cdb)
180d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
181d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return (u32)(cdb[6] << 24) + (cdb[7] << 16) + (cdb[8] << 8) + cdb[9];
182d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
183d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
184d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_16(unsigned char *cdb)
185d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
186d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return (u32)(cdb[10] << 24) + (cdb[11] << 16) +
187d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		    (cdb[12] << 8) + cdb[13];
188d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
189d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
190d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig/*
191d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Used for VARIABLE_LENGTH_CDB WRITE_32 and READ_32 variants
192d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */
193d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_32(unsigned char *cdb)
194d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
195d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return (u32)(cdb[28] << 24) + (cdb[29] << 16) +
196d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		    (cdb[30] << 8) + cdb[31];
197d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
198d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
199d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
200d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_lba_21(unsigned char *cdb)
201d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
202d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return ((cdb[1] & 0x1f) << 16) | (cdb[2] << 8) | cdb[3];
203d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
204d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
205d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_lba_32(unsigned char *cdb)
206d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
207d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return (cdb[2] << 24) | (cdb[3] << 16) | (cdb[4] << 8) | cdb[5];
208d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
209d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
210d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline unsigned long long transport_lba_64(unsigned char *cdb)
211d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
212d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	unsigned int __v1, __v2;
213d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
214d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	__v1 = (cdb[2] << 24) | (cdb[3] << 16) | (cdb[4] << 8) | cdb[5];
215d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	__v2 = (cdb[6] << 24) | (cdb[7] << 16) | (cdb[8] << 8) | cdb[9];
216d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
217d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return ((unsigned long long)__v2) | (unsigned long long)__v1 << 32;
218d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
219d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
220d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig/*
221d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * For VARIABLE_LENGTH_CDB w/ 32 byte extended CDBs
222d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */
223d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline unsigned long long transport_lba_64_ext(unsigned char *cdb)
224d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
225d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	unsigned int __v1, __v2;
226d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
227d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	__v1 = (cdb[12] << 24) | (cdb[13] << 16) | (cdb[14] << 8) | cdb[15];
228d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	__v2 = (cdb[16] << 24) | (cdb[17] << 16) | (cdb[18] << 8) | cdb[19];
229d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
230d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return ((unsigned long long)__v2) | (unsigned long long)__v1 << 32;
231d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
232d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
233cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellingerstatic sense_reason_t
234cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellingersbc_setup_write_same(struct se_cmd *cmd, unsigned char *flags, struct sbc_ops *ops)
235d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
236972b29c8f86093f44e1d781588bd5c5faae3d8e3Roland Dreier	unsigned int sectors = sbc_get_write_same_sectors(cmd);
237773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger
238d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	if ((flags[0] & 0x04) || (flags[0] & 0x02)) {
239d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		pr_err("WRITE_SAME PBDATA and LBDATA"
240d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			" bits not supported for Block Discard"
241d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			" Emulation\n");
242cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger		return TCM_UNSUPPORTED_SCSI_OPCODE;
243d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	}
244773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger	if (sectors > cmd->se_dev->dev_attrib.max_write_same_len) {
245773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger		pr_warn("WRITE_SAME sectors: %u exceeds max_write_same_len: %u\n",
246773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger			sectors, cmd->se_dev->dev_attrib.max_write_same_len);
247773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger		return TCM_INVALID_CDB_FIELD;
248773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger	}
249d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	/*
250cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger	 * Special case for WRITE_SAME w/ UNMAP=1 that ends up getting
251cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger	 * translated into block discard requests within backend code.
252d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 */
253cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger	if (flags[0] & 0x08) {
254cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger		if (!ops->execute_write_same_unmap)
255cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger			return TCM_UNSUPPORTED_SCSI_OPCODE;
256cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger
257cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger		cmd->execute_cmd = ops->execute_write_same_unmap;
258cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger		return 0;
259d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	}
260cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger	if (!ops->execute_write_same)
261cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger		return TCM_UNSUPPORTED_SCSI_OPCODE;
262d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
263cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger	cmd->execute_cmd = ops->execute_write_same;
264d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	return 0;
265d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
266d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
267d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic void xdreadwrite_callback(struct se_cmd *cmd)
268d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
269d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	unsigned char *buf, *addr;
270d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	struct scatterlist *sg;
271d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	unsigned int offset;
272d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	int i;
273d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	int count;
274d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	/*
275d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * From sbc3r22.pdf section 5.48 XDWRITEREAD (10) command
276d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 *
277d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * 1) read the specified logical block(s);
278d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * 2) transfer logical blocks from the data-out buffer;
279d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * 3) XOR the logical blocks transferred from the data-out buffer with
280d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 *    the logical blocks read, storing the resulting XOR data in a buffer;
281d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * 4) if the DISABLE WRITE bit is set to zero, then write the logical
282d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 *    blocks transferred from the data-out buffer; and
283d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * 5) transfer the resulting XOR data to the data-in buffer.
284d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 */
285d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	buf = kmalloc(cmd->data_length, GFP_KERNEL);
286d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	if (!buf) {
287d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		pr_err("Unable to allocate xor_callback buf\n");
288d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		return;
289d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	}
290d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	/*
291d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * Copy the scatterlist WRITE buffer located at cmd->t_data_sg
292d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * into the locally allocated *buf
293d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 */
294d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	sg_copy_to_buffer(cmd->t_data_sg,
295d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			  cmd->t_data_nents,
296d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			  buf,
297d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			  cmd->data_length);
298d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
299d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	/*
300d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * Now perform the XOR against the BIDI read memory located at
301d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 * cmd->t_mem_bidi_list
302d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	 */
303d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
304d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	offset = 0;
305d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	for_each_sg(cmd->t_bidi_data_sg, sg, cmd->t_bidi_data_nents, count) {
306d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		addr = kmap_atomic(sg_page(sg));
307d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (!addr)
308d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			goto out;
309d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
310d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		for (i = 0; i < sg->length; i++)
311d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			*(addr + sg->offset + i) ^= *(buf + offset + i);
312d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
313d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		offset += sg->length;
314d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		kunmap_atomic(addr);
315d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	}
316d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
317d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigout:
318d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	kfree(buf);
319d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
320d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
321de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigsense_reason_t
322de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigsbc_parse_cdb(struct se_cmd *cmd, struct sbc_ops *ops)
323d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{
324d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	struct se_device *dev = cmd->se_dev;
325d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	unsigned char *cdb = cmd->t_task_cdb;
3261fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig	unsigned int size;
327d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	u32 sectors = 0;
328de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig	sense_reason_t ret;
329d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
330d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	switch (cdb[0]) {
331d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case READ_6:
332d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_6(cdb);
333d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_21(cdb);
334d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
3350c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
336d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
337d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case READ_10:
338d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_10(cdb);
339d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_32(cdb);
340d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
3410c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
342d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
343d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case READ_12:
344d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_12(cdb);
345d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_32(cdb);
346d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
3470c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
348d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
349d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case READ_16:
350d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_16(cdb);
351d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_64(cdb);
352d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
3530c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
354d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
355d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case WRITE_6:
356d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_6(cdb);
357d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_21(cdb);
358d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
3590c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
360d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
361d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case WRITE_10:
362d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case WRITE_VERIFY:
363d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_10(cdb);
364d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_32(cdb);
365d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (cdb[1] & 0x8)
366d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->se_cmd_flags |= SCF_FUA;
367d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
3680c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
369d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
370d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case WRITE_12:
371d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_12(cdb);
372d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_32(cdb);
373d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (cdb[1] & 0x8)
374d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->se_cmd_flags |= SCF_FUA;
375d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
3760c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
377d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
378d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case WRITE_16:
379d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_16(cdb);
380d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_64(cdb);
381d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (cdb[1] & 0x8)
382d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->se_cmd_flags |= SCF_FUA;
383d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
3840c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
385d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
386d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case XDWRITEREAD_10:
387de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig		if (cmd->data_direction != DMA_TO_DEVICE ||
388d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		    !(cmd->se_cmd_flags & SCF_BIDI))
389de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig			return TCM_INVALID_CDB_FIELD;
390d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_10(cdb);
391d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
392d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = transport_lba_32(cdb);
393d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
394d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
395d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		/*
396d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 * Setup BIDI XOR callback to be run after I/O completion.
397d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 */
3980c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig		cmd->execute_cmd = ops->execute_rw;
399d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->transport_complete_callback = &xdreadwrite_callback;
400d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (cdb[1] & 0x8)
401d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->se_cmd_flags |= SCF_FUA;
402d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
403d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case VARIABLE_LENGTH_CMD:
404d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	{
405d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		u16 service_action = get_unaligned_be16(&cdb[8]);
406d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		switch (service_action) {
407d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		case XDWRITEREAD_32:
408d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			sectors = transport_get_sectors_32(cdb);
409d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
410d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			/*
411d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			 * Use WRITE_32 and READ_32 opcodes for the emulated
412d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			 * XDWRITE_READ_32 logic.
413d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			 */
414d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->t_task_lba = transport_lba_64_ext(cdb);
415d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB;
416d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
417d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			/*
418d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			 * Setup BIDI XOR callback to be run during after I/O
419d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			 * completion.
420d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			 */
4210c2ad7d1132d8b089b1d37875917858e03610019Christoph Hellwig			cmd->execute_cmd = ops->execute_rw;
422d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->transport_complete_callback = &xdreadwrite_callback;
423d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			if (cdb[1] & 0x8)
424d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				cmd->se_cmd_flags |= SCF_FUA;
425d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			break;
426d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		case WRITE_SAME_32:
427d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			sectors = transport_get_sectors_32(cdb);
428d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			if (!sectors) {
429d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not"
430d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				       " supported\n");
431de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig				return TCM_INVALID_CDB_FIELD;
432d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			}
433d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
4341fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig			size = sbc_get_size(cmd, 1);
435d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->t_task_lba = get_unaligned_be64(&cdb[12]);
436d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
437cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger			ret = sbc_setup_write_same(cmd, &cdb[10], ops);
4386b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter			if (ret)
439cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger				return ret;
440d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			break;
441d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		default:
442d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			pr_err("VARIABLE_LENGTH_CMD service action"
443d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				" 0x%04x not supported\n", service_action);
444de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig			return TCM_UNSUPPORTED_SCSI_OPCODE;
445d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		}
446d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
447d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	}
448d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case READ_CAPACITY:
4491fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		size = READ_CAP_LEN;
4501fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		cmd->execute_cmd = sbc_emulate_readcapacity;
451d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
452d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case SERVICE_ACTION_IN:
453d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		switch (cmd->t_task_cdb[1] & 0x1f) {
454d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		case SAI_READ_CAPACITY_16:
4551fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig			cmd->execute_cmd = sbc_emulate_readcapacity_16;
456d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			break;
457d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		default:
458d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			pr_err("Unsupported SA: 0x%02x\n",
459d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				cmd->t_task_cdb[1] & 0x1f);
460de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig			return TCM_INVALID_CDB_FIELD;
461d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		}
4621fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		size = (cdb[10] << 24) | (cdb[11] << 16) |
463d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		       (cdb[12] << 8) | cdb[13];
464d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
465d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case SYNCHRONIZE_CACHE:
466d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case SYNCHRONIZE_CACHE_16:
467882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke		if (!ops->execute_sync_cache) {
468882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke			size = 0;
469882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke			cmd->execute_cmd = sbc_emulate_noop;
470882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke			break;
471882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke		}
472ad67f0d9e63ca94661e06a145f05a9302368a826Christoph Hellwig
473d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		/*
474d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 * Extract LBA and range to be flushed for emulated SYNCHRONIZE_CACHE
475d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 */
476d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (cdb[0] == SYNCHRONIZE_CACHE) {
477d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			sectors = transport_get_sectors_10(cdb);
478d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->t_task_lba = transport_lba_32(cdb);
479d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		} else {
480d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			sectors = transport_get_sectors_16(cdb);
481d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			cmd->t_task_lba = transport_lba_64(cdb);
482d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		}
483d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
4841fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		size = sbc_get_size(cmd, sectors);
485d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
486d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		/*
487d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 * Check to ensure that LBA + Range does not exceed past end of
488d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 * device for IBLOCK and FILEIO ->do_sync_cache() backend calls
489d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 */
490d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (cmd->t_task_lba || sectors) {
491d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			if (sbc_check_valid_sectors(cmd) < 0)
49233633676df0d16d0685f2fbc571143801bc16e3bRoland Dreier				return TCM_ADDRESS_OUT_OF_RANGE;
493d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		}
494ad67f0d9e63ca94661e06a145f05a9302368a826Christoph Hellwig		cmd->execute_cmd = ops->execute_sync_cache;
495d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
496d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case UNMAP:
49714150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig		if (!ops->execute_unmap)
498de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig			return TCM_UNSUPPORTED_SCSI_OPCODE;
49914150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig
5001fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		size = get_unaligned_be16(&cdb[7]);
50114150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig		cmd->execute_cmd = ops->execute_unmap;
502d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
503d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case WRITE_SAME_16:
504d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_16(cdb);
505d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (!sectors) {
506d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n");
507de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig			return TCM_INVALID_CDB_FIELD;
508d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		}
509d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
5101fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		size = sbc_get_size(cmd, 1);
511d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = get_unaligned_be64(&cdb[2]);
512d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
513cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger		ret = sbc_setup_write_same(cmd, &cdb[1], ops);
5146b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter		if (ret)
515cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger			return ret;
516d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
517d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case WRITE_SAME:
518d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		sectors = transport_get_sectors_10(cdb);
519d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (!sectors) {
520d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n");
521de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig			return TCM_INVALID_CDB_FIELD;
522d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		}
523d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
5241fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		size = sbc_get_size(cmd, 1);
525d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		cmd->t_task_lba = get_unaligned_be32(&cdb[2]);
526d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
527d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		/*
528d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 * Follow sbcr26 with WRITE_SAME (10) and check for the existence
529d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 * of byte 1 bit 3 UNMAP instead of original reserved field
530d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		 */
531cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger		ret = sbc_setup_write_same(cmd, &cdb[1], ops);
5326b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter		if (ret)
533cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger			return ret;
534d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
535d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	case VERIFY:
5361fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		size = 0;
5371920ed61fbbbb38919edfb2427b0b1fd4e4ad8d9Nicholas Bellinger		cmd->execute_cmd = sbc_emulate_noop;
538d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		break;
5391a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl	case REZERO_UNIT:
5401a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl	case SEEK_6:
5411a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl	case SEEK_10:
5421a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		/*
5431a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		 * There are still clients out there which use these old SCSI-2
5441a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		 * commands. This mainly happens when running VMs with legacy
5451a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		 * guest systems, connected via SCSI command pass-through to
5461a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		 * iSCSI targets. Make them happy and return status GOOD.
5471a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		 */
5481a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		size = 0;
5491a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		cmd->execute_cmd = sbc_emulate_noop;
5501a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl		break;
551d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	default:
5521fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		ret = spc_parse_cdb(cmd, &size);
553d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		if (ret)
554d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			return ret;
555d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	}
556d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
557d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	/* reject any command that we don't have a handler for */
558d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	if (!(cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) && !cmd->execute_cmd)
559de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig		return TCM_UNSUPPORTED_SCSI_OPCODE;
560d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
561d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	if (cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) {
5621fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		unsigned long long end_lba;
5631fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
5640fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig		if (sectors > dev->dev_attrib.fabric_max_sectors) {
565d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			printk_ratelimited(KERN_ERR "SCSI OP %02xh with too"
566d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				" big sectors %u exceeds fabric_max_sectors:"
567d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				" %u\n", cdb[0], sectors,
5680fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig				dev->dev_attrib.fabric_max_sectors);
569de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig			return TCM_INVALID_CDB_FIELD;
570d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		}
5710fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig		if (sectors > dev->dev_attrib.hw_max_sectors) {
572d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig			printk_ratelimited(KERN_ERR "SCSI OP %02xh with too"
573d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				" big sectors %u exceeds backend hw_max_sectors:"
574d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig				" %u\n", cdb[0], sectors,
5750fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig				dev->dev_attrib.hw_max_sectors);
576de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig			return TCM_INVALID_CDB_FIELD;
577d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig		}
578d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
5791fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		end_lba = dev->transport->get_blocks(dev) + 1;
5801fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		if (cmd->t_task_lba + sectors > end_lba) {
5811fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig			pr_err("cmd exceeds last lba %llu "
5821fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig				"(lba %llu, sectors %u)\n",
5831fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig				end_lba, cmd->t_task_lba, sectors);
58409ceadc70383a4105c0372f9e83da2c0cb0a8017Roland Dreier			return TCM_ADDRESS_OUT_OF_RANGE;
5851fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		}
5861fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig
5871fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig		size = sbc_get_size(cmd, sectors);
588d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig	}
589d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig
590de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig	return target_cmd_size_check(cmd, size);
591d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig}
592d6e0175cf3f9737a760482d185bb73566bcc9331Christoph HellwigEXPORT_SYMBOL(sbc_parse_cdb);
5936f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig
5946f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwigu32 sbc_get_device_type(struct se_device *dev)
5956f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig{
5966f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig	return TYPE_DISK;
5976f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig}
5986f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph HellwigEXPORT_SYMBOL(sbc_get_device_type);
59986d7182985d25900929adce14fffd729cc8c6fb8Asias He
60086d7182985d25900929adce14fffd729cc8c6fb8Asias Hesense_reason_t
60186d7182985d25900929adce14fffd729cc8c6fb8Asias Hesbc_execute_unmap(struct se_cmd *cmd,
60286d7182985d25900929adce14fffd729cc8c6fb8Asias He	sense_reason_t (*do_unmap_fn)(struct se_cmd *, void *,
60386d7182985d25900929adce14fffd729cc8c6fb8Asias He				      sector_t, sector_t),
60486d7182985d25900929adce14fffd729cc8c6fb8Asias He	void *priv)
60586d7182985d25900929adce14fffd729cc8c6fb8Asias He{
60686d7182985d25900929adce14fffd729cc8c6fb8Asias He	struct se_device *dev = cmd->se_dev;
60786d7182985d25900929adce14fffd729cc8c6fb8Asias He	unsigned char *buf, *ptr = NULL;
60886d7182985d25900929adce14fffd729cc8c6fb8Asias He	sector_t lba;
60986d7182985d25900929adce14fffd729cc8c6fb8Asias He	int size;
61086d7182985d25900929adce14fffd729cc8c6fb8Asias He	u32 range;
61186d7182985d25900929adce14fffd729cc8c6fb8Asias He	sense_reason_t ret = 0;
61286d7182985d25900929adce14fffd729cc8c6fb8Asias He	int dl, bd_dl;
61386d7182985d25900929adce14fffd729cc8c6fb8Asias He
61486d7182985d25900929adce14fffd729cc8c6fb8Asias He	/* We never set ANC_SUP */
61586d7182985d25900929adce14fffd729cc8c6fb8Asias He	if (cmd->t_task_cdb[1])
61686d7182985d25900929adce14fffd729cc8c6fb8Asias He		return TCM_INVALID_CDB_FIELD;
61786d7182985d25900929adce14fffd729cc8c6fb8Asias He
61886d7182985d25900929adce14fffd729cc8c6fb8Asias He	if (cmd->data_length == 0) {
61986d7182985d25900929adce14fffd729cc8c6fb8Asias He		target_complete_cmd(cmd, SAM_STAT_GOOD);
62086d7182985d25900929adce14fffd729cc8c6fb8Asias He		return 0;
62186d7182985d25900929adce14fffd729cc8c6fb8Asias He	}
62286d7182985d25900929adce14fffd729cc8c6fb8Asias He
62386d7182985d25900929adce14fffd729cc8c6fb8Asias He	if (cmd->data_length < 8) {
62486d7182985d25900929adce14fffd729cc8c6fb8Asias He		pr_warn("UNMAP parameter list length %u too small\n",
62586d7182985d25900929adce14fffd729cc8c6fb8Asias He			cmd->data_length);
62686d7182985d25900929adce14fffd729cc8c6fb8Asias He		return TCM_PARAMETER_LIST_LENGTH_ERROR;
62786d7182985d25900929adce14fffd729cc8c6fb8Asias He	}
62886d7182985d25900929adce14fffd729cc8c6fb8Asias He
62986d7182985d25900929adce14fffd729cc8c6fb8Asias He	buf = transport_kmap_data_sg(cmd);
63086d7182985d25900929adce14fffd729cc8c6fb8Asias He	if (!buf)
63186d7182985d25900929adce14fffd729cc8c6fb8Asias He		return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
63286d7182985d25900929adce14fffd729cc8c6fb8Asias He
63386d7182985d25900929adce14fffd729cc8c6fb8Asias He	dl = get_unaligned_be16(&buf[0]);
63486d7182985d25900929adce14fffd729cc8c6fb8Asias He	bd_dl = get_unaligned_be16(&buf[2]);
63586d7182985d25900929adce14fffd729cc8c6fb8Asias He
63686d7182985d25900929adce14fffd729cc8c6fb8Asias He	size = cmd->data_length - 8;
63786d7182985d25900929adce14fffd729cc8c6fb8Asias He	if (bd_dl > size)
63886d7182985d25900929adce14fffd729cc8c6fb8Asias He		pr_warn("UNMAP parameter list length %u too small, ignoring bd_dl %u\n",
63986d7182985d25900929adce14fffd729cc8c6fb8Asias He			cmd->data_length, bd_dl);
64086d7182985d25900929adce14fffd729cc8c6fb8Asias He	else
64186d7182985d25900929adce14fffd729cc8c6fb8Asias He		size = bd_dl;
64286d7182985d25900929adce14fffd729cc8c6fb8Asias He
64386d7182985d25900929adce14fffd729cc8c6fb8Asias He	if (size / 16 > dev->dev_attrib.max_unmap_block_desc_count) {
64486d7182985d25900929adce14fffd729cc8c6fb8Asias He		ret = TCM_INVALID_PARAMETER_LIST;
64586d7182985d25900929adce14fffd729cc8c6fb8Asias He		goto err;
64686d7182985d25900929adce14fffd729cc8c6fb8Asias He	}
64786d7182985d25900929adce14fffd729cc8c6fb8Asias He
64886d7182985d25900929adce14fffd729cc8c6fb8Asias He	/* First UNMAP block descriptor starts at 8 byte offset */
64986d7182985d25900929adce14fffd729cc8c6fb8Asias He	ptr = &buf[8];
65086d7182985d25900929adce14fffd729cc8c6fb8Asias He	pr_debug("UNMAP: Sub: %s Using dl: %u bd_dl: %u size: %u"
65186d7182985d25900929adce14fffd729cc8c6fb8Asias He		" ptr: %p\n", dev->transport->name, dl, bd_dl, size, ptr);
65286d7182985d25900929adce14fffd729cc8c6fb8Asias He
65386d7182985d25900929adce14fffd729cc8c6fb8Asias He	while (size >= 16) {
65486d7182985d25900929adce14fffd729cc8c6fb8Asias He		lba = get_unaligned_be64(&ptr[0]);
65586d7182985d25900929adce14fffd729cc8c6fb8Asias He		range = get_unaligned_be32(&ptr[8]);
65686d7182985d25900929adce14fffd729cc8c6fb8Asias He		pr_debug("UNMAP: Using lba: %llu and range: %u\n",
65786d7182985d25900929adce14fffd729cc8c6fb8Asias He				 (unsigned long long)lba, range);
65886d7182985d25900929adce14fffd729cc8c6fb8Asias He
65986d7182985d25900929adce14fffd729cc8c6fb8Asias He		if (range > dev->dev_attrib.max_unmap_lba_count) {
66086d7182985d25900929adce14fffd729cc8c6fb8Asias He			ret = TCM_INVALID_PARAMETER_LIST;
66186d7182985d25900929adce14fffd729cc8c6fb8Asias He			goto err;
66286d7182985d25900929adce14fffd729cc8c6fb8Asias He		}
66386d7182985d25900929adce14fffd729cc8c6fb8Asias He
66486d7182985d25900929adce14fffd729cc8c6fb8Asias He		if (lba + range > dev->transport->get_blocks(dev) + 1) {
66586d7182985d25900929adce14fffd729cc8c6fb8Asias He			ret = TCM_ADDRESS_OUT_OF_RANGE;
66686d7182985d25900929adce14fffd729cc8c6fb8Asias He			goto err;
66786d7182985d25900929adce14fffd729cc8c6fb8Asias He		}
66886d7182985d25900929adce14fffd729cc8c6fb8Asias He
66986d7182985d25900929adce14fffd729cc8c6fb8Asias He		ret = do_unmap_fn(cmd, priv, lba, range);
67086d7182985d25900929adce14fffd729cc8c6fb8Asias He		if (ret)
67186d7182985d25900929adce14fffd729cc8c6fb8Asias He			goto err;
67286d7182985d25900929adce14fffd729cc8c6fb8Asias He
67386d7182985d25900929adce14fffd729cc8c6fb8Asias He		ptr += 16;
67486d7182985d25900929adce14fffd729cc8c6fb8Asias He		size -= 16;
67586d7182985d25900929adce14fffd729cc8c6fb8Asias He	}
67686d7182985d25900929adce14fffd729cc8c6fb8Asias He
67786d7182985d25900929adce14fffd729cc8c6fb8Asias Heerr:
67886d7182985d25900929adce14fffd729cc8c6fb8Asias He	transport_kunmap_data_sg(cmd);
67986d7182985d25900929adce14fffd729cc8c6fb8Asias He	if (!ret)
68086d7182985d25900929adce14fffd729cc8c6fb8Asias He		target_complete_cmd(cmd, GOOD);
68186d7182985d25900929adce14fffd729cc8c6fb8Asias He	return ret;
68286d7182985d25900929adce14fffd729cc8c6fb8Asias He}
68386d7182985d25900929adce14fffd729cc8c6fb8Asias HeEXPORT_SYMBOL(sbc_execute_unmap);
684