target_core_sbc.c revision 19f9361af7dfa0bb1f98c7619544ed71d2dded39
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 841fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig target_complete_cmd(cmd, GOOD); 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; 92a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini unsigned char *rbuf; 93a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini unsigned char buf[32]; 941fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig unsigned long long blocks = dev->transport->get_blocks(dev); 951fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 96a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini memset(buf, 0, sizeof(buf)); 971fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig buf[0] = (blocks >> 56) & 0xff; 981fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig buf[1] = (blocks >> 48) & 0xff; 991fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig buf[2] = (blocks >> 40) & 0xff; 1001fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig buf[3] = (blocks >> 32) & 0xff; 1011fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig buf[4] = (blocks >> 24) & 0xff; 1021fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig buf[5] = (blocks >> 16) & 0xff; 1031fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig buf[6] = (blocks >> 8) & 0xff; 1041fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig buf[7] = blocks & 0xff; 1050fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig buf[8] = (dev->dev_attrib.block_size >> 24) & 0xff; 1060fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig buf[9] = (dev->dev_attrib.block_size >> 16) & 0xff; 1070fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig buf[10] = (dev->dev_attrib.block_size >> 8) & 0xff; 1080fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig buf[11] = dev->dev_attrib.block_size & 0xff; 10956dac14cd25259fc567c5c4726a8f30f0ea407ceNicholas Bellinger /* 11056dac14cd25259fc567c5c4726a8f30f0ea407ceNicholas Bellinger * Set P_TYPE and PROT_EN bits for DIF support 11156dac14cd25259fc567c5c4726a8f30f0ea407ceNicholas Bellinger */ 11256dac14cd25259fc567c5c4726a8f30f0ea407ceNicholas Bellinger if (dev->dev_attrib.pi_prot_type) 11356dac14cd25259fc567c5c4726a8f30f0ea407ceNicholas Bellinger buf[12] = (dev->dev_attrib.pi_prot_type - 1) << 1 | 0x1; 1147f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover 1157f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover if (dev->transport->get_lbppbe) 1167f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover buf[13] = dev->transport->get_lbppbe(dev) & 0x0f; 1177f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover 1187f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover if (dev->transport->get_alignment_offset_lbas) { 1197f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover u16 lalba = dev->transport->get_alignment_offset_lbas(dev); 1207f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover buf[14] = (lalba >> 8) & 0x3f; 1217f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover buf[15] = lalba & 0xff; 1227f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover } 1237f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover 1241fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig /* 1251fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig * Set Thin Provisioning Enable bit following sbc3r22 in section 1261fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig * READ CAPACITY (16) byte 14 if emulate_tpu or emulate_tpws is enabled. 1271fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig */ 1280fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig if (dev->dev_attrib.emulate_tpu || dev->dev_attrib.emulate_tpws) 1297f7caf6aa74a4f4ad21ebe08bf23b594fce45ca7Andy Grover buf[14] |= 0x80; 1301fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 131a50da144d048f9dbebed2b1441ed779d6bbbcd03Paolo Bonzini rbuf = transport_kmap_data_sg(cmd); 1328b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger if (rbuf) { 1338b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger memcpy(rbuf, buf, min_t(u32, sizeof(buf), cmd->data_length)); 1348b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger transport_kunmap_data_sg(cmd); 1358b4b0dcbf70d10f3acd6a88fca0679ca711066e0Nicholas Bellinger } 1361fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 1371fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig target_complete_cmd(cmd, GOOD); 1381fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig return 0; 1391fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig} 1401fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 141972b29c8f86093f44e1d781588bd5c5faae3d8e3Roland Dreiersector_t sbc_get_write_same_sectors(struct se_cmd *cmd) 1421fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig{ 1431fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig u32 num_blocks; 1441fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 1451fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig if (cmd->t_task_cdb[0] == WRITE_SAME) 1461fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig num_blocks = get_unaligned_be16(&cmd->t_task_cdb[7]); 1471fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig else if (cmd->t_task_cdb[0] == WRITE_SAME_16) 1481fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig num_blocks = get_unaligned_be32(&cmd->t_task_cdb[10]); 1491fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig else /* WRITE_SAME_32 via VARIABLE_LENGTH_CMD */ 1501fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig num_blocks = get_unaligned_be32(&cmd->t_task_cdb[28]); 1511fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 1521fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig /* 1531fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig * Use the explicit range when non zero is supplied, otherwise calculate 1541fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig * the remaining range based on ->get_blocks() - starting LBA. 1551fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig */ 1566f974e8ce7b3f661910a49c7c2ba095631f341e9Christoph Hellwig if (num_blocks) 1576f974e8ce7b3f661910a49c7c2ba095631f341e9Christoph Hellwig return num_blocks; 1581fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 1596f974e8ce7b3f661910a49c7c2ba095631f341e9Christoph Hellwig return cmd->se_dev->transport->get_blocks(cmd->se_dev) - 1606f974e8ce7b3f661910a49c7c2ba095631f341e9Christoph Hellwig cmd->t_task_lba + 1; 1611fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig} 162972b29c8f86093f44e1d781588bd5c5faae3d8e3Roland DreierEXPORT_SYMBOL(sbc_get_write_same_sectors); 1631fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 164de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigstatic sense_reason_t 1651920ed61fbbbb38919edfb2427b0b1fd4e4ad8d9Nicholas Bellingersbc_emulate_noop(struct se_cmd *cmd) 1661a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl{ 1671a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl target_complete_cmd(cmd, GOOD); 1681a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl return 0; 1691a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl} 1701a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl 171d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 sbc_get_size(struct se_cmd *cmd, u32 sectors) 172d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 1730fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig return cmd->se_dev->dev_attrib.block_size * sectors; 174d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 175d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 176d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic int sbc_check_valid_sectors(struct se_cmd *cmd) 177d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 178d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig struct se_device *dev = cmd->se_dev; 179d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig unsigned long long end_lba; 180d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig u32 sectors; 181d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 1820fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig sectors = cmd->data_length / dev->dev_attrib.block_size; 183d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig end_lba = dev->transport->get_blocks(dev) + 1; 184d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 185d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cmd->t_task_lba + sectors > end_lba) { 186d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("target: lba %llu, sectors %u exceeds end lba %llu\n", 187d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba, sectors, end_lba); 188d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return -EINVAL; 189d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 190d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 191d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return 0; 192d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 193d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 194d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_6(unsigned char *cdb) 195d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 196d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 197d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Use 8-bit sector value. SBC-3 says: 198d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * 199d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * A TRANSFER LENGTH field set to zero specifies that 256 200d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * logical blocks shall be written. Any other value 201d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * specifies the number of logical blocks that shall be 202d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * written. 203d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 204d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return cdb[4] ? : 256; 205d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 206d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 207d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_10(unsigned char *cdb) 208d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 209d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return (u32)(cdb[7] << 8) + cdb[8]; 210d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 211d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 212d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_12(unsigned char *cdb) 213d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 214d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return (u32)(cdb[6] << 24) + (cdb[7] << 16) + (cdb[8] << 8) + cdb[9]; 215d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 216d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 217d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_16(unsigned char *cdb) 218d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 219d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return (u32)(cdb[10] << 24) + (cdb[11] << 16) + 220d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig (cdb[12] << 8) + cdb[13]; 221d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 222d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 223d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig/* 224d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Used for VARIABLE_LENGTH_CDB WRITE_32 and READ_32 variants 225d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 226d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_get_sectors_32(unsigned char *cdb) 227d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 228d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return (u32)(cdb[28] << 24) + (cdb[29] << 16) + 229d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig (cdb[30] << 8) + cdb[31]; 230d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 231d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 232d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 233d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_lba_21(unsigned char *cdb) 234d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 235d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return ((cdb[1] & 0x1f) << 16) | (cdb[2] << 8) | cdb[3]; 236d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 237d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 238d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline u32 transport_lba_32(unsigned char *cdb) 239d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 240d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return (cdb[2] << 24) | (cdb[3] << 16) | (cdb[4] << 8) | cdb[5]; 241d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 242d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 243d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline unsigned long long transport_lba_64(unsigned char *cdb) 244d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 245d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig unsigned int __v1, __v2; 246d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 247d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig __v1 = (cdb[2] << 24) | (cdb[3] << 16) | (cdb[4] << 8) | cdb[5]; 248d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig __v2 = (cdb[6] << 24) | (cdb[7] << 16) | (cdb[8] << 8) | cdb[9]; 249d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 250d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return ((unsigned long long)__v2) | (unsigned long long)__v1 << 32; 251d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 252d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 253d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig/* 254d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * For VARIABLE_LENGTH_CDB w/ 32 byte extended CDBs 255d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 256d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigstatic inline unsigned long long transport_lba_64_ext(unsigned char *cdb) 257d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 258d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig unsigned int __v1, __v2; 259d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 260d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig __v1 = (cdb[12] << 24) | (cdb[13] << 16) | (cdb[14] << 8) | cdb[15]; 261d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig __v2 = (cdb[16] << 24) | (cdb[17] << 16) | (cdb[18] << 8) | cdb[19]; 262d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 263d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return ((unsigned long long)__v2) | (unsigned long long)__v1 << 32; 264d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 265d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 266cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellingerstatic sense_reason_t 267cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellingersbc_setup_write_same(struct se_cmd *cmd, unsigned char *flags, struct sbc_ops *ops) 268d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 269972b29c8f86093f44e1d781588bd5c5faae3d8e3Roland Dreier unsigned int sectors = sbc_get_write_same_sectors(cmd); 270773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger 271d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if ((flags[0] & 0x04) || (flags[0] & 0x02)) { 272d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("WRITE_SAME PBDATA and LBDATA" 273d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " bits not supported for Block Discard" 274d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " Emulation\n"); 275cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 276d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 277773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger if (sectors > cmd->se_dev->dev_attrib.max_write_same_len) { 278773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger pr_warn("WRITE_SAME sectors: %u exceeds max_write_same_len: %u\n", 279773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger sectors, cmd->se_dev->dev_attrib.max_write_same_len); 280773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger return TCM_INVALID_CDB_FIELD; 281773cbaf7460aa58c67d4dca83c3f8bca10323bbeNicholas Bellinger } 2825cb770bf4b777dae832151f4bc4d35e7a99f9880Roland Dreier /* We always have ANC_SUP == 0 so setting ANCHOR is always an error */ 2835cb770bf4b777dae832151f4bc4d35e7a99f9880Roland Dreier if (flags[0] & 0x10) { 2845cb770bf4b777dae832151f4bc4d35e7a99f9880Roland Dreier pr_warn("WRITE SAME with ANCHOR not supported\n"); 2855cb770bf4b777dae832151f4bc4d35e7a99f9880Roland Dreier return TCM_INVALID_CDB_FIELD; 2865cb770bf4b777dae832151f4bc4d35e7a99f9880Roland Dreier } 287d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 288cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger * Special case for WRITE_SAME w/ UNMAP=1 that ends up getting 289cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger * translated into block discard requests within backend code. 290d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 291cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger if (flags[0] & 0x08) { 292cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger if (!ops->execute_write_same_unmap) 293cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 294cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger 295cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger cmd->execute_cmd = ops->execute_write_same_unmap; 296cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return 0; 297d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 298cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger if (!ops->execute_write_same) 299cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 300d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 301cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger cmd->execute_cmd = ops->execute_write_same; 302d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return 0; 303d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 304d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 305a6b0133c19af1ab268ed1f4414efa2782896a870Nicholas Bellingerstatic sense_reason_t xdreadwrite_callback(struct se_cmd *cmd) 306d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 307d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig unsigned char *buf, *addr; 308d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig struct scatterlist *sg; 309d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig unsigned int offset; 310a6b0133c19af1ab268ed1f4414efa2782896a870Nicholas Bellinger sense_reason_t ret = TCM_NO_SENSE; 311a6b0133c19af1ab268ed1f4414efa2782896a870Nicholas Bellinger int i, count; 312d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 313d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * From sbc3r22.pdf section 5.48 XDWRITEREAD (10) command 314d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * 315d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * 1) read the specified logical block(s); 316d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * 2) transfer logical blocks from the data-out buffer; 317d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * 3) XOR the logical blocks transferred from the data-out buffer with 318d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * the logical blocks read, storing the resulting XOR data in a buffer; 319d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * 4) if the DISABLE WRITE bit is set to zero, then write the logical 320d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * blocks transferred from the data-out buffer; and 321d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * 5) transfer the resulting XOR data to the data-in buffer. 322d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 323d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig buf = kmalloc(cmd->data_length, GFP_KERNEL); 324d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!buf) { 325d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("Unable to allocate xor_callback buf\n"); 326a6b0133c19af1ab268ed1f4414efa2782896a870Nicholas Bellinger return TCM_OUT_OF_RESOURCES; 327d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 328d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 329d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Copy the scatterlist WRITE buffer located at cmd->t_data_sg 330d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * into the locally allocated *buf 331d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 332d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sg_copy_to_buffer(cmd->t_data_sg, 333d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_data_nents, 334d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig buf, 335d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->data_length); 336d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 337d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 338d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Now perform the XOR against the BIDI read memory located at 339d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * cmd->t_mem_bidi_list 340d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 341d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 342d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig offset = 0; 343d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig for_each_sg(cmd->t_bidi_data_sg, sg, cmd->t_bidi_data_nents, count) { 344d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig addr = kmap_atomic(sg_page(sg)); 345a6b0133c19af1ab268ed1f4414efa2782896a870Nicholas Bellinger if (!addr) { 346a6b0133c19af1ab268ed1f4414efa2782896a870Nicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 347d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig goto out; 348a6b0133c19af1ab268ed1f4414efa2782896a870Nicholas Bellinger } 349d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 350d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig for (i = 0; i < sg->length; i++) 351d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig *(addr + sg->offset + i) ^= *(buf + offset + i); 352d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 353d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig offset += sg->length; 354d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig kunmap_atomic(addr); 355d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 356d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 357d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwigout: 358d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig kfree(buf); 359a6b0133c19af1ab268ed1f4414efa2782896a870Nicholas Bellinger return ret; 360d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 361d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 362a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellingerstatic sense_reason_t 363a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellingersbc_execute_rw(struct se_cmd *cmd) 364a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger{ 365a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger return cmd->execute_rw(cmd, cmd->t_data_sg, cmd->t_data_nents, 366a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->data_direction); 367a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger} 368a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger 36968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellingerstatic sense_reason_t compare_and_write_post(struct se_cmd *cmd) 37068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger{ 37168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger struct se_device *dev = cmd->se_dev; 37268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 373d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger /* 374d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger * Only set SCF_COMPARE_AND_WRITE_POST to force a response fall-through 375d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger * within target_complete_ok_work() if the command was successfully 376d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger * sent to the backend driver. 377d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger */ 378d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger spin_lock_irq(&cmd->t_state_lock); 379d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger if ((cmd->transport_state & CMD_T_SENT) && !cmd->scsi_status) 380d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger cmd->se_cmd_flags |= SCF_COMPARE_AND_WRITE_POST; 381d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger spin_unlock_irq(&cmd->t_state_lock); 382d8855c154e748c9ccd7c78e6478560ed61438e7dNicholas Bellinger 38368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 38468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Unlock ->caw_sem originally obtained during sbc_compare_and_write() 38568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * before the original READ I/O submission. 38668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 38768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger up(&dev->caw_sem); 38868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 38968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger return TCM_NO_SENSE; 39068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger} 39168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 39268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellingerstatic sense_reason_t compare_and_write_callback(struct se_cmd *cmd) 39368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger{ 39468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger struct se_device *dev = cmd->se_dev; 39568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger struct scatterlist *write_sg = NULL, *sg; 396db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger unsigned char *buf = NULL, *addr; 39768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger struct sg_mapping_iter m; 39868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger unsigned int offset = 0, len; 39968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger unsigned int nlbas = cmd->t_task_nolb; 40068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger unsigned int block_size = dev->dev_attrib.block_size; 40168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger unsigned int compare_len = (nlbas * block_size); 40268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sense_reason_t ret = TCM_NO_SENSE; 40368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger int rc, i; 40468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 405cf6d1f0964fa9db57fc660caf51939d7a03359a1Nicholas Bellinger /* 406cf6d1f0964fa9db57fc660caf51939d7a03359a1Nicholas Bellinger * Handle early failure in transport_generic_request_failure(), 407cf6d1f0964fa9db57fc660caf51939d7a03359a1Nicholas Bellinger * which will not have taken ->caw_mutex yet.. 408cf6d1f0964fa9db57fc660caf51939d7a03359a1Nicholas Bellinger */ 409cf6d1f0964fa9db57fc660caf51939d7a03359a1Nicholas Bellinger if (!cmd->t_data_sg || !cmd->t_bidi_data_sg) 410cf6d1f0964fa9db57fc660caf51939d7a03359a1Nicholas Bellinger return TCM_NO_SENSE; 411db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger /* 412db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger * Immediately exit + release dev->caw_sem if command has already 413db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger * been failed with a non-zero SCSI status. 414db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger */ 415db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger if (cmd->scsi_status) { 416db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger pr_err("compare_and_write_callback: non zero scsi_status:" 417db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger " 0x%02x\n", cmd->scsi_status); 418db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger goto out; 419db60df88ec39715fc3fb2a846cf35837e074c11dNicholas Bellinger } 420cf6d1f0964fa9db57fc660caf51939d7a03359a1Nicholas Bellinger 42168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger buf = kzalloc(cmd->data_length, GFP_KERNEL); 42268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (!buf) { 42368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger pr_err("Unable to allocate compare_and_write buf\n"); 424a2890087499ae530362139aaf6c120f438e1e679Nicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 425a2890087499ae530362139aaf6c120f438e1e679Nicholas Bellinger goto out; 42668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 42768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 42868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger write_sg = kzalloc(sizeof(struct scatterlist) * cmd->t_data_nents, 42968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger GFP_KERNEL); 43068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (!write_sg) { 43168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger pr_err("Unable to allocate compare_and_write sg\n"); 43268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 43368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger goto out; 43468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 43568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 43668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Setup verify and write data payloads from total NumberLBAs. 43768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 43868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger rc = sg_copy_to_buffer(cmd->t_data_sg, cmd->t_data_nents, buf, 43968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->data_length); 44068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (!rc) { 44168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger pr_err("sg_copy_to_buffer() failed for compare_and_write\n"); 44268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 44368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger goto out; 44468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 44568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 44668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Compare against SCSI READ payload against verify payload 44768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 44868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger for_each_sg(cmd->t_bidi_data_sg, sg, cmd->t_bidi_data_nents, i) { 44968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger addr = (unsigned char *)kmap_atomic(sg_page(sg)); 45068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (!addr) { 45168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger ret = TCM_OUT_OF_RESOURCES; 45268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger goto out; 45368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 45468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 45568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger len = min(sg->length, compare_len); 45668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 45768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (memcmp(addr, buf + offset, len)) { 45868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger pr_warn("Detected MISCOMPARE for addr: %p buf: %p\n", 45968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger addr, buf + offset); 46068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger kunmap_atomic(addr); 46168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger goto miscompare; 46268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 46368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger kunmap_atomic(addr); 46468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 46568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger offset += len; 46668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger compare_len -= len; 46768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (!compare_len) 46868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger break; 46968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 47068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 47168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger i = 0; 47268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger len = cmd->t_task_nolb * block_size; 47368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sg_miter_start(&m, cmd->t_data_sg, cmd->t_data_nents, SG_MITER_TO_SG); 47468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 47568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Currently assumes NoLB=1 and SGLs are PAGE_SIZE.. 47668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 47768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger while (len) { 47868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sg_miter_next(&m); 47968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 48068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (block_size < PAGE_SIZE) { 48168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sg_set_page(&write_sg[i], m.page, block_size, 48268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger block_size); 48368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } else { 48468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sg_miter_next(&m); 48568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sg_set_page(&write_sg[i], m.page, block_size, 48668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 0); 48768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 48868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger len -= block_size; 48968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger i++; 49068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 49168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sg_miter_stop(&m); 49268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 49368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Save the original SGL + nents values before updating to new 49468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * assignments, to be released in transport_free_pages() -> 49568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * transport_reset_sgl_orig() 49668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 49768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_data_sg_orig = cmd->t_data_sg; 49868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_data_sg = write_sg; 49968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_data_nents_orig = cmd->t_data_nents; 50068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_data_nents = 1; 50168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 50268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->sam_task_attr = MSG_HEAD_TAG; 50368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->transport_complete_callback = compare_and_write_post; 50468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 50568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Now reset ->execute_cmd() to the normal sbc_execute_rw() handler 50668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * for submitting the adjusted SGL to write instance user-data. 50768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 50868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 50968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 51068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger spin_lock_irq(&cmd->t_state_lock); 51168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_state = TRANSPORT_PROCESSING; 51268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->transport_state |= CMD_T_ACTIVE|CMD_T_BUSY|CMD_T_SENT; 51368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger spin_unlock_irq(&cmd->t_state_lock); 51468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 51568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger __target_execute_cmd(cmd); 51668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 51768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger kfree(buf); 51868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger return ret; 51968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 52068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellingermiscompare: 52168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger pr_warn("Target/%s: Send MISCOMPARE check condition and sense\n", 52268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger dev->transport->name); 52368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger ret = TCM_MISCOMPARE_VERIFY; 52468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellingerout: 52568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 52668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * In the MISCOMPARE or failure case, unlock ->caw_sem obtained in 52768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * sbc_compare_and_write() before the original READ I/O submission. 52868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 52968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger up(&dev->caw_sem); 53068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger kfree(write_sg); 53168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger kfree(buf); 53268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger return ret; 53368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger} 53468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 53568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellingerstatic sense_reason_t 53668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellingersbc_compare_and_write(struct se_cmd *cmd) 53768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger{ 53868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger struct se_device *dev = cmd->se_dev; 53968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sense_reason_t ret; 54068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger int rc; 54168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 54268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Submit the READ first for COMPARE_AND_WRITE to perform the 54368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * comparision using SGLs at cmd->t_bidi_data_sg.. 54468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 54568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger rc = down_interruptible(&dev->caw_sem); 54668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if ((rc != 0) || signal_pending(current)) { 54768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->transport_complete_callback = NULL; 54868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE; 54968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 550b7191253b302a9b98758c3616761ae111b6264b9Nicholas Bellinger /* 551b7191253b302a9b98758c3616761ae111b6264b9Nicholas Bellinger * Reset cmd->data_length to individual block_size in order to not 552b7191253b302a9b98758c3616761ae111b6264b9Nicholas Bellinger * confuse backend drivers that depend on this value matching the 553b7191253b302a9b98758c3616761ae111b6264b9Nicholas Bellinger * size of the I/O being submitted. 554b7191253b302a9b98758c3616761ae111b6264b9Nicholas Bellinger */ 555b7191253b302a9b98758c3616761ae111b6264b9Nicholas Bellinger cmd->data_length = cmd->t_task_nolb * dev->dev_attrib.block_size; 55668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 55768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger ret = cmd->execute_rw(cmd, cmd->t_bidi_data_sg, cmd->t_bidi_data_nents, 55868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger DMA_FROM_DEVICE); 55968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (ret) { 56068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->transport_complete_callback = NULL; 56168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger up(&dev->caw_sem); 56268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger return ret; 56368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 56468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 56568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Unlock of dev->caw_sem to occur in compare_and_write_callback() 56668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * upon MISCOMPARE, or in compare_and_write_done() upon completion 56768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * of WRITE instance user-data. 56868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 56968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger return TCM_NO_SENSE; 57068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger} 57168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger 57219f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimbergstatic int 57319f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimbergsbc_set_prot_op_checks(u8 protect, enum target_prot_type prot_type, 57419f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg bool is_write, struct se_cmd *cmd) 57519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg{ 57619f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (is_write) { 57719f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_op = protect ? TARGET_PROT_DOUT_PASS : 57819f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg TARGET_PROT_DOUT_INSERT; 57919f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg switch (protect) { 58019f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x0: 58119f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x3: 58219f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks = 0; 58319f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg break; 58419f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x1: 58519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x5: 58619f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_GUARD; 58719f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (prot_type == TARGET_DIF_TYPE1_PROT) 58819f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks |= TARGET_DIF_CHECK_REFTAG; 58919f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg break; 59019f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x2: 59119f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (prot_type == TARGET_DIF_TYPE1_PROT) 59219f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_REFTAG; 59319f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg break; 59419f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x4: 59519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_GUARD; 59619f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg break; 59719f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg default: 59819f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg pr_err("Unsupported protect field %d\n", protect); 59919f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg return -EINVAL; 60019f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg } 60119f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg } else { 60219f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_op = protect ? TARGET_PROT_DIN_PASS : 60319f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg TARGET_PROT_DIN_STRIP; 60419f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg switch (protect) { 60519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x0: 60619f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x1: 60719f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x5: 60819f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_GUARD; 60919f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (prot_type == TARGET_DIF_TYPE1_PROT) 61019f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks |= TARGET_DIF_CHECK_REFTAG; 61119f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg break; 61219f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x2: 61319f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (prot_type == TARGET_DIF_TYPE1_PROT) 61419f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_REFTAG; 61519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg break; 61619f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x3: 61719f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks = 0; 61819f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg break; 61919f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg case 0x4: 62019f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg cmd->prot_checks = TARGET_DIF_CHECK_GUARD; 62119f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg break; 62219f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg default: 62319f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg pr_err("Unsupported protect field %d\n", protect); 62419f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg return -EINVAL; 62519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg } 62619f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg } 62719f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg 62819f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg return 0; 62919f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg} 63019f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg 631499bf77b0169605a23c38351e3849066fe696877Nicholas Bellingerstatic bool 632499bf77b0169605a23c38351e3849066fe696877Nicholas Bellingersbc_check_prot(struct se_device *dev, struct se_cmd *cmd, unsigned char *cdb, 63319f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg u32 sectors, bool is_write) 634499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger{ 63519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg u8 protect = cdb[1] >> 5; 63619f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg 637499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger if (!cmd->t_prot_sg || !cmd->t_prot_nents) 638499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return true; 639499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 640499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger switch (dev->dev_attrib.pi_prot_type) { 641499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger case TARGET_DIF_TYPE3_PROT: 642499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger cmd->reftag_seed = 0xffffffff; 643499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger break; 644499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger case TARGET_DIF_TYPE2_PROT: 64519f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (protect) 646499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return false; 647499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 648499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger cmd->reftag_seed = cmd->t_task_lba; 649499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger break; 650499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger case TARGET_DIF_TYPE1_PROT: 651499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger cmd->reftag_seed = cmd->t_task_lba; 652499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger break; 653499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger case TARGET_DIF_TYPE0_PROT: 654499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger default: 655499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return true; 656499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger } 657499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 65819f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (sbc_set_prot_op_checks(protect, dev->dev_attrib.pi_prot_type, 65919f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg is_write, cmd)) 66019f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg return false; 66119f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg 662499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger cmd->prot_type = dev->dev_attrib.pi_prot_type; 663499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger cmd->prot_length = dev->prot_length * sectors; 664499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger cmd->prot_handover = PROT_SEPERATED; 665499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 666499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return true; 667499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger} 668499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 669de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigsense_reason_t 670de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwigsbc_parse_cdb(struct se_cmd *cmd, struct sbc_ops *ops) 671d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig{ 672d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig struct se_device *dev = cmd->se_dev; 673d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig unsigned char *cdb = cmd->t_task_cdb; 6741fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig unsigned int size; 675d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig u32 sectors = 0; 676de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig sense_reason_t ret; 677d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 678d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig switch (cdb[0]) { 679d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case READ_6: 680d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_6(cdb); 681d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_21(cdb); 682d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 683a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 684a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 685d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 686d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case READ_10: 687d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 688d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 689499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 69019f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, false)) 691499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 692499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 693d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 694a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 695a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 696d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 697d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case READ_12: 698d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_12(cdb); 699d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 700499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 70119f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, false)) 702499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 703499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 704d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 705a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 706a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 707d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 708d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case READ_16: 709d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_16(cdb); 710d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_64(cdb); 711499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 71219f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, false)) 713499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 714499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 715d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 716a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 717a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 718d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 719d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_6: 720d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_6(cdb); 721d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_21(cdb); 722d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 723a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 724a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 725d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 726d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_10: 727d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_VERIFY: 728d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 729d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 730499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 73119f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 732499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 733499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 734d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 735d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 736d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 737a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 738a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 739d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 740d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_12: 741d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_12(cdb); 742d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 743499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 74419f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 745499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 746499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 747d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 748d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 749d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 750a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 751a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 752d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 753d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_16: 754d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_16(cdb); 755d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_64(cdb); 756499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 75719f9361af7dfa0bb1f98c7619544ed71d2dded39Sagi Grimberg if (!sbc_check_prot(dev, cmd, cdb, sectors, true)) 758499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger return TCM_UNSUPPORTED_SCSI_OPCODE; 759499bf77b0169605a23c38351e3849066fe696877Nicholas Bellinger 760d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 761d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 762d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 763a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 764a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 765d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 766d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case XDWRITEREAD_10: 767de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig if (cmd->data_direction != DMA_TO_DEVICE || 768d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig !(cmd->se_cmd_flags & SCF_BIDI)) 769de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 770d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 771d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 772d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 773d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 774d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 775d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 776d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Setup BIDI XOR callback to be run after I/O completion. 777d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 778a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 779a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 780d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->transport_complete_callback = &xdreadwrite_callback; 781d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 782d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 783d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 784d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case VARIABLE_LENGTH_CMD: 785d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig { 786d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig u16 service_action = get_unaligned_be16(&cdb[8]); 787d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig switch (service_action) { 788d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case XDWRITEREAD_32: 789d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_32(cdb); 790d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 791d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 792d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Use WRITE_32 and READ_32 opcodes for the emulated 793d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * XDWRITE_READ_32 logic. 794d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 795d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_64_ext(cdb); 796d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB; 797d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 798d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 799d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Setup BIDI XOR callback to be run during after I/O 800d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * completion. 801d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 802a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_rw = ops->execute_rw; 803a82a9538dd30471e6428a2d55e91e986c439866bNicholas Bellinger cmd->execute_cmd = sbc_execute_rw; 804d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->transport_complete_callback = &xdreadwrite_callback; 805d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[1] & 0x8) 806d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->se_cmd_flags |= SCF_FUA; 807d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 808d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_SAME_32: 809d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_32(cdb); 810d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!sectors) { 811d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not" 812d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " supported\n"); 813de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 814d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 815d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 8161fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = sbc_get_size(cmd, 1); 817d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = get_unaligned_be64(&cdb[12]); 818d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 819cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[10], ops); 8206b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter if (ret) 821cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return ret; 822d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 823d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig default: 824d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("VARIABLE_LENGTH_CMD service action" 825d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " 0x%04x not supported\n", service_action); 826de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 827d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 828d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 829d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 83068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger case COMPARE_AND_WRITE: 83168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger sectors = cdb[13]; 83268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 83368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Currently enforce COMPARE_AND_WRITE for a single sector 83468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 83568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (sectors > 1) { 83668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger pr_err("COMPARE_AND_WRITE contains NoLB: %u greater" 83768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger " than 1\n", sectors); 83868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger return TCM_INVALID_CDB_FIELD; 83968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger } 84068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger /* 84168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * Double size because we have two buffers, note that 84268ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger * zero is not an error.. 84368ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger */ 84468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger size = 2 * sbc_get_size(cmd, sectors); 84568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_task_lba = get_unaligned_be64(&cdb[2]); 84668ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->t_task_nolb = sectors; 84768ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->se_cmd_flags |= SCF_SCSI_DATA_CDB | SCF_COMPARE_AND_WRITE; 84868ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->execute_rw = ops->execute_rw; 84968ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->execute_cmd = sbc_compare_and_write; 85068ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger cmd->transport_complete_callback = compare_and_write_callback; 85168ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger break; 852d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case READ_CAPACITY: 8531fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = READ_CAP_LEN; 8541fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig cmd->execute_cmd = sbc_emulate_readcapacity; 855d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 856d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case SERVICE_ACTION_IN: 857d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig switch (cmd->t_task_cdb[1] & 0x1f) { 858d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case SAI_READ_CAPACITY_16: 8591fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig cmd->execute_cmd = sbc_emulate_readcapacity_16; 860d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 861c66094bf325ee406b92298d73089ee25484a0263Hannes Reinecke case SAI_REPORT_REFERRALS: 862c66094bf325ee406b92298d73089ee25484a0263Hannes Reinecke cmd->execute_cmd = target_emulate_report_referrals; 863c66094bf325ee406b92298d73089ee25484a0263Hannes Reinecke break; 864d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig default: 865d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("Unsupported SA: 0x%02x\n", 866d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_cdb[1] & 0x1f); 867de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 868d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 8691fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = (cdb[10] << 24) | (cdb[11] << 16) | 870d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig (cdb[12] << 8) | cdb[13]; 871d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 872d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case SYNCHRONIZE_CACHE: 873d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case SYNCHRONIZE_CACHE_16: 874882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke if (!ops->execute_sync_cache) { 875882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke size = 0; 876882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke cmd->execute_cmd = sbc_emulate_noop; 877882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke break; 878882e3f8e6966109ad837cfe79e97cf3deb3ae19bHannes Reinecke } 879ad67f0d9e63ca94661e06a145f05a9302368a826Christoph Hellwig 880d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 881d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Extract LBA and range to be flushed for emulated SYNCHRONIZE_CACHE 882d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 883d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cdb[0] == SYNCHRONIZE_CACHE) { 884d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 885d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_32(cdb); 886d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } else { 887d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_16(cdb); 888d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = transport_lba_64(cdb); 889d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 890d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 8911fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = sbc_get_size(cmd, sectors); 892d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 893d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 894d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Check to ensure that LBA + Range does not exceed past end of 895d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * device for IBLOCK and FILEIO ->do_sync_cache() backend calls 896d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 897d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cmd->t_task_lba || sectors) { 898d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (sbc_check_valid_sectors(cmd) < 0) 89933633676df0d16d0685f2fbc571143801bc16e3bRoland Dreier return TCM_ADDRESS_OUT_OF_RANGE; 900d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 901ad67f0d9e63ca94661e06a145f05a9302368a826Christoph Hellwig cmd->execute_cmd = ops->execute_sync_cache; 902d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 903d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case UNMAP: 90414150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig if (!ops->execute_unmap) 905de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 90614150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig 9071fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = get_unaligned_be16(&cdb[7]); 90814150a6bbe9e15ce8e7a4f79047c2b4284a51b3dChristoph Hellwig cmd->execute_cmd = ops->execute_unmap; 909d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 910d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_SAME_16: 911d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_16(cdb); 912d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!sectors) { 913d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n"); 914de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 915d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 916d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 9171fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = sbc_get_size(cmd, 1); 918d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = get_unaligned_be64(&cdb[2]); 919d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 920cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[1], ops); 9216b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter if (ret) 922cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return ret; 923d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 924d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case WRITE_SAME: 925d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig sectors = transport_get_sectors_10(cdb); 926d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!sectors) { 927d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig pr_err("WSNZ=1, WRITE_SAME w/sectors=0 not supported\n"); 928de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 929d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 930d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 9311fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = sbc_get_size(cmd, 1); 932d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig cmd->t_task_lba = get_unaligned_be32(&cdb[2]); 933d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 934d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* 935d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * Follow sbcr26 with WRITE_SAME (10) and check for the existence 936d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig * of byte 1 bit 3 UNMAP instead of original reserved field 937d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig */ 938cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger ret = sbc_setup_write_same(cmd, &cdb[1], ops); 9396b64e1fe2ba80ac3ce12a21f1200bac594fa1a1cDan Carpenter if (ret) 940cd063bef414c51d79b9c6ea7a8ef8f9d319529bcNicholas Bellinger return ret; 941d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 942d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig case VERIFY: 9431fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig size = 0; 9441920ed61fbbbb38919edfb2427b0b1fd4e4ad8d9Nicholas Bellinger cmd->execute_cmd = sbc_emulate_noop; 945d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig break; 9461a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl case REZERO_UNIT: 9471a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl case SEEK_6: 9481a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl case SEEK_10: 9491a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl /* 9501a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl * There are still clients out there which use these old SCSI-2 9511a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl * commands. This mainly happens when running VMs with legacy 9521a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl * guest systems, connected via SCSI command pass-through to 9531a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl * iSCSI targets. Make them happy and return status GOOD. 9541a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl */ 9551a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl size = 0; 9561a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl cmd->execute_cmd = sbc_emulate_noop; 9571a1ff38c4cebf23be8bf0009a76b082a13bd25cbBernhard Kohl break; 958d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig default: 9591fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig ret = spc_parse_cdb(cmd, &size); 960d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (ret) 961d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig return ret; 962d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 963d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 964d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig /* reject any command that we don't have a handler for */ 965d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (!(cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) && !cmd->execute_cmd) 966de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_UNSUPPORTED_SCSI_OPCODE; 967d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 968d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig if (cmd->se_cmd_flags & SCF_SCSI_DATA_CDB) { 9691fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig unsigned long long end_lba; 9701fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 9710fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig if (sectors > dev->dev_attrib.fabric_max_sectors) { 972d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig printk_ratelimited(KERN_ERR "SCSI OP %02xh with too" 973d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " big sectors %u exceeds fabric_max_sectors:" 974d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " %u\n", cdb[0], sectors, 9750fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig dev->dev_attrib.fabric_max_sectors); 976de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 977d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 9780fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig if (sectors > dev->dev_attrib.hw_max_sectors) { 979d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig printk_ratelimited(KERN_ERR "SCSI OP %02xh with too" 980d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " big sectors %u exceeds backend hw_max_sectors:" 981d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig " %u\n", cdb[0], sectors, 9820fd97ccf45be26fb01b3a412f1f6c6b5044b2f16Christoph Hellwig dev->dev_attrib.hw_max_sectors); 983de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return TCM_INVALID_CDB_FIELD; 984d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 985d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 9861fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig end_lba = dev->transport->get_blocks(dev) + 1; 9871fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig if (cmd->t_task_lba + sectors > end_lba) { 9881fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig pr_err("cmd exceeds last lba %llu " 9891fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig "(lba %llu, sectors %u)\n", 9901fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig end_lba, cmd->t_task_lba, sectors); 99109ceadc70383a4105c0372f9e83da2c0cb0a8017Roland Dreier return TCM_ADDRESS_OUT_OF_RANGE; 9921fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig } 9931fd032ee10d2816c947f5d5b9abda95e728f0a8fChristoph Hellwig 99468ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger if (!(cmd->se_cmd_flags & SCF_COMPARE_AND_WRITE)) 99568ff9b9b27525cdaaea81890456f65aed5ce0b70Nicholas Bellinger size = sbc_get_size(cmd, sectors); 996d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig } 997d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig 998de103c93aff0bed0ae984274e5dc8b95899badabChristoph Hellwig return target_cmd_size_check(cmd, size); 999d6e0175cf3f9737a760482d185bb73566bcc9331Christoph Hellwig} 1000d6e0175cf3f9737a760482d185bb73566bcc9331Christoph HellwigEXPORT_SYMBOL(sbc_parse_cdb); 10016f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig 10026f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwigu32 sbc_get_device_type(struct se_device *dev) 10036f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig{ 10046f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig return TYPE_DISK; 10056f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph Hellwig} 10066f23ac8a39418d6c6711f4fd73cc4519067d7f08Christoph HellwigEXPORT_SYMBOL(sbc_get_device_type); 100786d7182985d25900929adce14fffd729cc8c6fb8Asias He 100886d7182985d25900929adce14fffd729cc8c6fb8Asias Hesense_reason_t 100986d7182985d25900929adce14fffd729cc8c6fb8Asias Hesbc_execute_unmap(struct se_cmd *cmd, 101086d7182985d25900929adce14fffd729cc8c6fb8Asias He sense_reason_t (*do_unmap_fn)(struct se_cmd *, void *, 101186d7182985d25900929adce14fffd729cc8c6fb8Asias He sector_t, sector_t), 101286d7182985d25900929adce14fffd729cc8c6fb8Asias He void *priv) 101386d7182985d25900929adce14fffd729cc8c6fb8Asias He{ 101486d7182985d25900929adce14fffd729cc8c6fb8Asias He struct se_device *dev = cmd->se_dev; 101586d7182985d25900929adce14fffd729cc8c6fb8Asias He unsigned char *buf, *ptr = NULL; 101686d7182985d25900929adce14fffd729cc8c6fb8Asias He sector_t lba; 101786d7182985d25900929adce14fffd729cc8c6fb8Asias He int size; 101886d7182985d25900929adce14fffd729cc8c6fb8Asias He u32 range; 101986d7182985d25900929adce14fffd729cc8c6fb8Asias He sense_reason_t ret = 0; 102086d7182985d25900929adce14fffd729cc8c6fb8Asias He int dl, bd_dl; 102186d7182985d25900929adce14fffd729cc8c6fb8Asias He 102286d7182985d25900929adce14fffd729cc8c6fb8Asias He /* We never set ANC_SUP */ 102386d7182985d25900929adce14fffd729cc8c6fb8Asias He if (cmd->t_task_cdb[1]) 102486d7182985d25900929adce14fffd729cc8c6fb8Asias He return TCM_INVALID_CDB_FIELD; 102586d7182985d25900929adce14fffd729cc8c6fb8Asias He 102686d7182985d25900929adce14fffd729cc8c6fb8Asias He if (cmd->data_length == 0) { 102786d7182985d25900929adce14fffd729cc8c6fb8Asias He target_complete_cmd(cmd, SAM_STAT_GOOD); 102886d7182985d25900929adce14fffd729cc8c6fb8Asias He return 0; 102986d7182985d25900929adce14fffd729cc8c6fb8Asias He } 103086d7182985d25900929adce14fffd729cc8c6fb8Asias He 103186d7182985d25900929adce14fffd729cc8c6fb8Asias He if (cmd->data_length < 8) { 103286d7182985d25900929adce14fffd729cc8c6fb8Asias He pr_warn("UNMAP parameter list length %u too small\n", 103386d7182985d25900929adce14fffd729cc8c6fb8Asias He cmd->data_length); 103486d7182985d25900929adce14fffd729cc8c6fb8Asias He return TCM_PARAMETER_LIST_LENGTH_ERROR; 103586d7182985d25900929adce14fffd729cc8c6fb8Asias He } 103686d7182985d25900929adce14fffd729cc8c6fb8Asias He 103786d7182985d25900929adce14fffd729cc8c6fb8Asias He buf = transport_kmap_data_sg(cmd); 103886d7182985d25900929adce14fffd729cc8c6fb8Asias He if (!buf) 103986d7182985d25900929adce14fffd729cc8c6fb8Asias He return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE; 104086d7182985d25900929adce14fffd729cc8c6fb8Asias He 104186d7182985d25900929adce14fffd729cc8c6fb8Asias He dl = get_unaligned_be16(&buf[0]); 104286d7182985d25900929adce14fffd729cc8c6fb8Asias He bd_dl = get_unaligned_be16(&buf[2]); 104386d7182985d25900929adce14fffd729cc8c6fb8Asias He 104486d7182985d25900929adce14fffd729cc8c6fb8Asias He size = cmd->data_length - 8; 104586d7182985d25900929adce14fffd729cc8c6fb8Asias He if (bd_dl > size) 104686d7182985d25900929adce14fffd729cc8c6fb8Asias He pr_warn("UNMAP parameter list length %u too small, ignoring bd_dl %u\n", 104786d7182985d25900929adce14fffd729cc8c6fb8Asias He cmd->data_length, bd_dl); 104886d7182985d25900929adce14fffd729cc8c6fb8Asias He else 104986d7182985d25900929adce14fffd729cc8c6fb8Asias He size = bd_dl; 105086d7182985d25900929adce14fffd729cc8c6fb8Asias He 105186d7182985d25900929adce14fffd729cc8c6fb8Asias He if (size / 16 > dev->dev_attrib.max_unmap_block_desc_count) { 105286d7182985d25900929adce14fffd729cc8c6fb8Asias He ret = TCM_INVALID_PARAMETER_LIST; 105386d7182985d25900929adce14fffd729cc8c6fb8Asias He goto err; 105486d7182985d25900929adce14fffd729cc8c6fb8Asias He } 105586d7182985d25900929adce14fffd729cc8c6fb8Asias He 105686d7182985d25900929adce14fffd729cc8c6fb8Asias He /* First UNMAP block descriptor starts at 8 byte offset */ 105786d7182985d25900929adce14fffd729cc8c6fb8Asias He ptr = &buf[8]; 105886d7182985d25900929adce14fffd729cc8c6fb8Asias He pr_debug("UNMAP: Sub: %s Using dl: %u bd_dl: %u size: %u" 105986d7182985d25900929adce14fffd729cc8c6fb8Asias He " ptr: %p\n", dev->transport->name, dl, bd_dl, size, ptr); 106086d7182985d25900929adce14fffd729cc8c6fb8Asias He 106186d7182985d25900929adce14fffd729cc8c6fb8Asias He while (size >= 16) { 106286d7182985d25900929adce14fffd729cc8c6fb8Asias He lba = get_unaligned_be64(&ptr[0]); 106386d7182985d25900929adce14fffd729cc8c6fb8Asias He range = get_unaligned_be32(&ptr[8]); 106486d7182985d25900929adce14fffd729cc8c6fb8Asias He pr_debug("UNMAP: Using lba: %llu and range: %u\n", 106586d7182985d25900929adce14fffd729cc8c6fb8Asias He (unsigned long long)lba, range); 106686d7182985d25900929adce14fffd729cc8c6fb8Asias He 106786d7182985d25900929adce14fffd729cc8c6fb8Asias He if (range > dev->dev_attrib.max_unmap_lba_count) { 106886d7182985d25900929adce14fffd729cc8c6fb8Asias He ret = TCM_INVALID_PARAMETER_LIST; 106986d7182985d25900929adce14fffd729cc8c6fb8Asias He goto err; 107086d7182985d25900929adce14fffd729cc8c6fb8Asias He } 107186d7182985d25900929adce14fffd729cc8c6fb8Asias He 107286d7182985d25900929adce14fffd729cc8c6fb8Asias He if (lba + range > dev->transport->get_blocks(dev) + 1) { 107386d7182985d25900929adce14fffd729cc8c6fb8Asias He ret = TCM_ADDRESS_OUT_OF_RANGE; 107486d7182985d25900929adce14fffd729cc8c6fb8Asias He goto err; 107586d7182985d25900929adce14fffd729cc8c6fb8Asias He } 107686d7182985d25900929adce14fffd729cc8c6fb8Asias He 107786d7182985d25900929adce14fffd729cc8c6fb8Asias He ret = do_unmap_fn(cmd, priv, lba, range); 107886d7182985d25900929adce14fffd729cc8c6fb8Asias He if (ret) 107986d7182985d25900929adce14fffd729cc8c6fb8Asias He goto err; 108086d7182985d25900929adce14fffd729cc8c6fb8Asias He 108186d7182985d25900929adce14fffd729cc8c6fb8Asias He ptr += 16; 108286d7182985d25900929adce14fffd729cc8c6fb8Asias He size -= 16; 108386d7182985d25900929adce14fffd729cc8c6fb8Asias He } 108486d7182985d25900929adce14fffd729cc8c6fb8Asias He 108586d7182985d25900929adce14fffd729cc8c6fb8Asias Heerr: 108686d7182985d25900929adce14fffd729cc8c6fb8Asias He transport_kunmap_data_sg(cmd); 108786d7182985d25900929adce14fffd729cc8c6fb8Asias He if (!ret) 108886d7182985d25900929adce14fffd729cc8c6fb8Asias He target_complete_cmd(cmd, GOOD); 108986d7182985d25900929adce14fffd729cc8c6fb8Asias He return ret; 109086d7182985d25900929adce14fffd729cc8c6fb8Asias He} 109186d7182985d25900929adce14fffd729cc8c6fb8Asias HeEXPORT_SYMBOL(sbc_execute_unmap); 109241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 109341861fa831afd4b5006f0042e1f701360330351eNicholas Bellingerstatic sense_reason_t 109441861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersbc_dif_v1_verify(struct se_device *dev, struct se_dif_v1_tuple *sdt, 109541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger const void *p, sector_t sector, unsigned int ei_lba) 109641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger{ 109741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger int block_size = dev->dev_attrib.block_size; 109841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger __be16 csum; 109941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 110041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger csum = cpu_to_be16(crc_t10dif(p, block_size)); 110141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 110241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (sdt->guard_tag != csum) { 110341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_err("DIFv1 checksum failed on sector %llu guard tag 0x%04x" 110441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " csum 0x%04x\n", (unsigned long long)sector, 110541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be16_to_cpu(sdt->guard_tag), be16_to_cpu(csum)); 110641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return TCM_LOGICAL_BLOCK_GUARD_CHECK_FAILED; 110741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 110841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 110941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE1_PROT && 111041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be32_to_cpu(sdt->ref_tag) != (sector & 0xffffffff)) { 111141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_err("DIFv1 Type 1 reference failed on sector: %llu tag: 0x%08x" 111241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " sector MSB: 0x%08x\n", (unsigned long long)sector, 111341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be32_to_cpu(sdt->ref_tag), (u32)(sector & 0xffffffff)); 111441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED; 111541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 111641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 111741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (dev->dev_attrib.pi_prot_type == TARGET_DIF_TYPE2_PROT && 111841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be32_to_cpu(sdt->ref_tag) != ei_lba) { 111941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_err("DIFv1 Type 2 reference failed on sector: %llu tag: 0x%08x" 112041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " ei_lba: 0x%08x\n", (unsigned long long)sector, 112141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger be32_to_cpu(sdt->ref_tag), ei_lba); 112241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return TCM_LOGICAL_BLOCK_REF_TAG_CHECK_FAILED; 112341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 112441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 112541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return 0; 112641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger} 112741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 112841861fa831afd4b5006f0042e1f701360330351eNicholas Bellingerstatic void 112941861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersbc_dif_copy_prot(struct se_cmd *cmd, unsigned int sectors, bool read, 113041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct scatterlist *sg, int sg_off) 113141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger{ 113241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_device *dev = cmd->se_dev; 113341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct scatterlist *psg; 113441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger void *paddr, *addr; 113541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger unsigned int i, len, left; 113610762e80489e73e2d52bf78e0869f253f42821bdNicholas Bellinger unsigned int offset = sg_off; 113741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 113841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger left = sectors * dev->prot_length; 113941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 114041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for_each_sg(cmd->t_prot_sg, psg, cmd->t_prot_nents, i) { 114116c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg unsigned int psg_len, copied = 0; 1142d6a65fdc8903e632aa7bf86ee0f61a73969371f6Sagi Grimberg 114341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 114416c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg psg_len = min(left, psg->length); 114516c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg while (psg_len) { 114616c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg len = min(psg_len, sg->length - offset); 114716c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg addr = kmap_atomic(sg_page(sg)) + sg->offset + offset; 114816c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg 114916c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg if (read) 115016c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg memcpy(paddr + copied, addr, len); 115116c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg else 115216c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg memcpy(addr, paddr + copied, len); 115316c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg 115416c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg left -= len; 115516c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg offset += len; 115616c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg copied += len; 115716c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg psg_len -= len; 115816c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg 115916c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg if (offset >= sg->length) { 116016c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg sg = sg_next(sg); 116116c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg offset = 0; 116216c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg } 116316c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg kunmap_atomic(addr); 116416c0ae028989df40bdab46b7f241d331ddc97c59Sagi Grimberg } 116541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 116641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 116741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger} 116841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 116941861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersense_reason_t 117041861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersbc_dif_verify_write(struct se_cmd *cmd, sector_t start, unsigned int sectors, 117141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger unsigned int ei_lba, struct scatterlist *sg, int sg_off) 117241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger{ 117341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_device *dev = cmd->se_dev; 117441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_dif_v1_tuple *sdt; 117541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct scatterlist *dsg, *psg = cmd->t_prot_sg; 117641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector_t sector = start; 117741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger void *daddr, *paddr; 117841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger int i, j, offset = 0; 117941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sense_reason_t rc; 118041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 118141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) { 118241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger daddr = kmap_atomic(sg_page(dsg)) + dsg->offset; 118341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 118441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 118541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) { 118641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 118741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (offset >= psg->length) { 118841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 118941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger psg = sg_next(psg); 119041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger paddr = kmap_atomic(sg_page(psg)) + psg->offset; 119141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset = 0; 119241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 119341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 119441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sdt = paddr + offset; 119541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 119641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_debug("DIF WRITE sector: %llu guard_tag: 0x%04x" 119741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " app_tag: 0x%04x ref_tag: %u\n", 119841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger (unsigned long long)sector, sdt->guard_tag, 119941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sdt->app_tag, be32_to_cpu(sdt->ref_tag)); 120041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 120141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector, 120241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger ei_lba); 120341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (rc) { 120441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 120541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(daddr); 120676736db3e291246fbce9db856706af3454b0b078Sagi Grimberg cmd->bad_sector = sector; 120741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return rc; 120841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 120941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 121041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector++; 121141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger ei_lba++; 121241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 121341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 121441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 121541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 121641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(daddr); 121741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 121841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sbc_dif_copy_prot(cmd, sectors, false, sg, sg_off); 121941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 122041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return 0; 122141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger} 122241861fa831afd4b5006f0042e1f701360330351eNicholas BellingerEXPORT_SYMBOL(sbc_dif_verify_write); 122341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 122441861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersense_reason_t 122541861fa831afd4b5006f0042e1f701360330351eNicholas Bellingersbc_dif_verify_read(struct se_cmd *cmd, sector_t start, unsigned int sectors, 122641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger unsigned int ei_lba, struct scatterlist *sg, int sg_off) 122741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger{ 122841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_device *dev = cmd->se_dev; 122941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger struct se_dif_v1_tuple *sdt; 1230fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg struct scatterlist *dsg, *psg = sg; 123141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector_t sector = start; 123241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger void *daddr, *paddr; 123341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger int i, j, offset = sg_off; 123441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sense_reason_t rc; 123541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 123641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for_each_sg(cmd->t_data_sg, dsg, cmd->t_data_nents, i) { 123741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger daddr = kmap_atomic(sg_page(dsg)) + dsg->offset; 1238fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg paddr = kmap_atomic(sg_page(psg)) + sg->offset; 123941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 124041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger for (j = 0; j < dsg->length; j += dev->dev_attrib.block_size) { 124141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 1242fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg if (offset >= psg->length) { 124341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 1244fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg psg = sg_next(psg); 1245fc272ec7a2dfe002b823c78f8ef0eb88042e2762Sagi Grimberg paddr = kmap_atomic(sg_page(psg)) + psg->offset; 124641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset = 0; 124741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 124841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 124941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sdt = paddr + offset; 125041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 125141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger pr_debug("DIF READ sector: %llu guard_tag: 0x%04x" 125241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger " app_tag: 0x%04x ref_tag: %u\n", 125341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger (unsigned long long)sector, sdt->guard_tag, 125441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sdt->app_tag, be32_to_cpu(sdt->ref_tag)); 125541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 125641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (sdt->app_tag == cpu_to_be16(0xffff)) { 125741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector++; 125841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 125941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger continue; 126041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 126141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 126241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger rc = sbc_dif_v1_verify(dev, sdt, daddr + j, sector, 126341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger ei_lba); 126441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger if (rc) { 126541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 126641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(daddr); 126776736db3e291246fbce9db856706af3454b0b078Sagi Grimberg cmd->bad_sector = sector; 126841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return rc; 126941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 127041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 127141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sector++; 127241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger ei_lba++; 127341861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger offset += sizeof(struct se_dif_v1_tuple); 127441861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 127541861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 127641861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(paddr); 127741861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger kunmap_atomic(daddr); 127841861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger } 127941861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger sbc_dif_copy_prot(cmd, sectors, true, sg, sg_off); 128041861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger 128141861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger return 0; 128241861fa831afd4b5006f0042e1f701360330351eNicholas Bellinger} 128341861fa831afd4b5006f0042e1f701360330351eNicholas BellingerEXPORT_SYMBOL(sbc_dif_verify_read); 1284