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