1d6e0175cSChristoph Hellwig /* 2d6e0175cSChristoph Hellwig * SCSI Block Commands (SBC) parsing and emulation. 3d6e0175cSChristoph Hellwig * 44c76251eSNicholas Bellinger * (c) Copyright 2002-2013 Datera, Inc. 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> 2641861fa8SNicholas Bellinger #include <linux/crc-t10dif.h> 27d6e0175cSChristoph Hellwig #include <asm/unaligned.h> 28d6e0175cSChristoph Hellwig #include <scsi/scsi.h> 2968ff9b9bSNicholas Bellinger #include <scsi/scsi_tcq.h> 30d6e0175cSChristoph Hellwig 31d6e0175cSChristoph Hellwig #include <target/target_core_base.h> 32d6e0175cSChristoph Hellwig #include <target/target_core_backend.h> 33d6e0175cSChristoph Hellwig #include <target/target_core_fabric.h> 34d6e0175cSChristoph Hellwig 35d6e0175cSChristoph Hellwig #include "target_core_internal.h" 36d6e0175cSChristoph Hellwig #include "target_core_ua.h" 37c66094bfSHannes Reinecke #include "target_core_alua.h" 38d6e0175cSChristoph Hellwig 39de103c93SChristoph Hellwig static sense_reason_t 40de103c93SChristoph Hellwig sbc_emulate_readcapacity(struct se_cmd *cmd) 411fd032eeSChristoph Hellwig { 421fd032eeSChristoph Hellwig struct se_device *dev = cmd->se_dev; 438dc8632aSRoland Dreier unsigned char *cdb = cmd->t_task_cdb; 441fd032eeSChristoph Hellwig unsigned long long blocks_long = dev->transport->get_blocks(dev); 45a50da144SPaolo Bonzini unsigned char *rbuf; 46a50da144SPaolo Bonzini unsigned char buf[8]; 471fd032eeSChristoph Hellwig u32 blocks; 481fd032eeSChristoph Hellwig 498dc8632aSRoland Dreier /* 508dc8632aSRoland Dreier * SBC-2 says: 518dc8632aSRoland Dreier * If the PMI bit is set to zero and the LOGICAL BLOCK 528dc8632aSRoland Dreier * ADDRESS field is not set to zero, the device server shall 538dc8632aSRoland Dreier * terminate the command with CHECK CONDITION status with 548dc8632aSRoland Dreier * the sense key set to ILLEGAL REQUEST and the additional 558dc8632aSRoland Dreier * sense code set to INVALID FIELD IN CDB. 568dc8632aSRoland Dreier * 578dc8632aSRoland Dreier * In SBC-3, these fields are obsolete, but some SCSI 588dc8632aSRoland Dreier * compliance tests actually check this, so we might as well 598dc8632aSRoland Dreier * follow SBC-2. 608dc8632aSRoland Dreier */ 618dc8632aSRoland Dreier if (!(cdb[8] & 1) && !!(cdb[2] | cdb[3] | cdb[4] | cdb[5])) 628dc8632aSRoland Dreier return TCM_INVALID_CDB_FIELD; 638dc8632aSRoland Dreier 641fd032eeSChristoph Hellwig if (blocks_long >= 0x00000000ffffffff) 651fd032eeSChristoph Hellwig blocks = 0xffffffff; 661fd032eeSChristoph Hellwig else 671fd032eeSChristoph Hellwig blocks = (u32)blocks_long; 681fd032eeSChristoph Hellwig 691fd032eeSChristoph Hellwig buf[0] = (blocks >> 24) & 0xff; 701fd032eeSChristoph Hellwig buf[1] = (blocks >> 16) & 0xff; 711fd032eeSChristoph Hellwig buf[2] = (blocks >> 8) & 0xff; 721fd032eeSChristoph Hellwig buf[3] = blocks & 0xff; 730fd97ccfSChristoph Hellwig buf[4] = (dev->dev_attrib.block_size >> 24) & 0xff; 740fd97ccfSChristoph Hellwig buf[5] = (dev->dev_attrib.block_size >> 16) & 0xff; 750fd97ccfSChristoph Hellwig buf[6] = (dev->dev_attrib.block_size >> 8) & 0xff; 760fd97ccfSChristoph Hellwig buf[7] = dev->dev_attrib.block_size & 0xff; 771fd032eeSChristoph Hellwig 78a50da144SPaolo Bonzini rbuf = transport_kmap_data_sg(cmd); 798b4b0dcbSNicholas Bellinger if (rbuf) { 80a50da144SPaolo Bonzini memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length)); 811fd032eeSChristoph Hellwig transport_kunmap_data_sg(cmd); 828b4b0dcbSNicholas Bellinger } 831fd032eeSChristoph Hellwig 842426bd45SRoland Dreier target_complete_cmd_with_length(cmd, GOOD, 8); 851fd032eeSChristoph Hellwig return 0; 861fd032eeSChristoph Hellwig } 871fd032eeSChristoph Hellwig 88de103c93SChristoph Hellwig static sense_reason_t 89de103c93SChristoph Hellwig sbc_emulate_readcapacity_16(struct se_cmd *cmd) 901fd032eeSChristoph Hellwig { 911fd032eeSChristoph Hellwig struct se_device *dev = cmd->se_dev; 922d335983SNicholas Bellinger struct se_session *sess = cmd->se_sess; 93a50da144SPaolo Bonzini unsigned char *rbuf; 94a50da144SPaolo Bonzini unsigned char buf[32]; 951fd032eeSChristoph Hellwig unsigned long long blocks = dev->transport->get_blocks(dev); 961fd032eeSChristoph Hellwig 97a50da144SPaolo Bonzini memset(buf, 0, sizeof(buf)); 981fd032eeSChristoph Hellwig buf[0] = (blocks >> 56) & 0xff; 991fd032eeSChristoph Hellwig buf[1] = (blocks >> 48) & 0xff; 1001fd032eeSChristoph Hellwig buf[2] = (blocks >> 40) & 0xff; 1011fd032eeSChristoph Hellwig buf[3] = (blocks >> 32) & 0xff; 1021fd032eeSChristoph Hellwig buf[4] = (blocks >> 24) & 0xff; 1031fd032eeSChristoph Hellwig buf[5] = (blocks >> 16) & 0xff; 1041fd032eeSChristoph Hellwig buf[6] = (blocks >> 8) & 0xff; 1051fd032eeSChristoph Hellwig buf[7] = blocks & 0xff; 1060fd97ccfSChristoph Hellwig buf[8] = (dev->dev_attrib.block_size >> 24) & 0xff; 1070fd97ccfSChristoph Hellwig buf[9] = (dev->dev_attrib.block_size >> 16) & 0xff; 1080fd97ccfSChristoph Hellwig buf[10] = (dev->dev_attrib.block_size >> 8) & 0xff; 1090fd97ccfSChristoph Hellwig buf[11] = dev->dev_attrib.block_size & 0xff; 11056dac14cSNicholas Bellinger /* 11156dac14cSNicholas Bellinger * Set P_TYPE and PROT_EN bits for DIF support 11256dac14cSNicholas Bellinger */ 1132d335983SNicholas Bellinger if (sess->sup_prot_ops & (TARGET_PROT_DIN_PASS | TARGET_PROT_DOUT_PASS)) { 11456dac14cSNicholas Bellinger if (dev->dev_attrib.pi_prot_type) 11556dac14cSNicholas Bellinger buf[12] = (dev->dev_attrib.pi_prot_type - 1) << 1 | 0x1; 1162d335983SNicholas Bellinger } 1177f7caf6aSAndy Grover 1187f7caf6aSAndy Grover if (dev->transport->get_lbppbe) 1197f7caf6aSAndy Grover buf[13] = dev->transport->get_lbppbe(dev) & 0x0f; 1207f7caf6aSAndy Grover 1217f7caf6aSAndy Grover if (dev->transport->get_alignment_offset_lbas) { 1227f7caf6aSAndy Grover u16 lalba = dev->transport->get_alignment_offset_lbas(dev); 1237f7caf6aSAndy Grover buf[14] = (lalba >> 8) & 0x3f; 1247f7caf6aSAndy Grover buf[15] = lalba & 0xff; 1257f7caf6aSAndy Grover } 1267f7caf6aSAndy Grover 1271fd032eeSChristoph Hellwig /* 1281fd032eeSChristoph Hellwig * Set Thin Provisioning Enable bit following sbc3r22 in section 1291fd032eeSChristoph Hellwig * READ CAPACITY (16) byte 14 if emulate_tpu or emulate_tpws is enabled. 1301fd032eeSChristoph Hellwig */ 1310fd97ccfSChristoph Hellwig if (dev->dev_attrib.emulate_tpu || dev->dev_attrib.emulate_tpws) 1327f7caf6aSAndy Grover buf[14] |= 0x80; 1331fd032eeSChristoph Hellwig 134a50da144SPaolo Bonzini rbuf = transport_kmap_data_sg(cmd); 1358b4b0dcbSNicholas Bellinger if (rbuf) { 136a50da144SPaolo Bonzini memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length)); 1371fd032eeSChristoph Hellwig transport_kunmap_data_sg(cmd); 1388b4b0dcbSNicholas Bellinger } 1391fd032eeSChristoph Hellwig 1402426bd45SRoland Dreier target_complete_cmd_with_length(cmd, GOOD, 32); 1411fd032eeSChristoph Hellwig return 0; 1421fd032eeSChristoph Hellwig } 1431fd032eeSChristoph Hellwig 144972b29c8SRoland Dreier sector_t sbc_get_write_same_sectors(struct se_cmd *cmd) 1451fd032eeSChristoph Hellwig { 1461fd032eeSChristoph Hellwig u32 num_blocks; 1471fd032eeSChristoph Hellwig 1481fd032eeSChristoph Hellwig if (cmd->t_task_cdb[0] == WRITE_SAME) 1491fd032eeSChristoph Hellwig num_blocks = get_unaligned_be16(&cmd->t_task_cdb[7]); 1501fd032eeSChristoph Hellwig else if (cmd->t_task_cdb[0] == WRITE_SAME_16) 1511fd032eeSChristoph Hellwig num_blocks = get_unaligned_be32(&cmd->t_task_cdb[10]); 1521fd032eeSChristoph Hellwig else /* WRITE_SAME_32 via VARIABLE_LENGTH_CMD */ 1531fd032eeSChristoph Hellwig num_blocks = get_unaligned_be32(&cmd->t_task_cdb[28]); 1541fd032eeSChristoph Hellwig 1551fd032eeSChristoph Hellwig /* 1561fd032eeSChristoph Hellwig * Use the explicit range when non zero is supplied, otherwise calculate 1571fd032eeSChristoph Hellwig * the remaining range based on ->get_blocks() - starting LBA. 1581fd032eeSChristoph Hellwig */ 1596f974e8cSChristoph Hellwig if (num_blocks) 1606f974e8cSChristoph Hellwig return num_blocks; 1611fd032eeSChristoph Hellwig 1626f974e8cSChristoph Hellwig return cmd->se_dev->transport->get_blocks(cmd->se_dev) - 1636f974e8cSChristoph Hellwig cmd->t_task_lba + 1; 1641fd032eeSChristoph Hellwig } 165972b29c8SRoland Dreier EXPORT_SYMBOL(sbc_get_write_same_sectors); 1661fd032eeSChristoph Hellwig 167de103c93SChristoph Hellwig static sense_reason_t 1681920ed61SNicholas Bellinger sbc_emulate_noop(struct se_cmd *cmd) 1691a1ff38cSBernhard Kohl { 1701a1ff38cSBernhard Kohl target_complete_cmd(cmd, GOOD); 1711a1ff38cSBernhard Kohl return 0; 1721a1ff38cSBernhard Kohl } 1731a1ff38cSBernhard Kohl 174d6e0175cSChristoph Hellwig static inline u32 sbc_get_size(struct se_cmd *cmd, u32 sectors) 175d6e0175cSChristoph Hellwig { 1760fd97ccfSChristoph Hellwig return cmd->se_dev->dev_attrib.block_size * sectors; 177d6e0175cSChristoph Hellwig } 178d6e0175cSChristoph Hellwig 179d6e0175cSChristoph Hellwig static inline u32 transport_get_sectors_6(unsigned char *cdb) 180d6e0175cSChristoph Hellwig { 181d6e0175cSChristoph Hellwig /* 182d6e0175cSChristoph Hellwig * Use 8-bit sector value. SBC-3 says: 183d6e0175cSChristoph Hellwig * 184d6e0175cSChristoph Hellwig * A TRANSFER LENGTH field set to zero specifies that 256 185d6e0175cSChristoph Hellwig * logical blocks shall be written. Any other value 186d6e0175cSChristoph Hellwig * specifies the number of logical blocks that shall be 187d6e0175cSChristoph Hellwig * written. 188d6e0175cSChristoph Hellwig */ 189d6e0175cSChristoph Hellwig return cdb[4] ? : 256; 190d6e0175cSChristoph Hellwig } 191d6e0175cSChristoph Hellwig 192d6e0175cSChristoph Hellwig static inline u32 transport_get_sectors_10(unsigned char *cdb) 193d6e0175cSChristoph Hellwig { 194d6e0175cSChristoph Hellwig return (u32)(cdb[7] << 8) + cdb[8]; 195d6e0175cSChristoph Hellwig } 196d6e0175cSChristoph Hellwig 197d6e0175cSChristoph Hellwig static inline u32 transport_get_sectors_12(unsigned char *cdb) 198d6e0175cSChristoph Hellwig { 199d6e0175cSChristoph Hellwig return (u32)(cdb[6] << 24) + (cdb[7] << 16) + (cdb[8] << 8) + cdb[9]; 200d6e0175cSChristoph Hellwig } 201d6e0175cSChristoph Hellwig 202d6e0175cSChristoph Hellwig static inline u32 transport_get_sectors_16(unsigned char *cdb) 203d6e0175cSChristoph Hellwig { 204d6e0175cSChristoph Hellwig return (u32)(cdb[10] << 24) + (cdb[11] << 16) + 205d6e0175cSChristoph Hellwig (cdb[12] << 8) + cdb[13]; 206d6e0175cSChristoph Hellwig } 207d6e0175cSChristoph Hellwig 208d6e0175cSChristoph Hellwig /* 209d6e0175cSChristoph Hellwig * Used for VARIABLE_LENGTH_CDB WRITE_32 and READ_32 variants 210d6e0175cSChristoph Hellwig */ 211d6e0175cSChristoph Hellwig static inline u32 transport_get_sectors_32(unsigned char *cdb) 212d6e0175cSChristoph Hellwig { 213d6e0175cSChristoph Hellwig return (u32)(cdb[28] << 24) + (cdb[29] << 16) + 214d6e0175cSChristoph Hellwig (cdb[30] << 8) + cdb[31]; 215d6e0175cSChristoph Hellwig 216d6e0175cSChristoph Hellwig } 217d6e0175cSChristoph Hellwig 218d6e0175cSChristoph Hellwig static inline u32 transport_lba_21(unsigned char *cdb) 219d6e0175cSChristoph Hellwig { 220d6e0175cSChristoph Hellwig return ((cdb[1] & 0x1f) << 16) | (cdb[2] << 8) | cdb[3]; 221d6e0175cSChristoph Hellwig } 222d6e0175cSChristoph Hellwig 223d6e0175cSChristoph Hellwig static inline u32 transport_lba_32(unsigned char *cdb) 224d6e0175cSChristoph Hellwig { 225d6e0175cSChristoph Hellwig return (cdb[2] << 24) | (cdb[3] << 16) | (cdb[4] << 8) | cdb[5]; 226d6e0175cSChristoph Hellwig } 227d6e0175cSChristoph Hellwig 228d6e0175cSChristoph Hellwig static inline unsigned long long transport_lba_64(unsigned char *cdb) 229d6e0175cSChristoph Hellwig { 230d6e0175cSChristoph Hellwig unsigned int __v1, __v2; 231d6e0175cSChristoph Hellwig 232d6e0175cSChristoph Hellwig __v1 = (cdb[2] << 24) | (cdb[3] << 16) | (cdb[4] << 8) | cdb[5]; 233d6e0175cSChristoph Hellwig __v2 = (cdb[6] << 24) | (cdb[7] << 16) | (cdb[8] << 8) | cdb[9]; 234d6e0175cSChristoph Hellwig 235d6e0175cSChristoph Hellwig return ((unsigned long long)__v2) | (unsigned long long)__v1 << 32; 236d6e0175cSChristoph Hellwig } 237d6e0175cSChristoph Hellwig 238d6e0175cSChristoph Hellwig /* 239d6e0175cSChristoph Hellwig * For VARIABLE_LENGTH_CDB w/ 32 byte extended CDBs 240d6e0175cSChristoph Hellwig */ 241d6e0175cSChristoph Hellwig static inline unsigned long long transport_lba_64_ext(unsigned char *cdb) 242d6e0175cSChristoph Hellwig { 243d6e0175cSChristoph Hellwig unsigned int __v1, __v2; 244d6e0175cSChristoph Hellwig 245d6e0175cSChristoph Hellwig __v1 = (cdb[12] << 24) | (cdb[13] << 16) | (cdb[14] << 8) | cdb[15]; 246d6e0175cSChristoph Hellwig __v2 = (cdb[16] << 24) | (cdb[17] << 16) | (cdb[18] << 8) | cdb[19]; 247d6e0175cSChristoph Hellwig 248d6e0175cSChristoph Hellwig return ((unsigned long long)__v2) | (unsigned long long)__v1 << 32; 249d6e0175cSChristoph Hellwig } 250d6e0175cSChristoph Hellwig 251cd063befSNicholas Bellinger static sense_reason_t 252cd063befSNicholas Bellinger sbc_setup_write_same(struct se_cmd *cmd, unsigned char *flags, struct sbc_ops *ops) 253d6e0175cSChristoph Hellwig { 254972b29c8SRoland Dreier unsigned int sectors = sbc_get_write_same_sectors(cmd); 255773cbaf7SNicholas Bellinger 256d6e0175cSChristoph Hellwig if ((flags[0] & 0x04) || (flags[0] & 0x02)) { 257d6e0175cSChristoph Hellwig pr_err("WRITE_SAME PBDATA and LBDATA" 258d6e0175cSChristoph Hellwig " bits not supported for Block Discard" 259d6e0175cSChristoph Hellwig " Emulation\n"); 260cd063befSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 261d6e0175cSChristoph Hellwig } 262773cbaf7SNicholas Bellinger if (sectors > cmd->se_dev->dev_attrib.max_write_same_len) { 263773cbaf7SNicholas Bellinger pr_warn("WRITE_SAME sectors: %u exceeds max_write_same_len: %u\n", 264773cbaf7SNicholas Bellinger sectors, cmd->se_dev->dev_attrib.max_write_same_len); 265773cbaf7SNicholas Bellinger return TCM_INVALID_CDB_FIELD; 266773cbaf7SNicholas Bellinger } 2675cb770bfSRoland Dreier /* We always have ANC_SUP == 0 so setting ANCHOR is always an error */ 2685cb770bfSRoland Dreier if (flags[0] & 0x10) { 2695cb770bfSRoland Dreier pr_warn("WRITE SAME with ANCHOR not supported\n"); 2705cb770bfSRoland Dreier return TCM_INVALID_CDB_FIELD; 2715cb770bfSRoland Dreier } 272d6e0175cSChristoph Hellwig /* 273cd063befSNicholas Bellinger * Special case for WRITE_SAME w/ UNMAP=1 that ends up getting 274cd063befSNicholas Bellinger * translated into block discard requests within backend code. 275d6e0175cSChristoph Hellwig */ 276cd063befSNicholas Bellinger if (flags[0] & 0x08) { 277cd063befSNicholas Bellinger if (!ops->execute_write_same_unmap) 278cd063befSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 279d6e0175cSChristoph Hellwig 280cd063befSNicholas Bellinger cmd->execute_cmd = ops->execute_write_same_unmap; 281cd063befSNicholas Bellinger return 0; 282cd063befSNicholas Bellinger } 283cd063befSNicholas Bellinger if (!ops->execute_write_same) 284cd063befSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 285cd063befSNicholas Bellinger 286cd063befSNicholas Bellinger cmd->execute_cmd = ops->execute_write_same; 287d6e0175cSChristoph Hellwig return 0; 288d6e0175cSChristoph Hellwig } 289d6e0175cSChristoph Hellwig 290a6b0133cSNicholas Bellinger static sense_reason_t xdreadwrite_callback(struct se_cmd *cmd) 291d6e0175cSChristoph Hellwig { 292d6e0175cSChristoph Hellwig unsigned char *buf, *addr; 293d6e0175cSChristoph Hellwig struct scatterlist *sg; 294d6e0175cSChristoph Hellwig unsigned int offset; 295a6b0133cSNicholas Bellinger sense_reason_t ret = TCM_NO_SENSE; 296a6b0133cSNicholas Bellinger int i, count; 297d6e0175cSChristoph Hellwig /* 298d6e0175cSChristoph Hellwig * From sbc3r22.pdf section 5.48 XDWRITEREAD (10) command 299d6e0175cSChristoph Hellwig * 300d6e0175cSChristoph Hellwig * 1) read the specified logical block(s); 301d6e0175cSChristoph Hellwig * 2) transfer logical blocks from the data-out buffer; 302d6e0175cSChristoph Hellwig * 3) XOR the logical blocks transferred from the data-out buffer with 303d6e0175cSChristoph Hellwig * the logical blocks read, storing the resulting XOR data in a buffer; 304d6e0175cSChristoph Hellwig * 4) if the DISABLE WRITE bit is set to zero, then write the logical 305d6e0175cSChristoph Hellwig * blocks transferred from the data-out buffer; and 306d6e0175cSChristoph Hellwig * 5) transfer the resulting XOR data to the data-in buffer. 307d6e0175cSChristoph Hellwig */ 308d6e0175cSChristoph Hellwig buf = kmalloc(cmd->data_length, GFP_KERNEL); 309d6e0175cSChristoph Hellwig if (!buf) { 310d6e0175cSChristoph Hellwig pr_err("Unable to allocate xor_callback buf\n"); 311a6b0133cSNicholas Bellinger return TCM_OUT_OF_RESOURCES; 312d6e0175cSChristoph Hellwig } 313d6e0175cSChristoph Hellwig /* 314d6e0175cSChristoph Hellwig * Copy the scatterlist WRITE buffer located at cmd->t_data_sg 315d6e0175cSChristoph Hellwig * into the locally allocated *buf 316d6e0175cSChristoph Hellwig */ 317d6e0175cSChristoph Hellwig sg_copy_to_buffer(cmd->t_data_sg, 318d6e0175cSChristoph Hellwig cmd->t_data_nents, 319d6e0175cSChristoph Hellwig buf, 320d6e0175cSChristoph Hellwig cmd->data_length); 321d6e0175cSChristoph Hellwig 322d6e0175cSChristoph Hellwig /* 323d6e0175cSChristoph Hellwig * Now perform the XOR against the BIDI read memory located at 324d6e0175cSChristoph Hellwig * cmd->t_mem_bidi_list 325d6e0175cSChristoph Hellwig */ 326d6e0175cSChristoph Hellwig 327d6e0175cSChristoph Hellwig offset = 0; 328d6e0175cSChristoph Hellwig for_each_sg(cmd->t_bidi_data_sg, sg, cmd->t_bidi_data_nents, count) { 329d6e0175cSChristoph Hellwig addr = kmap_atomic(sg_page(sg)); 330a6b0133cSNicholas Bellinger if (!addr) { 331a6b0133cSNicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 332d6e0175cSChristoph Hellwig goto out; 333a6b0133cSNicholas Bellinger } 334d6e0175cSChristoph Hellwig 335d6e0175cSChristoph Hellwig for (i = 0; i < sg->length; i++) 336d6e0175cSChristoph Hellwig *(addr + sg->offset + i) ^= *(buf + offset + i); 337d6e0175cSChristoph Hellwig 338d6e0175cSChristoph Hellwig offset += sg->length; 339d6e0175cSChristoph Hellwig kunmap_atomic(addr); 340d6e0175cSChristoph Hellwig } 341d6e0175cSChristoph Hellwig 342d6e0175cSChristoph Hellwig out: 343d6e0175cSChristoph Hellwig kfree(buf); 344a6b0133cSNicholas Bellinger return ret; 345d6e0175cSChristoph Hellwig } 346d6e0175cSChristoph Hellwig 347a82a9538SNicholas Bellinger static sense_reason_t 348a82a9538SNicholas Bellinger sbc_execute_rw(struct se_cmd *cmd) 349a82a9538SNicholas Bellinger { 350a82a9538SNicholas Bellinger return cmd->execute_rw(cmd, cmd->t_data_sg, cmd->t_data_nents, 351a82a9538SNicholas Bellinger cmd->data_direction); 352a82a9538SNicholas Bellinger } 353a82a9538SNicholas Bellinger 35468ff9b9bSNicholas Bellinger static sense_reason_t compare_and_write_post(struct se_cmd *cmd) 35568ff9b9bSNicholas Bellinger { 35668ff9b9bSNicholas Bellinger struct se_device *dev = cmd->se_dev; 35768ff9b9bSNicholas Bellinger 358d8855c15SNicholas Bellinger /* 359d8855c15SNicholas Bellinger * Only set SCF_COMPARE_AND_WRITE_POST to force a response fall-through 360d8855c15SNicholas Bellinger * within target_complete_ok_work() if the command was successfully 361d8855c15SNicholas Bellinger * sent to the backend driver. 362d8855c15SNicholas Bellinger */ 363d8855c15SNicholas Bellinger spin_lock_irq(&cmd->t_state_lock); 364d8855c15SNicholas Bellinger if ((cmd->transport_state & CMD_T_SENT) && !cmd->scsi_status) 36568ff9b9bSNicholas Bellinger cmd->se_cmd_flags |= SCF_COMPARE_AND_WRITE_POST; 366d8855c15SNicholas Bellinger spin_unlock_irq(&cmd->t_state_lock); 367d8855c15SNicholas Bellinger 36868ff9b9bSNicholas Bellinger /* 36968ff9b9bSNicholas Bellinger * Unlock ->caw_sem originally obtained during sbc_compare_and_write() 37068ff9b9bSNicholas Bellinger * before the original READ I/O submission. 37168ff9b9bSNicholas Bellinger */ 37268ff9b9bSNicholas Bellinger up(&dev->caw_sem); 37368ff9b9bSNicholas Bellinger 37468ff9b9bSNicholas Bellinger return TCM_NO_SENSE; 37568ff9b9bSNicholas Bellinger } 37668ff9b9bSNicholas Bellinger 37768ff9b9bSNicholas Bellinger static sense_reason_t compare_and_write_callback(struct se_cmd *cmd) 37868ff9b9bSNicholas Bellinger { 37968ff9b9bSNicholas Bellinger struct se_device *dev = cmd->se_dev; 38068ff9b9bSNicholas Bellinger struct scatterlist *write_sg = NULL, *sg; 381db60df88SNicholas Bellinger unsigned char *buf = NULL, *addr; 38268ff9b9bSNicholas Bellinger struct sg_mapping_iter m; 38368ff9b9bSNicholas Bellinger unsigned int offset = 0, len; 38468ff9b9bSNicholas Bellinger unsigned int nlbas = cmd->t_task_nolb; 38568ff9b9bSNicholas Bellinger unsigned int block_size = dev->dev_attrib.block_size; 38668ff9b9bSNicholas Bellinger unsigned int compare_len = (nlbas * block_size); 38768ff9b9bSNicholas Bellinger sense_reason_t ret = TCM_NO_SENSE; 38868ff9b9bSNicholas Bellinger int rc, i; 38968ff9b9bSNicholas Bellinger 390cf6d1f09SNicholas Bellinger /* 391cf6d1f09SNicholas Bellinger * Handle early failure in transport_generic_request_failure(), 392cf6d1f09SNicholas Bellinger * which will not have taken ->caw_mutex yet.. 393cf6d1f09SNicholas Bellinger */ 394cf6d1f09SNicholas Bellinger if (!cmd->t_data_sg || !cmd->t_bidi_data_sg) 395cf6d1f09SNicholas Bellinger return TCM_NO_SENSE; 396db60df88SNicholas Bellinger /* 397db60df88SNicholas Bellinger * Immediately exit + release dev->caw_sem if command has already 398db60df88SNicholas Bellinger * been failed with a non-zero SCSI status. 399db60df88SNicholas Bellinger */ 400db60df88SNicholas Bellinger if (cmd->scsi_status) { 401db60df88SNicholas Bellinger pr_err("compare_and_write_callback: non zero scsi_status:" 402db60df88SNicholas Bellinger " 0x%02x\n", cmd->scsi_status); 403db60df88SNicholas Bellinger goto out; 404db60df88SNicholas Bellinger } 405cf6d1f09SNicholas Bellinger 40668ff9b9bSNicholas Bellinger buf = kzalloc(cmd->data_length, GFP_KERNEL); 40768ff9b9bSNicholas Bellinger if (!buf) { 40868ff9b9bSNicholas Bellinger pr_err("Unable to allocate compare_and_write buf\n"); 409a2890087SNicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 410a2890087SNicholas Bellinger goto out; 41168ff9b9bSNicholas Bellinger } 41268ff9b9bSNicholas Bellinger 413a1e1774cSMartin Svec write_sg = kmalloc(sizeof(struct scatterlist) * cmd->t_data_nents, 41468ff9b9bSNicholas Bellinger GFP_KERNEL); 41568ff9b9bSNicholas Bellinger if (!write_sg) { 41668ff9b9bSNicholas Bellinger pr_err("Unable to allocate compare_and_write sg\n"); 41768ff9b9bSNicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 41868ff9b9bSNicholas Bellinger goto out; 41968ff9b9bSNicholas Bellinger } 420a1e1774cSMartin Svec sg_init_table(write_sg, cmd->t_data_nents); 42168ff9b9bSNicholas Bellinger /* 42268ff9b9bSNicholas Bellinger * Setup verify and write data payloads from total NumberLBAs. 42368ff9b9bSNicholas Bellinger */ 42468ff9b9bSNicholas Bellinger rc = sg_copy_to_buffer(cmd->t_data_sg, cmd->t_data_nents, buf, 42568ff9b9bSNicholas Bellinger cmd->data_length); 42668ff9b9bSNicholas Bellinger if (!rc) { 42768ff9b9bSNicholas Bellinger pr_err("sg_copy_to_buffer() failed for compare_and_write\n"); 42868ff9b9bSNicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 42968ff9b9bSNicholas Bellinger goto out; 43068ff9b9bSNicholas Bellinger } 43168ff9b9bSNicholas Bellinger /* 43268ff9b9bSNicholas Bellinger * Compare against SCSI READ payload against verify payload 43368ff9b9bSNicholas Bellinger */ 43468ff9b9bSNicholas Bellinger for_each_sg(cmd->t_bidi_data_sg, sg, cmd->t_bidi_data_nents, i) { 43568ff9b9bSNicholas Bellinger addr = (unsigned char *)kmap_atomic(sg_page(sg)); 43668ff9b9bSNicholas Bellinger if (!addr) { 43768ff9b9bSNicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 43868ff9b9bSNicholas Bellinger goto out; 43968ff9b9bSNicholas Bellinger } 44068ff9b9bSNicholas Bellinger 44168ff9b9bSNicholas Bellinger len = min(sg->length, compare_len); 44268ff9b9bSNicholas Bellinger 44368ff9b9bSNicholas Bellinger if (memcmp(addr, buf + offset, len)) { 44468ff9b9bSNicholas Bellinger pr_warn("Detected MISCOMPARE for addr: %p buf: %p\n", 44568ff9b9bSNicholas Bellinger addr, buf + offset); 44668ff9b9bSNicholas Bellinger kunmap_atomic(addr); 44768ff9b9bSNicholas Bellinger goto miscompare; 44868ff9b9bSNicholas Bellinger } 44968ff9b9bSNicholas Bellinger kunmap_atomic(addr); 45068ff9b9bSNicholas Bellinger 45168ff9b9bSNicholas Bellinger offset += len; 45268ff9b9bSNicholas Bellinger compare_len -= len; 45368ff9b9bSNicholas Bellinger if (!compare_len) 45468ff9b9bSNicholas Bellinger break; 45568ff9b9bSNicholas Bellinger } 45668ff9b9bSNicholas Bellinger 45768ff9b9bSNicholas Bellinger i = 0; 45868ff9b9bSNicholas Bellinger len = cmd->t_task_nolb * block_size; 45968ff9b9bSNicholas Bellinger sg_miter_start(&m, cmd->t_data_sg, cmd->t_data_nents, SG_MITER_TO_SG); 46068ff9b9bSNicholas Bellinger /* 46168ff9b9bSNicholas Bellinger * Currently assumes NoLB=1 and SGLs are PAGE_SIZE.. 46268ff9b9bSNicholas Bellinger */ 46368ff9b9bSNicholas Bellinger while (len) { 46468ff9b9bSNicholas Bellinger sg_miter_next(&m); 46568ff9b9bSNicholas Bellinger 46668ff9b9bSNicholas Bellinger if (block_size < PAGE_SIZE) { 46768ff9b9bSNicholas Bellinger sg_set_page(&write_sg[i], m.page, block_size, 46868ff9b9bSNicholas Bellinger block_size); 46968ff9b9bSNicholas Bellinger } else { 47068ff9b9bSNicholas Bellinger sg_miter_next(&m); 47168ff9b9bSNicholas Bellinger sg_set_page(&write_sg[i], m.page, block_size, 47268ff9b9bSNicholas Bellinger 0); 47368ff9b9bSNicholas Bellinger } 47468ff9b9bSNicholas Bellinger len -= block_size; 47568ff9b9bSNicholas Bellinger i++; 47668ff9b9bSNicholas Bellinger } 47768ff9b9bSNicholas Bellinger sg_miter_stop(&m); 47868ff9b9bSNicholas Bellinger /* 47968ff9b9bSNicholas Bellinger * Save the original SGL + nents values before updating to new 48068ff9b9bSNicholas Bellinger * assignments, to be released in transport_free_pages() -> 48168ff9b9bSNicholas Bellinger * transport_reset_sgl_orig() 48268ff9b9bSNicholas Bellinger */ 48368ff9b9bSNicholas Bellinger cmd->t_data_sg_orig = cmd->t_data_sg; 48468ff9b9bSNicholas Bellinger cmd->t_data_sg = write_sg; 48568ff9b9bSNicholas Bellinger cmd->t_data_nents_orig = cmd->t_data_nents; 48668ff9b9bSNicholas Bellinger cmd->t_data_nents = 1; 48768ff9b9bSNicholas Bellinger 48868ff9b9bSNicholas Bellinger cmd->sam_task_attr = MSG_HEAD_TAG; 48968ff9b9bSNicholas Bellinger cmd->transport_complete_callback = compare_and_write_post; 49068ff9b9bSNicholas Bellinger /* 49168ff9b9bSNicholas Bellinger * Now reset ->execute_cmd() to the normal sbc_execute_rw() handler 49268ff9b9bSNicholas Bellinger * for submitting the adjusted SGL to write instance user-data. 49368ff9b9bSNicholas Bellinger */ 49468ff9b9bSNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 49568ff9b9bSNicholas Bellinger 49668ff9b9bSNicholas Bellinger spin_lock_irq(&cmd->t_state_lock); 49768ff9b9bSNicholas Bellinger cmd->t_state = TRANSPORT_PROCESSING; 49868ff9b9bSNicholas Bellinger cmd->transport_state |= CMD_T_ACTIVE|CMD_T_BUSY|CMD_T_SENT; 49968ff9b9bSNicholas Bellinger spin_unlock_irq(&cmd->t_state_lock); 50068ff9b9bSNicholas Bellinger 50168ff9b9bSNicholas Bellinger __target_execute_cmd(cmd); 50268ff9b9bSNicholas Bellinger 50368ff9b9bSNicholas Bellinger kfree(buf); 50468ff9b9bSNicholas Bellinger return ret; 50568ff9b9bSNicholas Bellinger 50668ff9b9bSNicholas Bellinger miscompare: 50768ff9b9bSNicholas Bellinger pr_warn("Target/%s: Send MISCOMPARE check condition and sense\n", 50868ff9b9bSNicholas Bellinger dev->transport->name); 50968ff9b9bSNicholas Bellinger ret = TCM_MISCOMPARE_VERIFY; 51068ff9b9bSNicholas Bellinger out: 51168ff9b9bSNicholas Bellinger /* 51268ff9b9bSNicholas Bellinger * In the MISCOMPARE or failure case, unlock ->caw_sem obtained in 51368ff9b9bSNicholas Bellinger * sbc_compare_and_write() before the original READ I/O submission. 51468ff9b9bSNicholas Bellinger */ 51568ff9b9bSNicholas Bellinger up(&dev->caw_sem); 51668ff9b9bSNicholas Bellinger kfree(write_sg); 51768ff9b9bSNicholas Bellinger kfree(buf); 51868ff9b9bSNicholas Bellinger return ret; 51968ff9b9bSNicholas Bellinger } 52068ff9b9bSNicholas Bellinger 52168ff9b9bSNicholas Bellinger static sense_reason_t 52268ff9b9bSNicholas Bellinger sbc_compare_and_write(struct se_cmd *cmd) 52368ff9b9bSNicholas Bellinger { 52468ff9b9bSNicholas Bellinger struct se_device *dev = cmd->se_dev; 52568ff9b9bSNicholas Bellinger sense_reason_t ret; 52668ff9b9bSNicholas Bellinger int rc; 52768ff9b9bSNicholas Bellinger /* 52868ff9b9bSNicholas Bellinger * Submit the READ first for COMPARE_AND_WRITE to perform the 52968ff9b9bSNicholas Bellinger * comparision using SGLs at cmd->t_bidi_data_sg.. 53068ff9b9bSNicholas Bellinger */ 53168ff9b9bSNicholas Bellinger rc = down_interruptible(&dev->caw_sem); 53268ff9b9bSNicholas Bellinger if ((rc != 0) || signal_pending(current)) { 53368ff9b9bSNicholas Bellinger cmd->transport_complete_callback = NULL; 53468ff9b9bSNicholas Bellinger return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE; 53568ff9b9bSNicholas Bellinger } 536b7191253SNicholas Bellinger /* 537b7191253SNicholas Bellinger * Reset cmd->data_length to individual block_size in order to not 538b7191253SNicholas Bellinger * confuse backend drivers that depend on this value matching the 539b7191253SNicholas Bellinger * size of the I/O being submitted. 540b7191253SNicholas Bellinger */ 541b7191253SNicholas Bellinger cmd->data_length = cmd->t_task_nolb * dev->dev_attrib.block_size; 54268ff9b9bSNicholas Bellinger 54368ff9b9bSNicholas Bellinger ret = cmd->execute_rw(cmd, cmd->t_bidi_data_sg, cmd->t_bidi_data_nents, 54468ff9b9bSNicholas Bellinger DMA_FROM_DEVICE); 54568ff9b9bSNicholas Bellinger if (ret) { 54668ff9b9bSNicholas Bellinger cmd->transport_complete_callback = NULL; 54768ff9b9bSNicholas Bellinger up(&dev->caw_sem); 54868ff9b9bSNicholas Bellinger return ret; 54968ff9b9bSNicholas Bellinger } 55068ff9b9bSNicholas Bellinger /* 55168ff9b9bSNicholas Bellinger * Unlock of dev->caw_sem to occur in compare_and_write_callback() 55268ff9b9bSNicholas Bellinger * upon MISCOMPARE, or in compare_and_write_done() upon completion 55368ff9b9bSNicholas Bellinger * of WRITE instance user-data. 55468ff9b9bSNicholas Bellinger */ 55568ff9b9bSNicholas Bellinger return TCM_NO_SENSE; 55668ff9b9bSNicholas Bellinger } 55768ff9b9bSNicholas Bellinger 55819f9361aSSagi Grimberg static int 55919f9361aSSagi Grimberg sbc_set_prot_op_checks(u8 protect, enum target_prot_type prot_type, 56019f9361aSSagi Grimberg bool is_write, struct se_cmd *cmd) 56119f9361aSSagi Grimberg { 56219f9361aSSagi Grimberg if (is_write) { 56319f9361aSSagi Grimberg cmd->prot_op = protect ? TARGET_PROT_DOUT_PASS : 56419f9361aSSagi Grimberg TARGET_PROT_DOUT_INSERT; 56519f9361aSSagi Grimberg switch (protect) { 56619f9361aSSagi Grimberg case 0x0: 56719f9361aSSagi Grimberg case 0x3: 56819f9361aSSagi Grimberg cmd->prot_checks = 0; 56919f9361aSSagi Grimberg break; 57019f9361aSSagi Grimberg case 0x1: 57119f9361aSSagi Grimberg case 0x5: 57219f9361aSSagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_GUARD; 57319f9361aSSagi Grimberg if (prot_type == TARGET_DIF_TYPE1_PROT) 57419f9361aSSagi Grimberg cmd->prot_checks |= TARGET_DIF_CHECK_REFTAG; 57519f9361aSSagi Grimberg break; 57619f9361aSSagi Grimberg case 0x2: 57719f9361aSSagi Grimberg if (prot_type == TARGET_DIF_TYPE1_PROT) 57819f9361aSSagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_REFTAG; 57919f9361aSSagi Grimberg break; 58019f9361aSSagi Grimberg case 0x4: 58119f9361aSSagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_GUARD; 58219f9361aSSagi Grimberg break; 58319f9361aSSagi Grimberg default: 58419f9361aSSagi Grimberg pr_err("Unsupported protect field %d\n", protect); 58519f9361aSSagi Grimberg return -EINVAL; 58619f9361aSSagi Grimberg } 58719f9361aSSagi Grimberg } else { 58819f9361aSSagi Grimberg cmd->prot_op = protect ? TARGET_PROT_DIN_PASS : 58919f9361aSSagi Grimberg TARGET_PROT_DIN_STRIP; 59019f9361aSSagi Grimberg switch (protect) { 59119f9361aSSagi Grimberg case 0x0: 59219f9361aSSagi Grimberg case 0x1: 59319f9361aSSagi Grimberg case 0x5: 59419f9361aSSagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_GUARD; 59519f9361aSSagi Grimberg if (prot_type == TARGET_DIF_TYPE1_PROT) 59619f9361aSSagi Grimberg cmd->prot_checks |= TARGET_DIF_CHECK_REFTAG; 59719f9361aSSagi Grimberg break; 59819f9361aSSagi Grimberg case 0x2: 59919f9361aSSagi Grimberg if (prot_type == TARGET_DIF_TYPE1_PROT) 60019f9361aSSagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_REFTAG; 60119f9361aSSagi Grimberg break; 60219f9361aSSagi Grimberg case 0x3: 60319f9361aSSagi Grimberg cmd->prot_checks = 0; 60419f9361aSSagi Grimberg break; 60519f9361aSSagi Grimberg case 0x4: 60619f9361aSSagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_GUARD; 60719f9361aSSagi Grimberg break; 60819f9361aSSagi Grimberg default: 60919f9361aSSagi Grimberg pr_err("Unsupported protect field %d\n", protect); 61019f9361aSSagi Grimberg return -EINVAL; 61119f9361aSSagi Grimberg } 61219f9361aSSagi Grimberg } 61319f9361aSSagi Grimberg 61419f9361aSSagi Grimberg return 0; 61519f9361aSSagi Grimberg } 61619f9361aSSagi Grimberg 617499bf77bSNicholas Bellinger static bool 618499bf77bSNicholas Bellinger sbc_check_prot(struct se_device *dev, struct se_cmd *cmd, unsigned char *cdb, 61919f9361aSSagi Grimberg u32 sectors, bool is_write) 620499bf77bSNicholas Bellinger { 62119f9361aSSagi Grimberg u8 protect = cdb[1] >> 5; 62219f9361aSSagi Grimberg 623b5b8e298SSagi Grimberg if ((!cmd->t_prot_sg || !cmd->t_prot_nents) && cmd->prot_pto) 624499bf77bSNicholas Bellinger return true; 625499bf77bSNicholas Bellinger 626499bf77bSNicholas Bellinger switch (dev->dev_attrib.pi_prot_type) { 627499bf77bSNicholas Bellinger case TARGET_DIF_TYPE3_PROT: 628499bf77bSNicholas Bellinger cmd->reftag_seed = 0xffffffff; 629499bf77bSNicholas Bellinger break; 630499bf77bSNicholas Bellinger case TARGET_DIF_TYPE2_PROT: 63119f9361aSSagi Grimberg if (protect) 632499bf77bSNicholas Bellinger return false; 633499bf77bSNicholas Bellinger 634499bf77bSNicholas Bellinger cmd->reftag_seed = cmd->t_task_lba; 635499bf77bSNicholas Bellinger break; 636499bf77bSNicholas Bellinger case TARGET_DIF_TYPE1_PROT: 637499bf77bSNicholas Bellinger cmd->reftag_seed = cmd->t_task_lba; 638499bf77bSNicholas Bellinger break; 639499bf77bSNicholas Bellinger case TARGET_DIF_TYPE0_PROT: 640499bf77bSNicholas Bellinger default: 641499bf77bSNicholas Bellinger return true; 642499bf77bSNicholas Bellinger } 643499bf77bSNicholas Bellinger 64419f9361aSSagi Grimberg if (sbc_set_prot_op_checks(protect, dev->dev_attrib.pi_prot_type, 64519f9361aSSagi Grimberg is_write, cmd)) 64619f9361aSSagi Grimberg return false; 64719f9361aSSagi Grimberg 648499bf77bSNicholas Bellinger cmd->prot_type = dev->dev_attrib.pi_prot_type; 649499bf77bSNicholas Bellinger cmd->prot_length = dev->prot_length * sectors; 650e2a4f55cSSagi Grimberg 651e2a4f55cSSagi Grimberg /** 652e2a4f55cSSagi Grimberg * In case protection information exists over the wire 653e2a4f55cSSagi Grimberg * we modify command data length to describe pure data. 654e2a4f55cSSagi Grimberg * The actual transfer length is data length + protection 655e2a4f55cSSagi Grimberg * length 656e2a4f55cSSagi Grimberg **/ 657e2a4f55cSSagi Grimberg if (protect) 658e2a4f55cSSagi Grimberg cmd->data_length = sectors * dev->dev_attrib.block_size; 659e2a4f55cSSagi Grimberg 660e2a4f55cSSagi Grimberg pr_debug("%s: prot_type=%d, data_length=%d, prot_length=%d " 661e2a4f55cSSagi Grimberg "prot_op=%d prot_checks=%d\n", 662e2a4f55cSSagi Grimberg __func__, cmd->prot_type, cmd->data_length, cmd->prot_length, 66303abad9eSSagi Grimberg cmd->prot_op, cmd->prot_checks); 664499bf77bSNicholas Bellinger 665499bf77bSNicholas Bellinger return true; 666499bf77bSNicholas Bellinger } 667499bf77bSNicholas Bellinger 668de103c93SChristoph Hellwig sense_reason_t 669de103c93SChristoph Hellwig sbc_parse_cdb(struct se_cmd *cmd, struct sbc_ops *ops) 670d6e0175cSChristoph Hellwig { 671d6e0175cSChristoph Hellwig struct se_device *dev = cmd->se_dev; 672d6e0175cSChristoph Hellwig unsigned char *cdb = cmd->t_task_cdb; 6731fd032eeSChristoph Hellwig unsigned int size; 674d6e0175cSChristoph Hellwig u32 sectors = 0; 675de103c93SChristoph Hellwig sense_reason_t ret; 676d6e0175cSChristoph Hellwig 677d6e0175cSChristoph Hellwig switch (cdb[0]) { 678d6e0175cSChristoph Hellwig case READ_6: 679d6e0175cSChristoph Hellwig sectors = transport_get_sectors_6(cdb); 680d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_21(cdb); 681d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 682a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 683a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 684d6e0175cSChristoph Hellwig break; 685d6e0175cSChristoph Hellwig case READ_10: 686d6e0175cSChristoph Hellwig sectors = transport_get_sectors_10(cdb); 687d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 688499bf77bSNicholas Bellinger 68919f9361aSSagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, false)) 690499bf77bSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 691499bf77bSNicholas Bellinger 692d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 693a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 694a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 695d6e0175cSChristoph Hellwig break; 696d6e0175cSChristoph Hellwig case READ_12: 697d6e0175cSChristoph Hellwig sectors = transport_get_sectors_12(cdb); 698d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 699499bf77bSNicholas Bellinger 70019f9361aSSagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, false)) 701499bf77bSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 702499bf77bSNicholas Bellinger 703d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 704a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 705a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 706d6e0175cSChristoph Hellwig break; 707d6e0175cSChristoph Hellwig case READ_16: 708d6e0175cSChristoph Hellwig sectors = transport_get_sectors_16(cdb); 709d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_64(cdb); 710499bf77bSNicholas Bellinger 71119f9361aSSagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, false)) 712499bf77bSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 713499bf77bSNicholas Bellinger 714d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 715a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 716a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 717d6e0175cSChristoph Hellwig break; 718d6e0175cSChristoph Hellwig case WRITE_6: 719d6e0175cSChristoph Hellwig sectors = transport_get_sectors_6(cdb); 720d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_21(cdb); 721d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 722a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 723a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 724d6e0175cSChristoph Hellwig break; 725d6e0175cSChristoph Hellwig case WRITE_10: 726d6e0175cSChristoph Hellwig case WRITE_VERIFY: 727d6e0175cSChristoph Hellwig sectors = transport_get_sectors_10(cdb); 728d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 729499bf77bSNicholas Bellinger 73019f9361aSSagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 731499bf77bSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 732499bf77bSNicholas Bellinger 733d6e0175cSChristoph Hellwig if (cdb[1] & 0x8) 734d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 735d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 736a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 737a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 738d6e0175cSChristoph Hellwig break; 739d6e0175cSChristoph Hellwig case WRITE_12: 740d6e0175cSChristoph Hellwig sectors = transport_get_sectors_12(cdb); 741d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 742499bf77bSNicholas Bellinger 74319f9361aSSagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 744499bf77bSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 745499bf77bSNicholas Bellinger 746d6e0175cSChristoph Hellwig if (cdb[1] & 0x8) 747d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 748d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 749a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 750a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 751d6e0175cSChristoph Hellwig break; 752d6e0175cSChristoph Hellwig case WRITE_16: 753d6e0175cSChristoph Hellwig sectors = transport_get_sectors_16(cdb); 754d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_64(cdb); 755499bf77bSNicholas Bellinger 75619f9361aSSagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 757499bf77bSNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 758499bf77bSNicholas Bellinger 759d6e0175cSChristoph Hellwig if (cdb[1] & 0x8) 760d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 761d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 762a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 763a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 764d6e0175cSChristoph Hellwig break; 765d6e0175cSChristoph Hellwig case XDWRITEREAD_10: 766de103c93SChristoph Hellwig if (cmd->data_direction != DMA_TO_DEVICE || 767d6e0175cSChristoph Hellwig !(cmd->se_cmd_flags & SCF_BIDI)) 768de103c93SChristoph Hellwig return TCM_INVALID_CDB_FIELD; 769d6e0175cSChristoph Hellwig sectors = transport_get_sectors_10(cdb); 770d6e0175cSChristoph Hellwig 771d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 772d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 773d6e0175cSChristoph Hellwig 774d6e0175cSChristoph Hellwig /* 775d6e0175cSChristoph Hellwig * Setup BIDI XOR callback to be run after I/O completion. 776d6e0175cSChristoph Hellwig */ 777a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 778a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 779d6e0175cSChristoph Hellwig cmd->transport_complete_callback = &xdreadwrite_callback; 780d6e0175cSChristoph Hellwig if (cdb[1] & 0x8) 781d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 782d6e0175cSChristoph Hellwig break; 783d6e0175cSChristoph Hellwig case VARIABLE_LENGTH_CMD: 784d6e0175cSChristoph Hellwig { 785d6e0175cSChristoph Hellwig u16 service_action = get_unaligned_be16(&cdb[8]); 786d6e0175cSChristoph Hellwig switch (service_action) { 787d6e0175cSChristoph Hellwig case XDWRITEREAD_32: 788d6e0175cSChristoph Hellwig sectors = transport_get_sectors_32(cdb); 789d6e0175cSChristoph Hellwig 790d6e0175cSChristoph Hellwig /* 791d6e0175cSChristoph Hellwig * Use WRITE_32 and READ_32 opcodes for the emulated 792d6e0175cSChristoph Hellwig * XDWRITE_READ_32 logic. 793d6e0175cSChristoph Hellwig */ 794d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_64_ext(cdb); 795d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 796d6e0175cSChristoph Hellwig 797d6e0175cSChristoph Hellwig /* 798d6e0175cSChristoph Hellwig * Setup BIDI XOR callback to be run during after I/O 799d6e0175cSChristoph Hellwig * completion. 800d6e0175cSChristoph Hellwig */ 801a82a9538SNicholas Bellinger cmd->execute_rw = ops->execute_rw; 802a82a9538SNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 803d6e0175cSChristoph Hellwig cmd->transport_complete_callback = &xdreadwrite_callback; 804d6e0175cSChristoph Hellwig if (cdb[1] & 0x8) 805d6e0175cSChristoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 806d6e0175cSChristoph Hellwig break; 807d6e0175cSChristoph Hellwig case WRITE_SAME_32: 808d6e0175cSChristoph Hellwig sectors = transport_get_sectors_32(cdb); 809d6e0175cSChristoph Hellwig if (!sectors) { 810d6e0175cSChristoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not" 811d6e0175cSChristoph Hellwig " supported\n"); 812de103c93SChristoph Hellwig return TCM_INVALID_CDB_FIELD; 813d6e0175cSChristoph Hellwig } 814d6e0175cSChristoph Hellwig 8151fd032eeSChristoph Hellwig size = sbc_get_size(cmd, 1); 816d6e0175cSChristoph Hellwig cmd->t_task_lba = get_unaligned_be64(&cdb[12]); 817d6e0175cSChristoph Hellwig 818cd063befSNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[10], ops); 8196b64e1feSDan Carpenter if (ret) 820cd063befSNicholas Bellinger return ret; 821d6e0175cSChristoph Hellwig break; 822d6e0175cSChristoph Hellwig default: 823d6e0175cSChristoph Hellwig pr_err("VARIABLE_LENGTH_CMD service action" 824d6e0175cSChristoph Hellwig " 0x%04x not supported\n", service_action); 825de103c93SChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 826d6e0175cSChristoph Hellwig } 827d6e0175cSChristoph Hellwig break; 828d6e0175cSChristoph Hellwig } 82968ff9b9bSNicholas Bellinger case COMPARE_AND_WRITE: 83068ff9b9bSNicholas Bellinger sectors = cdb[13]; 83168ff9b9bSNicholas Bellinger /* 83268ff9b9bSNicholas Bellinger * Currently enforce COMPARE_AND_WRITE for a single sector 83368ff9b9bSNicholas Bellinger */ 83468ff9b9bSNicholas Bellinger if (sectors > 1) { 83568ff9b9bSNicholas Bellinger pr_err("COMPARE_AND_WRITE contains NoLB: %u greater" 83668ff9b9bSNicholas Bellinger " than 1\n", sectors); 83768ff9b9bSNicholas Bellinger return TCM_INVALID_CDB_FIELD; 83868ff9b9bSNicholas Bellinger } 83968ff9b9bSNicholas Bellinger /* 84068ff9b9bSNicholas Bellinger * Double size because we have two buffers, note that 84168ff9b9bSNicholas Bellinger * zero is not an error.. 84268ff9b9bSNicholas Bellinger */ 84368ff9b9bSNicholas Bellinger size = 2 * sbc_get_size(cmd, sectors); 84468ff9b9bSNicholas Bellinger cmd->t_task_lba = get_unaligned_be64(&cdb[2]); 84568ff9b9bSNicholas Bellinger cmd->t_task_nolb = sectors; 84668ff9b9bSNicholas Bellinger cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB | SCF_COMPARE_AND_WRITE; 84768ff9b9bSNicholas Bellinger cmd->execute_rw = ops->execute_rw; 84868ff9b9bSNicholas Bellinger cmd->execute_cmd = sbc_compare_and_write; 84968ff9b9bSNicholas Bellinger cmd->transport_complete_callback = compare_and_write_callback; 85068ff9b9bSNicholas Bellinger break; 851d6e0175cSChristoph Hellwig case READ_CAPACITY: 8521fd032eeSChristoph Hellwig size = READ_CAP_LEN; 8531fd032eeSChristoph Hellwig cmd->execute_cmd = sbc_emulate_readcapacity; 854d6e0175cSChristoph Hellwig break; 855d6e0175cSChristoph Hellwig case SERVICE_ACTION_IN: 856d6e0175cSChristoph Hellwig switch (cmd->t_task_cdb[1] & 0x1f) { 857d6e0175cSChristoph Hellwig case SAI_READ_CAPACITY_16: 8581fd032eeSChristoph Hellwig cmd->execute_cmd = sbc_emulate_readcapacity_16; 859d6e0175cSChristoph Hellwig break; 860c66094bfSHannes Reinecke case SAI_REPORT_REFERRALS: 861c66094bfSHannes Reinecke cmd->execute_cmd = target_emulate_report_referrals; 862c66094bfSHannes Reinecke break; 863d6e0175cSChristoph Hellwig default: 864d6e0175cSChristoph Hellwig pr_err("Unsupported SA: 0x%02x\n", 865d6e0175cSChristoph Hellwig cmd->t_task_cdb[1] & 0x1f); 866de103c93SChristoph Hellwig return TCM_INVALID_CDB_FIELD; 867d6e0175cSChristoph Hellwig } 8681fd032eeSChristoph Hellwig size = (cdb[10] << 24) | (cdb[11] << 16) | 869d6e0175cSChristoph Hellwig (cdb[12] << 8) | cdb[13]; 870d6e0175cSChristoph Hellwig break; 871d6e0175cSChristoph Hellwig case SYNCHRONIZE_CACHE: 872d6e0175cSChristoph Hellwig case SYNCHRONIZE_CACHE_16: 873d6e0175cSChristoph Hellwig if (cdb[0] == SYNCHRONIZE_CACHE) { 874d6e0175cSChristoph Hellwig sectors = transport_get_sectors_10(cdb); 875d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 876d6e0175cSChristoph Hellwig } else { 877d6e0175cSChristoph Hellwig sectors = transport_get_sectors_16(cdb); 878d6e0175cSChristoph Hellwig cmd->t_task_lba = transport_lba_64(cdb); 879d6e0175cSChristoph Hellwig } 8806ef31dc7SChristophe Vu-Brugier if (ops->execute_sync_cache) { 881ad67f0d9SChristoph Hellwig cmd->execute_cmd = ops->execute_sync_cache; 8826ef31dc7SChristophe Vu-Brugier goto check_lba; 8836ef31dc7SChristophe Vu-Brugier } 8846ef31dc7SChristophe Vu-Brugier size = 0; 8856ef31dc7SChristophe Vu-Brugier cmd->execute_cmd = sbc_emulate_noop; 886d6e0175cSChristoph Hellwig break; 887d6e0175cSChristoph Hellwig case UNMAP: 88814150a6bSChristoph Hellwig if (!ops->execute_unmap) 889de103c93SChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 89014150a6bSChristoph Hellwig 8911fd032eeSChristoph Hellwig size = get_unaligned_be16(&cdb[7]); 89214150a6bSChristoph Hellwig cmd->execute_cmd = ops->execute_unmap; 893d6e0175cSChristoph Hellwig break; 894d6e0175cSChristoph Hellwig case WRITE_SAME_16: 895d6e0175cSChristoph Hellwig sectors = transport_get_sectors_16(cdb); 896d6e0175cSChristoph Hellwig if (!sectors) { 897d6e0175cSChristoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n"); 898de103c93SChristoph Hellwig return TCM_INVALID_CDB_FIELD; 899d6e0175cSChristoph Hellwig } 900d6e0175cSChristoph Hellwig 9011fd032eeSChristoph Hellwig size = sbc_get_size(cmd, 1); 902d6e0175cSChristoph Hellwig cmd->t_task_lba = get_unaligned_be64(&cdb[2]); 903d6e0175cSChristoph Hellwig 904cd063befSNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[1], ops); 9056b64e1feSDan Carpenter if (ret) 906cd063befSNicholas Bellinger return ret; 907d6e0175cSChristoph Hellwig break; 908d6e0175cSChristoph Hellwig case WRITE_SAME: 909d6e0175cSChristoph Hellwig sectors = transport_get_sectors_10(cdb); 910d6e0175cSChristoph Hellwig if (!sectors) { 911d6e0175cSChristoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n"); 912de103c93SChristoph Hellwig return TCM_INVALID_CDB_FIELD; 913d6e0175cSChristoph Hellwig } 914d6e0175cSChristoph Hellwig 9151fd032eeSChristoph Hellwig size = sbc_get_size(cmd, 1); 916d6e0175cSChristoph Hellwig cmd->t_task_lba = get_unaligned_be32(&cdb[2]); 917d6e0175cSChristoph Hellwig 918d6e0175cSChristoph Hellwig /* 919d6e0175cSChristoph Hellwig * Follow sbcr26 with WRITE_SAME (10) and check for the existence 920d6e0175cSChristoph Hellwig * of byte 1 bit 3 UNMAP instead of original reserved field 921d6e0175cSChristoph Hellwig */ 922cd063befSNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[1], ops); 9236b64e1feSDan Carpenter if (ret) 924cd063befSNicholas Bellinger return ret; 925d6e0175cSChristoph Hellwig break; 926d6e0175cSChristoph Hellwig case VERIFY: 9271fd032eeSChristoph Hellwig size = 0; 928c52716deSChristophe Vu-Brugier sectors = transport_get_sectors_10(cdb); 929c52716deSChristophe Vu-Brugier cmd->t_task_lba = transport_lba_32(cdb); 9301920ed61SNicholas Bellinger cmd->execute_cmd = sbc_emulate_noop; 931c52716deSChristophe Vu-Brugier goto check_lba; 9321a1ff38cSBernhard Kohl case REZERO_UNIT: 9331a1ff38cSBernhard Kohl case SEEK_6: 9341a1ff38cSBernhard Kohl case SEEK_10: 9351a1ff38cSBernhard Kohl /* 9361a1ff38cSBernhard Kohl * There are still clients out there which use these old SCSI-2 9371a1ff38cSBernhard Kohl * commands. This mainly happens when running VMs with legacy 9381a1ff38cSBernhard Kohl * guest systems, connected via SCSI command pass-through to 9391a1ff38cSBernhard Kohl * iSCSI targets. Make them happy and return status GOOD. 9401a1ff38cSBernhard Kohl */ 9411a1ff38cSBernhard Kohl size = 0; 9421a1ff38cSBernhard Kohl cmd->execute_cmd = sbc_emulate_noop; 9431a1ff38cSBernhard Kohl break; 944d6e0175cSChristoph Hellwig default: 9451fd032eeSChristoph Hellwig ret = spc_parse_cdb(cmd, &size); 946d6e0175cSChristoph Hellwig if (ret) 947d6e0175cSChristoph Hellwig return ret; 948d6e0175cSChristoph Hellwig } 949d6e0175cSChristoph Hellwig 950d6e0175cSChristoph Hellwig /* reject any command that we don't have a handler for */ 951d6e0175cSChristoph Hellwig if (!(cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) && !cmd->execute_cmd) 952de103c93SChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 953d6e0175cSChristoph Hellwig 954d6e0175cSChristoph Hellwig if (cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) { 9551fd032eeSChristoph Hellwig unsigned long long end_lba; 9561fd032eeSChristoph Hellwig 9570fd97ccfSChristoph Hellwig if (sectors > dev->dev_attrib.fabric_max_sectors) { 958d6e0175cSChristoph Hellwig printk_ratelimited(KERN_ERR "SCSI OP %02xh with too" 959d6e0175cSChristoph Hellwig " big sectors %u exceeds fabric_max_sectors:" 960d6e0175cSChristoph Hellwig " %u\n", cdb[0], sectors, 9610fd97ccfSChristoph Hellwig dev->dev_attrib.fabric_max_sectors); 962de103c93SChristoph Hellwig return TCM_INVALID_CDB_FIELD; 963d6e0175cSChristoph Hellwig } 9640fd97ccfSChristoph Hellwig if (sectors > dev->dev_attrib.hw_max_sectors) { 965d6e0175cSChristoph Hellwig printk_ratelimited(KERN_ERR "SCSI OP %02xh with too" 966d6e0175cSChristoph Hellwig " big sectors %u exceeds backend hw_max_sectors:" 967d6e0175cSChristoph Hellwig " %u\n", cdb[0], sectors, 9680fd97ccfSChristoph Hellwig dev->dev_attrib.hw_max_sectors); 969de103c93SChristoph Hellwig return TCM_INVALID_CDB_FIELD; 970d6e0175cSChristoph Hellwig } 9716ef31dc7SChristophe Vu-Brugier check_lba: 9721fd032eeSChristoph Hellwig end_lba = dev->transport->get_blocks(dev) + 1; 9731fd032eeSChristoph Hellwig if (cmd->t_task_lba + sectors > end_lba) { 9741fd032eeSChristoph Hellwig pr_err("cmd exceeds last lba %llu " 9751fd032eeSChristoph Hellwig "(lba %llu, sectors %u)\n", 9761fd032eeSChristoph Hellwig end_lba, cmd->t_task_lba, sectors); 97709ceadc7SRoland Dreier return TCM_ADDRESS_OUT_OF_RANGE; 978d6e0175cSChristoph Hellwig } 979d6e0175cSChristoph Hellwig 98068ff9b9bSNicholas Bellinger if (!(cmd->se_cmd_flags & SCF_COMPARE_AND_WRITE)) 9811fd032eeSChristoph Hellwig size = sbc_get_size(cmd, sectors); 9821fd032eeSChristoph Hellwig } 9831fd032eeSChristoph Hellwig 984de103c93SChristoph Hellwig return target_cmd_size_check(cmd, size); 985d6e0175cSChristoph Hellwig } 986d6e0175cSChristoph Hellwig EXPORT_SYMBOL(sbc_parse_cdb); 9876f23ac8aSChristoph Hellwig 9886f23ac8aSChristoph Hellwig u32 sbc_get_device_type(struct se_device *dev) 9896f23ac8aSChristoph Hellwig { 9906f23ac8aSChristoph Hellwig return TYPE_DISK; 9916f23ac8aSChristoph Hellwig } 9926f23ac8aSChristoph Hellwig EXPORT_SYMBOL(sbc_get_device_type); 99386d71829SAsias He 99486d71829SAsias He sense_reason_t 99586d71829SAsias He sbc_execute_unmap(struct se_cmd *cmd, 99686d71829SAsias He sense_reason_t (*do_unmap_fn)(struct se_cmd *, void *, 99786d71829SAsias He sector_t, sector_t), 99886d71829SAsias He void *priv) 99986d71829SAsias He { 100086d71829SAsias He struct se_device *dev = cmd->se_dev; 100186d71829SAsias He unsigned char *buf, *ptr = NULL; 100286d71829SAsias He sector_t lba; 100386d71829SAsias He int size; 100486d71829SAsias He u32 range; 100586d71829SAsias He sense_reason_t ret = 0; 100686d71829SAsias He int dl, bd_dl; 100786d71829SAsias He 100886d71829SAsias He /* We never set ANC_SUP */ 100986d71829SAsias He if (cmd->t_task_cdb[1]) 101086d71829SAsias He return TCM_INVALID_CDB_FIELD; 101186d71829SAsias He 101286d71829SAsias He if (cmd->data_length == 0) { 101386d71829SAsias He target_complete_cmd(cmd, SAM_STAT_GOOD); 101486d71829SAsias He return 0; 101586d71829SAsias He } 101686d71829SAsias He 101786d71829SAsias He if (cmd->data_length < 8) { 101886d71829SAsias He pr_warn("UNMAP parameter list length %u too small\n", 101986d71829SAsias He cmd->data_length); 102086d71829SAsias He return TCM_PARAMETER_LIST_LENGTH_ERROR; 102186d71829SAsias He } 102286d71829SAsias He 102386d71829SAsias He buf = transport_kmap_data_sg(cmd); 102486d71829SAsias He if (!buf) 102586d71829SAsias He return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE; 102686d71829SAsias He 102786d71829SAsias He dl = get_unaligned_be16(&buf[0]); 102886d71829SAsias He bd_dl = get_unaligned_be16(&buf[2]); 102986d71829SAsias He 103086d71829SAsias He size = cmd->data_length - 8; 103186d71829SAsias He if (bd_dl > size) 103286d71829SAsias He pr_warn("UNMAP parameter list length %u too small, ignoring bd_dl %u\n", 103386d71829SAsias He cmd->data_length, bd_dl); 103486d71829SAsias He else 103586d71829SAsias He size = bd_dl; 103686d71829SAsias He 103786d71829SAsias He if (size / 16 > dev->dev_attrib.max_unmap_block_desc_count) { 103886d71829SAsias He ret = TCM_INVALID_PARAMETER_LIST; 103986d71829SAsias He goto err; 104086d71829SAsias He } 104186d71829SAsias He 104286d71829SAsias He /* First UNMAP block descriptor starts at 8 byte offset */ 104386d71829SAsias He ptr = &buf[8]; 104486d71829SAsias He pr_debug("UNMAP: Sub: %s Using dl: %u bd_dl: %u size: %u" 104586d71829SAsias He " ptr: %p\n", dev->transport->name, dl, bd_dl, size, ptr); 104686d71829SAsias He 104786d71829SAsias He while (size >= 16) { 104886d71829SAsias He lba = get_unaligned_be64(&ptr[0]); 104986d71829SAsias He range = get_unaligned_be32(&ptr[8]); 105086d71829SAsias He pr_debug("UNMAP: Using lba: %llu and range: %u\n", 105186d71829SAsias He (unsigned long long)lba, range); 105286d71829SAsias He 105386d71829SAsias He if (range > dev->dev_attrib.max_unmap_lba_count) { 105486d71829SAsias He ret = TCM_INVALID_PARAMETER_LIST; 105586d71829SAsias He goto err; 105686d71829SAsias He } 105786d71829SAsias He 105886d71829SAsias He if (lba + range > dev->transport->get_blocks(dev) + 1) { 105986d71829SAsias He ret = TCM_ADDRESS_OUT_OF_RANGE; 106086d71829SAsias He goto err; 106186d71829SAsias He } 106286d71829SAsias He 106386d71829SAsias He ret = do_unmap_fn(cmd, priv, lba, range); 106486d71829SAsias He if (ret) 106586d71829SAsias He goto err; 106686d71829SAsias He 106786d71829SAsias He ptr += 16; 106886d71829SAsias He size -= 16; 106986d71829SAsias He } 107086d71829SAsias He 107186d71829SAsias He err: 107286d71829SAsias He transport_kunmap_data_sg(cmd); 107386d71829SAsias He if (!ret) 107486d71829SAsias He target_complete_cmd(cmd, GOOD); 107586d71829SAsias He return ret; 107686d71829SAsias He } 107786d71829SAsias He EXPORT_SYMBOL(sbc_execute_unmap); 107841861fa8SNicholas Bellinger 107966a3d5bcSNicholas Bellinger void 108066a3d5bcSNicholas Bellinger sbc_dif_generate(struct se_cmd *cmd) 108166a3d5bcSNicholas Bellinger { 108266a3d5bcSNicholas Bellinger struct se_device *dev = cmd->se_dev; 108366a3d5bcSNicholas Bellinger struct se_dif_v1_tuple *sdt; 108466a3d5bcSNicholas Bellinger struct scatterlist *dsg, *psg = cmd->t_prot_sg; 108566a3d5bcSNicholas Bellinger sector_t sector = cmd->t_task_lba; 108666a3d5bcSNicholas Bellinger void *daddr, *paddr; 108766a3d5bcSNicholas Bellinger int i, j, offset = 0; 108866a3d5bcSNicholas Bellinger 108966a3d5bcSNicholas Bellinger for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) { 109066a3d5bcSNicholas Bellinger daddr = kmap_atomic(sg_page(dsg)) + dsg->offset; 109166a3d5bcSNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 109266a3d5bcSNicholas Bellinger 109366a3d5bcSNicholas Bellinger for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) { 109466a3d5bcSNicholas Bellinger 109566a3d5bcSNicholas Bellinger if (offset >= psg->length) { 109666a3d5bcSNicholas Bellinger kunmap_atomic(paddr); 109766a3d5bcSNicholas Bellinger psg = sg_next(psg); 109866a3d5bcSNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 109966a3d5bcSNicholas Bellinger offset = 0; 110066a3d5bcSNicholas Bellinger } 110166a3d5bcSNicholas Bellinger 110266a3d5bcSNicholas Bellinger sdt = paddr + offset; 110366a3d5bcSNicholas Bellinger sdt->guard_tag = cpu_to_be16(crc_t10dif(daddr + j, 110466a3d5bcSNicholas Bellinger dev->dev_attrib.block_size)); 110566a3d5bcSNicholas Bellinger if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT) 110666a3d5bcSNicholas Bellinger sdt->ref_tag = cpu_to_be32(sector & 0xffffffff); 110766a3d5bcSNicholas Bellinger sdt->app_tag = 0; 110866a3d5bcSNicholas Bellinger 110966a3d5bcSNicholas Bellinger pr_debug("DIF WRITE INSERT sector: %llu guard_tag: 0x%04x" 111066a3d5bcSNicholas Bellinger " app_tag: 0x%04x ref_tag: %u\n", 111166a3d5bcSNicholas Bellinger (unsigned long long)sector, sdt->guard_tag, 111266a3d5bcSNicholas Bellinger sdt->app_tag, be32_to_cpu(sdt->ref_tag)); 111366a3d5bcSNicholas Bellinger 111466a3d5bcSNicholas Bellinger sector++; 111566a3d5bcSNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 111666a3d5bcSNicholas Bellinger } 111766a3d5bcSNicholas Bellinger 111866a3d5bcSNicholas Bellinger kunmap_atomic(paddr); 111966a3d5bcSNicholas Bellinger kunmap_atomic(daddr); 112066a3d5bcSNicholas Bellinger } 112166a3d5bcSNicholas Bellinger } 112266a3d5bcSNicholas Bellinger 112341861fa8SNicholas Bellinger static sense_reason_t 112441861fa8SNicholas Bellinger sbc_dif_v1_verify(struct se_device *dev, struct se_dif_v1_tuple *sdt, 112541861fa8SNicholas Bellinger const void *p, sector_t sector, unsigned int ei_lba) 112641861fa8SNicholas Bellinger { 112741861fa8SNicholas Bellinger int block_size = dev->dev_attrib.block_size; 112841861fa8SNicholas Bellinger __be16 csum; 112941861fa8SNicholas Bellinger 113041861fa8SNicholas Bellinger csum = cpu_to_be16(crc_t10dif(p, block_size)); 113141861fa8SNicholas Bellinger 113241861fa8SNicholas Bellinger if (sdt->guard_tag != csum) { 113341861fa8SNicholas Bellinger pr_err("DIFv1 checksum failed on sector %llu guard tag 0x%04x" 113441861fa8SNicholas Bellinger " csum 0x%04x\n", (unsigned long long)sector, 113541861fa8SNicholas Bellinger be16_to_cpu(sdt->guard_tag), be16_to_cpu(csum)); 113641861fa8SNicholas Bellinger return TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED; 113741861fa8SNicholas Bellinger } 113841861fa8SNicholas Bellinger 113941861fa8SNicholas Bellinger if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT && 114041861fa8SNicholas Bellinger be32_to_cpu(sdt->ref_tag) != (sector & 0xffffffff)) { 114141861fa8SNicholas Bellinger pr_err("DIFv1 Type 1 reference failed on sector: %llu tag: 0x%08x" 114241861fa8SNicholas Bellinger " sector MSB: 0x%08x\n", (unsigned long long)sector, 114341861fa8SNicholas Bellinger be32_to_cpu(sdt->ref_tag), (u32)(sector & 0xffffffff)); 114441861fa8SNicholas Bellinger return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED; 114541861fa8SNicholas Bellinger } 114641861fa8SNicholas Bellinger 114741861fa8SNicholas Bellinger if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE2_PROT && 114841861fa8SNicholas Bellinger be32_to_cpu(sdt->ref_tag) != ei_lba) { 114941861fa8SNicholas Bellinger pr_err("DIFv1 Type 2 reference failed on sector: %llu tag: 0x%08x" 115041861fa8SNicholas Bellinger " ei_lba: 0x%08x\n", (unsigned long long)sector, 115141861fa8SNicholas Bellinger be32_to_cpu(sdt->ref_tag), ei_lba); 115241861fa8SNicholas Bellinger return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED; 115341861fa8SNicholas Bellinger } 115441861fa8SNicholas Bellinger 115541861fa8SNicholas Bellinger return 0; 115641861fa8SNicholas Bellinger } 115741861fa8SNicholas Bellinger 115841861fa8SNicholas Bellinger static void 115941861fa8SNicholas Bellinger sbc_dif_copy_prot(struct se_cmd *cmd, unsigned int sectors, bool read, 116041861fa8SNicholas Bellinger struct scatterlist *sg, int sg_off) 116141861fa8SNicholas Bellinger { 116241861fa8SNicholas Bellinger struct se_device *dev = cmd->se_dev; 116341861fa8SNicholas Bellinger struct scatterlist *psg; 116441861fa8SNicholas Bellinger void *paddr, *addr; 116541861fa8SNicholas Bellinger unsigned int i, len, left; 116610762e80SNicholas Bellinger unsigned int offset = sg_off; 116741861fa8SNicholas Bellinger 116841861fa8SNicholas Bellinger left = sectors * dev->prot_length; 116941861fa8SNicholas Bellinger 117041861fa8SNicholas Bellinger for_each_sg(cmd->t_prot_sg, psg, cmd->t_prot_nents, i) { 117116c0ae02SSagi Grimberg unsigned int psg_len, copied = 0; 117241861fa8SNicholas Bellinger 117316c0ae02SSagi Grimberg paddr = kmap_atomic(sg_page(psg)) + psg->offset; 117416c0ae02SSagi Grimberg psg_len = min(left, psg->length); 117516c0ae02SSagi Grimberg while (psg_len) { 117616c0ae02SSagi Grimberg len = min(psg_len, sg->length - offset); 117716c0ae02SSagi Grimberg addr = kmap_atomic(sg_page(sg)) + sg->offset + offset; 117816c0ae02SSagi Grimberg 117916c0ae02SSagi Grimberg if (read) 118016c0ae02SSagi Grimberg memcpy(paddr + copied, addr, len); 118116c0ae02SSagi Grimberg else 118216c0ae02SSagi Grimberg memcpy(addr, paddr + copied, len); 118316c0ae02SSagi Grimberg 118416c0ae02SSagi Grimberg left -= len; 118516c0ae02SSagi Grimberg offset += len; 118616c0ae02SSagi Grimberg copied += len; 118716c0ae02SSagi Grimberg psg_len -= len; 118816c0ae02SSagi Grimberg 1189d6a65fdcSSagi Grimberg if (offset >= sg->length) { 1190d6a65fdcSSagi Grimberg sg = sg_next(sg); 1191d6a65fdcSSagi Grimberg offset = 0; 1192d6a65fdcSSagi Grimberg } 119341861fa8SNicholas Bellinger kunmap_atomic(addr); 119441861fa8SNicholas Bellinger } 119516c0ae02SSagi Grimberg kunmap_atomic(paddr); 119616c0ae02SSagi Grimberg } 119741861fa8SNicholas Bellinger } 119841861fa8SNicholas Bellinger 119941861fa8SNicholas Bellinger sense_reason_t 120041861fa8SNicholas Bellinger sbc_dif_verify_write(struct se_cmd *cmd, sector_t start, unsigned int sectors, 120141861fa8SNicholas Bellinger unsigned int ei_lba, struct scatterlist *sg, int sg_off) 120241861fa8SNicholas Bellinger { 120341861fa8SNicholas Bellinger struct se_device *dev = cmd->se_dev; 120441861fa8SNicholas Bellinger struct se_dif_v1_tuple *sdt; 120541861fa8SNicholas Bellinger struct scatterlist *dsg, *psg = cmd->t_prot_sg; 120641861fa8SNicholas Bellinger sector_t sector = start; 120741861fa8SNicholas Bellinger void *daddr, *paddr; 120841861fa8SNicholas Bellinger int i, j, offset = 0; 120941861fa8SNicholas Bellinger sense_reason_t rc; 121041861fa8SNicholas Bellinger 121141861fa8SNicholas Bellinger for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) { 121241861fa8SNicholas Bellinger daddr = kmap_atomic(sg_page(dsg)) + dsg->offset; 121341861fa8SNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 121441861fa8SNicholas Bellinger 121541861fa8SNicholas Bellinger for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) { 121641861fa8SNicholas Bellinger 121741861fa8SNicholas Bellinger if (offset >= psg->length) { 121841861fa8SNicholas Bellinger kunmap_atomic(paddr); 121941861fa8SNicholas Bellinger psg = sg_next(psg); 122041861fa8SNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 122141861fa8SNicholas Bellinger offset = 0; 122241861fa8SNicholas Bellinger } 122341861fa8SNicholas Bellinger 122441861fa8SNicholas Bellinger sdt = paddr + offset; 122541861fa8SNicholas Bellinger 122641861fa8SNicholas Bellinger pr_debug("DIF WRITE sector: %llu guard_tag: 0x%04x" 122741861fa8SNicholas Bellinger " app_tag: 0x%04x ref_tag: %u\n", 122841861fa8SNicholas Bellinger (unsigned long long)sector, sdt->guard_tag, 122941861fa8SNicholas Bellinger sdt->app_tag, be32_to_cpu(sdt->ref_tag)); 123041861fa8SNicholas Bellinger 123141861fa8SNicholas Bellinger rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector, 123241861fa8SNicholas Bellinger ei_lba); 123341861fa8SNicholas Bellinger if (rc) { 123441861fa8SNicholas Bellinger kunmap_atomic(paddr); 123541861fa8SNicholas Bellinger kunmap_atomic(daddr); 123676736db3SSagi Grimberg cmd->bad_sector = sector; 123741861fa8SNicholas Bellinger return rc; 123841861fa8SNicholas Bellinger } 123941861fa8SNicholas Bellinger 124041861fa8SNicholas Bellinger sector++; 124141861fa8SNicholas Bellinger ei_lba++; 124241861fa8SNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 124341861fa8SNicholas Bellinger } 124441861fa8SNicholas Bellinger 124541861fa8SNicholas Bellinger kunmap_atomic(paddr); 124641861fa8SNicholas Bellinger kunmap_atomic(daddr); 124741861fa8SNicholas Bellinger } 124841861fa8SNicholas Bellinger sbc_dif_copy_prot(cmd, sectors, false, sg, sg_off); 124941861fa8SNicholas Bellinger 125041861fa8SNicholas Bellinger return 0; 125141861fa8SNicholas Bellinger } 125241861fa8SNicholas Bellinger EXPORT_SYMBOL(sbc_dif_verify_write); 125341861fa8SNicholas Bellinger 1254395ccb25SNicholas Bellinger static sense_reason_t 1255395ccb25SNicholas Bellinger __sbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors, 125641861fa8SNicholas Bellinger unsigned int ei_lba, struct scatterlist *sg, int sg_off) 125741861fa8SNicholas Bellinger { 125841861fa8SNicholas Bellinger struct se_device *dev = cmd->se_dev; 125941861fa8SNicholas Bellinger struct se_dif_v1_tuple *sdt; 1260fc272ec7SSagi Grimberg struct scatterlist *dsg, *psg = sg; 126141861fa8SNicholas Bellinger sector_t sector = start; 126241861fa8SNicholas Bellinger void *daddr, *paddr; 126341861fa8SNicholas Bellinger int i, j, offset = sg_off; 126441861fa8SNicholas Bellinger sense_reason_t rc; 126541861fa8SNicholas Bellinger 126641861fa8SNicholas Bellinger for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) { 126741861fa8SNicholas Bellinger daddr = kmap_atomic(sg_page(dsg)) + dsg->offset; 1268fc272ec7SSagi Grimberg paddr = kmap_atomic(sg_page(psg)) + sg->offset; 126941861fa8SNicholas Bellinger 127041861fa8SNicholas Bellinger for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) { 127141861fa8SNicholas Bellinger 1272fc272ec7SSagi Grimberg if (offset >= psg->length) { 127341861fa8SNicholas Bellinger kunmap_atomic(paddr); 1274fc272ec7SSagi Grimberg psg = sg_next(psg); 1275fc272ec7SSagi Grimberg paddr = kmap_atomic(sg_page(psg)) + psg->offset; 127641861fa8SNicholas Bellinger offset = 0; 127741861fa8SNicholas Bellinger } 127841861fa8SNicholas Bellinger 127941861fa8SNicholas Bellinger sdt = paddr + offset; 128041861fa8SNicholas Bellinger 128141861fa8SNicholas Bellinger pr_debug("DIF READ sector: %llu guard_tag: 0x%04x" 128241861fa8SNicholas Bellinger " app_tag: 0x%04x ref_tag: %u\n", 128341861fa8SNicholas Bellinger (unsigned long long)sector, sdt->guard_tag, 128441861fa8SNicholas Bellinger sdt->app_tag, be32_to_cpu(sdt->ref_tag)); 128541861fa8SNicholas Bellinger 128641861fa8SNicholas Bellinger if (sdt->app_tag == cpu_to_be16(0xffff)) { 128741861fa8SNicholas Bellinger sector++; 128841861fa8SNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 128941861fa8SNicholas Bellinger continue; 129041861fa8SNicholas Bellinger } 129141861fa8SNicholas Bellinger 129241861fa8SNicholas Bellinger rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector, 129341861fa8SNicholas Bellinger ei_lba); 129441861fa8SNicholas Bellinger if (rc) { 129541861fa8SNicholas Bellinger kunmap_atomic(paddr); 129641861fa8SNicholas Bellinger kunmap_atomic(daddr); 129776736db3SSagi Grimberg cmd->bad_sector = sector; 129841861fa8SNicholas Bellinger return rc; 129941861fa8SNicholas Bellinger } 130041861fa8SNicholas Bellinger 130141861fa8SNicholas Bellinger sector++; 130241861fa8SNicholas Bellinger ei_lba++; 130341861fa8SNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 130441861fa8SNicholas Bellinger } 130541861fa8SNicholas Bellinger 130641861fa8SNicholas Bellinger kunmap_atomic(paddr); 130741861fa8SNicholas Bellinger kunmap_atomic(daddr); 130841861fa8SNicholas Bellinger } 130941861fa8SNicholas Bellinger 131041861fa8SNicholas Bellinger return 0; 131141861fa8SNicholas Bellinger } 1312395ccb25SNicholas Bellinger 1313395ccb25SNicholas Bellinger sense_reason_t 1314395ccb25SNicholas Bellinger sbc_dif_read_strip(struct se_cmd *cmd) 1315395ccb25SNicholas Bellinger { 1316395ccb25SNicholas Bellinger struct se_device *dev = cmd->se_dev; 1317395ccb25SNicholas Bellinger u32 sectors = cmd->prot_length / dev->prot_length; 1318395ccb25SNicholas Bellinger 1319395ccb25SNicholas Bellinger return __sbc_dif_verify_read(cmd, cmd->t_task_lba, sectors, 0, 1320395ccb25SNicholas Bellinger cmd->t_prot_sg, 0); 1321395ccb25SNicholas Bellinger } 1322395ccb25SNicholas Bellinger 1323395ccb25SNicholas Bellinger sense_reason_t 1324395ccb25SNicholas Bellinger sbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors, 1325395ccb25SNicholas Bellinger unsigned int ei_lba, struct scatterlist *sg, int sg_off) 1326395ccb25SNicholas Bellinger { 1327395ccb25SNicholas Bellinger sense_reason_t rc; 1328395ccb25SNicholas Bellinger 1329395ccb25SNicholas Bellinger rc = __sbc_dif_verify_read(cmd, start, sectors, ei_lba, sg, sg_off); 1330395ccb25SNicholas Bellinger if (rc) 1331395ccb25SNicholas Bellinger return rc; 1332395ccb25SNicholas Bellinger 1333395ccb25SNicholas Bellinger sbc_dif_copy_prot(cmd, sectors, true, sg, sg_off); 1334395ccb25SNicholas Bellinger return 0; 1335395ccb25SNicholas Bellinger } 133641861fa8SNicholas Bellinger EXPORT_SYMBOL(sbc_dif_verify_read); 1337