target_core_sbc.c revision 2426bd456a61407388b6e61fc5f98dbcbebc50e2
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; 65003abad9e8715563ab3eef9609ba4d16b32bfd22dSagi Grimberg pr_debug("%s: prot_type=%d, prot_length=%d prot_op=%d prot_checks=%d\n", 65103abad9e8715563ab3eef9609ba4d16b32bfd22dSagi Grimberg __func__, cmd->prot_type, cmd->prot_length, 65203abad9e8715563ab3eef9609ba4d16b32bfd22dSagi Grimberg cmd->prot_op, cmd->prot_checks); 653499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 654499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return true; 655499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger} 656499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 657de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigsense_reason_t 658de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigsbc_parse_cdb(struct se_cmd *cmd, struct sbc_ops *ops) 659d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 660d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig struct se_device *dev = cmd->se_dev; 661d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig unsigned char *cdb = cmd->t_task_cdb; 6621fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig unsigned int size; 663d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig u32 sectors = 0; 664de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig sense_reason_t ret; 665d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 666d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig switch (cdb[0]) { 667d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case READ_6: 668d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_6(cdb); 669d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_21(cdb); 670d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 671a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 672a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 673d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 674d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case READ_10: 675d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 676d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 677499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 67819f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, false)) 679499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 680499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 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_12: 686d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_12(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_16: 697d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_16(cdb); 698d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_64(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 WRITE_6: 708d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_6(cdb); 709d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_21(cdb); 710d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 711a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 712a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 713d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 714d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_10: 715d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_VERIFY: 716d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 717d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 718499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 71919f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 720499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 721499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 722d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 723d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 724d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 725a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 726a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 727d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 728d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_12: 729d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_12(cdb); 730d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 731499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 73219f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 733499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 734499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 735d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 736d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 737d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 738a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 739a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 740d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 741d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_16: 742d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_16(cdb); 743d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_64(cdb); 744499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 74519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 746499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 747499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 748d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 749d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 750d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 751a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 752a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 753d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 754d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case XDWRITEREAD_10: 755de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig if (cmd->data_direction != DMA_TO_DEVICE || 756d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig !(cmd->se_cmd_flags & SCF_BIDI)) 757de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 758d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 759d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 760d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 761d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 762d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 763d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 764d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Setup BIDI XOR callback to be run after I/O completion. 765d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 766a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 767a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 768d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->transport_complete_callback = &xdreadwrite_callback; 769d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 770d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 771d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 772d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case VARIABLE_LENGTH_CMD: 773d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig { 774d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig u16 service_action = get_unaligned_be16(&cdb[8]); 775d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig switch (service_action) { 776d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case XDWRITEREAD_32: 777d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_32(cdb); 778d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 779d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 780d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Use WRITE_32 and READ_32 opcodes for the emulated 781d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * XDWRITE_READ_32 logic. 782d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 783d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_64_ext(cdb); 784d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 785d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 786d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 787d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Setup BIDI XOR callback to be run during after I/O 788d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * completion. 789d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 790a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 791a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 792d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->transport_complete_callback = &xdreadwrite_callback; 793d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 794d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 795d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 796d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_SAME_32: 797d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_32(cdb); 798d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!sectors) { 799d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not" 800d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " supported\n"); 801de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 802d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 803d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 8041fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = sbc_get_size(cmd, 1); 805d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = get_unaligned_be64(&cdb[12]); 806d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 807cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[10], ops); 8086b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter if (ret) 809cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return ret; 810d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 811d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig default: 812d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("VARIABLE_LENGTH_CMD service action" 813d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " 0x%04x not supported\n", service_action); 814de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 815d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 816d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 817d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 81868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger case COMPARE_AND_WRITE: 81968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sectors = cdb[13]; 82068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 82168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Currently enforce COMPARE_AND_WRITE for a single sector 82268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 82368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (sectors > 1) { 82468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger pr_err("COMPARE_AND_WRITE contains NoLB: %u greater" 82568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger " than 1\n", sectors); 82668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger return TCM_INVALID_CDB_FIELD; 82768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 82868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 82968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Double size because we have two buffers, note that 83068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * zero is not an error.. 83168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 83268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger size = 2 * sbc_get_size(cmd, sectors); 83368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_task_lba = get_unaligned_be64(&cdb[2]); 83468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_task_nolb = sectors; 83568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB | SCF_COMPARE_AND_WRITE; 83668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->execute_rw = ops->execute_rw; 83768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->execute_cmd = sbc_compare_and_write; 83868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->transport_complete_callback = compare_and_write_callback; 83968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger break; 840d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case READ_CAPACITY: 8411fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = READ_CAP_LEN; 8421fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig cmd->execute_cmd = sbc_emulate_readcapacity; 843d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 844d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case SERVICE_ACTION_IN: 845d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig switch (cmd->t_task_cdb[1] & 0x1f) { 846d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case SAI_READ_CAPACITY_16: 8471fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig cmd->execute_cmd = sbc_emulate_readcapacity_16; 848d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 849c66094bf325ee406b92298d73089ee25484a0263Hannes Reinecke case SAI_REPORT_REFERRALS: 850c66094bf325ee406b92298d73089ee25484a0263Hannes Reinecke cmd->execute_cmd = target_emulate_report_referrals; 851c66094bf325ee406b92298d73089ee25484a0263Hannes Reinecke break; 852d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig default: 853d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("Unsupported SA: 0x%02x\n", 854d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_cdb[1] & 0x1f); 855de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 856d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 8571fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = (cdb[10] << 24) | (cdb[11] << 16) | 858d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig (cdb[12] << 8) | cdb[13]; 859d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 860d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case SYNCHRONIZE_CACHE: 861d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case SYNCHRONIZE_CACHE_16: 862d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[0] == SYNCHRONIZE_CACHE) { 863d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 864d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 865d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } else { 866d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_16(cdb); 867d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_64(cdb); 868d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 8696ef31dc720cff4dc6a67ccb8c73c56dbf2ea6a08Christophe Vu-Brugier if (ops->execute_sync_cache) { 8706ef31dc720cff4dc6a67ccb8c73c56dbf2ea6a08Christophe Vu-Brugier cmd->execute_cmd = ops->execute_sync_cache; 8716ef31dc720cff4dc6a67ccb8c73c56dbf2ea6a08Christophe Vu-Brugier goto check_lba; 872d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 8736ef31dc720cff4dc6a67ccb8c73c56dbf2ea6a08Christophe Vu-Brugier size = 0; 8746ef31dc720cff4dc6a67ccb8c73c56dbf2ea6a08Christophe Vu-Brugier cmd->execute_cmd = sbc_emulate_noop; 875d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 876d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case UNMAP: 87714150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig if (!ops->execute_unmap) 878de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 87914150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig 8801fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = get_unaligned_be16(&cdb[7]); 88114150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig cmd->execute_cmd = ops->execute_unmap; 882d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 883d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_SAME_16: 884d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_16(cdb); 885d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!sectors) { 886d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n"); 887de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 888d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 889d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 8901fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = sbc_get_size(cmd, 1); 891d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = get_unaligned_be64(&cdb[2]); 892d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 893cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[1], ops); 8946b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter if (ret) 895cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return ret; 896d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 897d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_SAME: 898d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 899d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!sectors) { 900d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n"); 901de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 902d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 903d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 9041fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = sbc_get_size(cmd, 1); 905d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = get_unaligned_be32(&cdb[2]); 906d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 907d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 908d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Follow sbcr26 with WRITE_SAME (10) and check for the existence 909d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * of byte 1 bit 3 UNMAP instead of original reserved field 910d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 911cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[1], ops); 9126b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter if (ret) 913cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return ret; 914d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 915d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case VERIFY: 9161fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = 0; 917c52716defd6ec7e89c510c740de7ec3478008f28Christophe Vu-Brugier sectors = transport_get_sectors_10(cdb); 918c52716defd6ec7e89c510c740de7ec3478008f28Christophe Vu-Brugier cmd->t_task_lba = transport_lba_32(cdb); 9191920ed61fbbbb38919edfb2427b0b1fd4e4ad8d9Nicholas Bellinger cmd->execute_cmd = sbc_emulate_noop; 920c52716defd6ec7e89c510c740de7ec3478008f28Christophe Vu-Brugier goto check_lba; 9211a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl case REZERO_UNIT: 9221a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl case SEEK_6: 9231a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl case SEEK_10: 9241a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl /* 9251a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl * There are still clients out there which use these old SCSI-2 9261a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl * commands. This mainly happens when running VMs with legacy 9271a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl * guest systems, connected via SCSI command pass-through to 9281a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl * iSCSI targets. Make them happy and return status GOOD. 9291a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl */ 9301a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl size = 0; 9311a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl cmd->execute_cmd = sbc_emulate_noop; 9321a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl break; 933d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig default: 9341fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig ret = spc_parse_cdb(cmd, &size); 935d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (ret) 936d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return ret; 937d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 938d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 939d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* reject any command that we don't have a handler for */ 940d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!(cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) && !cmd->execute_cmd) 941de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 942d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 943d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) { 9441fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig unsigned long long end_lba; 9451fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 9460fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig if (sectors > dev->dev_attrib.fabric_max_sectors) { 947d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig printk_ratelimited(KERN_ERR "SCSI OP %02xh with too" 948d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " big sectors %u exceeds fabric_max_sectors:" 949d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " %u\n", cdb[0], sectors, 9500fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig dev->dev_attrib.fabric_max_sectors); 951de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 952d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 9530fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig if (sectors > dev->dev_attrib.hw_max_sectors) { 954d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig printk_ratelimited(KERN_ERR "SCSI OP %02xh with too" 955d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " big sectors %u exceeds backend hw_max_sectors:" 956d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " %u\n", cdb[0], sectors, 9570fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig dev->dev_attrib.hw_max_sectors); 958de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 959d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 9606ef31dc720cff4dc6a67ccb8c73c56dbf2ea6a08Christophe Vu-Brugiercheck_lba: 9611fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig end_lba = dev->transport->get_blocks(dev) + 1; 9621fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig if (cmd->t_task_lba + sectors > end_lba) { 9631fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig pr_err("cmd exceeds last lba %llu " 9641fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig "(lba %llu, sectors %u)\n", 9651fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig end_lba, cmd->t_task_lba, sectors); 96609ceadc70383a4105c0372f9e83da2c0cb0a8017Roland Dreier return TCM_ADDRESS_OUT_OF_RANGE; 9671fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig } 9681fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 96968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (!(cmd->se_cmd_flags & SCF_COMPARE_AND_WRITE)) 97068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger size = sbc_get_size(cmd, sectors); 971d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 972d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 973de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return target_cmd_size_check(cmd, size); 974d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 975d6e0175cf3f9737a760482d185bb73566bcc9331Christoph HellwigEXPORT_SYMBOL(sbc_parse_cdb); 9766f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig 9776f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwigu32 sbc_get_device_type(struct se_device *dev) 9786f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig{ 9796f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig return TYPE_DISK; 9806f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig} 9816f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph HellwigEXPORT_SYMBOL(sbc_get_device_type); 98286d7182985d25900929adce14fffd729cc8c6fb8Asias He 98386d7182985d25900929adce14fffd729cc8c6fb8Asias Hesense_reason_t 98486d7182985d25900929adce14fffd729cc8c6fb8Asias Hesbc_execute_unmap(struct se_cmd *cmd, 98586d7182985d25900929adce14fffd729cc8c6fb8Asias He sense_reason_t (*do_unmap_fn)(struct se_cmd *, void *, 98686d7182985d25900929adce14fffd729cc8c6fb8Asias He sector_t, sector_t), 98786d7182985d25900929adce14fffd729cc8c6fb8Asias He void *priv) 98886d7182985d25900929adce14fffd729cc8c6fb8Asias He{ 98986d7182985d25900929adce14fffd729cc8c6fb8Asias He struct se_device *dev = cmd->se_dev; 99086d7182985d25900929adce14fffd729cc8c6fb8Asias He unsigned char *buf, *ptr = NULL; 99186d7182985d25900929adce14fffd729cc8c6fb8Asias He sector_t lba; 99286d7182985d25900929adce14fffd729cc8c6fb8Asias He int size; 99386d7182985d25900929adce14fffd729cc8c6fb8Asias He u32 range; 99486d7182985d25900929adce14fffd729cc8c6fb8Asias He sense_reason_t ret = 0; 99586d7182985d25900929adce14fffd729cc8c6fb8Asias He int dl, bd_dl; 99686d7182985d25900929adce14fffd729cc8c6fb8Asias He 99786d7182985d25900929adce14fffd729cc8c6fb8Asias He /* We never set ANC_SUP */ 99886d7182985d25900929adce14fffd729cc8c6fb8Asias He if (cmd->t_task_cdb[1]) 99986d7182985d25900929adce14fffd729cc8c6fb8Asias He return TCM_INVALID_CDB_FIELD; 100086d7182985d25900929adce14fffd729cc8c6fb8Asias He 100186d7182985d25900929adce14fffd729cc8c6fb8Asias He if (cmd->data_length == 0) { 100286d7182985d25900929adce14fffd729cc8c6fb8Asias He target_complete_cmd(cmd, SAM_STAT_GOOD); 100386d7182985d25900929adce14fffd729cc8c6fb8Asias He return 0; 100486d7182985d25900929adce14fffd729cc8c6fb8Asias He } 100586d7182985d25900929adce14fffd729cc8c6fb8Asias He 100686d7182985d25900929adce14fffd729cc8c6fb8Asias He if (cmd->data_length < 8) { 100786d7182985d25900929adce14fffd729cc8c6fb8Asias He pr_warn("UNMAP parameter list length %u too small\n", 100886d7182985d25900929adce14fffd729cc8c6fb8Asias He cmd->data_length); 100986d7182985d25900929adce14fffd729cc8c6fb8Asias He return TCM_PARAMETER_LIST_LENGTH_ERROR; 101086d7182985d25900929adce14fffd729cc8c6fb8Asias He } 101186d7182985d25900929adce14fffd729cc8c6fb8Asias He 101286d7182985d25900929adce14fffd729cc8c6fb8Asias He buf = transport_kmap_data_sg(cmd); 101386d7182985d25900929adce14fffd729cc8c6fb8Asias He if (!buf) 101486d7182985d25900929adce14fffd729cc8c6fb8Asias He return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE; 101586d7182985d25900929adce14fffd729cc8c6fb8Asias He 101686d7182985d25900929adce14fffd729cc8c6fb8Asias He dl = get_unaligned_be16(&buf[0]); 101786d7182985d25900929adce14fffd729cc8c6fb8Asias He bd_dl = get_unaligned_be16(&buf[2]); 101886d7182985d25900929adce14fffd729cc8c6fb8Asias He 101986d7182985d25900929adce14fffd729cc8c6fb8Asias He size = cmd->data_length - 8; 102086d7182985d25900929adce14fffd729cc8c6fb8Asias He if (bd_dl > size) 102186d7182985d25900929adce14fffd729cc8c6fb8Asias He pr_warn("UNMAP parameter list length %u too small, ignoring bd_dl %u\n", 102286d7182985d25900929adce14fffd729cc8c6fb8Asias He cmd->data_length, bd_dl); 102386d7182985d25900929adce14fffd729cc8c6fb8Asias He else 102486d7182985d25900929adce14fffd729cc8c6fb8Asias He size = bd_dl; 102586d7182985d25900929adce14fffd729cc8c6fb8Asias He 102686d7182985d25900929adce14fffd729cc8c6fb8Asias He if (size / 16 > dev->dev_attrib.max_unmap_block_desc_count) { 102786d7182985d25900929adce14fffd729cc8c6fb8Asias He ret = TCM_INVALID_PARAMETER_LIST; 102886d7182985d25900929adce14fffd729cc8c6fb8Asias He goto err; 102986d7182985d25900929adce14fffd729cc8c6fb8Asias He } 103086d7182985d25900929adce14fffd729cc8c6fb8Asias He 103186d7182985d25900929adce14fffd729cc8c6fb8Asias He /* First UNMAP block descriptor starts at 8 byte offset */ 103286d7182985d25900929adce14fffd729cc8c6fb8Asias He ptr = &buf[8]; 103386d7182985d25900929adce14fffd729cc8c6fb8Asias He pr_debug("UNMAP: Sub: %s Using dl: %u bd_dl: %u size: %u" 103486d7182985d25900929adce14fffd729cc8c6fb8Asias He " ptr: %p\n", dev->transport->name, dl, bd_dl, size, ptr); 103586d7182985d25900929adce14fffd729cc8c6fb8Asias He 103686d7182985d25900929adce14fffd729cc8c6fb8Asias He while (size >= 16) { 103786d7182985d25900929adce14fffd729cc8c6fb8Asias He lba = get_unaligned_be64(&ptr[0]); 103886d7182985d25900929adce14fffd729cc8c6fb8Asias He range = get_unaligned_be32(&ptr[8]); 103986d7182985d25900929adce14fffd729cc8c6fb8Asias He pr_debug("UNMAP: Using lba: %llu and range: %u\n", 104086d7182985d25900929adce14fffd729cc8c6fb8Asias He (unsigned long long)lba, range); 104186d7182985d25900929adce14fffd729cc8c6fb8Asias He 104286d7182985d25900929adce14fffd729cc8c6fb8Asias He if (range > dev->dev_attrib.max_unmap_lba_count) { 104386d7182985d25900929adce14fffd729cc8c6fb8Asias He ret = TCM_INVALID_PARAMETER_LIST; 104486d7182985d25900929adce14fffd729cc8c6fb8Asias He goto err; 104586d7182985d25900929adce14fffd729cc8c6fb8Asias He } 104686d7182985d25900929adce14fffd729cc8c6fb8Asias He 104786d7182985d25900929adce14fffd729cc8c6fb8Asias He if (lba + range > dev->transport->get_blocks(dev) + 1) { 104886d7182985d25900929adce14fffd729cc8c6fb8Asias He ret = TCM_ADDRESS_OUT_OF_RANGE; 104986d7182985d25900929adce14fffd729cc8c6fb8Asias He goto err; 105086d7182985d25900929adce14fffd729cc8c6fb8Asias He } 105186d7182985d25900929adce14fffd729cc8c6fb8Asias He 105286d7182985d25900929adce14fffd729cc8c6fb8Asias He ret = do_unmap_fn(cmd, priv, lba, range); 105386d7182985d25900929adce14fffd729cc8c6fb8Asias He if (ret) 105486d7182985d25900929adce14fffd729cc8c6fb8Asias He goto err; 105586d7182985d25900929adce14fffd729cc8c6fb8Asias He 105686d7182985d25900929adce14fffd729cc8c6fb8Asias He ptr += 16; 105786d7182985d25900929adce14fffd729cc8c6fb8Asias He size -= 16; 105886d7182985d25900929adce14fffd729cc8c6fb8Asias He } 105986d7182985d25900929adce14fffd729cc8c6fb8Asias He 106086d7182985d25900929adce14fffd729cc8c6fb8Asias Heerr: 106186d7182985d25900929adce14fffd729cc8c6fb8Asias He transport_kunmap_data_sg(cmd); 106286d7182985d25900929adce14fffd729cc8c6fb8Asias He if (!ret) 106386d7182985d25900929adce14fffd729cc8c6fb8Asias He target_complete_cmd(cmd, GOOD); 106486d7182985d25900929adce14fffd729cc8c6fb8Asias He return ret; 106586d7182985d25900929adce14fffd729cc8c6fb8Asias He} 106686d7182985d25900929adce14fffd729cc8c6fb8Asias HeEXPORT_SYMBOL(sbc_execute_unmap); 106741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 106866a3d5bc47d2973820816226e957db9e85285455Nicholas Bellingervoid 106966a3d5bc47d2973820816226e957db9e85285455Nicholas Bellingersbc_dif_generate(struct se_cmd *cmd) 107066a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger{ 107166a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger struct se_device *dev = cmd->se_dev; 107266a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger struct se_dif_v1_tuple *sdt; 107366a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger struct scatterlist *dsg, *psg = cmd->t_prot_sg; 107466a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger sector_t sector = cmd->t_task_lba; 107566a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger void *daddr, *paddr; 107666a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger int i, j, offset = 0; 107766a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger 107866a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) { 107966a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger daddr = kmap_atomic(sg_page(dsg)) + dsg->offset; 108066a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 108166a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger 108266a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) { 108366a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger 108466a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger if (offset >= psg->length) { 108566a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger kunmap_atomic(paddr); 108666a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger psg = sg_next(psg); 108766a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 108866a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger offset = 0; 108966a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger } 109066a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger 109166a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger sdt = paddr + offset; 109266a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger sdt->guard_tag = cpu_to_be16(crc_t10dif(daddr + j, 109366a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger dev->dev_attrib.block_size)); 109466a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT) 109566a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger sdt->ref_tag = cpu_to_be32(sector & 0xffffffff); 109666a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger sdt->app_tag = 0; 109766a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger 109866a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger pr_debug("DIF WRITE INSERT sector: %llu guard_tag: 0x%04x" 109966a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger " app_tag: 0x%04x ref_tag: %u\n", 110066a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger (unsigned long long)sector, sdt->guard_tag, 110166a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger sdt->app_tag, be32_to_cpu(sdt->ref_tag)); 110266a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger 110366a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger sector++; 110466a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 110566a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger } 110666a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger 110766a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger kunmap_atomic(paddr); 110866a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger kunmap_atomic(daddr); 110966a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger } 111066a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger} 111166a3d5bc47d2973820816226e957db9e85285455Nicholas Bellinger 111241861fa831afd4b5006f0042e1f701360330351eNicholas Bellingerstatic sense_reason_t 111341861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersbc_dif_v1_verify(struct se_device *dev, struct se_dif_v1_tuple *sdt, 111441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger const void *p, sector_t sector, unsigned int ei_lba) 111541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger{ 111641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger int block_size = dev->dev_attrib.block_size; 111741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger __be16 csum; 111841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 111941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger csum = cpu_to_be16(crc_t10dif(p, block_size)); 112041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 112141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (sdt->guard_tag != csum) { 112241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_err("DIFv1 checksum failed on sector %llu guard tag 0x%04x" 112341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " csum 0x%04x\n", (unsigned long long)sector, 112441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be16_to_cpu(sdt->guard_tag), be16_to_cpu(csum)); 112541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED; 112641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 112741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 112841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT && 112941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be32_to_cpu(sdt->ref_tag) != (sector & 0xffffffff)) { 113041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_err("DIFv1 Type 1 reference failed on sector: %llu tag: 0x%08x" 113141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " sector MSB: 0x%08x\n", (unsigned long long)sector, 113241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be32_to_cpu(sdt->ref_tag), (u32)(sector & 0xffffffff)); 113341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED; 113441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 113541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 113641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE2_PROT && 113741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be32_to_cpu(sdt->ref_tag) != ei_lba) { 113841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_err("DIFv1 Type 2 reference failed on sector: %llu tag: 0x%08x" 113941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " ei_lba: 0x%08x\n", (unsigned long long)sector, 114041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be32_to_cpu(sdt->ref_tag), ei_lba); 114141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED; 114241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 114341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 114441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return 0; 114541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger} 114641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 114741861fa831afd4b5006f0042e1f701360330351eNicholas Bellingerstatic void 114841861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersbc_dif_copy_prot(struct se_cmd *cmd, unsigned int sectors, bool read, 114941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct scatterlist *sg, int sg_off) 115041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger{ 115141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_device *dev = cmd->se_dev; 115241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct scatterlist *psg; 115341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger void *paddr, *addr; 115441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger unsigned int i, len, left; 115510762e80489e73e2d52bf78e0869f253f42821bdNicholas Bellinger unsigned int offset = sg_off; 115641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 115741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger left = sectors * dev->prot_length; 115841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 115941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for_each_sg(cmd->t_prot_sg, psg, cmd->t_prot_nents, i) { 116016c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg unsigned int psg_len, copied = 0; 1161d6a65fdc8903e632aa7bf86ee0f61a73969371f6Sagi Grimberg 116241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 116316c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg psg_len = min(left, psg->length); 116416c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg while (psg_len) { 116516c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg len = min(psg_len, sg->length - offset); 116616c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg addr = kmap_atomic(sg_page(sg)) + sg->offset + offset; 116716c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg 116816c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg if (read) 116916c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg memcpy(paddr + copied, addr, len); 117016c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg else 117116c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg memcpy(addr, paddr + copied, len); 117216c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg 117316c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg left -= len; 117416c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg offset += len; 117516c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg copied += len; 117616c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg psg_len -= len; 117716c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg 117816c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg if (offset >= sg->length) { 117916c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg sg = sg_next(sg); 118016c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg offset = 0; 118116c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg } 118216c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg kunmap_atomic(addr); 118316c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg } 118441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 118541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 118641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger} 118741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 118841861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersense_reason_t 118941861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersbc_dif_verify_write(struct se_cmd *cmd, sector_t start, unsigned int sectors, 119041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger unsigned int ei_lba, struct scatterlist *sg, int sg_off) 119141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger{ 119241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_device *dev = cmd->se_dev; 119341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_dif_v1_tuple *sdt; 119441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct scatterlist *dsg, *psg = cmd->t_prot_sg; 119541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector_t sector = start; 119641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger void *daddr, *paddr; 119741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger int i, j, offset = 0; 119841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sense_reason_t rc; 119941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 120041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) { 120141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger daddr = kmap_atomic(sg_page(dsg)) + dsg->offset; 120241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 120341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 120441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) { 120541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 120641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (offset >= psg->length) { 120741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 120841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger psg = sg_next(psg); 120941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 121041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset = 0; 121141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 121241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 121341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sdt = paddr + offset; 121441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 121541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_debug("DIF WRITE sector: %llu guard_tag: 0x%04x" 121641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " app_tag: 0x%04x ref_tag: %u\n", 121741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger (unsigned long long)sector, sdt->guard_tag, 121841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sdt->app_tag, be32_to_cpu(sdt->ref_tag)); 121941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 122041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector, 122141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger ei_lba); 122241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (rc) { 122341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 122441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(daddr); 122576736db3e291246fbce9db856706af3454b0b078Sagi Grimberg cmd->bad_sector = sector; 122641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return rc; 122741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 122841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 122941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector++; 123041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger ei_lba++; 123141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 123241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 123341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 123441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 123541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(daddr); 123641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 123741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sbc_dif_copy_prot(cmd, sectors, false, sg, sg_off); 123841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 123941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return 0; 124041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger} 124141861fa831afd4b5006f0042e1f701360330351eNicholas BellingerEXPORT_SYMBOL(sbc_dif_verify_write); 124241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 1243395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellingerstatic sense_reason_t 1244395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger__sbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors, 1245395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger unsigned int ei_lba, struct scatterlist *sg, int sg_off) 124641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger{ 124741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_device *dev = cmd->se_dev; 124841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_dif_v1_tuple *sdt; 1249fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg struct scatterlist *dsg, *psg = sg; 125041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector_t sector = start; 125141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger void *daddr, *paddr; 125241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger int i, j, offset = sg_off; 125341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sense_reason_t rc; 125441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 125541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) { 125641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger daddr = kmap_atomic(sg_page(dsg)) + dsg->offset; 1257fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg paddr = kmap_atomic(sg_page(psg)) + sg->offset; 125841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 125941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) { 126041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 1261fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg if (offset >= psg->length) { 126241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 1263fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg psg = sg_next(psg); 1264fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg paddr = kmap_atomic(sg_page(psg)) + psg->offset; 126541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset = 0; 126641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 126741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 126841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sdt = paddr + offset; 126941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 127041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_debug("DIF READ sector: %llu guard_tag: 0x%04x" 127141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " app_tag: 0x%04x ref_tag: %u\n", 127241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger (unsigned long long)sector, sdt->guard_tag, 127341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sdt->app_tag, be32_to_cpu(sdt->ref_tag)); 127441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 127541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (sdt->app_tag == cpu_to_be16(0xffff)) { 127641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector++; 127741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 127841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger continue; 127941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 128041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 128141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector, 128241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger ei_lba); 128341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (rc) { 128441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 128541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(daddr); 128676736db3e291246fbce9db856706af3454b0b078Sagi Grimberg cmd->bad_sector = sector; 128741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return rc; 128841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 128941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 129041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector++; 129141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger ei_lba++; 129241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 129341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 129441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 129541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 129641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(daddr); 129741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 129841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 129941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return 0; 130041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger} 1301395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger 1302395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellingersense_reason_t 1303395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellingersbc_dif_read_strip(struct se_cmd *cmd) 1304395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger{ 1305395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger struct se_device *dev = cmd->se_dev; 1306395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger u32 sectors = cmd->prot_length / dev->prot_length; 1307395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger 1308395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger return __sbc_dif_verify_read(cmd, cmd->t_task_lba, sectors, 0, 1309395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger cmd->t_prot_sg, 0); 1310395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger} 1311395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger 1312395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellingersense_reason_t 1313395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellingersbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors, 1314395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger unsigned int ei_lba, struct scatterlist *sg, int sg_off) 1315395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger{ 1316395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger sense_reason_t rc; 1317395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger 1318395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger rc = __sbc_dif_verify_read(cmd, start, sectors, ei_lba, sg, sg_off); 1319395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger if (rc) 1320395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger return rc; 1321395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger 1322395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger sbc_dif_copy_prot(cmd, sectors, true, sg, sg_off); 1323395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger return 0; 1324395ccb2531021974d309f26e5fb08a8240ac5f84Nicholas Bellinger} 132541861fa831afd4b5006f0042e1f701360330351eNicholas BellingerEXPORT_SYMBOL(sbc_dif_verify_read); 1326