162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci *  scsi.c Copyright (C) 1992 Drew Eckhardt
462306a36Sopenharmony_ci *         Copyright (C) 1993, 1994, 1995, 1999 Eric Youngdale
562306a36Sopenharmony_ci *         Copyright (C) 2002, 2003 Christoph Hellwig
662306a36Sopenharmony_ci *
762306a36Sopenharmony_ci *  generic mid-level SCSI driver
862306a36Sopenharmony_ci *      Initial versions: Drew Eckhardt
962306a36Sopenharmony_ci *      Subsequent revisions: Eric Youngdale
1062306a36Sopenharmony_ci *
1162306a36Sopenharmony_ci *  <drew@colorado.edu>
1262306a36Sopenharmony_ci *
1362306a36Sopenharmony_ci *  Bug correction thanks go to :
1462306a36Sopenharmony_ci *      Rik Faith <faith@cs.unc.edu>
1562306a36Sopenharmony_ci *      Tommy Thorn <tthorn>
1662306a36Sopenharmony_ci *      Thomas Wuensche <tw@fgb1.fgb.mw.tu-muenchen.de>
1762306a36Sopenharmony_ci *
1862306a36Sopenharmony_ci *  Modified by Eric Youngdale eric@andante.org or ericy@gnu.ai.mit.edu to
1962306a36Sopenharmony_ci *  add scatter-gather, multiple outstanding request, and other
2062306a36Sopenharmony_ci *  enhancements.
2162306a36Sopenharmony_ci *
2262306a36Sopenharmony_ci *  Native multichannel, wide scsi, /proc/scsi and hot plugging
2362306a36Sopenharmony_ci *  support added by Michael Neuffer <mike@i-connect.net>
2462306a36Sopenharmony_ci *
2562306a36Sopenharmony_ci *  Added request_module("scsi_hostadapter") for kerneld:
2662306a36Sopenharmony_ci *  (Put an "alias scsi_hostadapter your_hostadapter" in /etc/modprobe.conf)
2762306a36Sopenharmony_ci *  Bjorn Ekwall  <bj0rn@blox.se>
2862306a36Sopenharmony_ci *  (changed to kmod)
2962306a36Sopenharmony_ci *
3062306a36Sopenharmony_ci *  Major improvements to the timeout, abort, and reset processing,
3162306a36Sopenharmony_ci *  as well as performance modifications for large queue depths by
3262306a36Sopenharmony_ci *  Leonard N. Zubkoff <lnz@dandelion.com>
3362306a36Sopenharmony_ci *
3462306a36Sopenharmony_ci *  Converted cli() code to spinlocks, Ingo Molnar
3562306a36Sopenharmony_ci *
3662306a36Sopenharmony_ci *  Jiffies wrap fixes (host->resetting), 3 Dec 1998 Andrea Arcangeli
3762306a36Sopenharmony_ci *
3862306a36Sopenharmony_ci *  out_of_space hacks, D. Gilbert (dpg) 990608
3962306a36Sopenharmony_ci */
4062306a36Sopenharmony_ci
4162306a36Sopenharmony_ci#include <linux/module.h>
4262306a36Sopenharmony_ci#include <linux/moduleparam.h>
4362306a36Sopenharmony_ci#include <linux/kernel.h>
4462306a36Sopenharmony_ci#include <linux/timer.h>
4562306a36Sopenharmony_ci#include <linux/string.h>
4662306a36Sopenharmony_ci#include <linux/slab.h>
4762306a36Sopenharmony_ci#include <linux/blkdev.h>
4862306a36Sopenharmony_ci#include <linux/delay.h>
4962306a36Sopenharmony_ci#include <linux/init.h>
5062306a36Sopenharmony_ci#include <linux/completion.h>
5162306a36Sopenharmony_ci#include <linux/unistd.h>
5262306a36Sopenharmony_ci#include <linux/spinlock.h>
5362306a36Sopenharmony_ci#include <linux/kmod.h>
5462306a36Sopenharmony_ci#include <linux/interrupt.h>
5562306a36Sopenharmony_ci#include <linux/notifier.h>
5662306a36Sopenharmony_ci#include <linux/cpu.h>
5762306a36Sopenharmony_ci#include <linux/mutex.h>
5862306a36Sopenharmony_ci#include <asm/unaligned.h>
5962306a36Sopenharmony_ci
6062306a36Sopenharmony_ci#include <scsi/scsi.h>
6162306a36Sopenharmony_ci#include <scsi/scsi_cmnd.h>
6262306a36Sopenharmony_ci#include <scsi/scsi_dbg.h>
6362306a36Sopenharmony_ci#include <scsi/scsi_device.h>
6462306a36Sopenharmony_ci#include <scsi/scsi_driver.h>
6562306a36Sopenharmony_ci#include <scsi/scsi_eh.h>
6662306a36Sopenharmony_ci#include <scsi/scsi_host.h>
6762306a36Sopenharmony_ci#include <scsi/scsi_tcq.h>
6862306a36Sopenharmony_ci
6962306a36Sopenharmony_ci#include "scsi_priv.h"
7062306a36Sopenharmony_ci#include "scsi_logging.h"
7162306a36Sopenharmony_ci
7262306a36Sopenharmony_ci#define CREATE_TRACE_POINTS
7362306a36Sopenharmony_ci#include <trace/events/scsi.h>
7462306a36Sopenharmony_ci
7562306a36Sopenharmony_ci/*
7662306a36Sopenharmony_ci * Definitions and constants.
7762306a36Sopenharmony_ci */
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_ci/*
8062306a36Sopenharmony_ci * Note - the initial logging level can be set here to log events at boot time.
8162306a36Sopenharmony_ci * After the system is up, you may enable logging via the /proc interface.
8262306a36Sopenharmony_ci */
8362306a36Sopenharmony_ciunsigned int scsi_logging_level;
8462306a36Sopenharmony_ci#if defined(CONFIG_SCSI_LOGGING)
8562306a36Sopenharmony_ciEXPORT_SYMBOL(scsi_logging_level);
8662306a36Sopenharmony_ci#endif
8762306a36Sopenharmony_ci
8862306a36Sopenharmony_ci#ifdef CONFIG_SCSI_LOGGING
8962306a36Sopenharmony_civoid scsi_log_send(struct scsi_cmnd *cmd)
9062306a36Sopenharmony_ci{
9162306a36Sopenharmony_ci	unsigned int level;
9262306a36Sopenharmony_ci
9362306a36Sopenharmony_ci	/*
9462306a36Sopenharmony_ci	 * If ML QUEUE log level is greater than or equal to:
9562306a36Sopenharmony_ci	 *
9662306a36Sopenharmony_ci	 * 1: nothing (match completion)
9762306a36Sopenharmony_ci	 *
9862306a36Sopenharmony_ci	 * 2: log opcode + command of all commands + cmd address
9962306a36Sopenharmony_ci	 *
10062306a36Sopenharmony_ci	 * 3: same as 2
10162306a36Sopenharmony_ci	 *
10262306a36Sopenharmony_ci	 * 4: same as 3
10362306a36Sopenharmony_ci	 */
10462306a36Sopenharmony_ci	if (unlikely(scsi_logging_level)) {
10562306a36Sopenharmony_ci		level = SCSI_LOG_LEVEL(SCSI_LOG_MLQUEUE_SHIFT,
10662306a36Sopenharmony_ci				       SCSI_LOG_MLQUEUE_BITS);
10762306a36Sopenharmony_ci		if (level > 1) {
10862306a36Sopenharmony_ci			scmd_printk(KERN_INFO, cmd,
10962306a36Sopenharmony_ci				    "Send: scmd 0x%p\n", cmd);
11062306a36Sopenharmony_ci			scsi_print_command(cmd);
11162306a36Sopenharmony_ci		}
11262306a36Sopenharmony_ci	}
11362306a36Sopenharmony_ci}
11462306a36Sopenharmony_ci
11562306a36Sopenharmony_civoid scsi_log_completion(struct scsi_cmnd *cmd, int disposition)
11662306a36Sopenharmony_ci{
11762306a36Sopenharmony_ci	unsigned int level;
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci	/*
12062306a36Sopenharmony_ci	 * If ML COMPLETE log level is greater than or equal to:
12162306a36Sopenharmony_ci	 *
12262306a36Sopenharmony_ci	 * 1: log disposition, result, opcode + command, and conditionally
12362306a36Sopenharmony_ci	 * sense data for failures or non SUCCESS dispositions.
12462306a36Sopenharmony_ci	 *
12562306a36Sopenharmony_ci	 * 2: same as 1 but for all command completions.
12662306a36Sopenharmony_ci	 *
12762306a36Sopenharmony_ci	 * 3: same as 2
12862306a36Sopenharmony_ci	 *
12962306a36Sopenharmony_ci	 * 4: same as 3 plus dump extra junk
13062306a36Sopenharmony_ci	 */
13162306a36Sopenharmony_ci	if (unlikely(scsi_logging_level)) {
13262306a36Sopenharmony_ci		level = SCSI_LOG_LEVEL(SCSI_LOG_MLCOMPLETE_SHIFT,
13362306a36Sopenharmony_ci				       SCSI_LOG_MLCOMPLETE_BITS);
13462306a36Sopenharmony_ci		if (((level > 0) && (cmd->result || disposition != SUCCESS)) ||
13562306a36Sopenharmony_ci		    (level > 1)) {
13662306a36Sopenharmony_ci			scsi_print_result(cmd, "Done", disposition);
13762306a36Sopenharmony_ci			scsi_print_command(cmd);
13862306a36Sopenharmony_ci			if (scsi_status_is_check_condition(cmd->result))
13962306a36Sopenharmony_ci				scsi_print_sense(cmd);
14062306a36Sopenharmony_ci			if (level > 3)
14162306a36Sopenharmony_ci				scmd_printk(KERN_INFO, cmd,
14262306a36Sopenharmony_ci					    "scsi host busy %d failed %d\n",
14362306a36Sopenharmony_ci					    scsi_host_busy(cmd->device->host),
14462306a36Sopenharmony_ci					    cmd->device->host->host_failed);
14562306a36Sopenharmony_ci		}
14662306a36Sopenharmony_ci	}
14762306a36Sopenharmony_ci}
14862306a36Sopenharmony_ci#endif
14962306a36Sopenharmony_ci
15062306a36Sopenharmony_ci/**
15162306a36Sopenharmony_ci * scsi_finish_command - cleanup and pass command back to upper layer
15262306a36Sopenharmony_ci * @cmd: the command
15362306a36Sopenharmony_ci *
15462306a36Sopenharmony_ci * Description: Pass command off to upper layer for finishing of I/O
15562306a36Sopenharmony_ci *              request, waking processes that are waiting on results,
15662306a36Sopenharmony_ci *              etc.
15762306a36Sopenharmony_ci */
15862306a36Sopenharmony_civoid scsi_finish_command(struct scsi_cmnd *cmd)
15962306a36Sopenharmony_ci{
16062306a36Sopenharmony_ci	struct scsi_device *sdev = cmd->device;
16162306a36Sopenharmony_ci	struct scsi_target *starget = scsi_target(sdev);
16262306a36Sopenharmony_ci	struct Scsi_Host *shost = sdev->host;
16362306a36Sopenharmony_ci	struct scsi_driver *drv;
16462306a36Sopenharmony_ci	unsigned int good_bytes;
16562306a36Sopenharmony_ci
16662306a36Sopenharmony_ci	scsi_device_unbusy(sdev, cmd);
16762306a36Sopenharmony_ci
16862306a36Sopenharmony_ci	/*
16962306a36Sopenharmony_ci	 * Clear the flags that say that the device/target/host is no longer
17062306a36Sopenharmony_ci	 * capable of accepting new commands.
17162306a36Sopenharmony_ci	 */
17262306a36Sopenharmony_ci	if (atomic_read(&shost->host_blocked))
17362306a36Sopenharmony_ci		atomic_set(&shost->host_blocked, 0);
17462306a36Sopenharmony_ci	if (atomic_read(&starget->target_blocked))
17562306a36Sopenharmony_ci		atomic_set(&starget->target_blocked, 0);
17662306a36Sopenharmony_ci	if (atomic_read(&sdev->device_blocked))
17762306a36Sopenharmony_ci		atomic_set(&sdev->device_blocked, 0);
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_ci	SCSI_LOG_MLCOMPLETE(4, sdev_printk(KERN_INFO, sdev,
18062306a36Sopenharmony_ci				"Notifying upper driver of completion "
18162306a36Sopenharmony_ci				"(result %x)\n", cmd->result));
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_ci	good_bytes = scsi_bufflen(cmd);
18462306a36Sopenharmony_ci	if (!blk_rq_is_passthrough(scsi_cmd_to_rq(cmd))) {
18562306a36Sopenharmony_ci		int old_good_bytes = good_bytes;
18662306a36Sopenharmony_ci		drv = scsi_cmd_to_driver(cmd);
18762306a36Sopenharmony_ci		if (drv->done)
18862306a36Sopenharmony_ci			good_bytes = drv->done(cmd);
18962306a36Sopenharmony_ci		/*
19062306a36Sopenharmony_ci		 * USB may not give sense identifying bad sector and
19162306a36Sopenharmony_ci		 * simply return a residue instead, so subtract off the
19262306a36Sopenharmony_ci		 * residue if drv->done() error processing indicates no
19362306a36Sopenharmony_ci		 * change to the completion length.
19462306a36Sopenharmony_ci		 */
19562306a36Sopenharmony_ci		if (good_bytes == old_good_bytes)
19662306a36Sopenharmony_ci			good_bytes -= scsi_get_resid(cmd);
19762306a36Sopenharmony_ci	}
19862306a36Sopenharmony_ci	scsi_io_completion(cmd, good_bytes);
19962306a36Sopenharmony_ci}
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_ci/*
20362306a36Sopenharmony_ci * 4096 is big enough for saturating fast SCSI LUNs.
20462306a36Sopenharmony_ci */
20562306a36Sopenharmony_ciint scsi_device_max_queue_depth(struct scsi_device *sdev)
20662306a36Sopenharmony_ci{
20762306a36Sopenharmony_ci	return min_t(int, sdev->host->can_queue, 4096);
20862306a36Sopenharmony_ci}
20962306a36Sopenharmony_ci
21062306a36Sopenharmony_ci/**
21162306a36Sopenharmony_ci * scsi_change_queue_depth - change a device's queue depth
21262306a36Sopenharmony_ci * @sdev: SCSI Device in question
21362306a36Sopenharmony_ci * @depth: number of commands allowed to be queued to the driver
21462306a36Sopenharmony_ci *
21562306a36Sopenharmony_ci * Sets the device queue depth and returns the new value.
21662306a36Sopenharmony_ci */
21762306a36Sopenharmony_ciint scsi_change_queue_depth(struct scsi_device *sdev, int depth)
21862306a36Sopenharmony_ci{
21962306a36Sopenharmony_ci	depth = min_t(int, depth, scsi_device_max_queue_depth(sdev));
22062306a36Sopenharmony_ci
22162306a36Sopenharmony_ci	if (depth > 0) {
22262306a36Sopenharmony_ci		sdev->queue_depth = depth;
22362306a36Sopenharmony_ci		wmb();
22462306a36Sopenharmony_ci	}
22562306a36Sopenharmony_ci
22662306a36Sopenharmony_ci	if (sdev->request_queue)
22762306a36Sopenharmony_ci		blk_set_queue_depth(sdev->request_queue, depth);
22862306a36Sopenharmony_ci
22962306a36Sopenharmony_ci	sbitmap_resize(&sdev->budget_map, sdev->queue_depth);
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_ci	return sdev->queue_depth;
23262306a36Sopenharmony_ci}
23362306a36Sopenharmony_ciEXPORT_SYMBOL(scsi_change_queue_depth);
23462306a36Sopenharmony_ci
23562306a36Sopenharmony_ci/**
23662306a36Sopenharmony_ci * scsi_track_queue_full - track QUEUE_FULL events to adjust queue depth
23762306a36Sopenharmony_ci * @sdev: SCSI Device in question
23862306a36Sopenharmony_ci * @depth: Current number of outstanding SCSI commands on this device,
23962306a36Sopenharmony_ci *         not counting the one returned as QUEUE_FULL.
24062306a36Sopenharmony_ci *
24162306a36Sopenharmony_ci * Description:	This function will track successive QUEUE_FULL events on a
24262306a36Sopenharmony_ci * 		specific SCSI device to determine if and when there is a
24362306a36Sopenharmony_ci * 		need to adjust the queue depth on the device.
24462306a36Sopenharmony_ci *
24562306a36Sopenharmony_ci * Returns:	0 - No change needed, >0 - Adjust queue depth to this new depth,
24662306a36Sopenharmony_ci * 		-1 - Drop back to untagged operation using host->cmd_per_lun
24762306a36Sopenharmony_ci * 			as the untagged command depth
24862306a36Sopenharmony_ci *
24962306a36Sopenharmony_ci * Lock Status:	None held on entry
25062306a36Sopenharmony_ci *
25162306a36Sopenharmony_ci * Notes:	Low level drivers may call this at any time and we will do
25262306a36Sopenharmony_ci * 		"The Right Thing."  We are interrupt context safe.
25362306a36Sopenharmony_ci */
25462306a36Sopenharmony_ciint scsi_track_queue_full(struct scsi_device *sdev, int depth)
25562306a36Sopenharmony_ci{
25662306a36Sopenharmony_ci
25762306a36Sopenharmony_ci	/*
25862306a36Sopenharmony_ci	 * Don't let QUEUE_FULLs on the same
25962306a36Sopenharmony_ci	 * jiffies count, they could all be from
26062306a36Sopenharmony_ci	 * same event.
26162306a36Sopenharmony_ci	 */
26262306a36Sopenharmony_ci	if ((jiffies >> 4) == (sdev->last_queue_full_time >> 4))
26362306a36Sopenharmony_ci		return 0;
26462306a36Sopenharmony_ci
26562306a36Sopenharmony_ci	sdev->last_queue_full_time = jiffies;
26662306a36Sopenharmony_ci	if (sdev->last_queue_full_depth != depth) {
26762306a36Sopenharmony_ci		sdev->last_queue_full_count = 1;
26862306a36Sopenharmony_ci		sdev->last_queue_full_depth = depth;
26962306a36Sopenharmony_ci	} else {
27062306a36Sopenharmony_ci		sdev->last_queue_full_count++;
27162306a36Sopenharmony_ci	}
27262306a36Sopenharmony_ci
27362306a36Sopenharmony_ci	if (sdev->last_queue_full_count <= 10)
27462306a36Sopenharmony_ci		return 0;
27562306a36Sopenharmony_ci
27662306a36Sopenharmony_ci	return scsi_change_queue_depth(sdev, depth);
27762306a36Sopenharmony_ci}
27862306a36Sopenharmony_ciEXPORT_SYMBOL(scsi_track_queue_full);
27962306a36Sopenharmony_ci
28062306a36Sopenharmony_ci/**
28162306a36Sopenharmony_ci * scsi_vpd_inquiry - Request a device provide us with a VPD page
28262306a36Sopenharmony_ci * @sdev: The device to ask
28362306a36Sopenharmony_ci * @buffer: Where to put the result
28462306a36Sopenharmony_ci * @page: Which Vital Product Data to return
28562306a36Sopenharmony_ci * @len: The length of the buffer
28662306a36Sopenharmony_ci *
28762306a36Sopenharmony_ci * This is an internal helper function.  You probably want to use
28862306a36Sopenharmony_ci * scsi_get_vpd_page instead.
28962306a36Sopenharmony_ci *
29062306a36Sopenharmony_ci * Returns size of the vpd page on success or a negative error number.
29162306a36Sopenharmony_ci */
29262306a36Sopenharmony_cistatic int scsi_vpd_inquiry(struct scsi_device *sdev, unsigned char *buffer,
29362306a36Sopenharmony_ci							u8 page, unsigned len)
29462306a36Sopenharmony_ci{
29562306a36Sopenharmony_ci	int result;
29662306a36Sopenharmony_ci	unsigned char cmd[16];
29762306a36Sopenharmony_ci
29862306a36Sopenharmony_ci	if (len < 4)
29962306a36Sopenharmony_ci		return -EINVAL;
30062306a36Sopenharmony_ci
30162306a36Sopenharmony_ci	cmd[0] = INQUIRY;
30262306a36Sopenharmony_ci	cmd[1] = 1;		/* EVPD */
30362306a36Sopenharmony_ci	cmd[2] = page;
30462306a36Sopenharmony_ci	cmd[3] = len >> 8;
30562306a36Sopenharmony_ci	cmd[4] = len & 0xff;
30662306a36Sopenharmony_ci	cmd[5] = 0;		/* Control byte */
30762306a36Sopenharmony_ci
30862306a36Sopenharmony_ci	/*
30962306a36Sopenharmony_ci	 * I'm not convinced we need to try quite this hard to get VPD, but
31062306a36Sopenharmony_ci	 * all the existing users tried this hard.
31162306a36Sopenharmony_ci	 */
31262306a36Sopenharmony_ci	result = scsi_execute_cmd(sdev, cmd, REQ_OP_DRV_IN, buffer, len,
31362306a36Sopenharmony_ci				  30 * HZ, 3, NULL);
31462306a36Sopenharmony_ci	if (result)
31562306a36Sopenharmony_ci		return -EIO;
31662306a36Sopenharmony_ci
31762306a36Sopenharmony_ci	/*
31862306a36Sopenharmony_ci	 * Sanity check that we got the page back that we asked for and that
31962306a36Sopenharmony_ci	 * the page size is not 0.
32062306a36Sopenharmony_ci	 */
32162306a36Sopenharmony_ci	if (buffer[1] != page)
32262306a36Sopenharmony_ci		return -EIO;
32362306a36Sopenharmony_ci
32462306a36Sopenharmony_ci	result = get_unaligned_be16(&buffer[2]);
32562306a36Sopenharmony_ci	if (!result)
32662306a36Sopenharmony_ci		return -EIO;
32762306a36Sopenharmony_ci
32862306a36Sopenharmony_ci	return result + 4;
32962306a36Sopenharmony_ci}
33062306a36Sopenharmony_ci
33162306a36Sopenharmony_cienum scsi_vpd_parameters {
33262306a36Sopenharmony_ci	SCSI_VPD_HEADER_SIZE = 4,
33362306a36Sopenharmony_ci	SCSI_VPD_LIST_SIZE = 36,
33462306a36Sopenharmony_ci};
33562306a36Sopenharmony_ci
33662306a36Sopenharmony_cistatic int scsi_get_vpd_size(struct scsi_device *sdev, u8 page)
33762306a36Sopenharmony_ci{
33862306a36Sopenharmony_ci	unsigned char vpd[SCSI_VPD_LIST_SIZE] __aligned(4);
33962306a36Sopenharmony_ci	int result;
34062306a36Sopenharmony_ci
34162306a36Sopenharmony_ci	if (sdev->no_vpd_size)
34262306a36Sopenharmony_ci		return SCSI_DEFAULT_VPD_LEN;
34362306a36Sopenharmony_ci
34462306a36Sopenharmony_ci	/*
34562306a36Sopenharmony_ci	 * Fetch the supported pages VPD and validate that the requested page
34662306a36Sopenharmony_ci	 * number is present.
34762306a36Sopenharmony_ci	 */
34862306a36Sopenharmony_ci	if (page != 0) {
34962306a36Sopenharmony_ci		result = scsi_vpd_inquiry(sdev, vpd, 0, sizeof(vpd));
35062306a36Sopenharmony_ci		if (result < SCSI_VPD_HEADER_SIZE)
35162306a36Sopenharmony_ci			return 0;
35262306a36Sopenharmony_ci
35362306a36Sopenharmony_ci		result -= SCSI_VPD_HEADER_SIZE;
35462306a36Sopenharmony_ci		if (!memchr(&vpd[SCSI_VPD_HEADER_SIZE], page, result))
35562306a36Sopenharmony_ci			return 0;
35662306a36Sopenharmony_ci	}
35762306a36Sopenharmony_ci	/*
35862306a36Sopenharmony_ci	 * Fetch the VPD page header to find out how big the page
35962306a36Sopenharmony_ci	 * is. This is done to prevent problems on legacy devices
36062306a36Sopenharmony_ci	 * which can not handle allocation lengths as large as
36162306a36Sopenharmony_ci	 * potentially requested by the caller.
36262306a36Sopenharmony_ci	 */
36362306a36Sopenharmony_ci	result = scsi_vpd_inquiry(sdev, vpd, page, SCSI_VPD_HEADER_SIZE);
36462306a36Sopenharmony_ci	if (result < 0)
36562306a36Sopenharmony_ci		return 0;
36662306a36Sopenharmony_ci
36762306a36Sopenharmony_ci	if (result < SCSI_VPD_HEADER_SIZE) {
36862306a36Sopenharmony_ci		dev_warn_once(&sdev->sdev_gendev,
36962306a36Sopenharmony_ci			      "%s: short VPD page 0x%02x length: %d bytes\n",
37062306a36Sopenharmony_ci			      __func__, page, result);
37162306a36Sopenharmony_ci		return 0;
37262306a36Sopenharmony_ci	}
37362306a36Sopenharmony_ci
37462306a36Sopenharmony_ci	return result;
37562306a36Sopenharmony_ci}
37662306a36Sopenharmony_ci
37762306a36Sopenharmony_ci/**
37862306a36Sopenharmony_ci * scsi_get_vpd_page - Get Vital Product Data from a SCSI device
37962306a36Sopenharmony_ci * @sdev: The device to ask
38062306a36Sopenharmony_ci * @page: Which Vital Product Data to return
38162306a36Sopenharmony_ci * @buf: where to store the VPD
38262306a36Sopenharmony_ci * @buf_len: number of bytes in the VPD buffer area
38362306a36Sopenharmony_ci *
38462306a36Sopenharmony_ci * SCSI devices may optionally supply Vital Product Data.  Each 'page'
38562306a36Sopenharmony_ci * of VPD is defined in the appropriate SCSI document (eg SPC, SBC).
38662306a36Sopenharmony_ci * If the device supports this VPD page, this routine fills @buf
38762306a36Sopenharmony_ci * with the data from that page and return 0. If the VPD page is not
38862306a36Sopenharmony_ci * supported or its content cannot be retrieved, -EINVAL is returned.
38962306a36Sopenharmony_ci */
39062306a36Sopenharmony_ciint scsi_get_vpd_page(struct scsi_device *sdev, u8 page, unsigned char *buf,
39162306a36Sopenharmony_ci		      int buf_len)
39262306a36Sopenharmony_ci{
39362306a36Sopenharmony_ci	int result, vpd_len;
39462306a36Sopenharmony_ci
39562306a36Sopenharmony_ci	if (!scsi_device_supports_vpd(sdev))
39662306a36Sopenharmony_ci		return -EINVAL;
39762306a36Sopenharmony_ci
39862306a36Sopenharmony_ci	vpd_len = scsi_get_vpd_size(sdev, page);
39962306a36Sopenharmony_ci	if (vpd_len <= 0)
40062306a36Sopenharmony_ci		return -EINVAL;
40162306a36Sopenharmony_ci
40262306a36Sopenharmony_ci	vpd_len = min(vpd_len, buf_len);
40362306a36Sopenharmony_ci
40462306a36Sopenharmony_ci	/*
40562306a36Sopenharmony_ci	 * Fetch the actual page. Since the appropriate size was reported
40662306a36Sopenharmony_ci	 * by the device it is now safe to ask for something bigger.
40762306a36Sopenharmony_ci	 */
40862306a36Sopenharmony_ci	memset(buf, 0, buf_len);
40962306a36Sopenharmony_ci	result = scsi_vpd_inquiry(sdev, buf, page, vpd_len);
41062306a36Sopenharmony_ci	if (result < 0)
41162306a36Sopenharmony_ci		return -EINVAL;
41262306a36Sopenharmony_ci	else if (result > vpd_len)
41362306a36Sopenharmony_ci		dev_warn_once(&sdev->sdev_gendev,
41462306a36Sopenharmony_ci			      "%s: VPD page 0x%02x result %d > %d bytes\n",
41562306a36Sopenharmony_ci			      __func__, page, result, vpd_len);
41662306a36Sopenharmony_ci
41762306a36Sopenharmony_ci	return 0;
41862306a36Sopenharmony_ci}
41962306a36Sopenharmony_ciEXPORT_SYMBOL_GPL(scsi_get_vpd_page);
42062306a36Sopenharmony_ci
42162306a36Sopenharmony_ci/**
42262306a36Sopenharmony_ci * scsi_get_vpd_buf - Get Vital Product Data from a SCSI device
42362306a36Sopenharmony_ci * @sdev: The device to ask
42462306a36Sopenharmony_ci * @page: Which Vital Product Data to return
42562306a36Sopenharmony_ci *
42662306a36Sopenharmony_ci * Returns %NULL upon failure.
42762306a36Sopenharmony_ci */
42862306a36Sopenharmony_cistatic struct scsi_vpd *scsi_get_vpd_buf(struct scsi_device *sdev, u8 page)
42962306a36Sopenharmony_ci{
43062306a36Sopenharmony_ci	struct scsi_vpd *vpd_buf;
43162306a36Sopenharmony_ci	int vpd_len, result;
43262306a36Sopenharmony_ci
43362306a36Sopenharmony_ci	vpd_len = scsi_get_vpd_size(sdev, page);
43462306a36Sopenharmony_ci	if (vpd_len <= 0)
43562306a36Sopenharmony_ci		return NULL;
43662306a36Sopenharmony_ci
43762306a36Sopenharmony_ciretry_pg:
43862306a36Sopenharmony_ci	/*
43962306a36Sopenharmony_ci	 * Fetch the actual page. Since the appropriate size was reported
44062306a36Sopenharmony_ci	 * by the device it is now safe to ask for something bigger.
44162306a36Sopenharmony_ci	 */
44262306a36Sopenharmony_ci	vpd_buf = kmalloc(sizeof(*vpd_buf) + vpd_len, GFP_KERNEL);
44362306a36Sopenharmony_ci	if (!vpd_buf)
44462306a36Sopenharmony_ci		return NULL;
44562306a36Sopenharmony_ci
44662306a36Sopenharmony_ci	result = scsi_vpd_inquiry(sdev, vpd_buf->data, page, vpd_len);
44762306a36Sopenharmony_ci	if (result < 0) {
44862306a36Sopenharmony_ci		kfree(vpd_buf);
44962306a36Sopenharmony_ci		return NULL;
45062306a36Sopenharmony_ci	}
45162306a36Sopenharmony_ci	if (result > vpd_len) {
45262306a36Sopenharmony_ci		dev_warn_once(&sdev->sdev_gendev,
45362306a36Sopenharmony_ci			      "%s: VPD page 0x%02x result %d > %d bytes\n",
45462306a36Sopenharmony_ci			      __func__, page, result, vpd_len);
45562306a36Sopenharmony_ci		vpd_len = result;
45662306a36Sopenharmony_ci		kfree(vpd_buf);
45762306a36Sopenharmony_ci		goto retry_pg;
45862306a36Sopenharmony_ci	}
45962306a36Sopenharmony_ci
46062306a36Sopenharmony_ci	vpd_buf->len = result;
46162306a36Sopenharmony_ci
46262306a36Sopenharmony_ci	return vpd_buf;
46362306a36Sopenharmony_ci}
46462306a36Sopenharmony_ci
46562306a36Sopenharmony_cistatic void scsi_update_vpd_page(struct scsi_device *sdev, u8 page,
46662306a36Sopenharmony_ci				 struct scsi_vpd __rcu **sdev_vpd_buf)
46762306a36Sopenharmony_ci{
46862306a36Sopenharmony_ci	struct scsi_vpd *vpd_buf;
46962306a36Sopenharmony_ci
47062306a36Sopenharmony_ci	vpd_buf = scsi_get_vpd_buf(sdev, page);
47162306a36Sopenharmony_ci	if (!vpd_buf)
47262306a36Sopenharmony_ci		return;
47362306a36Sopenharmony_ci
47462306a36Sopenharmony_ci	mutex_lock(&sdev->inquiry_mutex);
47562306a36Sopenharmony_ci	vpd_buf = rcu_replace_pointer(*sdev_vpd_buf, vpd_buf,
47662306a36Sopenharmony_ci				      lockdep_is_held(&sdev->inquiry_mutex));
47762306a36Sopenharmony_ci	mutex_unlock(&sdev->inquiry_mutex);
47862306a36Sopenharmony_ci
47962306a36Sopenharmony_ci	if (vpd_buf)
48062306a36Sopenharmony_ci		kfree_rcu(vpd_buf, rcu);
48162306a36Sopenharmony_ci}
48262306a36Sopenharmony_ci
48362306a36Sopenharmony_ci/**
48462306a36Sopenharmony_ci * scsi_attach_vpd - Attach Vital Product Data to a SCSI device structure
48562306a36Sopenharmony_ci * @sdev: The device to ask
48662306a36Sopenharmony_ci *
48762306a36Sopenharmony_ci * Attach the 'Device Identification' VPD page (0x83) and the
48862306a36Sopenharmony_ci * 'Unit Serial Number' VPD page (0x80) to a SCSI device
48962306a36Sopenharmony_ci * structure. This information can be used to identify the device
49062306a36Sopenharmony_ci * uniquely.
49162306a36Sopenharmony_ci */
49262306a36Sopenharmony_civoid scsi_attach_vpd(struct scsi_device *sdev)
49362306a36Sopenharmony_ci{
49462306a36Sopenharmony_ci	int i;
49562306a36Sopenharmony_ci	struct scsi_vpd *vpd_buf;
49662306a36Sopenharmony_ci
49762306a36Sopenharmony_ci	if (!scsi_device_supports_vpd(sdev))
49862306a36Sopenharmony_ci		return;
49962306a36Sopenharmony_ci
50062306a36Sopenharmony_ci	/* Ask for all the pages supported by this device */
50162306a36Sopenharmony_ci	vpd_buf = scsi_get_vpd_buf(sdev, 0);
50262306a36Sopenharmony_ci	if (!vpd_buf)
50362306a36Sopenharmony_ci		return;
50462306a36Sopenharmony_ci
50562306a36Sopenharmony_ci	for (i = 4; i < vpd_buf->len; i++) {
50662306a36Sopenharmony_ci		if (vpd_buf->data[i] == 0x0)
50762306a36Sopenharmony_ci			scsi_update_vpd_page(sdev, 0x0, &sdev->vpd_pg0);
50862306a36Sopenharmony_ci		if (vpd_buf->data[i] == 0x80)
50962306a36Sopenharmony_ci			scsi_update_vpd_page(sdev, 0x80, &sdev->vpd_pg80);
51062306a36Sopenharmony_ci		if (vpd_buf->data[i] == 0x83)
51162306a36Sopenharmony_ci			scsi_update_vpd_page(sdev, 0x83, &sdev->vpd_pg83);
51262306a36Sopenharmony_ci		if (vpd_buf->data[i] == 0x89)
51362306a36Sopenharmony_ci			scsi_update_vpd_page(sdev, 0x89, &sdev->vpd_pg89);
51462306a36Sopenharmony_ci		if (vpd_buf->data[i] == 0xb0)
51562306a36Sopenharmony_ci			scsi_update_vpd_page(sdev, 0xb0, &sdev->vpd_pgb0);
51662306a36Sopenharmony_ci		if (vpd_buf->data[i] == 0xb1)
51762306a36Sopenharmony_ci			scsi_update_vpd_page(sdev, 0xb1, &sdev->vpd_pgb1);
51862306a36Sopenharmony_ci		if (vpd_buf->data[i] == 0xb2)
51962306a36Sopenharmony_ci			scsi_update_vpd_page(sdev, 0xb2, &sdev->vpd_pgb2);
52062306a36Sopenharmony_ci	}
52162306a36Sopenharmony_ci	kfree(vpd_buf);
52262306a36Sopenharmony_ci}
52362306a36Sopenharmony_ci
52462306a36Sopenharmony_ci/**
52562306a36Sopenharmony_ci * scsi_report_opcode - Find out if a given command is supported
52662306a36Sopenharmony_ci * @sdev:	scsi device to query
52762306a36Sopenharmony_ci * @buffer:	scratch buffer (must be at least 20 bytes long)
52862306a36Sopenharmony_ci * @len:	length of buffer
52962306a36Sopenharmony_ci * @opcode:	opcode for the command to look up
53062306a36Sopenharmony_ci * @sa:		service action for the command to look up
53162306a36Sopenharmony_ci *
53262306a36Sopenharmony_ci * Uses the REPORT SUPPORTED OPERATION CODES to check support for the
53362306a36Sopenharmony_ci * command identified with @opcode and @sa. If the command does not
53462306a36Sopenharmony_ci * have a service action, @sa must be 0. Returns -EINVAL if RSOC fails,
53562306a36Sopenharmony_ci * 0 if the command is not supported and 1 if the device claims to
53662306a36Sopenharmony_ci * support the command.
53762306a36Sopenharmony_ci */
53862306a36Sopenharmony_ciint scsi_report_opcode(struct scsi_device *sdev, unsigned char *buffer,
53962306a36Sopenharmony_ci		       unsigned int len, unsigned char opcode,
54062306a36Sopenharmony_ci		       unsigned short sa)
54162306a36Sopenharmony_ci{
54262306a36Sopenharmony_ci	unsigned char cmd[16];
54362306a36Sopenharmony_ci	struct scsi_sense_hdr sshdr;
54462306a36Sopenharmony_ci	int result, request_len;
54562306a36Sopenharmony_ci	const struct scsi_exec_args exec_args = {
54662306a36Sopenharmony_ci		.sshdr = &sshdr,
54762306a36Sopenharmony_ci	};
54862306a36Sopenharmony_ci
54962306a36Sopenharmony_ci	if (sdev->no_report_opcodes || sdev->scsi_level < SCSI_SPC_3)
55062306a36Sopenharmony_ci		return -EINVAL;
55162306a36Sopenharmony_ci
55262306a36Sopenharmony_ci	/* RSOC header + size of command we are asking about */
55362306a36Sopenharmony_ci	request_len = 4 + COMMAND_SIZE(opcode);
55462306a36Sopenharmony_ci	if (request_len > len) {
55562306a36Sopenharmony_ci		dev_warn_once(&sdev->sdev_gendev,
55662306a36Sopenharmony_ci			      "%s: len %u bytes, opcode 0x%02x needs %u\n",
55762306a36Sopenharmony_ci			      __func__, len, opcode, request_len);
55862306a36Sopenharmony_ci		return -EINVAL;
55962306a36Sopenharmony_ci	}
56062306a36Sopenharmony_ci
56162306a36Sopenharmony_ci	memset(cmd, 0, 16);
56262306a36Sopenharmony_ci	cmd[0] = MAINTENANCE_IN;
56362306a36Sopenharmony_ci	cmd[1] = MI_REPORT_SUPPORTED_OPERATION_CODES;
56462306a36Sopenharmony_ci	if (!sa) {
56562306a36Sopenharmony_ci		cmd[2] = 1;	/* One command format */
56662306a36Sopenharmony_ci		cmd[3] = opcode;
56762306a36Sopenharmony_ci	} else {
56862306a36Sopenharmony_ci		cmd[2] = 3;	/* One command format with service action */
56962306a36Sopenharmony_ci		cmd[3] = opcode;
57062306a36Sopenharmony_ci		put_unaligned_be16(sa, &cmd[4]);
57162306a36Sopenharmony_ci	}
57262306a36Sopenharmony_ci	put_unaligned_be32(request_len, &cmd[6]);
57362306a36Sopenharmony_ci	memset(buffer, 0, len);
57462306a36Sopenharmony_ci
57562306a36Sopenharmony_ci	result = scsi_execute_cmd(sdev, cmd, REQ_OP_DRV_IN, buffer,
57662306a36Sopenharmony_ci				  request_len, 30 * HZ, 3, &exec_args);
57762306a36Sopenharmony_ci	if (result < 0)
57862306a36Sopenharmony_ci		return result;
57962306a36Sopenharmony_ci	if (result && scsi_sense_valid(&sshdr) &&
58062306a36Sopenharmony_ci	    sshdr.sense_key == ILLEGAL_REQUEST &&
58162306a36Sopenharmony_ci	    (sshdr.asc == 0x20 || sshdr.asc == 0x24) && sshdr.ascq == 0x00)
58262306a36Sopenharmony_ci		return -EINVAL;
58362306a36Sopenharmony_ci
58462306a36Sopenharmony_ci	if ((buffer[1] & 3) == 3) /* Command supported */
58562306a36Sopenharmony_ci		return 1;
58662306a36Sopenharmony_ci
58762306a36Sopenharmony_ci	return 0;
58862306a36Sopenharmony_ci}
58962306a36Sopenharmony_ciEXPORT_SYMBOL(scsi_report_opcode);
59062306a36Sopenharmony_ci
59162306a36Sopenharmony_ci#define SCSI_CDL_CHECK_BUF_LEN	64
59262306a36Sopenharmony_ci
59362306a36Sopenharmony_cistatic bool scsi_cdl_check_cmd(struct scsi_device *sdev, u8 opcode, u16 sa,
59462306a36Sopenharmony_ci			       unsigned char *buf)
59562306a36Sopenharmony_ci{
59662306a36Sopenharmony_ci	int ret;
59762306a36Sopenharmony_ci	u8 cdlp;
59862306a36Sopenharmony_ci
59962306a36Sopenharmony_ci	/* Check operation code */
60062306a36Sopenharmony_ci	ret = scsi_report_opcode(sdev, buf, SCSI_CDL_CHECK_BUF_LEN, opcode, sa);
60162306a36Sopenharmony_ci	if (ret <= 0)
60262306a36Sopenharmony_ci		return false;
60362306a36Sopenharmony_ci
60462306a36Sopenharmony_ci	if ((buf[1] & 0x03) != 0x03)
60562306a36Sopenharmony_ci		return false;
60662306a36Sopenharmony_ci
60762306a36Sopenharmony_ci	/*
60862306a36Sopenharmony_ci	 * See SPC-6, One_command parameter data format for
60962306a36Sopenharmony_ci	 * REPORT SUPPORTED OPERATION CODES. We have the following cases
61062306a36Sopenharmony_ci	 * depending on rwcdlp (buf[0] & 0x01) value:
61162306a36Sopenharmony_ci	 *  - rwcdlp == 0: then cdlp indicates support for the A mode page when
61262306a36Sopenharmony_ci	 *		   it is equal to 1 and for the B mode page when it is
61362306a36Sopenharmony_ci	 *		   equal to 2.
61462306a36Sopenharmony_ci	 *  - rwcdlp == 1: then cdlp indicates support for the T2A mode page
61562306a36Sopenharmony_ci	 *		   when it is equal to 1 and for the T2B mode page when
61662306a36Sopenharmony_ci	 *		   it is equal to 2.
61762306a36Sopenharmony_ci	 * Overall, to detect support for command duration limits, we only need
61862306a36Sopenharmony_ci	 * to check that cdlp is 1 or 2.
61962306a36Sopenharmony_ci	 */
62062306a36Sopenharmony_ci	cdlp = (buf[1] & 0x18) >> 3;
62162306a36Sopenharmony_ci
62262306a36Sopenharmony_ci	return cdlp == 0x01 || cdlp == 0x02;
62362306a36Sopenharmony_ci}
62462306a36Sopenharmony_ci
62562306a36Sopenharmony_ci/**
62662306a36Sopenharmony_ci * scsi_cdl_check - Check if a SCSI device supports Command Duration Limits
62762306a36Sopenharmony_ci * @sdev: The device to check
62862306a36Sopenharmony_ci */
62962306a36Sopenharmony_civoid scsi_cdl_check(struct scsi_device *sdev)
63062306a36Sopenharmony_ci{
63162306a36Sopenharmony_ci	bool cdl_supported;
63262306a36Sopenharmony_ci	unsigned char *buf;
63362306a36Sopenharmony_ci
63462306a36Sopenharmony_ci	/*
63562306a36Sopenharmony_ci	 * Support for CDL was defined in SPC-5. Ignore devices reporting an
63662306a36Sopenharmony_ci	 * lower SPC version. This also avoids problems with old drives choking
63762306a36Sopenharmony_ci	 * on MAINTENANCE_IN / MI_REPORT_SUPPORTED_OPERATION_CODES with a
63862306a36Sopenharmony_ci	 * service action specified, as done in scsi_cdl_check_cmd().
63962306a36Sopenharmony_ci	 */
64062306a36Sopenharmony_ci	if (sdev->scsi_level < SCSI_SPC_5) {
64162306a36Sopenharmony_ci		sdev->cdl_supported = 0;
64262306a36Sopenharmony_ci		return;
64362306a36Sopenharmony_ci	}
64462306a36Sopenharmony_ci
64562306a36Sopenharmony_ci	buf = kmalloc(SCSI_CDL_CHECK_BUF_LEN, GFP_KERNEL);
64662306a36Sopenharmony_ci	if (!buf) {
64762306a36Sopenharmony_ci		sdev->cdl_supported = 0;
64862306a36Sopenharmony_ci		return;
64962306a36Sopenharmony_ci	}
65062306a36Sopenharmony_ci
65162306a36Sopenharmony_ci	/* Check support for READ_16, WRITE_16, READ_32 and WRITE_32 commands */
65262306a36Sopenharmony_ci	cdl_supported =
65362306a36Sopenharmony_ci		scsi_cdl_check_cmd(sdev, READ_16, 0, buf) ||
65462306a36Sopenharmony_ci		scsi_cdl_check_cmd(sdev, WRITE_16, 0, buf) ||
65562306a36Sopenharmony_ci		scsi_cdl_check_cmd(sdev, VARIABLE_LENGTH_CMD, READ_32, buf) ||
65662306a36Sopenharmony_ci		scsi_cdl_check_cmd(sdev, VARIABLE_LENGTH_CMD, WRITE_32, buf);
65762306a36Sopenharmony_ci	if (cdl_supported) {
65862306a36Sopenharmony_ci		/*
65962306a36Sopenharmony_ci		 * We have CDL support: force the use of READ16/WRITE16.
66062306a36Sopenharmony_ci		 * READ32 and WRITE32 will be used for devices that support
66162306a36Sopenharmony_ci		 * the T10_PI_TYPE2_PROTECTION protection type.
66262306a36Sopenharmony_ci		 */
66362306a36Sopenharmony_ci		sdev->use_16_for_rw = 1;
66462306a36Sopenharmony_ci		sdev->use_10_for_rw = 0;
66562306a36Sopenharmony_ci
66662306a36Sopenharmony_ci		sdev->cdl_supported = 1;
66762306a36Sopenharmony_ci	} else {
66862306a36Sopenharmony_ci		sdev->cdl_supported = 0;
66962306a36Sopenharmony_ci	}
67062306a36Sopenharmony_ci
67162306a36Sopenharmony_ci	kfree(buf);
67262306a36Sopenharmony_ci}
67362306a36Sopenharmony_ci
67462306a36Sopenharmony_ci/**
67562306a36Sopenharmony_ci * scsi_cdl_enable - Enable or disable a SCSI device supports for Command
67662306a36Sopenharmony_ci *                   Duration Limits
67762306a36Sopenharmony_ci * @sdev: The target device
67862306a36Sopenharmony_ci * @enable: the target state
67962306a36Sopenharmony_ci */
68062306a36Sopenharmony_ciint scsi_cdl_enable(struct scsi_device *sdev, bool enable)
68162306a36Sopenharmony_ci{
68262306a36Sopenharmony_ci	struct scsi_mode_data data;
68362306a36Sopenharmony_ci	struct scsi_sense_hdr sshdr;
68462306a36Sopenharmony_ci	struct scsi_vpd *vpd;
68562306a36Sopenharmony_ci	bool is_ata = false;
68662306a36Sopenharmony_ci	char buf[64];
68762306a36Sopenharmony_ci	int ret;
68862306a36Sopenharmony_ci
68962306a36Sopenharmony_ci	if (!sdev->cdl_supported)
69062306a36Sopenharmony_ci		return -EOPNOTSUPP;
69162306a36Sopenharmony_ci
69262306a36Sopenharmony_ci	rcu_read_lock();
69362306a36Sopenharmony_ci	vpd = rcu_dereference(sdev->vpd_pg89);
69462306a36Sopenharmony_ci	if (vpd)
69562306a36Sopenharmony_ci		is_ata = true;
69662306a36Sopenharmony_ci	rcu_read_unlock();
69762306a36Sopenharmony_ci
69862306a36Sopenharmony_ci	/*
69962306a36Sopenharmony_ci	 * For ATA devices, CDL needs to be enabled with a SET FEATURES command.
70062306a36Sopenharmony_ci	 */
70162306a36Sopenharmony_ci	if (is_ata) {
70262306a36Sopenharmony_ci		char *buf_data;
70362306a36Sopenharmony_ci		int len;
70462306a36Sopenharmony_ci
70562306a36Sopenharmony_ci		ret = scsi_mode_sense(sdev, 0x08, 0x0a, 0xf2, buf, sizeof(buf),
70662306a36Sopenharmony_ci				      5 * HZ, 3, &data, NULL);
70762306a36Sopenharmony_ci		if (ret)
70862306a36Sopenharmony_ci			return -EINVAL;
70962306a36Sopenharmony_ci
71062306a36Sopenharmony_ci		/* Enable CDL using the ATA feature page */
71162306a36Sopenharmony_ci		len = min_t(size_t, sizeof(buf),
71262306a36Sopenharmony_ci			    data.length - data.header_length -
71362306a36Sopenharmony_ci			    data.block_descriptor_length);
71462306a36Sopenharmony_ci		buf_data = buf + data.header_length +
71562306a36Sopenharmony_ci			data.block_descriptor_length;
71662306a36Sopenharmony_ci		if (enable)
71762306a36Sopenharmony_ci			buf_data[4] = 0x02;
71862306a36Sopenharmony_ci		else
71962306a36Sopenharmony_ci			buf_data[4] = 0;
72062306a36Sopenharmony_ci
72162306a36Sopenharmony_ci		ret = scsi_mode_select(sdev, 1, 0, buf_data, len, 5 * HZ, 3,
72262306a36Sopenharmony_ci				       &data, &sshdr);
72362306a36Sopenharmony_ci		if (ret) {
72462306a36Sopenharmony_ci			if (scsi_sense_valid(&sshdr))
72562306a36Sopenharmony_ci				scsi_print_sense_hdr(sdev,
72662306a36Sopenharmony_ci					dev_name(&sdev->sdev_gendev), &sshdr);
72762306a36Sopenharmony_ci			return ret;
72862306a36Sopenharmony_ci		}
72962306a36Sopenharmony_ci	}
73062306a36Sopenharmony_ci
73162306a36Sopenharmony_ci	sdev->cdl_enable = enable;
73262306a36Sopenharmony_ci
73362306a36Sopenharmony_ci	return 0;
73462306a36Sopenharmony_ci}
73562306a36Sopenharmony_ci
73662306a36Sopenharmony_ci/**
73762306a36Sopenharmony_ci * scsi_device_get  -  get an additional reference to a scsi_device
73862306a36Sopenharmony_ci * @sdev:	device to get a reference to
73962306a36Sopenharmony_ci *
74062306a36Sopenharmony_ci * Description: Gets a reference to the scsi_device and increments the use count
74162306a36Sopenharmony_ci * of the underlying LLDD module.  You must hold host_lock of the
74262306a36Sopenharmony_ci * parent Scsi_Host or already have a reference when calling this.
74362306a36Sopenharmony_ci *
74462306a36Sopenharmony_ci * This will fail if a device is deleted or cancelled, or when the LLD module
74562306a36Sopenharmony_ci * is in the process of being unloaded.
74662306a36Sopenharmony_ci */
74762306a36Sopenharmony_ciint scsi_device_get(struct scsi_device *sdev)
74862306a36Sopenharmony_ci{
74962306a36Sopenharmony_ci	if (sdev->sdev_state == SDEV_DEL || sdev->sdev_state == SDEV_CANCEL)
75062306a36Sopenharmony_ci		goto fail;
75162306a36Sopenharmony_ci	if (!try_module_get(sdev->host->hostt->module))
75262306a36Sopenharmony_ci		goto fail;
75362306a36Sopenharmony_ci	if (!get_device(&sdev->sdev_gendev))
75462306a36Sopenharmony_ci		goto fail_put_module;
75562306a36Sopenharmony_ci	return 0;
75662306a36Sopenharmony_ci
75762306a36Sopenharmony_cifail_put_module:
75862306a36Sopenharmony_ci	module_put(sdev->host->hostt->module);
75962306a36Sopenharmony_cifail:
76062306a36Sopenharmony_ci	return -ENXIO;
76162306a36Sopenharmony_ci}
76262306a36Sopenharmony_ciEXPORT_SYMBOL(scsi_device_get);
76362306a36Sopenharmony_ci
76462306a36Sopenharmony_ci/**
76562306a36Sopenharmony_ci * scsi_device_put  -  release a reference to a scsi_device
76662306a36Sopenharmony_ci * @sdev:	device to release a reference on.
76762306a36Sopenharmony_ci *
76862306a36Sopenharmony_ci * Description: Release a reference to the scsi_device and decrements the use
76962306a36Sopenharmony_ci * count of the underlying LLDD module.  The device is freed once the last
77062306a36Sopenharmony_ci * user vanishes.
77162306a36Sopenharmony_ci */
77262306a36Sopenharmony_civoid scsi_device_put(struct scsi_device *sdev)
77362306a36Sopenharmony_ci{
77462306a36Sopenharmony_ci	struct module *mod = sdev->host->hostt->module;
77562306a36Sopenharmony_ci
77662306a36Sopenharmony_ci	put_device(&sdev->sdev_gendev);
77762306a36Sopenharmony_ci	module_put(mod);
77862306a36Sopenharmony_ci}
77962306a36Sopenharmony_ciEXPORT_SYMBOL(scsi_device_put);
78062306a36Sopenharmony_ci
78162306a36Sopenharmony_ci/* helper for shost_for_each_device, see that for documentation */
78262306a36Sopenharmony_cistruct scsi_device *__scsi_iterate_devices(struct Scsi_Host *shost,
78362306a36Sopenharmony_ci					   struct scsi_device *prev)
78462306a36Sopenharmony_ci{
78562306a36Sopenharmony_ci	struct list_head *list = (prev ? &prev->siblings : &shost->__devices);
78662306a36Sopenharmony_ci	struct scsi_device *next = NULL;
78762306a36Sopenharmony_ci	unsigned long flags;
78862306a36Sopenharmony_ci
78962306a36Sopenharmony_ci	spin_lock_irqsave(shost->host_lock, flags);
79062306a36Sopenharmony_ci	while (list->next != &shost->__devices) {
79162306a36Sopenharmony_ci		next = list_entry(list->next, struct scsi_device, siblings);
79262306a36Sopenharmony_ci		/* skip devices that we can't get a reference to */
79362306a36Sopenharmony_ci		if (!scsi_device_get(next))
79462306a36Sopenharmony_ci			break;
79562306a36Sopenharmony_ci		next = NULL;
79662306a36Sopenharmony_ci		list = list->next;
79762306a36Sopenharmony_ci	}
79862306a36Sopenharmony_ci	spin_unlock_irqrestore(shost->host_lock, flags);
79962306a36Sopenharmony_ci
80062306a36Sopenharmony_ci	if (prev)
80162306a36Sopenharmony_ci		scsi_device_put(prev);
80262306a36Sopenharmony_ci	return next;
80362306a36Sopenharmony_ci}
80462306a36Sopenharmony_ciEXPORT_SYMBOL(__scsi_iterate_devices);
80562306a36Sopenharmony_ci
80662306a36Sopenharmony_ci/**
80762306a36Sopenharmony_ci * starget_for_each_device  -  helper to walk all devices of a target
80862306a36Sopenharmony_ci * @starget:	target whose devices we want to iterate over.
80962306a36Sopenharmony_ci * @data:	Opaque passed to each function call.
81062306a36Sopenharmony_ci * @fn:		Function to call on each device
81162306a36Sopenharmony_ci *
81262306a36Sopenharmony_ci * This traverses over each device of @starget.  The devices have
81362306a36Sopenharmony_ci * a reference that must be released by scsi_host_put when breaking
81462306a36Sopenharmony_ci * out of the loop.
81562306a36Sopenharmony_ci */
81662306a36Sopenharmony_civoid starget_for_each_device(struct scsi_target *starget, void *data,
81762306a36Sopenharmony_ci		     void (*fn)(struct scsi_device *, void *))
81862306a36Sopenharmony_ci{
81962306a36Sopenharmony_ci	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
82062306a36Sopenharmony_ci	struct scsi_device *sdev;
82162306a36Sopenharmony_ci
82262306a36Sopenharmony_ci	shost_for_each_device(sdev, shost) {
82362306a36Sopenharmony_ci		if ((sdev->channel == starget->channel) &&
82462306a36Sopenharmony_ci		    (sdev->id == starget->id))
82562306a36Sopenharmony_ci			fn(sdev, data);
82662306a36Sopenharmony_ci	}
82762306a36Sopenharmony_ci}
82862306a36Sopenharmony_ciEXPORT_SYMBOL(starget_for_each_device);
82962306a36Sopenharmony_ci
83062306a36Sopenharmony_ci/**
83162306a36Sopenharmony_ci * __starget_for_each_device - helper to walk all devices of a target (UNLOCKED)
83262306a36Sopenharmony_ci * @starget:	target whose devices we want to iterate over.
83362306a36Sopenharmony_ci * @data:	parameter for callback @fn()
83462306a36Sopenharmony_ci * @fn:		callback function that is invoked for each device
83562306a36Sopenharmony_ci *
83662306a36Sopenharmony_ci * This traverses over each device of @starget.  It does _not_
83762306a36Sopenharmony_ci * take a reference on the scsi_device, so the whole loop must be
83862306a36Sopenharmony_ci * protected by shost->host_lock.
83962306a36Sopenharmony_ci *
84062306a36Sopenharmony_ci * Note:  The only reason why drivers would want to use this is because
84162306a36Sopenharmony_ci * they need to access the device list in irq context.  Otherwise you
84262306a36Sopenharmony_ci * really want to use starget_for_each_device instead.
84362306a36Sopenharmony_ci **/
84462306a36Sopenharmony_civoid __starget_for_each_device(struct scsi_target *starget, void *data,
84562306a36Sopenharmony_ci			       void (*fn)(struct scsi_device *, void *))
84662306a36Sopenharmony_ci{
84762306a36Sopenharmony_ci	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
84862306a36Sopenharmony_ci	struct scsi_device *sdev;
84962306a36Sopenharmony_ci
85062306a36Sopenharmony_ci	__shost_for_each_device(sdev, shost) {
85162306a36Sopenharmony_ci		if ((sdev->channel == starget->channel) &&
85262306a36Sopenharmony_ci		    (sdev->id == starget->id))
85362306a36Sopenharmony_ci			fn(sdev, data);
85462306a36Sopenharmony_ci	}
85562306a36Sopenharmony_ci}
85662306a36Sopenharmony_ciEXPORT_SYMBOL(__starget_for_each_device);
85762306a36Sopenharmony_ci
85862306a36Sopenharmony_ci/**
85962306a36Sopenharmony_ci * __scsi_device_lookup_by_target - find a device given the target (UNLOCKED)
86062306a36Sopenharmony_ci * @starget:	SCSI target pointer
86162306a36Sopenharmony_ci * @lun:	SCSI Logical Unit Number
86262306a36Sopenharmony_ci *
86362306a36Sopenharmony_ci * Description: Looks up the scsi_device with the specified @lun for a given
86462306a36Sopenharmony_ci * @starget.  The returned scsi_device does not have an additional
86562306a36Sopenharmony_ci * reference.  You must hold the host's host_lock over this call and
86662306a36Sopenharmony_ci * any access to the returned scsi_device. A scsi_device in state
86762306a36Sopenharmony_ci * SDEV_DEL is skipped.
86862306a36Sopenharmony_ci *
86962306a36Sopenharmony_ci * Note:  The only reason why drivers should use this is because
87062306a36Sopenharmony_ci * they need to access the device list in irq context.  Otherwise you
87162306a36Sopenharmony_ci * really want to use scsi_device_lookup_by_target instead.
87262306a36Sopenharmony_ci **/
87362306a36Sopenharmony_cistruct scsi_device *__scsi_device_lookup_by_target(struct scsi_target *starget,
87462306a36Sopenharmony_ci						   u64 lun)
87562306a36Sopenharmony_ci{
87662306a36Sopenharmony_ci	struct scsi_device *sdev;
87762306a36Sopenharmony_ci
87862306a36Sopenharmony_ci	list_for_each_entry(sdev, &starget->devices, same_target_siblings) {
87962306a36Sopenharmony_ci		if (sdev->sdev_state == SDEV_DEL)
88062306a36Sopenharmony_ci			continue;
88162306a36Sopenharmony_ci		if (sdev->lun ==lun)
88262306a36Sopenharmony_ci			return sdev;
88362306a36Sopenharmony_ci	}
88462306a36Sopenharmony_ci
88562306a36Sopenharmony_ci	return NULL;
88662306a36Sopenharmony_ci}
88762306a36Sopenharmony_ciEXPORT_SYMBOL(__scsi_device_lookup_by_target);
88862306a36Sopenharmony_ci
88962306a36Sopenharmony_ci/**
89062306a36Sopenharmony_ci * scsi_device_lookup_by_target - find a device given the target
89162306a36Sopenharmony_ci * @starget:	SCSI target pointer
89262306a36Sopenharmony_ci * @lun:	SCSI Logical Unit Number
89362306a36Sopenharmony_ci *
89462306a36Sopenharmony_ci * Description: Looks up the scsi_device with the specified @lun for a given
89562306a36Sopenharmony_ci * @starget.  The returned scsi_device has an additional reference that
89662306a36Sopenharmony_ci * needs to be released with scsi_device_put once you're done with it.
89762306a36Sopenharmony_ci **/
89862306a36Sopenharmony_cistruct scsi_device *scsi_device_lookup_by_target(struct scsi_target *starget,
89962306a36Sopenharmony_ci						 u64 lun)
90062306a36Sopenharmony_ci{
90162306a36Sopenharmony_ci	struct scsi_device *sdev;
90262306a36Sopenharmony_ci	struct Scsi_Host *shost = dev_to_shost(starget->dev.parent);
90362306a36Sopenharmony_ci	unsigned long flags;
90462306a36Sopenharmony_ci
90562306a36Sopenharmony_ci	spin_lock_irqsave(shost->host_lock, flags);
90662306a36Sopenharmony_ci	sdev = __scsi_device_lookup_by_target(starget, lun);
90762306a36Sopenharmony_ci	if (sdev && scsi_device_get(sdev))
90862306a36Sopenharmony_ci		sdev = NULL;
90962306a36Sopenharmony_ci	spin_unlock_irqrestore(shost->host_lock, flags);
91062306a36Sopenharmony_ci
91162306a36Sopenharmony_ci	return sdev;
91262306a36Sopenharmony_ci}
91362306a36Sopenharmony_ciEXPORT_SYMBOL(scsi_device_lookup_by_target);
91462306a36Sopenharmony_ci
91562306a36Sopenharmony_ci/**
91662306a36Sopenharmony_ci * __scsi_device_lookup - find a device given the host (UNLOCKED)
91762306a36Sopenharmony_ci * @shost:	SCSI host pointer
91862306a36Sopenharmony_ci * @channel:	SCSI channel (zero if only one channel)
91962306a36Sopenharmony_ci * @id:		SCSI target number (physical unit number)
92062306a36Sopenharmony_ci * @lun:	SCSI Logical Unit Number
92162306a36Sopenharmony_ci *
92262306a36Sopenharmony_ci * Description: Looks up the scsi_device with the specified @channel, @id, @lun
92362306a36Sopenharmony_ci * for a given host. The returned scsi_device does not have an additional
92462306a36Sopenharmony_ci * reference.  You must hold the host's host_lock over this call and any access
92562306a36Sopenharmony_ci * to the returned scsi_device.
92662306a36Sopenharmony_ci *
92762306a36Sopenharmony_ci * Note:  The only reason why drivers would want to use this is because
92862306a36Sopenharmony_ci * they need to access the device list in irq context.  Otherwise you
92962306a36Sopenharmony_ci * really want to use scsi_device_lookup instead.
93062306a36Sopenharmony_ci **/
93162306a36Sopenharmony_cistruct scsi_device *__scsi_device_lookup(struct Scsi_Host *shost,
93262306a36Sopenharmony_ci		uint channel, uint id, u64 lun)
93362306a36Sopenharmony_ci{
93462306a36Sopenharmony_ci	struct scsi_device *sdev;
93562306a36Sopenharmony_ci
93662306a36Sopenharmony_ci	list_for_each_entry(sdev, &shost->__devices, siblings) {
93762306a36Sopenharmony_ci		if (sdev->sdev_state == SDEV_DEL)
93862306a36Sopenharmony_ci			continue;
93962306a36Sopenharmony_ci		if (sdev->channel == channel && sdev->id == id &&
94062306a36Sopenharmony_ci				sdev->lun ==lun)
94162306a36Sopenharmony_ci			return sdev;
94262306a36Sopenharmony_ci	}
94362306a36Sopenharmony_ci
94462306a36Sopenharmony_ci	return NULL;
94562306a36Sopenharmony_ci}
94662306a36Sopenharmony_ciEXPORT_SYMBOL(__scsi_device_lookup);
94762306a36Sopenharmony_ci
94862306a36Sopenharmony_ci/**
94962306a36Sopenharmony_ci * scsi_device_lookup - find a device given the host
95062306a36Sopenharmony_ci * @shost:	SCSI host pointer
95162306a36Sopenharmony_ci * @channel:	SCSI channel (zero if only one channel)
95262306a36Sopenharmony_ci * @id:		SCSI target number (physical unit number)
95362306a36Sopenharmony_ci * @lun:	SCSI Logical Unit Number
95462306a36Sopenharmony_ci *
95562306a36Sopenharmony_ci * Description: Looks up the scsi_device with the specified @channel, @id, @lun
95662306a36Sopenharmony_ci * for a given host.  The returned scsi_device has an additional reference that
95762306a36Sopenharmony_ci * needs to be released with scsi_device_put once you're done with it.
95862306a36Sopenharmony_ci **/
95962306a36Sopenharmony_cistruct scsi_device *scsi_device_lookup(struct Scsi_Host *shost,
96062306a36Sopenharmony_ci		uint channel, uint id, u64 lun)
96162306a36Sopenharmony_ci{
96262306a36Sopenharmony_ci	struct scsi_device *sdev;
96362306a36Sopenharmony_ci	unsigned long flags;
96462306a36Sopenharmony_ci
96562306a36Sopenharmony_ci	spin_lock_irqsave(shost->host_lock, flags);
96662306a36Sopenharmony_ci	sdev = __scsi_device_lookup(shost, channel, id, lun);
96762306a36Sopenharmony_ci	if (sdev && scsi_device_get(sdev))
96862306a36Sopenharmony_ci		sdev = NULL;
96962306a36Sopenharmony_ci	spin_unlock_irqrestore(shost->host_lock, flags);
97062306a36Sopenharmony_ci
97162306a36Sopenharmony_ci	return sdev;
97262306a36Sopenharmony_ci}
97362306a36Sopenharmony_ciEXPORT_SYMBOL(scsi_device_lookup);
97462306a36Sopenharmony_ci
97562306a36Sopenharmony_ciMODULE_DESCRIPTION("SCSI core");
97662306a36Sopenharmony_ciMODULE_LICENSE("GPL");
97762306a36Sopenharmony_ci
97862306a36Sopenharmony_cimodule_param(scsi_logging_level, int, S_IRUGO|S_IWUSR);
97962306a36Sopenharmony_ciMODULE_PARM_DESC(scsi_logging_level, "a bit mask of logging levels");
98062306a36Sopenharmony_ci
98162306a36Sopenharmony_cistatic int __init init_scsi(void)
98262306a36Sopenharmony_ci{
98362306a36Sopenharmony_ci	int error;
98462306a36Sopenharmony_ci
98562306a36Sopenharmony_ci	error = scsi_init_procfs();
98662306a36Sopenharmony_ci	if (error)
98762306a36Sopenharmony_ci		goto cleanup_queue;
98862306a36Sopenharmony_ci	error = scsi_init_devinfo();
98962306a36Sopenharmony_ci	if (error)
99062306a36Sopenharmony_ci		goto cleanup_procfs;
99162306a36Sopenharmony_ci	error = scsi_init_hosts();
99262306a36Sopenharmony_ci	if (error)
99362306a36Sopenharmony_ci		goto cleanup_devlist;
99462306a36Sopenharmony_ci	error = scsi_init_sysctl();
99562306a36Sopenharmony_ci	if (error)
99662306a36Sopenharmony_ci		goto cleanup_hosts;
99762306a36Sopenharmony_ci	error = scsi_sysfs_register();
99862306a36Sopenharmony_ci	if (error)
99962306a36Sopenharmony_ci		goto cleanup_sysctl;
100062306a36Sopenharmony_ci
100162306a36Sopenharmony_ci	scsi_netlink_init();
100262306a36Sopenharmony_ci
100362306a36Sopenharmony_ci	printk(KERN_NOTICE "SCSI subsystem initialized\n");
100462306a36Sopenharmony_ci	return 0;
100562306a36Sopenharmony_ci
100662306a36Sopenharmony_cicleanup_sysctl:
100762306a36Sopenharmony_ci	scsi_exit_sysctl();
100862306a36Sopenharmony_cicleanup_hosts:
100962306a36Sopenharmony_ci	scsi_exit_hosts();
101062306a36Sopenharmony_cicleanup_devlist:
101162306a36Sopenharmony_ci	scsi_exit_devinfo();
101262306a36Sopenharmony_cicleanup_procfs:
101362306a36Sopenharmony_ci	scsi_exit_procfs();
101462306a36Sopenharmony_cicleanup_queue:
101562306a36Sopenharmony_ci	scsi_exit_queue();
101662306a36Sopenharmony_ci	printk(KERN_ERR "SCSI subsystem failed to initialize, error = %d\n",
101762306a36Sopenharmony_ci	       -error);
101862306a36Sopenharmony_ci	return error;
101962306a36Sopenharmony_ci}
102062306a36Sopenharmony_ci
102162306a36Sopenharmony_cistatic void __exit exit_scsi(void)
102262306a36Sopenharmony_ci{
102362306a36Sopenharmony_ci	scsi_netlink_exit();
102462306a36Sopenharmony_ci	scsi_sysfs_unregister();
102562306a36Sopenharmony_ci	scsi_exit_sysctl();
102662306a36Sopenharmony_ci	scsi_exit_hosts();
102762306a36Sopenharmony_ci	scsi_exit_devinfo();
102862306a36Sopenharmony_ci	scsi_exit_procfs();
102962306a36Sopenharmony_ci	scsi_exit_queue();
103062306a36Sopenharmony_ci}
103162306a36Sopenharmony_ci
103262306a36Sopenharmony_cisubsys_initcall(init_scsi);
103362306a36Sopenharmony_cimodule_exit(exit_scsi);
1034