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