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