xref: /linux/drivers/target/target_core_pscsi.c (revision a85d667e58bddf73be84d1981b41eaac985ed216)
1c66ac9dbSNicholas Bellinger /*******************************************************************************
2c66ac9dbSNicholas Bellinger  * Filename:  target_core_pscsi.c
3c66ac9dbSNicholas Bellinger  *
4c66ac9dbSNicholas Bellinger  * This file contains the generic target mode <-> Linux SCSI subsystem plugin.
5c66ac9dbSNicholas Bellinger  *
64c76251eSNicholas Bellinger  * (c) Copyright 2003-2013 Datera, Inc.
7c66ac9dbSNicholas Bellinger  *
8c66ac9dbSNicholas Bellinger  * Nicholas A. Bellinger <nab@kernel.org>
9c66ac9dbSNicholas Bellinger  *
10c66ac9dbSNicholas Bellinger  * This program is free software; you can redistribute it and/or modify
11c66ac9dbSNicholas Bellinger  * it under the terms of the GNU General Public License as published by
12c66ac9dbSNicholas Bellinger  * the Free Software Foundation; either version 2 of the License, or
13c66ac9dbSNicholas Bellinger  * (at your option) any later version.
14c66ac9dbSNicholas Bellinger  *
15c66ac9dbSNicholas Bellinger  * This program is distributed in the hope that it will be useful,
16c66ac9dbSNicholas Bellinger  * but WITHOUT ANY WARRANTY; without even the implied warranty of
17c66ac9dbSNicholas Bellinger  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
18c66ac9dbSNicholas Bellinger  * GNU General Public License for more details.
19c66ac9dbSNicholas Bellinger  *
20c66ac9dbSNicholas Bellinger  * You should have received a copy of the GNU General Public License
21c66ac9dbSNicholas Bellinger  * along with this program; if not, write to the Free Software
22c66ac9dbSNicholas Bellinger  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
23c66ac9dbSNicholas Bellinger  *
24c66ac9dbSNicholas Bellinger  ******************************************************************************/
25c66ac9dbSNicholas Bellinger 
26c66ac9dbSNicholas Bellinger #include <linux/string.h>
27c66ac9dbSNicholas Bellinger #include <linux/parser.h>
28c66ac9dbSNicholas Bellinger #include <linux/timer.h>
29c66ac9dbSNicholas Bellinger #include <linux/blkdev.h>
30c66ac9dbSNicholas Bellinger #include <linux/blk_types.h>
31c66ac9dbSNicholas Bellinger #include <linux/slab.h>
32c66ac9dbSNicholas Bellinger #include <linux/spinlock.h>
33c66ac9dbSNicholas Bellinger #include <linux/genhd.h>
34c66ac9dbSNicholas Bellinger #include <linux/cdrom.h>
35d6e0175cSChristoph Hellwig #include <linux/ratelimit.h>
36827509e3SPaul Gortmaker #include <linux/module.h>
37d6e0175cSChristoph Hellwig #include <asm/unaligned.h>
38d6e0175cSChristoph Hellwig 
39c66ac9dbSNicholas Bellinger #include <scsi/scsi_device.h>
40c66ac9dbSNicholas Bellinger #include <scsi/scsi_host.h>
41e66ecd50SNicholas Bellinger #include <scsi/scsi_tcq.h>
42c66ac9dbSNicholas Bellinger 
43c66ac9dbSNicholas Bellinger #include <target/target_core_base.h>
44c4795fb2SChristoph Hellwig #include <target/target_core_backend.h>
45c66ac9dbSNicholas Bellinger 
46d6e0175cSChristoph Hellwig #include "target_core_alua.h"
4729a05deeSNicholas Bellinger #include "target_core_internal.h"
48c66ac9dbSNicholas Bellinger #include "target_core_pscsi.h"
49c66ac9dbSNicholas Bellinger 
50c66ac9dbSNicholas Bellinger #define ISPRINT(a)  ((a >= ' ') && (a <= '~'))
51c66ac9dbSNicholas Bellinger 
520fd97ccfSChristoph Hellwig static inline struct pscsi_dev_virt *PSCSI_DEV(struct se_device *dev)
530fd97ccfSChristoph Hellwig {
540fd97ccfSChristoph Hellwig 	return container_of(dev, struct pscsi_dev_virt, dev);
550fd97ccfSChristoph Hellwig }
560fd97ccfSChristoph Hellwig 
57de103c93SChristoph Hellwig static sense_reason_t pscsi_execute_cmd(struct se_cmd *cmd);
58c66ac9dbSNicholas Bellinger static void pscsi_req_done(struct request *, int);
59c66ac9dbSNicholas Bellinger 
60c66ac9dbSNicholas Bellinger /*	pscsi_attach_hba():
61c66ac9dbSNicholas Bellinger  *
62c66ac9dbSNicholas Bellinger  * 	pscsi_get_sh() used scsi_host_lookup() to locate struct Scsi_Host.
63c66ac9dbSNicholas Bellinger  *	from the passed SCSI Host ID.
64c66ac9dbSNicholas Bellinger  */
65c66ac9dbSNicholas Bellinger static int pscsi_attach_hba(struct se_hba *hba, u32 host_id)
66c66ac9dbSNicholas Bellinger {
67c66ac9dbSNicholas Bellinger 	struct pscsi_hba_virt *phv;
68c66ac9dbSNicholas Bellinger 
69c66ac9dbSNicholas Bellinger 	phv = kzalloc(sizeof(struct pscsi_hba_virt), GFP_KERNEL);
706708bb27SAndy Grover 	if (!phv) {
716708bb27SAndy Grover 		pr_err("Unable to allocate struct pscsi_hba_virt\n");
72e3d6f909SAndy Grover 		return -ENOMEM;
73c66ac9dbSNicholas Bellinger 	}
74c66ac9dbSNicholas Bellinger 	phv->phv_host_id = host_id;
75e6a8a41aSStefan Hajnoczi 	phv->phv_mode = PHV_VIRTUAL_HOST_ID;
76c66ac9dbSNicholas Bellinger 
775951146dSAndy Grover 	hba->hba_ptr = phv;
78c66ac9dbSNicholas Bellinger 
796708bb27SAndy Grover 	pr_debug("CORE_HBA[%d] - TCM SCSI HBA Driver %s on"
80c66ac9dbSNicholas Bellinger 		" Generic Target Core Stack %s\n", hba->hba_id,
81ce8dd25dSChristoph Hellwig 		PSCSI_VERSION, TARGET_CORE_VERSION);
826708bb27SAndy Grover 	pr_debug("CORE_HBA[%d] - Attached SCSI HBA to Generic\n",
83e3d6f909SAndy Grover 	       hba->hba_id);
84c66ac9dbSNicholas Bellinger 
85c66ac9dbSNicholas Bellinger 	return 0;
86c66ac9dbSNicholas Bellinger }
87c66ac9dbSNicholas Bellinger 
88c66ac9dbSNicholas Bellinger static void pscsi_detach_hba(struct se_hba *hba)
89c66ac9dbSNicholas Bellinger {
90c66ac9dbSNicholas Bellinger 	struct pscsi_hba_virt *phv = hba->hba_ptr;
91c66ac9dbSNicholas Bellinger 	struct Scsi_Host *scsi_host = phv->phv_lld_host;
92c66ac9dbSNicholas Bellinger 
93c66ac9dbSNicholas Bellinger 	if (scsi_host) {
94c66ac9dbSNicholas Bellinger 		scsi_host_put(scsi_host);
95c66ac9dbSNicholas Bellinger 
966708bb27SAndy Grover 		pr_debug("CORE_HBA[%d] - Detached SCSI HBA: %s from"
97c66ac9dbSNicholas Bellinger 			" Generic Target Core\n", hba->hba_id,
98c66ac9dbSNicholas Bellinger 			(scsi_host->hostt->name) ? (scsi_host->hostt->name) :
99c66ac9dbSNicholas Bellinger 			"Unknown");
100c66ac9dbSNicholas Bellinger 	} else
1016708bb27SAndy Grover 		pr_debug("CORE_HBA[%d] - Detached Virtual SCSI HBA"
102c66ac9dbSNicholas Bellinger 			" from Generic Target Core\n", hba->hba_id);
103c66ac9dbSNicholas Bellinger 
104c66ac9dbSNicholas Bellinger 	kfree(phv);
105c66ac9dbSNicholas Bellinger 	hba->hba_ptr = NULL;
106c66ac9dbSNicholas Bellinger }
107c66ac9dbSNicholas Bellinger 
108c66ac9dbSNicholas Bellinger static int pscsi_pmode_enable_hba(struct se_hba *hba, unsigned long mode_flag)
109c66ac9dbSNicholas Bellinger {
1108359cf43SJörn Engel 	struct pscsi_hba_virt *phv = hba->hba_ptr;
111c66ac9dbSNicholas Bellinger 	struct Scsi_Host *sh = phv->phv_lld_host;
112c66ac9dbSNicholas Bellinger 	/*
113c66ac9dbSNicholas Bellinger 	 * Release the struct Scsi_Host
114c66ac9dbSNicholas Bellinger 	 */
1156708bb27SAndy Grover 	if (!mode_flag) {
1166708bb27SAndy Grover 		if (!sh)
117c66ac9dbSNicholas Bellinger 			return 0;
118c66ac9dbSNicholas Bellinger 
119c66ac9dbSNicholas Bellinger 		phv->phv_lld_host = NULL;
120e6a8a41aSStefan Hajnoczi 		phv->phv_mode = PHV_VIRTUAL_HOST_ID;
121c66ac9dbSNicholas Bellinger 
1226708bb27SAndy Grover 		pr_debug("CORE_HBA[%d] - Disabled pSCSI HBA Passthrough"
123c66ac9dbSNicholas Bellinger 			" %s\n", hba->hba_id, (sh->hostt->name) ?
124c66ac9dbSNicholas Bellinger 			(sh->hostt->name) : "Unknown");
125c66ac9dbSNicholas Bellinger 
126c66ac9dbSNicholas Bellinger 		scsi_host_put(sh);
127c66ac9dbSNicholas Bellinger 		return 0;
128c66ac9dbSNicholas Bellinger 	}
129c66ac9dbSNicholas Bellinger 	/*
130c66ac9dbSNicholas Bellinger 	 * Otherwise, locate struct Scsi_Host from the original passed
131c66ac9dbSNicholas Bellinger 	 * pSCSI Host ID and enable for phba mode
132c66ac9dbSNicholas Bellinger 	 */
133e3d6f909SAndy Grover 	sh = scsi_host_lookup(phv->phv_host_id);
13458932e96SWei Yongjun 	if (!sh) {
1356708bb27SAndy Grover 		pr_err("pSCSI: Unable to locate SCSI Host for"
136c66ac9dbSNicholas Bellinger 			" phv_host_id: %d\n", phv->phv_host_id);
13758932e96SWei Yongjun 		return -EINVAL;
138c66ac9dbSNicholas Bellinger 	}
139c66ac9dbSNicholas Bellinger 
140c66ac9dbSNicholas Bellinger 	phv->phv_lld_host = sh;
141c66ac9dbSNicholas Bellinger 	phv->phv_mode = PHV_LLD_SCSI_HOST_NO;
142c66ac9dbSNicholas Bellinger 
1436708bb27SAndy Grover 	pr_debug("CORE_HBA[%d] - Enabled pSCSI HBA Passthrough %s\n",
144c66ac9dbSNicholas Bellinger 		hba->hba_id, (sh->hostt->name) ? (sh->hostt->name) : "Unknown");
145c66ac9dbSNicholas Bellinger 
146c66ac9dbSNicholas Bellinger 	return 1;
147c66ac9dbSNicholas Bellinger }
148c66ac9dbSNicholas Bellinger 
149c66ac9dbSNicholas Bellinger static void pscsi_tape_read_blocksize(struct se_device *dev,
150c66ac9dbSNicholas Bellinger 		struct scsi_device *sdev)
151c66ac9dbSNicholas Bellinger {
152c66ac9dbSNicholas Bellinger 	unsigned char cdb[MAX_COMMAND_SIZE], *buf;
153c66ac9dbSNicholas Bellinger 	int ret;
154c66ac9dbSNicholas Bellinger 
155c66ac9dbSNicholas Bellinger 	buf = kzalloc(12, GFP_KERNEL);
156c66ac9dbSNicholas Bellinger 	if (!buf)
157a04e54f2SNicholas Bellinger 		goto out_free;
158c66ac9dbSNicholas Bellinger 
159c66ac9dbSNicholas Bellinger 	memset(cdb, 0, MAX_COMMAND_SIZE);
160c66ac9dbSNicholas Bellinger 	cdb[0] = MODE_SENSE;
161c66ac9dbSNicholas Bellinger 	cdb[4] = 0x0c; /* 12 bytes */
162c66ac9dbSNicholas Bellinger 
163c66ac9dbSNicholas Bellinger 	ret = scsi_execute_req(sdev, cdb, DMA_FROM_DEVICE, buf, 12, NULL,
164c66ac9dbSNicholas Bellinger 			HZ, 1, NULL);
165c66ac9dbSNicholas Bellinger 	if (ret)
166c66ac9dbSNicholas Bellinger 		goto out_free;
167c66ac9dbSNicholas Bellinger 
168c66ac9dbSNicholas Bellinger 	/*
169c66ac9dbSNicholas Bellinger 	 * If MODE_SENSE still returns zero, set the default value to 1024.
170c66ac9dbSNicholas Bellinger 	 */
171*a85d667eSBart Van Assche 	sdev->sector_size = get_unaligned_be24(&buf[9]);
172a04e54f2SNicholas Bellinger out_free:
173c66ac9dbSNicholas Bellinger 	if (!sdev->sector_size)
174c66ac9dbSNicholas Bellinger 		sdev->sector_size = 1024;
175a04e54f2SNicholas Bellinger 
176c66ac9dbSNicholas Bellinger 	kfree(buf);
177c66ac9dbSNicholas Bellinger }
178c66ac9dbSNicholas Bellinger 
179c66ac9dbSNicholas Bellinger static void
180c66ac9dbSNicholas Bellinger pscsi_set_inquiry_info(struct scsi_device *sdev, struct t10_wwn *wwn)
181c66ac9dbSNicholas Bellinger {
182c66ac9dbSNicholas Bellinger 	unsigned char *buf;
183c66ac9dbSNicholas Bellinger 
184c66ac9dbSNicholas Bellinger 	if (sdev->inquiry_len < INQUIRY_LEN)
185c66ac9dbSNicholas Bellinger 		return;
186c66ac9dbSNicholas Bellinger 
187c66ac9dbSNicholas Bellinger 	buf = sdev->inquiry;
188c66ac9dbSNicholas Bellinger 	if (!buf)
189c66ac9dbSNicholas Bellinger 		return;
190c66ac9dbSNicholas Bellinger 	/*
191c66ac9dbSNicholas Bellinger 	 * Use sdev->inquiry from drivers/scsi/scsi_scan.c:scsi_alloc_sdev()
192c66ac9dbSNicholas Bellinger 	 */
193c66ac9dbSNicholas Bellinger 	memcpy(&wwn->vendor[0], &buf[8], sizeof(wwn->vendor));
194c66ac9dbSNicholas Bellinger 	memcpy(&wwn->model[0], &buf[16], sizeof(wwn->model));
195c66ac9dbSNicholas Bellinger 	memcpy(&wwn->revision[0], &buf[32], sizeof(wwn->revision));
196c66ac9dbSNicholas Bellinger }
197c66ac9dbSNicholas Bellinger 
198c66ac9dbSNicholas Bellinger static int
199c66ac9dbSNicholas Bellinger pscsi_get_inquiry_vpd_serial(struct scsi_device *sdev, struct t10_wwn *wwn)
200c66ac9dbSNicholas Bellinger {
201c66ac9dbSNicholas Bellinger 	unsigned char cdb[MAX_COMMAND_SIZE], *buf;
202c66ac9dbSNicholas Bellinger 	int ret;
203c66ac9dbSNicholas Bellinger 
204c66ac9dbSNicholas Bellinger 	buf = kzalloc(INQUIRY_VPD_SERIAL_LEN, GFP_KERNEL);
205c66ac9dbSNicholas Bellinger 	if (!buf)
206e3d6f909SAndy Grover 		return -ENOMEM;
207c66ac9dbSNicholas Bellinger 
208c66ac9dbSNicholas Bellinger 	memset(cdb, 0, MAX_COMMAND_SIZE);
209c66ac9dbSNicholas Bellinger 	cdb[0] = INQUIRY;
210c66ac9dbSNicholas Bellinger 	cdb[1] = 0x01; /* Query VPD */
211c66ac9dbSNicholas Bellinger 	cdb[2] = 0x80; /* Unit Serial Number */
212*a85d667eSBart Van Assche 	put_unaligned_be16(INQUIRY_VPD_SERIAL_LEN, &cdb[3]);
213c66ac9dbSNicholas Bellinger 
214c66ac9dbSNicholas Bellinger 	ret = scsi_execute_req(sdev, cdb, DMA_FROM_DEVICE, buf,
215c66ac9dbSNicholas Bellinger 			      INQUIRY_VPD_SERIAL_LEN, NULL, HZ, 1, NULL);
216c66ac9dbSNicholas Bellinger 	if (ret)
217c66ac9dbSNicholas Bellinger 		goto out_free;
218c66ac9dbSNicholas Bellinger 
219c66ac9dbSNicholas Bellinger 	snprintf(&wwn->unit_serial[0], INQUIRY_VPD_SERIAL_LEN, "%s", &buf[4]);
220c66ac9dbSNicholas Bellinger 
2210fd97ccfSChristoph Hellwig 	wwn->t10_dev->dev_flags |= DF_FIRMWARE_VPD_UNIT_SERIAL;
222c66ac9dbSNicholas Bellinger 
223c66ac9dbSNicholas Bellinger 	kfree(buf);
224c66ac9dbSNicholas Bellinger 	return 0;
225c66ac9dbSNicholas Bellinger 
226c66ac9dbSNicholas Bellinger out_free:
227c66ac9dbSNicholas Bellinger 	kfree(buf);
228e3d6f909SAndy Grover 	return -EPERM;
229c66ac9dbSNicholas Bellinger }
230c66ac9dbSNicholas Bellinger 
231c66ac9dbSNicholas Bellinger static void
232c66ac9dbSNicholas Bellinger pscsi_get_inquiry_vpd_device_ident(struct scsi_device *sdev,
233c66ac9dbSNicholas Bellinger 		struct t10_wwn *wwn)
234c66ac9dbSNicholas Bellinger {
235c66ac9dbSNicholas Bellinger 	unsigned char cdb[MAX_COMMAND_SIZE], *buf, *page_83;
236c66ac9dbSNicholas Bellinger 	int ident_len, page_len, off = 4, ret;
237c66ac9dbSNicholas Bellinger 	struct t10_vpd *vpd;
238c66ac9dbSNicholas Bellinger 
239c66ac9dbSNicholas Bellinger 	buf = kzalloc(INQUIRY_VPD_SERIAL_LEN, GFP_KERNEL);
240c66ac9dbSNicholas Bellinger 	if (!buf)
241c66ac9dbSNicholas Bellinger 		return;
242c66ac9dbSNicholas Bellinger 
243c66ac9dbSNicholas Bellinger 	memset(cdb, 0, MAX_COMMAND_SIZE);
244c66ac9dbSNicholas Bellinger 	cdb[0] = INQUIRY;
245c66ac9dbSNicholas Bellinger 	cdb[1] = 0x01; /* Query VPD */
246c66ac9dbSNicholas Bellinger 	cdb[2] = 0x83; /* Device Identifier */
247*a85d667eSBart Van Assche 	put_unaligned_be16(INQUIRY_VPD_DEVICE_IDENTIFIER_LEN, &cdb[3]);
248c66ac9dbSNicholas Bellinger 
249c66ac9dbSNicholas Bellinger 	ret = scsi_execute_req(sdev, cdb, DMA_FROM_DEVICE, buf,
250c66ac9dbSNicholas Bellinger 			      INQUIRY_VPD_DEVICE_IDENTIFIER_LEN,
251c66ac9dbSNicholas Bellinger 			      NULL, HZ, 1, NULL);
252c66ac9dbSNicholas Bellinger 	if (ret)
253c66ac9dbSNicholas Bellinger 		goto out;
254c66ac9dbSNicholas Bellinger 
255*a85d667eSBart Van Assche 	page_len = get_unaligned_be16(&buf[2]);
256c66ac9dbSNicholas Bellinger 	while (page_len > 0) {
257c66ac9dbSNicholas Bellinger 		/* Grab a pointer to the Identification descriptor */
258c66ac9dbSNicholas Bellinger 		page_83 = &buf[off];
259c66ac9dbSNicholas Bellinger 		ident_len = page_83[3];
260c66ac9dbSNicholas Bellinger 		if (!ident_len) {
2616708bb27SAndy Grover 			pr_err("page_83[3]: identifier"
262c66ac9dbSNicholas Bellinger 					" length zero!\n");
263c66ac9dbSNicholas Bellinger 			break;
264c66ac9dbSNicholas Bellinger 		}
26535d1efe8SMasanari Iida 		pr_debug("T10 VPD Identifier Length: %d\n", ident_len);
266c66ac9dbSNicholas Bellinger 
267c66ac9dbSNicholas Bellinger 		vpd = kzalloc(sizeof(struct t10_vpd), GFP_KERNEL);
268c66ac9dbSNicholas Bellinger 		if (!vpd) {
2696708bb27SAndy Grover 			pr_err("Unable to allocate memory for"
270c66ac9dbSNicholas Bellinger 					" struct t10_vpd\n");
271c66ac9dbSNicholas Bellinger 			goto out;
272c66ac9dbSNicholas Bellinger 		}
273c66ac9dbSNicholas Bellinger 		INIT_LIST_HEAD(&vpd->vpd_list);
274c66ac9dbSNicholas Bellinger 
275c66ac9dbSNicholas Bellinger 		transport_set_vpd_proto_id(vpd, page_83);
276c66ac9dbSNicholas Bellinger 		transport_set_vpd_assoc(vpd, page_83);
277c66ac9dbSNicholas Bellinger 
278c66ac9dbSNicholas Bellinger 		if (transport_set_vpd_ident_type(vpd, page_83) < 0) {
279c66ac9dbSNicholas Bellinger 			off += (ident_len + 4);
280c66ac9dbSNicholas Bellinger 			page_len -= (ident_len + 4);
281c66ac9dbSNicholas Bellinger 			kfree(vpd);
282c66ac9dbSNicholas Bellinger 			continue;
283c66ac9dbSNicholas Bellinger 		}
284c66ac9dbSNicholas Bellinger 		if (transport_set_vpd_ident(vpd, page_83) < 0) {
285c66ac9dbSNicholas Bellinger 			off += (ident_len + 4);
286c66ac9dbSNicholas Bellinger 			page_len -= (ident_len + 4);
287c66ac9dbSNicholas Bellinger 			kfree(vpd);
288c66ac9dbSNicholas Bellinger 			continue;
289c66ac9dbSNicholas Bellinger 		}
290c66ac9dbSNicholas Bellinger 
291c66ac9dbSNicholas Bellinger 		list_add_tail(&vpd->vpd_list, &wwn->t10_vpd_list);
292c66ac9dbSNicholas Bellinger 		off += (ident_len + 4);
293c66ac9dbSNicholas Bellinger 		page_len -= (ident_len + 4);
294c66ac9dbSNicholas Bellinger 	}
295c66ac9dbSNicholas Bellinger 
296c66ac9dbSNicholas Bellinger out:
297c66ac9dbSNicholas Bellinger 	kfree(buf);
298c66ac9dbSNicholas Bellinger }
299c66ac9dbSNicholas Bellinger 
3000fd97ccfSChristoph Hellwig static int pscsi_add_device_to_list(struct se_device *dev,
3010fd97ccfSChristoph Hellwig 		struct scsi_device *sd)
302c66ac9dbSNicholas Bellinger {
3030fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
3040fd97ccfSChristoph Hellwig 	struct request_queue *q = sd->request_queue;
305c66ac9dbSNicholas Bellinger 
3060fd97ccfSChristoph Hellwig 	pdv->pdv_sd = sd;
307c66ac9dbSNicholas Bellinger 
308c66ac9dbSNicholas Bellinger 	if (!sd->queue_depth) {
309c66ac9dbSNicholas Bellinger 		sd->queue_depth = PSCSI_DEFAULT_QUEUEDEPTH;
310c66ac9dbSNicholas Bellinger 
3119cb78c16SHannes Reinecke 		pr_err("Set broken SCSI Device %d:%d:%llu"
312c66ac9dbSNicholas Bellinger 			" queue_depth to %d\n", sd->channel, sd->id,
313c66ac9dbSNicholas Bellinger 				sd->lun, sd->queue_depth);
314c66ac9dbSNicholas Bellinger 	}
3150fd97ccfSChristoph Hellwig 
316a04e54f2SNicholas Bellinger 	dev->dev_attrib.hw_block_size =
317a04e54f2SNicholas Bellinger 		min_not_zero((int)sd->sector_size, 512);
3180fd97ccfSChristoph Hellwig 	dev->dev_attrib.hw_max_sectors =
319a04e54f2SNicholas Bellinger 		min_not_zero(sd->host->max_sectors, queue_max_hw_sectors(q));
3200fd97ccfSChristoph Hellwig 	dev->dev_attrib.hw_queue_depth = sd->queue_depth;
3210fd97ccfSChristoph Hellwig 
322c66ac9dbSNicholas Bellinger 	/*
323c66ac9dbSNicholas Bellinger 	 * Setup our standard INQUIRY info into se_dev->t10_wwn
324c66ac9dbSNicholas Bellinger 	 */
3250fd97ccfSChristoph Hellwig 	pscsi_set_inquiry_info(sd, &dev->t10_wwn);
326c66ac9dbSNicholas Bellinger 
327c66ac9dbSNicholas Bellinger 	/*
328c66ac9dbSNicholas Bellinger 	 * Locate VPD WWN Information used for various purposes within
329c66ac9dbSNicholas Bellinger 	 * the Storage Engine.
330c66ac9dbSNicholas Bellinger 	 */
3310fd97ccfSChristoph Hellwig 	if (!pscsi_get_inquiry_vpd_serial(sd, &dev->t10_wwn)) {
332c66ac9dbSNicholas Bellinger 		/*
333c66ac9dbSNicholas Bellinger 		 * If VPD Unit Serial returned GOOD status, try
334c66ac9dbSNicholas Bellinger 		 * VPD Device Identification page (0x83).
335c66ac9dbSNicholas Bellinger 		 */
3360fd97ccfSChristoph Hellwig 		pscsi_get_inquiry_vpd_device_ident(sd, &dev->t10_wwn);
337c66ac9dbSNicholas Bellinger 	}
338c66ac9dbSNicholas Bellinger 
339c66ac9dbSNicholas Bellinger 	/*
340c66ac9dbSNicholas Bellinger 	 * For TYPE_TAPE, attempt to determine blocksize with MODE_SENSE.
341c66ac9dbSNicholas Bellinger 	 */
342a04e54f2SNicholas Bellinger 	if (sd->type == TYPE_TAPE) {
343c66ac9dbSNicholas Bellinger 		pscsi_tape_read_blocksize(dev, sd);
344a04e54f2SNicholas Bellinger 		dev->dev_attrib.hw_block_size = sd->sector_size;
345a04e54f2SNicholas Bellinger 	}
3460fd97ccfSChristoph Hellwig 	return 0;
347c66ac9dbSNicholas Bellinger }
348c66ac9dbSNicholas Bellinger 
3490fd97ccfSChristoph Hellwig static struct se_device *pscsi_alloc_device(struct se_hba *hba,
3500fd97ccfSChristoph Hellwig 		const char *name)
351c66ac9dbSNicholas Bellinger {
352c66ac9dbSNicholas Bellinger 	struct pscsi_dev_virt *pdv;
353c66ac9dbSNicholas Bellinger 
354c66ac9dbSNicholas Bellinger 	pdv = kzalloc(sizeof(struct pscsi_dev_virt), GFP_KERNEL);
3556708bb27SAndy Grover 	if (!pdv) {
3566708bb27SAndy Grover 		pr_err("Unable to allocate memory for struct pscsi_dev_virt\n");
357c66ac9dbSNicholas Bellinger 		return NULL;
358c66ac9dbSNicholas Bellinger 	}
359c66ac9dbSNicholas Bellinger 
3606708bb27SAndy Grover 	pr_debug("PSCSI: Allocated pdv: %p for %s\n", pdv, name);
3610fd97ccfSChristoph Hellwig 	return &pdv->dev;
362c66ac9dbSNicholas Bellinger }
363c66ac9dbSNicholas Bellinger 
364c66ac9dbSNicholas Bellinger /*
365c66ac9dbSNicholas Bellinger  * Called with struct Scsi_Host->host_lock called.
366c66ac9dbSNicholas Bellinger  */
3670fd97ccfSChristoph Hellwig static int pscsi_create_type_disk(struct se_device *dev, struct scsi_device *sd)
3685dd7ed2eSDan Carpenter 	__releases(sh->host_lock)
369c66ac9dbSNicholas Bellinger {
3700fd97ccfSChristoph Hellwig 	struct pscsi_hba_virt *phv = dev->se_hba->hba_ptr;
3710fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
372c66ac9dbSNicholas Bellinger 	struct Scsi_Host *sh = sd->host;
373c66ac9dbSNicholas Bellinger 	struct block_device *bd;
3740fd97ccfSChristoph Hellwig 	int ret;
375c66ac9dbSNicholas Bellinger 
376c66ac9dbSNicholas Bellinger 	if (scsi_device_get(sd)) {
3779cb78c16SHannes Reinecke 		pr_err("scsi_device_get() failed for %d:%d:%d:%llu\n",
378c66ac9dbSNicholas Bellinger 			sh->host_no, sd->channel, sd->id, sd->lun);
379c66ac9dbSNicholas Bellinger 		spin_unlock_irq(sh->host_lock);
3800fd97ccfSChristoph Hellwig 		return -EIO;
381c66ac9dbSNicholas Bellinger 	}
382c66ac9dbSNicholas Bellinger 	spin_unlock_irq(sh->host_lock);
383c66ac9dbSNicholas Bellinger 	/*
384c66ac9dbSNicholas Bellinger 	 * Claim exclusive struct block_device access to struct scsi_device
385c66ac9dbSNicholas Bellinger 	 * for TYPE_DISK using supplied udev_path
386c66ac9dbSNicholas Bellinger 	 */
3870fd97ccfSChristoph Hellwig 	bd = blkdev_get_by_path(dev->udev_path,
388c66ac9dbSNicholas Bellinger 				FMODE_WRITE|FMODE_READ|FMODE_EXCL, pdv);
3893ae279d2SDan Carpenter 	if (IS_ERR(bd)) {
3906708bb27SAndy Grover 		pr_err("pSCSI: blkdev_get_by_path() failed\n");
391c66ac9dbSNicholas Bellinger 		scsi_device_put(sd);
3920fd97ccfSChristoph Hellwig 		return PTR_ERR(bd);
393c66ac9dbSNicholas Bellinger 	}
394c66ac9dbSNicholas Bellinger 	pdv->pdv_bd = bd;
395c66ac9dbSNicholas Bellinger 
3960fd97ccfSChristoph Hellwig 	ret = pscsi_add_device_to_list(dev, sd);
3970fd97ccfSChristoph Hellwig 	if (ret) {
398c66ac9dbSNicholas Bellinger 		blkdev_put(pdv->pdv_bd, FMODE_WRITE|FMODE_READ|FMODE_EXCL);
399c66ac9dbSNicholas Bellinger 		scsi_device_put(sd);
4000fd97ccfSChristoph Hellwig 		return ret;
401c66ac9dbSNicholas Bellinger 	}
4020fd97ccfSChristoph Hellwig 
4039cb78c16SHannes Reinecke 	pr_debug("CORE_PSCSI[%d] - Added TYPE_DISK for %d:%d:%d:%llu\n",
404c66ac9dbSNicholas Bellinger 		phv->phv_host_id, sh->host_no, sd->channel, sd->id, sd->lun);
4050fd97ccfSChristoph Hellwig 	return 0;
406c66ac9dbSNicholas Bellinger }
407c66ac9dbSNicholas Bellinger 
408c66ac9dbSNicholas Bellinger /*
409c66ac9dbSNicholas Bellinger  * Called with struct Scsi_Host->host_lock called.
410c66ac9dbSNicholas Bellinger  */
411a04e54f2SNicholas Bellinger static int pscsi_create_type_nondisk(struct se_device *dev, struct scsi_device *sd)
4125dd7ed2eSDan Carpenter 	__releases(sh->host_lock)
413c66ac9dbSNicholas Bellinger {
4140fd97ccfSChristoph Hellwig 	struct pscsi_hba_virt *phv = dev->se_hba->hba_ptr;
415c66ac9dbSNicholas Bellinger 	struct Scsi_Host *sh = sd->host;
4160fd97ccfSChristoph Hellwig 	int ret;
417c66ac9dbSNicholas Bellinger 
418c66ac9dbSNicholas Bellinger 	if (scsi_device_get(sd)) {
4199cb78c16SHannes Reinecke 		pr_err("scsi_device_get() failed for %d:%d:%d:%llu\n",
420c66ac9dbSNicholas Bellinger 			sh->host_no, sd->channel, sd->id, sd->lun);
421c66ac9dbSNicholas Bellinger 		spin_unlock_irq(sh->host_lock);
4220fd97ccfSChristoph Hellwig 		return -EIO;
423c66ac9dbSNicholas Bellinger 	}
424c66ac9dbSNicholas Bellinger 	spin_unlock_irq(sh->host_lock);
425c66ac9dbSNicholas Bellinger 
4260fd97ccfSChristoph Hellwig 	ret = pscsi_add_device_to_list(dev, sd);
4270fd97ccfSChristoph Hellwig 	if (ret) {
428c66ac9dbSNicholas Bellinger 		scsi_device_put(sd);
4290fd97ccfSChristoph Hellwig 		return ret;
430c66ac9dbSNicholas Bellinger 	}
4319cb78c16SHannes Reinecke 	pr_debug("CORE_PSCSI[%d] - Added Type: %s for %d:%d:%d:%llu\n",
432c66ac9dbSNicholas Bellinger 		phv->phv_host_id, scsi_device_type(sd->type), sh->host_no,
433c66ac9dbSNicholas Bellinger 		sd->channel, sd->id, sd->lun);
434c66ac9dbSNicholas Bellinger 
4350fd97ccfSChristoph Hellwig 	return 0;
436c66ac9dbSNicholas Bellinger }
437c66ac9dbSNicholas Bellinger 
438ecf0dd66SFengguang Wu static int pscsi_configure_device(struct se_device *dev)
439c66ac9dbSNicholas Bellinger {
4400fd97ccfSChristoph Hellwig 	struct se_hba *hba = dev->se_hba;
4410fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
442c66ac9dbSNicholas Bellinger 	struct scsi_device *sd;
4430fd97ccfSChristoph Hellwig 	struct pscsi_hba_virt *phv = dev->se_hba->hba_ptr;
444c66ac9dbSNicholas Bellinger 	struct Scsi_Host *sh = phv->phv_lld_host;
445c66ac9dbSNicholas Bellinger 	int legacy_mode_enable = 0;
4460fd97ccfSChristoph Hellwig 	int ret;
447c66ac9dbSNicholas Bellinger 
4480fd97ccfSChristoph Hellwig 	if (!(pdv->pdv_flags & PDF_HAS_CHANNEL_ID) ||
4490fd97ccfSChristoph Hellwig 	    !(pdv->pdv_flags & PDF_HAS_TARGET_ID) ||
4500fd97ccfSChristoph Hellwig 	    !(pdv->pdv_flags & PDF_HAS_LUN_ID)) {
4510fd97ccfSChristoph Hellwig 		pr_err("Missing scsi_channel_id=, scsi_target_id= and"
4520fd97ccfSChristoph Hellwig 			" scsi_lun_id= parameters\n");
4530fd97ccfSChristoph Hellwig 		return -EINVAL;
454c66ac9dbSNicholas Bellinger 	}
4550fd97ccfSChristoph Hellwig 
456c66ac9dbSNicholas Bellinger 	/*
457c66ac9dbSNicholas Bellinger 	 * If not running in PHV_LLD_SCSI_HOST_NO mode, locate the
458c66ac9dbSNicholas Bellinger 	 * struct Scsi_Host we will need to bring the TCM/pSCSI object online
459c66ac9dbSNicholas Bellinger 	 */
4606708bb27SAndy Grover 	if (!sh) {
461c66ac9dbSNicholas Bellinger 		if (phv->phv_mode == PHV_LLD_SCSI_HOST_NO) {
4626708bb27SAndy Grover 			pr_err("pSCSI: Unable to locate struct"
463c66ac9dbSNicholas Bellinger 				" Scsi_Host for PHV_LLD_SCSI_HOST_NO\n");
4640fd97ccfSChristoph Hellwig 			return -ENODEV;
465c66ac9dbSNicholas Bellinger 		}
466c66ac9dbSNicholas Bellinger 		/*
467e6a8a41aSStefan Hajnoczi 		 * For the newer PHV_VIRTUAL_HOST_ID struct scsi_device
468c66ac9dbSNicholas Bellinger 		 * reference, we enforce that udev_path has been set
469c66ac9dbSNicholas Bellinger 		 */
4700fd97ccfSChristoph Hellwig 		if (!(dev->dev_flags & DF_USING_UDEV_PATH)) {
4716708bb27SAndy Grover 			pr_err("pSCSI: udev_path attribute has not"
472c66ac9dbSNicholas Bellinger 				" been set before ENABLE=1\n");
4730fd97ccfSChristoph Hellwig 			return -EINVAL;
474c66ac9dbSNicholas Bellinger 		}
475c66ac9dbSNicholas Bellinger 		/*
476e6a8a41aSStefan Hajnoczi 		 * If no scsi_host_id= was passed for PHV_VIRTUAL_HOST_ID,
477c66ac9dbSNicholas Bellinger 		 * use the original TCM hba ID to reference Linux/SCSI Host No
478c66ac9dbSNicholas Bellinger 		 * and enable for PHV_LLD_SCSI_HOST_NO mode.
479c66ac9dbSNicholas Bellinger 		 */
480c66ac9dbSNicholas Bellinger 		if (!(pdv->pdv_flags & PDF_HAS_VIRT_HOST_ID)) {
4810fd97ccfSChristoph Hellwig 			if (hba->dev_count) {
4826708bb27SAndy Grover 				pr_err("pSCSI: Unable to set hba_mode"
483c66ac9dbSNicholas Bellinger 					" with active devices\n");
4840fd97ccfSChristoph Hellwig 				return -EEXIST;
485c66ac9dbSNicholas Bellinger 			}
486c66ac9dbSNicholas Bellinger 
487c66ac9dbSNicholas Bellinger 			if (pscsi_pmode_enable_hba(hba, 1) != 1)
4880fd97ccfSChristoph Hellwig 				return -ENODEV;
489c66ac9dbSNicholas Bellinger 
490c66ac9dbSNicholas Bellinger 			legacy_mode_enable = 1;
491c66ac9dbSNicholas Bellinger 			hba->hba_flags |= HBA_FLAGS_PSCSI_MODE;
492c66ac9dbSNicholas Bellinger 			sh = phv->phv_lld_host;
493c66ac9dbSNicholas Bellinger 		} else {
494e3d6f909SAndy Grover 			sh = scsi_host_lookup(pdv->pdv_host_id);
49558932e96SWei Yongjun 			if (!sh) {
4966708bb27SAndy Grover 				pr_err("pSCSI: Unable to locate"
497c66ac9dbSNicholas Bellinger 					" pdv_host_id: %d\n", pdv->pdv_host_id);
49858932e96SWei Yongjun 				return -EINVAL;
499c66ac9dbSNicholas Bellinger 			}
5005a7125c6SAndy Grover 			pdv->pdv_lld_host = sh;
501c66ac9dbSNicholas Bellinger 		}
502c66ac9dbSNicholas Bellinger 	} else {
503e6a8a41aSStefan Hajnoczi 		if (phv->phv_mode == PHV_VIRTUAL_HOST_ID) {
504e6a8a41aSStefan Hajnoczi 			pr_err("pSCSI: PHV_VIRTUAL_HOST_ID set while"
505c66ac9dbSNicholas Bellinger 				" struct Scsi_Host exists\n");
5060fd97ccfSChristoph Hellwig 			return -EEXIST;
507c66ac9dbSNicholas Bellinger 		}
508c66ac9dbSNicholas Bellinger 	}
509c66ac9dbSNicholas Bellinger 
510c66ac9dbSNicholas Bellinger 	spin_lock_irq(sh->host_lock);
511c66ac9dbSNicholas Bellinger 	list_for_each_entry(sd, &sh->__devices, siblings) {
512c66ac9dbSNicholas Bellinger 		if ((pdv->pdv_channel_id != sd->channel) ||
513c66ac9dbSNicholas Bellinger 		    (pdv->pdv_target_id != sd->id) ||
514c66ac9dbSNicholas Bellinger 		    (pdv->pdv_lun_id != sd->lun))
515c66ac9dbSNicholas Bellinger 			continue;
516c66ac9dbSNicholas Bellinger 		/*
517c66ac9dbSNicholas Bellinger 		 * Functions will release the held struct scsi_host->host_lock
518c66ac9dbSNicholas Bellinger 		 * before calling calling pscsi_add_device_to_list() to register
519c66ac9dbSNicholas Bellinger 		 * struct scsi_device with target_core_mod.
520c66ac9dbSNicholas Bellinger 		 */
521c66ac9dbSNicholas Bellinger 		switch (sd->type) {
522c66ac9dbSNicholas Bellinger 		case TYPE_DISK:
5230fd97ccfSChristoph Hellwig 			ret = pscsi_create_type_disk(dev, sd);
524c66ac9dbSNicholas Bellinger 			break;
525c66ac9dbSNicholas Bellinger 		default:
526a04e54f2SNicholas Bellinger 			ret = pscsi_create_type_nondisk(dev, sd);
527c66ac9dbSNicholas Bellinger 			break;
528c66ac9dbSNicholas Bellinger 		}
529c66ac9dbSNicholas Bellinger 
5300fd97ccfSChristoph Hellwig 		if (ret) {
531e6a8a41aSStefan Hajnoczi 			if (phv->phv_mode == PHV_VIRTUAL_HOST_ID)
532c66ac9dbSNicholas Bellinger 				scsi_host_put(sh);
533c66ac9dbSNicholas Bellinger 			else if (legacy_mode_enable) {
534c66ac9dbSNicholas Bellinger 				pscsi_pmode_enable_hba(hba, 0);
535c66ac9dbSNicholas Bellinger 				hba->hba_flags &= ~HBA_FLAGS_PSCSI_MODE;
536c66ac9dbSNicholas Bellinger 			}
537c66ac9dbSNicholas Bellinger 			pdv->pdv_sd = NULL;
5380fd97ccfSChristoph Hellwig 			return ret;
539c66ac9dbSNicholas Bellinger 		}
5400fd97ccfSChristoph Hellwig 		return 0;
541c66ac9dbSNicholas Bellinger 	}
542c66ac9dbSNicholas Bellinger 	spin_unlock_irq(sh->host_lock);
543c66ac9dbSNicholas Bellinger 
5446708bb27SAndy Grover 	pr_err("pSCSI: Unable to locate %d:%d:%d:%d\n", sh->host_no,
545c66ac9dbSNicholas Bellinger 		pdv->pdv_channel_id,  pdv->pdv_target_id, pdv->pdv_lun_id);
546c66ac9dbSNicholas Bellinger 
547e6a8a41aSStefan Hajnoczi 	if (phv->phv_mode == PHV_VIRTUAL_HOST_ID)
548c66ac9dbSNicholas Bellinger 		scsi_host_put(sh);
549c66ac9dbSNicholas Bellinger 	else if (legacy_mode_enable) {
550c66ac9dbSNicholas Bellinger 		pscsi_pmode_enable_hba(hba, 0);
551c66ac9dbSNicholas Bellinger 		hba->hba_flags &= ~HBA_FLAGS_PSCSI_MODE;
552c66ac9dbSNicholas Bellinger 	}
553c66ac9dbSNicholas Bellinger 
5540fd97ccfSChristoph Hellwig 	return -ENODEV;
555c66ac9dbSNicholas Bellinger }
556c66ac9dbSNicholas Bellinger 
5574cc987eaSNicholas Bellinger static void pscsi_dev_call_rcu(struct rcu_head *p)
5584cc987eaSNicholas Bellinger {
5594cc987eaSNicholas Bellinger 	struct se_device *dev = container_of(p, struct se_device, rcu_head);
5604cc987eaSNicholas Bellinger 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
5614cc987eaSNicholas Bellinger 
5624cc987eaSNicholas Bellinger 	kfree(pdv);
5634cc987eaSNicholas Bellinger }
5644cc987eaSNicholas Bellinger 
5650fd97ccfSChristoph Hellwig static void pscsi_free_device(struct se_device *dev)
566c66ac9dbSNicholas Bellinger {
5670fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
5680fd97ccfSChristoph Hellwig 	struct pscsi_hba_virt *phv = dev->se_hba->hba_ptr;
569c66ac9dbSNicholas Bellinger 	struct scsi_device *sd = pdv->pdv_sd;
570c66ac9dbSNicholas Bellinger 
571c66ac9dbSNicholas Bellinger 	if (sd) {
572c66ac9dbSNicholas Bellinger 		/*
573c66ac9dbSNicholas Bellinger 		 * Release exclusive pSCSI internal struct block_device claim for
574c66ac9dbSNicholas Bellinger 		 * struct scsi_device with TYPE_DISK from pscsi_create_type_disk()
575c66ac9dbSNicholas Bellinger 		 */
576c66ac9dbSNicholas Bellinger 		if ((sd->type == TYPE_DISK) && pdv->pdv_bd) {
577c66ac9dbSNicholas Bellinger 			blkdev_put(pdv->pdv_bd,
578c66ac9dbSNicholas Bellinger 				   FMODE_WRITE|FMODE_READ|FMODE_EXCL);
579c66ac9dbSNicholas Bellinger 			pdv->pdv_bd = NULL;
580c66ac9dbSNicholas Bellinger 		}
581c66ac9dbSNicholas Bellinger 		/*
582c66ac9dbSNicholas Bellinger 		 * For HBA mode PHV_LLD_SCSI_HOST_NO, release the reference
583c66ac9dbSNicholas Bellinger 		 * to struct Scsi_Host now.
584c66ac9dbSNicholas Bellinger 		 */
585c66ac9dbSNicholas Bellinger 		if ((phv->phv_mode == PHV_LLD_SCSI_HOST_NO) &&
586c66ac9dbSNicholas Bellinger 		    (phv->phv_lld_host != NULL))
587c66ac9dbSNicholas Bellinger 			scsi_host_put(phv->phv_lld_host);
5885a7125c6SAndy Grover 		else if (pdv->pdv_lld_host)
5895a7125c6SAndy Grover 			scsi_host_put(pdv->pdv_lld_host);
590c66ac9dbSNicholas Bellinger 
591c66ac9dbSNicholas Bellinger 		scsi_device_put(sd);
592c66ac9dbSNicholas Bellinger 
593c66ac9dbSNicholas Bellinger 		pdv->pdv_sd = NULL;
594c66ac9dbSNicholas Bellinger 	}
5954cc987eaSNicholas Bellinger 	call_rcu(&dev->rcu_head, pscsi_dev_call_rcu);
596c66ac9dbSNicholas Bellinger }
597c66ac9dbSNicholas Bellinger 
598d5829eacSPaolo Bonzini static void pscsi_transport_complete(struct se_cmd *cmd, struct scatterlist *sg,
599d5829eacSPaolo Bonzini 				     unsigned char *sense_buffer)
600c66ac9dbSNicholas Bellinger {
6010fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(cmd->se_dev);
602c66ac9dbSNicholas Bellinger 	struct scsi_device *sd = pdv->pdv_sd;
603c66ac9dbSNicholas Bellinger 	int result;
6045787cacdSChristoph Hellwig 	struct pscsi_plugin_task *pt = cmd->priv;
6051d2a2cd9SNicholas Bellinger 	unsigned char *cdb;
6061d2a2cd9SNicholas Bellinger 	/*
6071d2a2cd9SNicholas Bellinger 	 * Special case for REPORT_LUNs handling where pscsi_plugin_task has
6081d2a2cd9SNicholas Bellinger 	 * not been allocated because TCM is handling the emulation directly.
6091d2a2cd9SNicholas Bellinger 	 */
6101d2a2cd9SNicholas Bellinger 	if (!pt)
611d5829eacSPaolo Bonzini 		return;
612c66ac9dbSNicholas Bellinger 
6131d2a2cd9SNicholas Bellinger 	cdb = &pt->pscsi_cdb[0];
614c66ac9dbSNicholas Bellinger 	result = pt->pscsi_result;
615c66ac9dbSNicholas Bellinger 	/*
616c66ac9dbSNicholas Bellinger 	 * Hack to make sure that Write-Protect modepage is set if R/O mode is
617c66ac9dbSNicholas Bellinger 	 * forced.
618c66ac9dbSNicholas Bellinger 	 */
61929a05deeSNicholas Bellinger 	if (!cmd->data_length)
620c66ac9dbSNicholas Bellinger 		goto after_mode_sense;
621c66ac9dbSNicholas Bellinger 
622306c11b2SPaolo Bonzini 	if (((cdb[0] == MODE_SENSE) || (cdb[0] == MODE_SENSE_10)) &&
623306c11b2SPaolo Bonzini 	     (status_byte(result) << 1) == SAM_STAT_GOOD) {
62429a05deeSNicholas Bellinger 		bool read_only = target_lun_is_rdonly(cmd);
62529a05deeSNicholas Bellinger 
62629a05deeSNicholas Bellinger 		if (read_only) {
627de103c93SChristoph Hellwig 			unsigned char *buf;
628de103c93SChristoph Hellwig 
629de103c93SChristoph Hellwig 			buf = transport_kmap_data_sg(cmd);
630de103c93SChristoph Hellwig 			if (!buf)
631de103c93SChristoph Hellwig 				; /* XXX: TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE */
632c66ac9dbSNicholas Bellinger 
633c66ac9dbSNicholas Bellinger 			if (cdb[0] == MODE_SENSE_10) {
634c66ac9dbSNicholas Bellinger 				if (!(buf[3] & 0x80))
635c66ac9dbSNicholas Bellinger 					buf[3] |= 0x80;
636c66ac9dbSNicholas Bellinger 			} else {
637c66ac9dbSNicholas Bellinger 				if (!(buf[2] & 0x80))
638c66ac9dbSNicholas Bellinger 					buf[2] |= 0x80;
639c66ac9dbSNicholas Bellinger 			}
64005d1c7c0SAndy Grover 
6415787cacdSChristoph Hellwig 			transport_kunmap_data_sg(cmd);
642c66ac9dbSNicholas Bellinger 		}
643c66ac9dbSNicholas Bellinger 	}
644c66ac9dbSNicholas Bellinger after_mode_sense:
645c66ac9dbSNicholas Bellinger 
646306c11b2SPaolo Bonzini 	if (sd->type != TYPE_TAPE || !cmd->data_length)
647c66ac9dbSNicholas Bellinger 		goto after_mode_select;
648c66ac9dbSNicholas Bellinger 
649c66ac9dbSNicholas Bellinger 	/*
650c66ac9dbSNicholas Bellinger 	 * Hack to correctly obtain the initiator requested blocksize for
651c66ac9dbSNicholas Bellinger 	 * TYPE_TAPE.  Since this value is dependent upon each tape media,
652c66ac9dbSNicholas Bellinger 	 * struct scsi_device->sector_size will not contain the correct value
653c66ac9dbSNicholas Bellinger 	 * by default, so we go ahead and set it so
654c66ac9dbSNicholas Bellinger 	 * TRANSPORT(dev)->get_blockdev() returns the correct value to the
655c66ac9dbSNicholas Bellinger 	 * storage engine.
656c66ac9dbSNicholas Bellinger 	 */
657c66ac9dbSNicholas Bellinger 	if (((cdb[0] == MODE_SELECT) || (cdb[0] == MODE_SELECT_10)) &&
658c66ac9dbSNicholas Bellinger 	      (status_byte(result) << 1) == SAM_STAT_GOOD) {
659c66ac9dbSNicholas Bellinger 		unsigned char *buf;
660c66ac9dbSNicholas Bellinger 		u16 bdl;
661c66ac9dbSNicholas Bellinger 		u32 blocksize;
662c66ac9dbSNicholas Bellinger 
663c66ac9dbSNicholas Bellinger 		buf = sg_virt(&sg[0]);
6646708bb27SAndy Grover 		if (!buf) {
6656708bb27SAndy Grover 			pr_err("Unable to get buf for scatterlist\n");
666c66ac9dbSNicholas Bellinger 			goto after_mode_select;
667c66ac9dbSNicholas Bellinger 		}
668c66ac9dbSNicholas Bellinger 
669c66ac9dbSNicholas Bellinger 		if (cdb[0] == MODE_SELECT)
670*a85d667eSBart Van Assche 			bdl = buf[3];
671c66ac9dbSNicholas Bellinger 		else
672*a85d667eSBart Van Assche 			bdl = get_unaligned_be16(&buf[6]);
673c66ac9dbSNicholas Bellinger 
674c66ac9dbSNicholas Bellinger 		if (!bdl)
675c66ac9dbSNicholas Bellinger 			goto after_mode_select;
676c66ac9dbSNicholas Bellinger 
677c66ac9dbSNicholas Bellinger 		if (cdb[0] == MODE_SELECT)
678*a85d667eSBart Van Assche 			blocksize = get_unaligned_be24(&buf[9]);
679c66ac9dbSNicholas Bellinger 		else
680*a85d667eSBart Van Assche 			blocksize = get_unaligned_be24(&buf[13]);
681c66ac9dbSNicholas Bellinger 
682c66ac9dbSNicholas Bellinger 		sd->sector_size = blocksize;
683c66ac9dbSNicholas Bellinger 	}
684c66ac9dbSNicholas Bellinger after_mode_select:
685c66ac9dbSNicholas Bellinger 
686d5829eacSPaolo Bonzini 	if (sense_buffer && (status_byte(result) & CHECK_CONDITION)) {
687d5829eacSPaolo Bonzini 		memcpy(sense_buffer, pt->pscsi_sense, TRANSPORT_SENSE_BUFFER);
688d5829eacSPaolo Bonzini 		cmd->se_cmd_flags |= SCF_TRANSPORT_TASK_SENSE;
689d5829eacSPaolo Bonzini 	}
690c66ac9dbSNicholas Bellinger }
691c66ac9dbSNicholas Bellinger 
692c66ac9dbSNicholas Bellinger enum {
693c66ac9dbSNicholas Bellinger 	Opt_scsi_host_id, Opt_scsi_channel_id, Opt_scsi_target_id,
694c66ac9dbSNicholas Bellinger 	Opt_scsi_lun_id, Opt_err
695c66ac9dbSNicholas Bellinger };
696c66ac9dbSNicholas Bellinger 
697c66ac9dbSNicholas Bellinger static match_table_t tokens = {
698c66ac9dbSNicholas Bellinger 	{Opt_scsi_host_id, "scsi_host_id=%d"},
699c66ac9dbSNicholas Bellinger 	{Opt_scsi_channel_id, "scsi_channel_id=%d"},
700c66ac9dbSNicholas Bellinger 	{Opt_scsi_target_id, "scsi_target_id=%d"},
701c66ac9dbSNicholas Bellinger 	{Opt_scsi_lun_id, "scsi_lun_id=%d"},
702c66ac9dbSNicholas Bellinger 	{Opt_err, NULL}
703c66ac9dbSNicholas Bellinger };
704c66ac9dbSNicholas Bellinger 
7050fd97ccfSChristoph Hellwig static ssize_t pscsi_set_configfs_dev_params(struct se_device *dev,
7060fd97ccfSChristoph Hellwig 		const char *page, ssize_t count)
707c66ac9dbSNicholas Bellinger {
7080fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
7090fd97ccfSChristoph Hellwig 	struct pscsi_hba_virt *phv = dev->se_hba->hba_ptr;
710c66ac9dbSNicholas Bellinger 	char *orig, *ptr, *opts;
711c66ac9dbSNicholas Bellinger 	substring_t args[MAX_OPT_ARGS];
712c66ac9dbSNicholas Bellinger 	int ret = 0, arg, token;
713c66ac9dbSNicholas Bellinger 
714c66ac9dbSNicholas Bellinger 	opts = kstrdup(page, GFP_KERNEL);
715c66ac9dbSNicholas Bellinger 	if (!opts)
716c66ac9dbSNicholas Bellinger 		return -ENOMEM;
717c66ac9dbSNicholas Bellinger 
718c66ac9dbSNicholas Bellinger 	orig = opts;
719c66ac9dbSNicholas Bellinger 
72090c161b6SSebastian Andrzej Siewior 	while ((ptr = strsep(&opts, ",\n")) != NULL) {
721c66ac9dbSNicholas Bellinger 		if (!*ptr)
722c66ac9dbSNicholas Bellinger 			continue;
723c66ac9dbSNicholas Bellinger 
724c66ac9dbSNicholas Bellinger 		token = match_token(ptr, tokens, args);
725c66ac9dbSNicholas Bellinger 		switch (token) {
726c66ac9dbSNicholas Bellinger 		case Opt_scsi_host_id:
727c66ac9dbSNicholas Bellinger 			if (phv->phv_mode == PHV_LLD_SCSI_HOST_NO) {
7286708bb27SAndy Grover 				pr_err("PSCSI[%d]: Unable to accept"
729c66ac9dbSNicholas Bellinger 					" scsi_host_id while phv_mode =="
730c66ac9dbSNicholas Bellinger 					" PHV_LLD_SCSI_HOST_NO\n",
731c66ac9dbSNicholas Bellinger 					phv->phv_host_id);
732c66ac9dbSNicholas Bellinger 				ret = -EINVAL;
733c66ac9dbSNicholas Bellinger 				goto out;
734c66ac9dbSNicholas Bellinger 			}
735ce31c1b0SJoern Engel 			ret = match_int(args, &arg);
736ce31c1b0SJoern Engel 			if (ret)
737ce31c1b0SJoern Engel 				goto out;
738c66ac9dbSNicholas Bellinger 			pdv->pdv_host_id = arg;
7396708bb27SAndy Grover 			pr_debug("PSCSI[%d]: Referencing SCSI Host ID:"
740c66ac9dbSNicholas Bellinger 				" %d\n", phv->phv_host_id, pdv->pdv_host_id);
741c66ac9dbSNicholas Bellinger 			pdv->pdv_flags |= PDF_HAS_VIRT_HOST_ID;
742c66ac9dbSNicholas Bellinger 			break;
743c66ac9dbSNicholas Bellinger 		case Opt_scsi_channel_id:
744ce31c1b0SJoern Engel 			ret = match_int(args, &arg);
745ce31c1b0SJoern Engel 			if (ret)
746ce31c1b0SJoern Engel 				goto out;
747c66ac9dbSNicholas Bellinger 			pdv->pdv_channel_id = arg;
7486708bb27SAndy Grover 			pr_debug("PSCSI[%d]: Referencing SCSI Channel"
749c66ac9dbSNicholas Bellinger 				" ID: %d\n",  phv->phv_host_id,
750c66ac9dbSNicholas Bellinger 				pdv->pdv_channel_id);
751c66ac9dbSNicholas Bellinger 			pdv->pdv_flags |= PDF_HAS_CHANNEL_ID;
752c66ac9dbSNicholas Bellinger 			break;
753c66ac9dbSNicholas Bellinger 		case Opt_scsi_target_id:
754ce31c1b0SJoern Engel 			ret = match_int(args, &arg);
755ce31c1b0SJoern Engel 			if (ret)
756ce31c1b0SJoern Engel 				goto out;
757c66ac9dbSNicholas Bellinger 			pdv->pdv_target_id = arg;
7586708bb27SAndy Grover 			pr_debug("PSCSI[%d]: Referencing SCSI Target"
759c66ac9dbSNicholas Bellinger 				" ID: %d\n", phv->phv_host_id,
760c66ac9dbSNicholas Bellinger 				pdv->pdv_target_id);
761c66ac9dbSNicholas Bellinger 			pdv->pdv_flags |= PDF_HAS_TARGET_ID;
762c66ac9dbSNicholas Bellinger 			break;
763c66ac9dbSNicholas Bellinger 		case Opt_scsi_lun_id:
764ce31c1b0SJoern Engel 			ret = match_int(args, &arg);
765ce31c1b0SJoern Engel 			if (ret)
766ce31c1b0SJoern Engel 				goto out;
767c66ac9dbSNicholas Bellinger 			pdv->pdv_lun_id = arg;
7686708bb27SAndy Grover 			pr_debug("PSCSI[%d]: Referencing SCSI LUN ID:"
769c66ac9dbSNicholas Bellinger 				" %d\n", phv->phv_host_id, pdv->pdv_lun_id);
770c66ac9dbSNicholas Bellinger 			pdv->pdv_flags |= PDF_HAS_LUN_ID;
771c66ac9dbSNicholas Bellinger 			break;
772c66ac9dbSNicholas Bellinger 		default:
773c66ac9dbSNicholas Bellinger 			break;
774c66ac9dbSNicholas Bellinger 		}
775c66ac9dbSNicholas Bellinger 	}
776c66ac9dbSNicholas Bellinger 
777c66ac9dbSNicholas Bellinger out:
778c66ac9dbSNicholas Bellinger 	kfree(orig);
779c66ac9dbSNicholas Bellinger 	return (!ret) ? count : ret;
780c66ac9dbSNicholas Bellinger }
781c66ac9dbSNicholas Bellinger 
7820fd97ccfSChristoph Hellwig static ssize_t pscsi_show_configfs_dev_params(struct se_device *dev, char *b)
783c66ac9dbSNicholas Bellinger {
7840fd97ccfSChristoph Hellwig 	struct pscsi_hba_virt *phv = dev->se_hba->hba_ptr;
7850fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
786c66ac9dbSNicholas Bellinger 	struct scsi_device *sd = pdv->pdv_sd;
787c66ac9dbSNicholas Bellinger 	unsigned char host_id[16];
788c66ac9dbSNicholas Bellinger 	ssize_t bl;
789c66ac9dbSNicholas Bellinger 	int i;
790c66ac9dbSNicholas Bellinger 
791e6a8a41aSStefan Hajnoczi 	if (phv->phv_mode == PHV_VIRTUAL_HOST_ID)
792c66ac9dbSNicholas Bellinger 		snprintf(host_id, 16, "%d", pdv->pdv_host_id);
793c66ac9dbSNicholas Bellinger 	else
794c66ac9dbSNicholas Bellinger 		snprintf(host_id, 16, "PHBA Mode");
795c66ac9dbSNicholas Bellinger 
796c66ac9dbSNicholas Bellinger 	bl = sprintf(b, "SCSI Device Bus Location:"
797c66ac9dbSNicholas Bellinger 		" Channel ID: %d Target ID: %d LUN: %d Host ID: %s\n",
798c66ac9dbSNicholas Bellinger 		pdv->pdv_channel_id, pdv->pdv_target_id, pdv->pdv_lun_id,
799c66ac9dbSNicholas Bellinger 		host_id);
800c66ac9dbSNicholas Bellinger 
801c66ac9dbSNicholas Bellinger 	if (sd) {
802c66ac9dbSNicholas Bellinger 		bl += sprintf(b + bl, "        ");
803c66ac9dbSNicholas Bellinger 		bl += sprintf(b + bl, "Vendor: ");
804c66ac9dbSNicholas Bellinger 		for (i = 0; i < 8; i++) {
805c66ac9dbSNicholas Bellinger 			if (ISPRINT(sd->vendor[i]))   /* printable character? */
806c66ac9dbSNicholas Bellinger 				bl += sprintf(b + bl, "%c", sd->vendor[i]);
807c66ac9dbSNicholas Bellinger 			else
808c66ac9dbSNicholas Bellinger 				bl += sprintf(b + bl, " ");
809c66ac9dbSNicholas Bellinger 		}
810c66ac9dbSNicholas Bellinger 		bl += sprintf(b + bl, " Model: ");
811c66ac9dbSNicholas Bellinger 		for (i = 0; i < 16; i++) {
812c66ac9dbSNicholas Bellinger 			if (ISPRINT(sd->model[i]))   /* printable character ? */
813c66ac9dbSNicholas Bellinger 				bl += sprintf(b + bl, "%c", sd->model[i]);
814c66ac9dbSNicholas Bellinger 			else
815c66ac9dbSNicholas Bellinger 				bl += sprintf(b + bl, " ");
816c66ac9dbSNicholas Bellinger 		}
817c66ac9dbSNicholas Bellinger 		bl += sprintf(b + bl, " Rev: ");
818c66ac9dbSNicholas Bellinger 		for (i = 0; i < 4; i++) {
819c66ac9dbSNicholas Bellinger 			if (ISPRINT(sd->rev[i]))   /* printable character ? */
820c66ac9dbSNicholas Bellinger 				bl += sprintf(b + bl, "%c", sd->rev[i]);
821c66ac9dbSNicholas Bellinger 			else
822c66ac9dbSNicholas Bellinger 				bl += sprintf(b + bl, " ");
823c66ac9dbSNicholas Bellinger 		}
824c66ac9dbSNicholas Bellinger 		bl += sprintf(b + bl, "\n");
825c66ac9dbSNicholas Bellinger 	}
826c66ac9dbSNicholas Bellinger 	return bl;
827c66ac9dbSNicholas Bellinger }
828c66ac9dbSNicholas Bellinger 
8294246a0b6SChristoph Hellwig static void pscsi_bi_endio(struct bio *bio)
830c66ac9dbSNicholas Bellinger {
831c66ac9dbSNicholas Bellinger 	bio_put(bio);
832c66ac9dbSNicholas Bellinger }
833c66ac9dbSNicholas Bellinger 
8342dbe10a2SAsias He static inline struct bio *pscsi_get_bio(int nr_vecs)
835c66ac9dbSNicholas Bellinger {
836c66ac9dbSNicholas Bellinger 	struct bio *bio;
837c66ac9dbSNicholas Bellinger 	/*
838c66ac9dbSNicholas Bellinger 	 * Use bio_malloc() following the comment in for bio -> struct request
839c66ac9dbSNicholas Bellinger 	 * in block/blk-core.c:blk_make_request()
840c66ac9dbSNicholas Bellinger 	 */
8412dbe10a2SAsias He 	bio = bio_kmalloc(GFP_KERNEL, nr_vecs);
8426708bb27SAndy Grover 	if (!bio) {
8436708bb27SAndy Grover 		pr_err("PSCSI: bio_kmalloc() failed\n");
844c66ac9dbSNicholas Bellinger 		return NULL;
845c66ac9dbSNicholas Bellinger 	}
846c66ac9dbSNicholas Bellinger 	bio->bi_end_io = pscsi_bi_endio;
847c66ac9dbSNicholas Bellinger 
848c66ac9dbSNicholas Bellinger 	return bio;
849c66ac9dbSNicholas Bellinger }
850c66ac9dbSNicholas Bellinger 
851de103c93SChristoph Hellwig static sense_reason_t
852de103c93SChristoph Hellwig pscsi_map_sg(struct se_cmd *cmd, struct scatterlist *sgl, u32 sgl_nents,
853dd9cf046SChristoph Hellwig 		struct request *req)
854c66ac9dbSNicholas Bellinger {
8550fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(cmd->se_dev);
856dd9cf046SChristoph Hellwig 	struct bio *bio = NULL;
857c66ac9dbSNicholas Bellinger 	struct page *page;
858c66ac9dbSNicholas Bellinger 	struct scatterlist *sg;
8597a83aa4eSChristoph Hellwig 	u32 data_len = cmd->data_length, i, len, bytes, off;
8605787cacdSChristoph Hellwig 	int nr_pages = (cmd->data_length + sgl[0].offset +
861c66ac9dbSNicholas Bellinger 			PAGE_SIZE - 1) >> PAGE_SHIFT;
86203e98c9eSNicholas Bellinger 	int nr_vecs = 0, rc;
863dd9cf046SChristoph Hellwig 	int rw = (cmd->data_direction == DMA_TO_DEVICE);
864c66ac9dbSNicholas Bellinger 
865dd9cf046SChristoph Hellwig 	BUG_ON(!cmd->data_length);
86602b1a746SChristoph Hellwig 
8676708bb27SAndy Grover 	pr_debug("PSCSI: nr_pages: %d\n", nr_pages);
868c66ac9dbSNicholas Bellinger 
8695787cacdSChristoph Hellwig 	for_each_sg(sgl, sg, sgl_nents, i) {
870c66ac9dbSNicholas Bellinger 		page = sg_page(sg);
871c66ac9dbSNicholas Bellinger 		off = sg->offset;
872c66ac9dbSNicholas Bellinger 		len = sg->length;
873c66ac9dbSNicholas Bellinger 
8746708bb27SAndy Grover 		pr_debug("PSCSI: i: %d page: %p len: %d off: %d\n", i,
875c66ac9dbSNicholas Bellinger 			page, len, off);
876c66ac9dbSNicholas Bellinger 
8778f27d487SAsias He 		/*
8788f27d487SAsias He 		 * We only have one page of data in each sg element,
8798f27d487SAsias He 		 * we can not cross a page boundary.
8808f27d487SAsias He 		 */
8818f27d487SAsias He 		if (off + len > PAGE_SIZE)
8828f27d487SAsias He 			goto fail;
8838f27d487SAsias He 
8848f27d487SAsias He 		if (len > 0 && data_len > 0) {
885c66ac9dbSNicholas Bellinger 			bytes = min_t(unsigned int, len, PAGE_SIZE - off);
886c66ac9dbSNicholas Bellinger 			bytes = min(bytes, data_len);
887c66ac9dbSNicholas Bellinger 
8886708bb27SAndy Grover 			if (!bio) {
889c66ac9dbSNicholas Bellinger 				nr_vecs = min_t(int, BIO_MAX_PAGES, nr_pages);
890c66ac9dbSNicholas Bellinger 				nr_pages -= nr_vecs;
891c66ac9dbSNicholas Bellinger 				/*
892c66ac9dbSNicholas Bellinger 				 * Calls bio_kmalloc() and sets bio->bi_end_io()
893c66ac9dbSNicholas Bellinger 				 */
894a1d8b49aSAndy Grover 				bio = pscsi_get_bio(nr_vecs);
8956708bb27SAndy Grover 				if (!bio)
896c66ac9dbSNicholas Bellinger 					goto fail;
897c66ac9dbSNicholas Bellinger 
898c66ac9dbSNicholas Bellinger 				if (rw)
899e742fc32SMike Christie 					bio_set_op_attrs(bio, REQ_OP_WRITE, 0);
900c66ac9dbSNicholas Bellinger 
9016708bb27SAndy Grover 				pr_debug("PSCSI: Allocated bio: %p,"
902c66ac9dbSNicholas Bellinger 					" dir: %s nr_vecs: %d\n", bio,
903c66ac9dbSNicholas Bellinger 					(rw) ? "rw" : "r", nr_vecs);
904c66ac9dbSNicholas Bellinger 			}
905c66ac9dbSNicholas Bellinger 
9066708bb27SAndy Grover 			pr_debug("PSCSI: Calling bio_add_pc_page() i: %d"
907c66ac9dbSNicholas Bellinger 				" bio: %p page: %p len: %d off: %d\n", i, bio,
908c66ac9dbSNicholas Bellinger 				page, len, off);
909c66ac9dbSNicholas Bellinger 
910c66ac9dbSNicholas Bellinger 			rc = bio_add_pc_page(pdv->pdv_sd->request_queue,
911c66ac9dbSNicholas Bellinger 					bio, page, bytes, off);
9126708bb27SAndy Grover 			pr_debug("PSCSI: bio->bi_vcnt: %d nr_vecs: %d\n",
91384c85906SMing Lei 				bio_segments(bio), nr_vecs);
91484c85906SMing Lei 			if (rc != bytes) {
9156708bb27SAndy Grover 				pr_debug("PSCSI: Reached bio->bi_vcnt max:"
916c66ac9dbSNicholas Bellinger 					" %d i: %d bio: %p, allocating another"
917c66ac9dbSNicholas Bellinger 					" bio\n", bio->bi_vcnt, i, bio);
918dd9cf046SChristoph Hellwig 
919dd9cf046SChristoph Hellwig 				rc = blk_rq_append_bio(req, bio);
920dd9cf046SChristoph Hellwig 				if (rc) {
921dd9cf046SChristoph Hellwig 					pr_err("pSCSI: failed to append bio\n");
922dd9cf046SChristoph Hellwig 					goto fail;
923dd9cf046SChristoph Hellwig 				}
924dd9cf046SChristoph Hellwig 
925c66ac9dbSNicholas Bellinger 				/*
926c66ac9dbSNicholas Bellinger 				 * Clear the pointer so that another bio will
927dd9cf046SChristoph Hellwig 				 * be allocated with pscsi_get_bio() above.
928c66ac9dbSNicholas Bellinger 				 */
929c66ac9dbSNicholas Bellinger 				bio = NULL;
930c66ac9dbSNicholas Bellinger 			}
931c66ac9dbSNicholas Bellinger 
932c66ac9dbSNicholas Bellinger 			data_len -= bytes;
933c66ac9dbSNicholas Bellinger 		}
934c66ac9dbSNicholas Bellinger 	}
935c66ac9dbSNicholas Bellinger 
936dd9cf046SChristoph Hellwig 	if (bio) {
937dd9cf046SChristoph Hellwig 		rc = blk_rq_append_bio(req, bio);
938dd9cf046SChristoph Hellwig 		if (rc) {
939dd9cf046SChristoph Hellwig 			pr_err("pSCSI: failed to append bio\n");
940dd9cf046SChristoph Hellwig 			goto fail;
941dd9cf046SChristoph Hellwig 		}
942dd9cf046SChristoph Hellwig 	}
943dd9cf046SChristoph Hellwig 
944de103c93SChristoph Hellwig 	return 0;
945c66ac9dbSNicholas Bellinger fail:
946de103c93SChristoph Hellwig 	return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
947c66ac9dbSNicholas Bellinger }
948c66ac9dbSNicholas Bellinger 
949de103c93SChristoph Hellwig static sense_reason_t
950de103c93SChristoph Hellwig pscsi_parse_cdb(struct se_cmd *cmd)
951d6e0175cSChristoph Hellwig {
952de103c93SChristoph Hellwig 	if (cmd->se_cmd_flags & SCF_BIDI)
953de103c93SChristoph Hellwig 		return TCM_UNSUPPORTED_SCSI_OPCODE;
954d6e0175cSChristoph Hellwig 
9557bfea53bSAndy Grover 	return passthrough_parse_cdb(cmd, pscsi_execute_cmd);
9568de530a5SChristoph Hellwig }
957d6e0175cSChristoph Hellwig 
958de103c93SChristoph Hellwig static sense_reason_t
959de103c93SChristoph Hellwig pscsi_execute_cmd(struct se_cmd *cmd)
960c66ac9dbSNicholas Bellinger {
9610c2ad7d1SChristoph Hellwig 	struct scatterlist *sgl = cmd->t_data_sg;
9620c2ad7d1SChristoph Hellwig 	u32 sgl_nents = cmd->t_data_nents;
9630fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(cmd->se_dev);
9645787cacdSChristoph Hellwig 	struct pscsi_plugin_task *pt;
96502b1a746SChristoph Hellwig 	struct request *req;
966de103c93SChristoph Hellwig 	sense_reason_t ret;
967c66ac9dbSNicholas Bellinger 
9685787cacdSChristoph Hellwig 	/*
9695787cacdSChristoph Hellwig 	 * Dynamically alloc cdb space, since it may be larger than
9705787cacdSChristoph Hellwig 	 * TCM_MAX_COMMAND_SIZE
9715787cacdSChristoph Hellwig 	 */
9725787cacdSChristoph Hellwig 	pt = kzalloc(sizeof(*pt) + scsi_command_size(cmd->t_task_cdb), GFP_KERNEL);
9735787cacdSChristoph Hellwig 	if (!pt) {
974de103c93SChristoph Hellwig 		return TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
9755787cacdSChristoph Hellwig 	}
9765787cacdSChristoph Hellwig 	cmd->priv = pt;
9775787cacdSChristoph Hellwig 
978ed3102c6SChristoph Hellwig 	memcpy(pt->pscsi_cdb, cmd->t_task_cdb,
979ed3102c6SChristoph Hellwig 		scsi_command_size(cmd->t_task_cdb));
980485fd0d1SChristoph Hellwig 
98102b1a746SChristoph Hellwig 	req = blk_get_request(pdv->pdv_sd->request_queue,
982aebf526bSChristoph Hellwig 			cmd->data_direction == DMA_TO_DEVICE ?
983aebf526bSChristoph Hellwig 			REQ_OP_SCSI_OUT : REQ_OP_SCSI_IN,
98402b1a746SChristoph Hellwig 			GFP_KERNEL);
985a492f075SJoe Lawrence 	if (IS_ERR(req)) {
986fdb4c1f3SDan Carpenter 		pr_err("PSCSI: blk_get_request() failed\n");
987de103c93SChristoph Hellwig 		ret = TCM_LOGICAL_UNIT_COMMUNICATION_FAILURE;
9885787cacdSChristoph Hellwig 		goto fail;
98902b1a746SChristoph Hellwig 	}
990f27b087bSJens Axboe 
99182ed4db4SChristoph Hellwig 	scsi_req_init(req);
99202b1a746SChristoph Hellwig 
993dd9cf046SChristoph Hellwig 	if (sgl) {
994dd9cf046SChristoph Hellwig 		ret = pscsi_map_sg(cmd, sgl, sgl_nents, req);
995de103c93SChristoph Hellwig 		if (ret)
996dd9cf046SChristoph Hellwig 			goto fail_put_request;
99702b1a746SChristoph Hellwig 	}
99802b1a746SChristoph Hellwig 
99902b1a746SChristoph Hellwig 	req->end_io = pscsi_req_done;
10005787cacdSChristoph Hellwig 	req->end_io_data = cmd;
100182ed4db4SChristoph Hellwig 	scsi_req(req)->cmd_len = scsi_command_size(pt->pscsi_cdb);
100282ed4db4SChristoph Hellwig 	scsi_req(req)->cmd = &pt->pscsi_cdb[0];
100302b1a746SChristoph Hellwig 	if (pdv->pdv_sd->type == TYPE_DISK)
100402b1a746SChristoph Hellwig 		req->timeout = PS_TIMEOUT_DISK;
100502b1a746SChristoph Hellwig 	else
100602b1a746SChristoph Hellwig 		req->timeout = PS_TIMEOUT_OTHER;
100764c7f1d1SChristoph Hellwig 	scsi_req(req)->retries = PS_RETRY;
100802b1a746SChristoph Hellwig 
100902b1a746SChristoph Hellwig 	blk_execute_rq_nowait(pdv->pdv_sd->request_queue, NULL, req,
101068d81f40SChristoph Hellwig 			(cmd->sam_task_attr == TCM_HEAD_TAG),
101102b1a746SChristoph Hellwig 			pscsi_req_done);
101202b1a746SChristoph Hellwig 
101303e98c9eSNicholas Bellinger 	return 0;
101402b1a746SChristoph Hellwig 
1015dd9cf046SChristoph Hellwig fail_put_request:
1016dd9cf046SChristoph Hellwig 	blk_put_request(req);
10175787cacdSChristoph Hellwig fail:
10185787cacdSChristoph Hellwig 	kfree(pt);
1019de103c93SChristoph Hellwig 	return ret;
102002b1a746SChristoph Hellwig }
102102b1a746SChristoph Hellwig 
1022c66ac9dbSNicholas Bellinger /*	pscsi_get_device_type():
1023c66ac9dbSNicholas Bellinger  *
1024c66ac9dbSNicholas Bellinger  *
1025c66ac9dbSNicholas Bellinger  */
1026c66ac9dbSNicholas Bellinger static u32 pscsi_get_device_type(struct se_device *dev)
1027c66ac9dbSNicholas Bellinger {
10280fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
1029c66ac9dbSNicholas Bellinger 	struct scsi_device *sd = pdv->pdv_sd;
1030c66ac9dbSNicholas Bellinger 
1031215a8fe4SNicholas Bellinger 	return (sd) ? sd->type : TYPE_NO_LUN;
1032c66ac9dbSNicholas Bellinger }
1033c66ac9dbSNicholas Bellinger 
1034c66ac9dbSNicholas Bellinger static sector_t pscsi_get_blocks(struct se_device *dev)
1035c66ac9dbSNicholas Bellinger {
10360fd97ccfSChristoph Hellwig 	struct pscsi_dev_virt *pdv = PSCSI_DEV(dev);
1037c66ac9dbSNicholas Bellinger 
1038c66ac9dbSNicholas Bellinger 	if (pdv->pdv_bd && pdv->pdv_bd->bd_part)
1039c66ac9dbSNicholas Bellinger 		return pdv->pdv_bd->bd_part->nr_sects;
1040c66ac9dbSNicholas Bellinger 
1041c66ac9dbSNicholas Bellinger 	return 0;
1042c66ac9dbSNicholas Bellinger }
1043c66ac9dbSNicholas Bellinger 
10445787cacdSChristoph Hellwig static void pscsi_req_done(struct request *req, int uptodate)
1045c66ac9dbSNicholas Bellinger {
10465787cacdSChristoph Hellwig 	struct se_cmd *cmd = req->end_io_data;
10475787cacdSChristoph Hellwig 	struct pscsi_plugin_task *pt = cmd->priv;
10485787cacdSChristoph Hellwig 
104917d5363bSChristoph Hellwig 	pt->pscsi_result = scsi_req(req)->result;
105082ed4db4SChristoph Hellwig 	pt->pscsi_resid = scsi_req(req)->resid_len;
10515787cacdSChristoph Hellwig 
10525787cacdSChristoph Hellwig 	cmd->scsi_status = status_byte(pt->pscsi_result) << 1;
10535787cacdSChristoph Hellwig 	if (cmd->scsi_status) {
10545787cacdSChristoph Hellwig 		pr_debug("PSCSI Status Byte exception at cmd: %p CDB:"
10555787cacdSChristoph Hellwig 			" 0x%02x Result: 0x%08x\n", cmd, pt->pscsi_cdb[0],
1056c66ac9dbSNicholas Bellinger 			pt->pscsi_result);
1057c66ac9dbSNicholas Bellinger 	}
1058c66ac9dbSNicholas Bellinger 
1059c66ac9dbSNicholas Bellinger 	switch (host_byte(pt->pscsi_result)) {
1060c66ac9dbSNicholas Bellinger 	case DID_OK:
10615787cacdSChristoph Hellwig 		target_complete_cmd(cmd, cmd->scsi_status);
1062c66ac9dbSNicholas Bellinger 		break;
1063c66ac9dbSNicholas Bellinger 	default:
10645787cacdSChristoph Hellwig 		pr_debug("PSCSI Host Byte exception at cmd: %p CDB:"
10655787cacdSChristoph Hellwig 			" 0x%02x Result: 0x%08x\n", cmd, pt->pscsi_cdb[0],
1066c66ac9dbSNicholas Bellinger 			pt->pscsi_result);
10675787cacdSChristoph Hellwig 		target_complete_cmd(cmd, SAM_STAT_CHECK_CONDITION);
1068c66ac9dbSNicholas Bellinger 		break;
1069c66ac9dbSNicholas Bellinger 	}
1070c66ac9dbSNicholas Bellinger 
107182ed4db4SChristoph Hellwig 	memcpy(pt->pscsi_sense, scsi_req(req)->sense, TRANSPORT_SENSE_BUFFER);
1072c66ac9dbSNicholas Bellinger 	__blk_put_request(req->q, req);
10735787cacdSChristoph Hellwig 	kfree(pt);
1074c66ac9dbSNicholas Bellinger }
1075c66ac9dbSNicholas Bellinger 
10760a06d430SChristoph Hellwig static const struct target_backend_ops pscsi_ops = {
1077c66ac9dbSNicholas Bellinger 	.name			= "pscsi",
1078c66ac9dbSNicholas Bellinger 	.owner			= THIS_MODULE,
1079530c6891SMike Christie 	.transport_flags	= TRANSPORT_FLAG_PASSTHROUGH |
10804ec5bf0eSBryant G. Ly 				  TRANSPORT_FLAG_PASSTHROUGH_ALUA |
10814ec5bf0eSBryant G. Ly 				  TRANSPORT_FLAG_PASSTHROUGH_PGR,
1082c66ac9dbSNicholas Bellinger 	.attach_hba		= pscsi_attach_hba,
1083c66ac9dbSNicholas Bellinger 	.detach_hba		= pscsi_detach_hba,
1084c66ac9dbSNicholas Bellinger 	.pmode_enable_hba	= pscsi_pmode_enable_hba,
10850fd97ccfSChristoph Hellwig 	.alloc_device		= pscsi_alloc_device,
10860fd97ccfSChristoph Hellwig 	.configure_device	= pscsi_configure_device,
1087c66ac9dbSNicholas Bellinger 	.free_device		= pscsi_free_device,
1088c66ac9dbSNicholas Bellinger 	.transport_complete	= pscsi_transport_complete,
1089d6e0175cSChristoph Hellwig 	.parse_cdb		= pscsi_parse_cdb,
1090c66ac9dbSNicholas Bellinger 	.set_configfs_dev_params = pscsi_set_configfs_dev_params,
1091c66ac9dbSNicholas Bellinger 	.show_configfs_dev_params = pscsi_show_configfs_dev_params,
1092c66ac9dbSNicholas Bellinger 	.get_device_type	= pscsi_get_device_type,
1093c66ac9dbSNicholas Bellinger 	.get_blocks		= pscsi_get_blocks,
10945873c4d1SChristoph Hellwig 	.tb_dev_attrib_attrs	= passthrough_attrib_attrs,
1095c66ac9dbSNicholas Bellinger };
1096c66ac9dbSNicholas Bellinger 
1097c66ac9dbSNicholas Bellinger static int __init pscsi_module_init(void)
1098c66ac9dbSNicholas Bellinger {
10990a06d430SChristoph Hellwig 	return transport_backend_register(&pscsi_ops);
1100c66ac9dbSNicholas Bellinger }
1101c66ac9dbSNicholas Bellinger 
110263b91d5aSAsias He static void __exit pscsi_module_exit(void)
1103c66ac9dbSNicholas Bellinger {
11040a06d430SChristoph Hellwig 	target_backend_unregister(&pscsi_ops);
1105c66ac9dbSNicholas Bellinger }
1106c66ac9dbSNicholas Bellinger 
1107c66ac9dbSNicholas Bellinger MODULE_DESCRIPTION("TCM PSCSI subsystem plugin");
1108c66ac9dbSNicholas Bellinger MODULE_AUTHOR("nab@Linux-iSCSI.org");
1109c66ac9dbSNicholas Bellinger MODULE_LICENSE("GPL");
1110c66ac9dbSNicholas Bellinger 
1111c66ac9dbSNicholas Bellinger module_init(pscsi_module_init);
1112c66ac9dbSNicholas Bellinger module_exit(pscsi_module_exit);
1113