| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
| Jeff Garzik | af36d7f | 2005-08-28 20:18:39 -0400 | [diff] [blame] | 2 |  *  libata-scsi.c - helper library for ATA | 
 | 3 |  * | 
 | 4 |  *  Maintained by:  Jeff Garzik <jgarzik@pobox.com> | 
 | 5 |  *    		    Please ALWAYS copy linux-ide@vger.kernel.org | 
 | 6 |  *		    on emails. | 
 | 7 |  * | 
 | 8 |  *  Copyright 2003-2004 Red Hat, Inc.  All rights reserved. | 
 | 9 |  *  Copyright 2003-2004 Jeff Garzik | 
 | 10 |  * | 
 | 11 |  * | 
 | 12 |  *  This program is free software; you can redistribute it and/or modify | 
 | 13 |  *  it under the terms of the GNU General Public License as published by | 
 | 14 |  *  the Free Software Foundation; either version 2, or (at your option) | 
 | 15 |  *  any later version. | 
 | 16 |  * | 
 | 17 |  *  This program is distributed in the hope that it will be useful, | 
 | 18 |  *  but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 | 19 |  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 | 20 |  *  GNU General Public License for more details. | 
 | 21 |  * | 
 | 22 |  *  You should have received a copy of the GNU General Public License | 
 | 23 |  *  along with this program; see the file COPYING.  If not, write to | 
 | 24 |  *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA. | 
 | 25 |  * | 
 | 26 |  * | 
 | 27 |  *  libata documentation is available via 'make {ps|pdf}docs', | 
 | 28 |  *  as Documentation/DocBook/libata.* | 
 | 29 |  * | 
 | 30 |  *  Hardware documentation available from | 
 | 31 |  *  - http://www.t10.org/ | 
 | 32 |  *  - http://www.t13.org/ | 
 | 33 |  * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 34 |  */ | 
 | 35 |  | 
 | 36 | #include <linux/kernel.h> | 
 | 37 | #include <linux/blkdev.h> | 
 | 38 | #include <linux/spinlock.h> | 
 | 39 | #include <scsi/scsi.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 40 | #include <scsi/scsi_host.h> | 
| Christoph Hellwig | beb4048 | 2006-06-10 18:01:03 +0200 | [diff] [blame] | 41 | #include <scsi/scsi_cmnd.h> | 
| Mike Christie | 85837eb | 2005-11-11 16:38:53 -0600 | [diff] [blame] | 42 | #include <scsi/scsi_eh.h> | 
| Jeff Garzik | 005a5a0 | 2005-10-30 23:31:48 -0500 | [diff] [blame] | 43 | #include <scsi/scsi_device.h> | 
| Tejun Heo | a6e6ce8 | 2006-05-15 21:03:48 +0900 | [diff] [blame] | 44 | #include <scsi/scsi_tcq.h> | 
| Tejun Heo | 30afc84 | 2006-03-18 18:40:14 +0900 | [diff] [blame] | 45 | #include <scsi/scsi_transport.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 46 | #include <linux/libata.h> | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 47 | #include <linux/hdreg.h> | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 48 | #include <linux/uaccess.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 |  | 
 | 50 | #include "libata.h" | 
 | 51 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 52 | #define SECTOR_SIZE		512 | 
 | 53 | #define ATA_SCSI_RBUF_SIZE	4096 | 
 | 54 |  | 
 | 55 | static DEFINE_SPINLOCK(ata_scsi_rbuf_lock); | 
 | 56 | static u8 ata_scsi_rbuf[ATA_SCSI_RBUF_SIZE]; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 57 |  | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 58 | typedef unsigned int (*ata_xlat_func_t)(struct ata_queued_cmd *qc); | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 59 |  | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 60 | static struct ata_device *__ata_scsi_find_dev(struct ata_port *ap, | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 61 | 					const struct scsi_device *scsidev); | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 62 | static struct ata_device *ata_scsi_find_dev(struct ata_port *ap, | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 63 | 					    const struct scsi_device *scsidev); | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 64 | static int ata_scsi_user_scan(struct Scsi_Host *shost, unsigned int channel, | 
 | 65 | 			      unsigned int id, unsigned int lun); | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 66 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 |  | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 68 | #define RW_RECOVERY_MPAGE 0x1 | 
 | 69 | #define RW_RECOVERY_MPAGE_LEN 12 | 
 | 70 | #define CACHE_MPAGE 0x8 | 
 | 71 | #define CACHE_MPAGE_LEN 20 | 
 | 72 | #define CONTROL_MPAGE 0xa | 
 | 73 | #define CONTROL_MPAGE_LEN 12 | 
 | 74 | #define ALL_MPAGES 0x3f | 
 | 75 | #define ALL_SUB_MPAGES 0xff | 
 | 76 |  | 
 | 77 |  | 
| Jeff Garzik | 24f7568 | 2007-09-21 07:54:49 -0400 | [diff] [blame] | 78 | static const u8 def_rw_recovery_mpage[RW_RECOVERY_MPAGE_LEN] = { | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 79 | 	RW_RECOVERY_MPAGE, | 
 | 80 | 	RW_RECOVERY_MPAGE_LEN - 2, | 
| Jeff Garzik | 24f7568 | 2007-09-21 07:54:49 -0400 | [diff] [blame] | 81 | 	(1 << 7),	/* AWRE */ | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 82 | 	0,		/* read retry count */ | 
 | 83 | 	0, 0, 0, 0, | 
 | 84 | 	0,		/* write retry count */ | 
 | 85 | 	0, 0, 0 | 
 | 86 | }; | 
 | 87 |  | 
 | 88 | static const u8 def_cache_mpage[CACHE_MPAGE_LEN] = { | 
 | 89 | 	CACHE_MPAGE, | 
 | 90 | 	CACHE_MPAGE_LEN - 2, | 
 | 91 | 	0,		/* contains WCE, needs to be 0 for logic */ | 
 | 92 | 	0, 0, 0, 0, 0, 0, 0, 0, 0, | 
 | 93 | 	0,		/* contains DRA, needs to be 0 for logic */ | 
 | 94 | 	0, 0, 0, 0, 0, 0, 0 | 
 | 95 | }; | 
 | 96 |  | 
 | 97 | static const u8 def_control_mpage[CONTROL_MPAGE_LEN] = { | 
 | 98 | 	CONTROL_MPAGE, | 
 | 99 | 	CONTROL_MPAGE_LEN - 2, | 
 | 100 | 	2,	/* DSENSE=0, GLTSD=1 */ | 
 | 101 | 	0,	/* [QAM+QERR may be 1, see 05-359r1] */ | 
 | 102 | 	0, 0, 0, 0, 0xff, 0xff, | 
 | 103 | 	0, 30	/* extended self test time, see 05-359r1 */ | 
 | 104 | }; | 
 | 105 |  | 
| Tejun Heo | 30afc84 | 2006-03-18 18:40:14 +0900 | [diff] [blame] | 106 | /* | 
 | 107 |  * libata transport template.  libata doesn't do real transport stuff. | 
 | 108 |  * It just needs the eh_timed_out hook. | 
 | 109 |  */ | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 110 | static struct scsi_transport_template ata_scsi_transport_template = { | 
| Christoph Hellwig | 9227c33 | 2006-04-01 19:21:04 +0200 | [diff] [blame] | 111 | 	.eh_strategy_handler	= ata_scsi_error, | 
| Tejun Heo | 30afc84 | 2006-03-18 18:40:14 +0900 | [diff] [blame] | 112 | 	.eh_timed_out		= ata_scsi_timed_out, | 
| Tejun Heo | ccf68c3 | 2006-05-31 18:28:09 +0900 | [diff] [blame] | 113 | 	.user_scan		= ata_scsi_user_scan, | 
| Tejun Heo | 30afc84 | 2006-03-18 18:40:14 +0900 | [diff] [blame] | 114 | }; | 
 | 115 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 116 |  | 
| Kristen Carlson Accardi | ca77329 | 2007-10-25 00:58:59 -0400 | [diff] [blame] | 117 | static const struct { | 
 | 118 | 	enum link_pm	value; | 
 | 119 | 	const char	*name; | 
 | 120 | } link_pm_policy[] = { | 
 | 121 | 	{ NOT_AVAILABLE, "max_performance" }, | 
 | 122 | 	{ MIN_POWER, "min_power" }, | 
 | 123 | 	{ MAX_PERFORMANCE, "max_performance" }, | 
 | 124 | 	{ MEDIUM_POWER, "medium_power" }, | 
 | 125 | }; | 
 | 126 |  | 
| Adrian Bunk | a2d6ed1 | 2007-10-31 00:50:23 +0100 | [diff] [blame] | 127 | static const char *ata_scsi_lpm_get(enum link_pm policy) | 
| Kristen Carlson Accardi | ca77329 | 2007-10-25 00:58:59 -0400 | [diff] [blame] | 128 | { | 
 | 129 | 	int i; | 
 | 130 |  | 
 | 131 | 	for (i = 0; i < ARRAY_SIZE(link_pm_policy); i++) | 
 | 132 | 		if (link_pm_policy[i].value == policy) | 
 | 133 | 			return link_pm_policy[i].name; | 
 | 134 |  | 
 | 135 | 	return NULL; | 
 | 136 | } | 
 | 137 |  | 
| Tony Jones | ee959b0 | 2008-02-22 00:13:36 +0100 | [diff] [blame] | 138 | static ssize_t ata_scsi_lpm_put(struct device *dev, | 
 | 139 | 				struct device_attribute *attr, | 
 | 140 | 				const char *buf, size_t count) | 
| Kristen Carlson Accardi | ca77329 | 2007-10-25 00:58:59 -0400 | [diff] [blame] | 141 | { | 
| Tony Jones | ee959b0 | 2008-02-22 00:13:36 +0100 | [diff] [blame] | 142 | 	struct Scsi_Host *shost = class_to_shost(dev); | 
| Kristen Carlson Accardi | ca77329 | 2007-10-25 00:58:59 -0400 | [diff] [blame] | 143 | 	struct ata_port *ap = ata_shost_to_port(shost); | 
 | 144 | 	enum link_pm policy = 0; | 
 | 145 | 	int i; | 
 | 146 |  | 
 | 147 | 	/* | 
 | 148 | 	 * we are skipping array location 0 on purpose - this | 
 | 149 | 	 * is because a value of NOT_AVAILABLE is displayed | 
 | 150 | 	 * to the user as max_performance, but when the user | 
 | 151 | 	 * writes "max_performance", they actually want the | 
 | 152 | 	 * value to match MAX_PERFORMANCE. | 
 | 153 | 	 */ | 
 | 154 | 	for (i = 1; i < ARRAY_SIZE(link_pm_policy); i++) { | 
 | 155 | 		const int len = strlen(link_pm_policy[i].name); | 
 | 156 | 		if (strncmp(link_pm_policy[i].name, buf, len) == 0 && | 
 | 157 | 		   buf[len] == '\n') { | 
 | 158 | 			policy = link_pm_policy[i].value; | 
 | 159 | 			break; | 
 | 160 | 		} | 
 | 161 | 	} | 
 | 162 | 	if (!policy) | 
 | 163 | 		return -EINVAL; | 
 | 164 |  | 
 | 165 | 	ata_lpm_schedule(ap, policy); | 
 | 166 | 	return count; | 
 | 167 | } | 
 | 168 |  | 
 | 169 | static ssize_t | 
| Tony Jones | ee959b0 | 2008-02-22 00:13:36 +0100 | [diff] [blame] | 170 | ata_scsi_lpm_show(struct device *dev, struct device_attribute *attr, char *buf) | 
| Kristen Carlson Accardi | ca77329 | 2007-10-25 00:58:59 -0400 | [diff] [blame] | 171 | { | 
| Tony Jones | ee959b0 | 2008-02-22 00:13:36 +0100 | [diff] [blame] | 172 | 	struct Scsi_Host *shost = class_to_shost(dev); | 
| Kristen Carlson Accardi | ca77329 | 2007-10-25 00:58:59 -0400 | [diff] [blame] | 173 | 	struct ata_port *ap = ata_shost_to_port(shost); | 
 | 174 | 	const char *policy = | 
 | 175 | 		ata_scsi_lpm_get(ap->pm_policy); | 
 | 176 |  | 
 | 177 | 	if (!policy) | 
 | 178 | 		return -EINVAL; | 
 | 179 |  | 
 | 180 | 	return snprintf(buf, 23, "%s\n", policy); | 
 | 181 | } | 
| Tony Jones | ee959b0 | 2008-02-22 00:13:36 +0100 | [diff] [blame] | 182 | DEVICE_ATTR(link_power_management_policy, S_IRUGO | S_IWUSR, | 
| Kristen Carlson Accardi | ca77329 | 2007-10-25 00:58:59 -0400 | [diff] [blame] | 183 | 		ata_scsi_lpm_show, ata_scsi_lpm_put); | 
| Tony Jones | ee959b0 | 2008-02-22 00:13:36 +0100 | [diff] [blame] | 184 | EXPORT_SYMBOL_GPL(dev_attr_link_power_management_policy); | 
| Kristen Carlson Accardi | ca77329 | 2007-10-25 00:58:59 -0400 | [diff] [blame] | 185 |  | 
| Elias Oltmanns | 45fabbb | 2008-09-21 11:54:08 +0200 | [diff] [blame] | 186 | static ssize_t ata_scsi_park_show(struct device *device, | 
 | 187 | 				  struct device_attribute *attr, char *buf) | 
 | 188 | { | 
 | 189 | 	struct scsi_device *sdev = to_scsi_device(device); | 
 | 190 | 	struct ata_port *ap; | 
 | 191 | 	struct ata_link *link; | 
 | 192 | 	struct ata_device *dev; | 
| Elias Oltmanns | a464189 | 2008-11-03 19:01:08 +0900 | [diff] [blame] | 193 | 	unsigned long flags, now; | 
| Elias Oltmanns | 45fabbb | 2008-09-21 11:54:08 +0200 | [diff] [blame] | 194 | 	unsigned int uninitialized_var(msecs); | 
 | 195 | 	int rc = 0; | 
 | 196 |  | 
 | 197 | 	ap = ata_shost_to_port(sdev->host); | 
 | 198 |  | 
 | 199 | 	spin_lock_irqsave(ap->lock, flags); | 
 | 200 | 	dev = ata_scsi_find_dev(ap, sdev); | 
 | 201 | 	if (!dev) { | 
 | 202 | 		rc = -ENODEV; | 
 | 203 | 		goto unlock; | 
 | 204 | 	} | 
 | 205 | 	if (dev->flags & ATA_DFLAG_NO_UNLOAD) { | 
 | 206 | 		rc = -EOPNOTSUPP; | 
 | 207 | 		goto unlock; | 
 | 208 | 	} | 
 | 209 |  | 
 | 210 | 	link = dev->link; | 
| Elias Oltmanns | a464189 | 2008-11-03 19:01:08 +0900 | [diff] [blame] | 211 | 	now = jiffies; | 
| Elias Oltmanns | 45fabbb | 2008-09-21 11:54:08 +0200 | [diff] [blame] | 212 | 	if (ap->pflags & ATA_PFLAG_EH_IN_PROGRESS && | 
 | 213 | 	    link->eh_context.unloaded_mask & (1 << dev->devno) && | 
| Elias Oltmanns | a464189 | 2008-11-03 19:01:08 +0900 | [diff] [blame] | 214 | 	    time_after(dev->unpark_deadline, now)) | 
 | 215 | 		msecs = jiffies_to_msecs(dev->unpark_deadline - now); | 
| Elias Oltmanns | 45fabbb | 2008-09-21 11:54:08 +0200 | [diff] [blame] | 216 | 	else | 
 | 217 | 		msecs = 0; | 
 | 218 |  | 
 | 219 | unlock: | 
 | 220 | 	spin_unlock_irq(ap->lock); | 
 | 221 |  | 
 | 222 | 	return rc ? rc : snprintf(buf, 20, "%u\n", msecs); | 
 | 223 | } | 
 | 224 |  | 
 | 225 | static ssize_t ata_scsi_park_store(struct device *device, | 
 | 226 | 				   struct device_attribute *attr, | 
 | 227 | 				   const char *buf, size_t len) | 
 | 228 | { | 
 | 229 | 	struct scsi_device *sdev = to_scsi_device(device); | 
 | 230 | 	struct ata_port *ap; | 
 | 231 | 	struct ata_device *dev; | 
 | 232 | 	long int input; | 
 | 233 | 	unsigned long flags; | 
 | 234 | 	int rc; | 
 | 235 |  | 
 | 236 | 	rc = strict_strtol(buf, 10, &input); | 
 | 237 | 	if (rc || input < -2) | 
 | 238 | 		return -EINVAL; | 
 | 239 | 	if (input > ATA_TMOUT_MAX_PARK) { | 
 | 240 | 		rc = -EOVERFLOW; | 
 | 241 | 		input = ATA_TMOUT_MAX_PARK; | 
 | 242 | 	} | 
 | 243 |  | 
 | 244 | 	ap = ata_shost_to_port(sdev->host); | 
 | 245 |  | 
 | 246 | 	spin_lock_irqsave(ap->lock, flags); | 
 | 247 | 	dev = ata_scsi_find_dev(ap, sdev); | 
 | 248 | 	if (unlikely(!dev)) { | 
 | 249 | 		rc = -ENODEV; | 
 | 250 | 		goto unlock; | 
 | 251 | 	} | 
 | 252 | 	if (dev->class != ATA_DEV_ATA) { | 
 | 253 | 		rc = -EOPNOTSUPP; | 
 | 254 | 		goto unlock; | 
 | 255 | 	} | 
 | 256 |  | 
 | 257 | 	if (input >= 0) { | 
 | 258 | 		if (dev->flags & ATA_DFLAG_NO_UNLOAD) { | 
 | 259 | 			rc = -EOPNOTSUPP; | 
 | 260 | 			goto unlock; | 
 | 261 | 		} | 
 | 262 |  | 
 | 263 | 		dev->unpark_deadline = ata_deadline(jiffies, input); | 
 | 264 | 		dev->link->eh_info.dev_action[dev->devno] |= ATA_EH_PARK; | 
 | 265 | 		ata_port_schedule_eh(ap); | 
 | 266 | 		complete(&ap->park_req_pending); | 
 | 267 | 	} else { | 
 | 268 | 		switch (input) { | 
 | 269 | 		case -1: | 
 | 270 | 			dev->flags &= ~ATA_DFLAG_NO_UNLOAD; | 
 | 271 | 			break; | 
 | 272 | 		case -2: | 
 | 273 | 			dev->flags |= ATA_DFLAG_NO_UNLOAD; | 
 | 274 | 			break; | 
 | 275 | 		} | 
 | 276 | 	} | 
 | 277 | unlock: | 
 | 278 | 	spin_unlock_irqrestore(ap->lock, flags); | 
 | 279 |  | 
 | 280 | 	return rc ? rc : len; | 
 | 281 | } | 
 | 282 | DEVICE_ATTR(unload_heads, S_IRUGO | S_IWUSR, | 
 | 283 | 	    ata_scsi_park_show, ata_scsi_park_store); | 
 | 284 | EXPORT_SYMBOL_GPL(dev_attr_unload_heads); | 
 | 285 |  | 
| Tejun Heo | f0761be | 2008-04-28 17:16:52 +0900 | [diff] [blame] | 286 | static void ata_scsi_set_sense(struct scsi_cmnd *cmd, u8 sk, u8 asc, u8 ascq) | 
 | 287 | { | 
 | 288 | 	cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION; | 
 | 289 |  | 
 | 290 | 	scsi_build_sense_buffer(0, cmd->sense_buffer, sk, asc, ascq); | 
 | 291 | } | 
 | 292 |  | 
| Kristen Carlson Accardi | 18f7ba4 | 2008-06-03 10:33:55 -0700 | [diff] [blame] | 293 | static ssize_t | 
 | 294 | ata_scsi_em_message_store(struct device *dev, struct device_attribute *attr, | 
 | 295 | 			  const char *buf, size_t count) | 
 | 296 | { | 
 | 297 | 	struct Scsi_Host *shost = class_to_shost(dev); | 
 | 298 | 	struct ata_port *ap = ata_shost_to_port(shost); | 
 | 299 | 	if (ap->ops->em_store && (ap->flags & ATA_FLAG_EM)) | 
 | 300 | 		return ap->ops->em_store(ap, buf, count); | 
 | 301 | 	return -EINVAL; | 
 | 302 | } | 
 | 303 |  | 
 | 304 | static ssize_t | 
 | 305 | ata_scsi_em_message_show(struct device *dev, struct device_attribute *attr, | 
 | 306 | 			 char *buf) | 
 | 307 | { | 
 | 308 | 	struct Scsi_Host *shost = class_to_shost(dev); | 
 | 309 | 	struct ata_port *ap = ata_shost_to_port(shost); | 
 | 310 |  | 
 | 311 | 	if (ap->ops->em_show && (ap->flags & ATA_FLAG_EM)) | 
 | 312 | 		return ap->ops->em_show(ap, buf); | 
 | 313 | 	return -EINVAL; | 
 | 314 | } | 
 | 315 | DEVICE_ATTR(em_message, S_IRUGO | S_IWUGO, | 
 | 316 | 		ata_scsi_em_message_show, ata_scsi_em_message_store); | 
 | 317 | EXPORT_SYMBOL_GPL(dev_attr_em_message); | 
 | 318 |  | 
 | 319 | static ssize_t | 
 | 320 | ata_scsi_em_message_type_show(struct device *dev, struct device_attribute *attr, | 
 | 321 | 			      char *buf) | 
 | 322 | { | 
 | 323 | 	struct Scsi_Host *shost = class_to_shost(dev); | 
 | 324 | 	struct ata_port *ap = ata_shost_to_port(shost); | 
 | 325 |  | 
 | 326 | 	return snprintf(buf, 23, "%d\n", ap->em_message_type); | 
 | 327 | } | 
 | 328 | DEVICE_ATTR(em_message_type, S_IRUGO, | 
 | 329 | 		  ata_scsi_em_message_type_show, NULL); | 
 | 330 | EXPORT_SYMBOL_GPL(dev_attr_em_message_type); | 
 | 331 |  | 
 | 332 | static ssize_t | 
 | 333 | ata_scsi_activity_show(struct device *dev, struct device_attribute *attr, | 
 | 334 | 		char *buf) | 
 | 335 | { | 
 | 336 | 	struct scsi_device *sdev = to_scsi_device(dev); | 
 | 337 | 	struct ata_port *ap = ata_shost_to_port(sdev->host); | 
 | 338 | 	struct ata_device *atadev = ata_scsi_find_dev(ap, sdev); | 
 | 339 |  | 
 | 340 | 	if (ap->ops->sw_activity_show && (ap->flags & ATA_FLAG_SW_ACTIVITY)) | 
 | 341 | 		return ap->ops->sw_activity_show(atadev, buf); | 
 | 342 | 	return -EINVAL; | 
 | 343 | } | 
 | 344 |  | 
 | 345 | static ssize_t | 
 | 346 | ata_scsi_activity_store(struct device *dev, struct device_attribute *attr, | 
 | 347 | 	const char *buf, size_t count) | 
 | 348 | { | 
 | 349 | 	struct scsi_device *sdev = to_scsi_device(dev); | 
 | 350 | 	struct ata_port *ap = ata_shost_to_port(sdev->host); | 
 | 351 | 	struct ata_device *atadev = ata_scsi_find_dev(ap, sdev); | 
 | 352 | 	enum sw_activity val; | 
 | 353 | 	int rc; | 
 | 354 |  | 
 | 355 | 	if (ap->ops->sw_activity_store && (ap->flags & ATA_FLAG_SW_ACTIVITY)) { | 
 | 356 | 		val = simple_strtoul(buf, NULL, 0); | 
 | 357 | 		switch (val) { | 
 | 358 | 		case OFF: case BLINK_ON: case BLINK_OFF: | 
 | 359 | 			rc = ap->ops->sw_activity_store(atadev, val); | 
 | 360 | 			if (!rc) | 
 | 361 | 				return count; | 
 | 362 | 			else | 
 | 363 | 				return rc; | 
 | 364 | 		} | 
 | 365 | 	} | 
 | 366 | 	return -EINVAL; | 
 | 367 | } | 
 | 368 | DEVICE_ATTR(sw_activity, S_IWUGO | S_IRUGO, ata_scsi_activity_show, | 
 | 369 | 			ata_scsi_activity_store); | 
 | 370 | EXPORT_SYMBOL_GPL(dev_attr_sw_activity); | 
 | 371 |  | 
| Elias Oltmanns | 45fabbb | 2008-09-21 11:54:08 +0200 | [diff] [blame] | 372 | struct device_attribute *ata_common_sdev_attrs[] = { | 
 | 373 | 	&dev_attr_unload_heads, | 
 | 374 | 	NULL | 
 | 375 | }; | 
 | 376 | EXPORT_SYMBOL_GPL(ata_common_sdev_attrs); | 
 | 377 |  | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 378 | static void ata_scsi_invalid_field(struct scsi_cmnd *cmd, | 
 | 379 | 				   void (*done)(struct scsi_cmnd *)) | 
 | 380 | { | 
 | 381 | 	ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x24, 0x0); | 
 | 382 | 	/* "Invalid field in cbd" */ | 
 | 383 | 	done(cmd); | 
 | 384 | } | 
 | 385 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 386 | /** | 
 | 387 |  *	ata_std_bios_param - generic bios head/sector/cylinder calculator used by sd. | 
 | 388 |  *	@sdev: SCSI device for which BIOS geometry is to be determined | 
 | 389 |  *	@bdev: block device associated with @sdev | 
 | 390 |  *	@capacity: capacity of SCSI device | 
 | 391 |  *	@geom: location to which geometry will be output | 
 | 392 |  * | 
 | 393 |  *	Generic bios head/sector/cylinder calculator | 
 | 394 |  *	used by sd. Most BIOSes nowadays expect a XXX/255/16  (CHS) | 
 | 395 |  *	mapping. Some situations may arise where the disk is not | 
 | 396 |  *	bootable if this is not used. | 
 | 397 |  * | 
 | 398 |  *	LOCKING: | 
 | 399 |  *	Defined by the SCSI layer.  We don't really care. | 
 | 400 |  * | 
 | 401 |  *	RETURNS: | 
 | 402 |  *	Zero. | 
 | 403 |  */ | 
 | 404 | int ata_std_bios_param(struct scsi_device *sdev, struct block_device *bdev, | 
 | 405 | 		       sector_t capacity, int geom[]) | 
 | 406 | { | 
 | 407 | 	geom[0] = 255; | 
 | 408 | 	geom[1] = 63; | 
 | 409 | 	sector_div(capacity, 255*63); | 
 | 410 | 	geom[2] = capacity; | 
 | 411 |  | 
 | 412 | 	return 0; | 
 | 413 | } | 
 | 414 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 415 | /** | 
| Tejun Heo | 5924b74 | 2007-01-02 20:20:07 +0900 | [diff] [blame] | 416 |  *	ata_get_identity - Handler for HDIO_GET_IDENTITY ioctl | 
 | 417 |  *	@sdev: SCSI device to get identify data for | 
 | 418 |  *	@arg: User buffer area for identify data | 
 | 419 |  * | 
 | 420 |  *	LOCKING: | 
 | 421 |  *	Defined by the SCSI layer.  We don't really care. | 
 | 422 |  * | 
 | 423 |  *	RETURNS: | 
 | 424 |  *	Zero on success, negative errno on error. | 
 | 425 |  */ | 
| Jeff Garzik | 94be9a5 | 2009-01-16 10:17:09 -0500 | [diff] [blame] | 426 | static int ata_get_identity(struct ata_port *ap, struct scsi_device *sdev, | 
 | 427 | 			    void __user *arg) | 
| Tejun Heo | 5924b74 | 2007-01-02 20:20:07 +0900 | [diff] [blame] | 428 | { | 
| Tejun Heo | 5924b74 | 2007-01-02 20:20:07 +0900 | [diff] [blame] | 429 | 	struct ata_device *dev = ata_scsi_find_dev(ap, sdev); | 
 | 430 | 	u16 __user *dst = arg; | 
 | 431 | 	char buf[40]; | 
 | 432 |  | 
 | 433 | 	if (!dev) | 
 | 434 | 		return -ENOMSG; | 
 | 435 |  | 
 | 436 | 	if (copy_to_user(dst, dev->id, ATA_ID_WORDS * sizeof(u16))) | 
 | 437 | 		return -EFAULT; | 
 | 438 |  | 
 | 439 | 	ata_id_string(dev->id, buf, ATA_ID_PROD, ATA_ID_PROD_LEN); | 
 | 440 | 	if (copy_to_user(dst + ATA_ID_PROD, buf, ATA_ID_PROD_LEN)) | 
 | 441 | 		return -EFAULT; | 
 | 442 |  | 
 | 443 | 	ata_id_string(dev->id, buf, ATA_ID_FW_REV, ATA_ID_FW_REV_LEN); | 
 | 444 | 	if (copy_to_user(dst + ATA_ID_FW_REV, buf, ATA_ID_FW_REV_LEN)) | 
 | 445 | 		return -EFAULT; | 
 | 446 |  | 
 | 447 | 	ata_id_string(dev->id, buf, ATA_ID_SERNO, ATA_ID_SERNO_LEN); | 
 | 448 | 	if (copy_to_user(dst + ATA_ID_SERNO, buf, ATA_ID_SERNO_LEN)) | 
 | 449 | 		return -EFAULT; | 
 | 450 |  | 
 | 451 | 	return 0; | 
 | 452 | } | 
 | 453 |  | 
 | 454 | /** | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 455 |  *	ata_cmd_ioctl - Handler for HDIO_DRIVE_CMD ioctl | 
| Randy Dunlap | 8e8b77d | 2005-11-01 21:29:27 -0800 | [diff] [blame] | 456 |  *	@scsidev: Device to which we are issuing command | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 457 |  *	@arg: User provided data for issuing command | 
 | 458 |  * | 
 | 459 |  *	LOCKING: | 
 | 460 |  *	Defined by the SCSI layer.  We don't really care. | 
 | 461 |  * | 
 | 462 |  *	RETURNS: | 
 | 463 |  *	Zero on success, negative errno on error. | 
 | 464 |  */ | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 465 | int ata_cmd_ioctl(struct scsi_device *scsidev, void __user *arg) | 
 | 466 | { | 
 | 467 | 	int rc = 0; | 
 | 468 | 	u8 scsi_cmd[MAX_COMMAND_SIZE]; | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 469 | 	u8 args[4], *argbuf = NULL, *sensebuf = NULL; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 470 | 	int argsize = 0; | 
| Mike Christie | 85837eb | 2005-11-11 16:38:53 -0600 | [diff] [blame] | 471 | 	enum dma_data_direction data_dir; | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 472 | 	int cmd_result; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 473 |  | 
| Randy Dunlap | c893a3a | 2006-01-28 13:15:32 -0500 | [diff] [blame] | 474 | 	if (arg == NULL) | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 475 | 		return -EINVAL; | 
 | 476 |  | 
 | 477 | 	if (copy_from_user(args, arg, sizeof(args))) | 
 | 478 | 		return -EFAULT; | 
 | 479 |  | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 480 | 	sensebuf = kzalloc(SCSI_SENSE_BUFFERSIZE, GFP_NOIO); | 
 | 481 | 	if (!sensebuf) | 
 | 482 | 		return -ENOMEM; | 
 | 483 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 484 | 	memset(scsi_cmd, 0, sizeof(scsi_cmd)); | 
 | 485 |  | 
 | 486 | 	if (args[3]) { | 
 | 487 | 		argsize = SECTOR_SIZE * args[3]; | 
 | 488 | 		argbuf = kmalloc(argsize, GFP_KERNEL); | 
| Jeff Raubitschek | 54dac83 | 2005-10-04 10:21:19 -0400 | [diff] [blame] | 489 | 		if (argbuf == NULL) { | 
 | 490 | 			rc = -ENOMEM; | 
 | 491 | 			goto error; | 
 | 492 | 		} | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 493 |  | 
 | 494 | 		scsi_cmd[1]  = (4 << 1); /* PIO Data-in */ | 
 | 495 | 		scsi_cmd[2]  = 0x0e;     /* no off.line or cc, read from dev, | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 496 | 					    block count in sector count field */ | 
| Mike Christie | 85837eb | 2005-11-11 16:38:53 -0600 | [diff] [blame] | 497 | 		data_dir = DMA_FROM_DEVICE; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 498 | 	} else { | 
 | 499 | 		scsi_cmd[1]  = (3 << 1); /* Non-data */ | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 500 | 		scsi_cmd[2]  = 0x20;     /* cc but no off.line or data xfer */ | 
| Mike Christie | 85837eb | 2005-11-11 16:38:53 -0600 | [diff] [blame] | 501 | 		data_dir = DMA_NONE; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 502 | 	} | 
 | 503 |  | 
 | 504 | 	scsi_cmd[0] = ATA_16; | 
 | 505 |  | 
 | 506 | 	scsi_cmd[4] = args[2]; | 
| Bartlomiej Zolnierkiewicz | a4f1904 | 2008-10-10 22:39:20 +0200 | [diff] [blame] | 507 | 	if (args[0] == ATA_CMD_SMART) { /* hack -- ide driver does this too */ | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 508 | 		scsi_cmd[6]  = args[3]; | 
 | 509 | 		scsi_cmd[8]  = args[1]; | 
 | 510 | 		scsi_cmd[10] = 0x4f; | 
 | 511 | 		scsi_cmd[12] = 0xc2; | 
 | 512 | 	} else { | 
 | 513 | 		scsi_cmd[6]  = args[1]; | 
 | 514 | 	} | 
 | 515 | 	scsi_cmd[14] = args[0]; | 
 | 516 |  | 
 | 517 | 	/* Good values for timeout and retries?  Values below | 
 | 518 | 	   from scsi_ioctl_send_command() for default case... */ | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 519 | 	cmd_result = scsi_execute(scsidev, scsi_cmd, data_dir, argbuf, argsize, | 
| FUJITA Tomonori | f4f4e47 | 2008-12-04 14:24:39 +0900 | [diff] [blame] | 520 | 				  sensebuf, (10*HZ), 5, 0, NULL); | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 521 |  | 
 | 522 | 	if (driver_byte(cmd_result) == DRIVER_SENSE) {/* sense data available */ | 
 | 523 | 		u8 *desc = sensebuf + 8; | 
 | 524 | 		cmd_result &= ~(0xFF<<24); /* DRIVER_SENSE is not an error */ | 
 | 525 |  | 
 | 526 | 		/* If we set cc then ATA pass-through will cause a | 
 | 527 | 		 * check condition even if no error. Filter that. */ | 
 | 528 | 		if (cmd_result & SAM_STAT_CHECK_CONDITION) { | 
 | 529 | 			struct scsi_sense_hdr sshdr; | 
 | 530 | 			scsi_normalize_sense(sensebuf, SCSI_SENSE_BUFFERSIZE, | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 531 | 					     &sshdr); | 
 | 532 | 			if (sshdr.sense_key == 0 && | 
 | 533 | 			    sshdr.asc == 0 && sshdr.ascq == 0) | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 534 | 				cmd_result &= ~SAM_STAT_CHECK_CONDITION; | 
 | 535 | 		} | 
 | 536 |  | 
 | 537 | 		/* Send userspace a few ATA registers (same as drivers/ide) */ | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 538 | 		if (sensebuf[0] == 0x72 &&	/* format is "descriptor" */ | 
 | 539 | 		    desc[0] == 0x09) {		/* code is "ATA Descriptor" */ | 
 | 540 | 			args[0] = desc[13];	/* status */ | 
 | 541 | 			args[1] = desc[3];	/* error */ | 
 | 542 | 			args[2] = desc[5];	/* sector count (0:7) */ | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 543 | 			if (copy_to_user(arg, args, sizeof(args))) | 
 | 544 | 				rc = -EFAULT; | 
 | 545 | 		} | 
 | 546 | 	} | 
 | 547 |  | 
 | 548 |  | 
 | 549 | 	if (cmd_result) { | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 550 | 		rc = -EIO; | 
 | 551 | 		goto error; | 
 | 552 | 	} | 
 | 553 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 554 | 	if ((argbuf) | 
| Randy Dunlap | c893a3a | 2006-01-28 13:15:32 -0500 | [diff] [blame] | 555 | 	 && copy_to_user(arg + sizeof(args), argbuf, argsize)) | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 556 | 		rc = -EFAULT; | 
 | 557 | error: | 
| Eran Tromer | bbe1fe7 | 2006-10-10 14:29:25 -0700 | [diff] [blame] | 558 | 	kfree(sensebuf); | 
| Jesper Juhl | 8f76078 | 2006-06-27 02:55:06 -0700 | [diff] [blame] | 559 | 	kfree(argbuf); | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 560 | 	return rc; | 
 | 561 | } | 
 | 562 |  | 
 | 563 | /** | 
 | 564 |  *	ata_task_ioctl - Handler for HDIO_DRIVE_TASK ioctl | 
| Randy Dunlap | 8e8b77d | 2005-11-01 21:29:27 -0800 | [diff] [blame] | 565 |  *	@scsidev: Device to which we are issuing command | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 566 |  *	@arg: User provided data for issuing command | 
 | 567 |  * | 
 | 568 |  *	LOCKING: | 
 | 569 |  *	Defined by the SCSI layer.  We don't really care. | 
 | 570 |  * | 
 | 571 |  *	RETURNS: | 
 | 572 |  *	Zero on success, negative errno on error. | 
 | 573 |  */ | 
 | 574 | int ata_task_ioctl(struct scsi_device *scsidev, void __user *arg) | 
 | 575 | { | 
 | 576 | 	int rc = 0; | 
 | 577 | 	u8 scsi_cmd[MAX_COMMAND_SIZE]; | 
| David Milburn | af068bd | 2007-01-30 00:59:15 -0800 | [diff] [blame] | 578 | 	u8 args[7], *sensebuf = NULL; | 
 | 579 | 	int cmd_result; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 580 |  | 
| Randy Dunlap | c893a3a | 2006-01-28 13:15:32 -0500 | [diff] [blame] | 581 | 	if (arg == NULL) | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 582 | 		return -EINVAL; | 
 | 583 |  | 
 | 584 | 	if (copy_from_user(args, arg, sizeof(args))) | 
 | 585 | 		return -EFAULT; | 
 | 586 |  | 
| David Milburn | af068bd | 2007-01-30 00:59:15 -0800 | [diff] [blame] | 587 | 	sensebuf = kzalloc(SCSI_SENSE_BUFFERSIZE, GFP_NOIO); | 
 | 588 | 	if (!sensebuf) | 
 | 589 | 		return -ENOMEM; | 
 | 590 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 591 | 	memset(scsi_cmd, 0, sizeof(scsi_cmd)); | 
 | 592 | 	scsi_cmd[0]  = ATA_16; | 
 | 593 | 	scsi_cmd[1]  = (3 << 1); /* Non-data */ | 
| David Milburn | af068bd | 2007-01-30 00:59:15 -0800 | [diff] [blame] | 594 | 	scsi_cmd[2]  = 0x20;     /* cc but no off.line or data xfer */ | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 595 | 	scsi_cmd[4]  = args[1]; | 
 | 596 | 	scsi_cmd[6]  = args[2]; | 
 | 597 | 	scsi_cmd[8]  = args[3]; | 
 | 598 | 	scsi_cmd[10] = args[4]; | 
 | 599 | 	scsi_cmd[12] = args[5]; | 
| Mark Lord | 277239f | 2007-03-30 17:45:52 -0400 | [diff] [blame] | 600 | 	scsi_cmd[13] = args[6] & 0x4f; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 601 | 	scsi_cmd[14] = args[0]; | 
 | 602 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 603 | 	/* Good values for timeout and retries?  Values below | 
| Jeff Garzik | 2e9edbf | 2006-03-24 09:56:57 -0500 | [diff] [blame] | 604 | 	   from scsi_ioctl_send_command() for default case... */ | 
| David Milburn | af068bd | 2007-01-30 00:59:15 -0800 | [diff] [blame] | 605 | 	cmd_result = scsi_execute(scsidev, scsi_cmd, DMA_NONE, NULL, 0, | 
| FUJITA Tomonori | f4f4e47 | 2008-12-04 14:24:39 +0900 | [diff] [blame] | 606 | 				sensebuf, (10*HZ), 5, 0, NULL); | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 607 |  | 
| David Milburn | af068bd | 2007-01-30 00:59:15 -0800 | [diff] [blame] | 608 | 	if (driver_byte(cmd_result) == DRIVER_SENSE) {/* sense data available */ | 
 | 609 | 		u8 *desc = sensebuf + 8; | 
 | 610 | 		cmd_result &= ~(0xFF<<24); /* DRIVER_SENSE is not an error */ | 
 | 611 |  | 
 | 612 | 		/* If we set cc then ATA pass-through will cause a | 
 | 613 | 		 * check condition even if no error. Filter that. */ | 
 | 614 | 		if (cmd_result & SAM_STAT_CHECK_CONDITION) { | 
 | 615 | 			struct scsi_sense_hdr sshdr; | 
 | 616 | 			scsi_normalize_sense(sensebuf, SCSI_SENSE_BUFFERSIZE, | 
 | 617 | 						&sshdr); | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 618 | 			if (sshdr.sense_key == 0 && | 
 | 619 | 				sshdr.asc == 0 && sshdr.ascq == 0) | 
| David Milburn | af068bd | 2007-01-30 00:59:15 -0800 | [diff] [blame] | 620 | 				cmd_result &= ~SAM_STAT_CHECK_CONDITION; | 
 | 621 | 		} | 
 | 622 |  | 
 | 623 | 		/* Send userspace ATA registers */ | 
 | 624 | 		if (sensebuf[0] == 0x72 &&	/* format is "descriptor" */ | 
 | 625 | 				desc[0] == 0x09) {/* code is "ATA Descriptor" */ | 
 | 626 | 			args[0] = desc[13];	/* status */ | 
 | 627 | 			args[1] = desc[3];	/* error */ | 
 | 628 | 			args[2] = desc[5];	/* sector count (0:7) */ | 
 | 629 | 			args[3] = desc[7];	/* lbal */ | 
 | 630 | 			args[4] = desc[9];	/* lbam */ | 
 | 631 | 			args[5] = desc[11];	/* lbah */ | 
 | 632 | 			args[6] = desc[12];	/* select */ | 
 | 633 | 			if (copy_to_user(arg, args, sizeof(args))) | 
 | 634 | 				rc = -EFAULT; | 
 | 635 | 		} | 
 | 636 | 	} | 
 | 637 |  | 
 | 638 | 	if (cmd_result) { | 
 | 639 | 		rc = -EIO; | 
 | 640 | 		goto error; | 
 | 641 | 	} | 
 | 642 |  | 
 | 643 |  error: | 
 | 644 | 	kfree(sensebuf); | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 645 | 	return rc; | 
 | 646 | } | 
 | 647 |  | 
| Jeff Garzik | 94be9a5 | 2009-01-16 10:17:09 -0500 | [diff] [blame] | 648 | int ata_sas_scsi_ioctl(struct ata_port *ap, struct scsi_device *scsidev, | 
 | 649 | 		     int cmd, void __user *arg) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 650 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 651 | 	int val = -EINVAL, rc = -EINVAL; | 
 | 652 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 653 | 	switch (cmd) { | 
 | 654 | 	case ATA_IOC_GET_IO32: | 
 | 655 | 		val = 0; | 
 | 656 | 		if (copy_to_user(arg, &val, 1)) | 
 | 657 | 			return -EFAULT; | 
 | 658 | 		return 0; | 
 | 659 |  | 
 | 660 | 	case ATA_IOC_SET_IO32: | 
 | 661 | 		val = (unsigned long) arg; | 
 | 662 | 		if (val != 0) | 
 | 663 | 			return -EINVAL; | 
 | 664 | 		return 0; | 
 | 665 |  | 
| Tejun Heo | 5924b74 | 2007-01-02 20:20:07 +0900 | [diff] [blame] | 666 | 	case HDIO_GET_IDENTITY: | 
| Jeff Garzik | 94be9a5 | 2009-01-16 10:17:09 -0500 | [diff] [blame] | 667 | 		return ata_get_identity(ap, scsidev, arg); | 
| Tejun Heo | 5924b74 | 2007-01-02 20:20:07 +0900 | [diff] [blame] | 668 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 669 | 	case HDIO_DRIVE_CMD: | 
 | 670 | 		if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO)) | 
 | 671 | 			return -EACCES; | 
 | 672 | 		return ata_cmd_ioctl(scsidev, arg); | 
 | 673 |  | 
 | 674 | 	case HDIO_DRIVE_TASK: | 
 | 675 | 		if (!capable(CAP_SYS_ADMIN) || !capable(CAP_SYS_RAWIO)) | 
 | 676 | 			return -EACCES; | 
 | 677 | 		return ata_task_ioctl(scsidev, arg); | 
 | 678 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 679 | 	default: | 
 | 680 | 		rc = -ENOTTY; | 
 | 681 | 		break; | 
 | 682 | 	} | 
 | 683 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 684 | 	return rc; | 
 | 685 | } | 
| Jeff Garzik | 94be9a5 | 2009-01-16 10:17:09 -0500 | [diff] [blame] | 686 | EXPORT_SYMBOL_GPL(ata_sas_scsi_ioctl); | 
 | 687 |  | 
 | 688 | int ata_scsi_ioctl(struct scsi_device *scsidev, int cmd, void __user *arg) | 
 | 689 | { | 
 | 690 | 	return ata_sas_scsi_ioctl(ata_shost_to_port(scsidev->host), | 
 | 691 | 				scsidev, cmd, arg); | 
 | 692 | } | 
 | 693 | EXPORT_SYMBOL_GPL(ata_scsi_ioctl); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 694 |  | 
 | 695 | /** | 
 | 696 |  *	ata_scsi_qc_new - acquire new ata_queued_cmd reference | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 697 |  *	@dev: ATA device to which the new command is attached | 
 | 698 |  *	@cmd: SCSI command that originated this ATA command | 
 | 699 |  *	@done: SCSI command completion function | 
 | 700 |  * | 
 | 701 |  *	Obtain a reference to an unused ata_queued_cmd structure, | 
 | 702 |  *	which is the basic libata structure representing a single | 
 | 703 |  *	ATA command sent to the hardware. | 
 | 704 |  * | 
 | 705 |  *	If a command was available, fill in the SCSI-specific | 
 | 706 |  *	portions of the structure with information on the | 
 | 707 |  *	current command. | 
 | 708 |  * | 
 | 709 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 710 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 711 |  * | 
 | 712 |  *	RETURNS: | 
 | 713 |  *	Command allocated, or %NULL if none available. | 
 | 714 |  */ | 
| Adrian Bunk | 7102d23 | 2007-01-04 00:09:36 +0100 | [diff] [blame] | 715 | static struct ata_queued_cmd *ata_scsi_qc_new(struct ata_device *dev, | 
 | 716 | 					      struct scsi_cmnd *cmd, | 
 | 717 | 					      void (*done)(struct scsi_cmnd *)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 718 | { | 
 | 719 | 	struct ata_queued_cmd *qc; | 
 | 720 |  | 
| Tejun Heo | 8a8bc22 | 2008-11-10 14:48:21 +0900 | [diff] [blame] | 721 | 	qc = ata_qc_new_init(dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 722 | 	if (qc) { | 
 | 723 | 		qc->scsicmd = cmd; | 
 | 724 | 		qc->scsidone = done; | 
 | 725 |  | 
| Tejun Heo | ff2aeb1 | 2007-12-05 16:43:11 +0900 | [diff] [blame] | 726 | 		qc->sg = scsi_sglist(cmd); | 
| Boaz Harrosh | 7120165 | 2007-09-18 17:48:50 +0200 | [diff] [blame] | 727 | 		qc->n_elem = scsi_sg_count(cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 728 | 	} else { | 
 | 729 | 		cmd->result = (DID_OK << 16) | (QUEUE_FULL << 1); | 
 | 730 | 		done(cmd); | 
 | 731 | 	} | 
 | 732 |  | 
 | 733 | 	return qc; | 
 | 734 | } | 
 | 735 |  | 
| Tejun Heo | aacda37 | 2008-03-18 17:47:43 +0900 | [diff] [blame] | 736 | static void ata_qc_set_pc_nbytes(struct ata_queued_cmd *qc) | 
 | 737 | { | 
 | 738 | 	struct scsi_cmnd *scmd = qc->scsicmd; | 
 | 739 |  | 
 | 740 | 	qc->extrabytes = scmd->request->extra_len; | 
 | 741 | 	qc->nbytes = scsi_bufflen(scmd) + qc->extrabytes; | 
 | 742 | } | 
 | 743 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 744 | /** | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 745 |  *	ata_dump_status - user friendly display of error info | 
 | 746 |  *	@id: id of the port in question | 
 | 747 |  *	@tf: ptr to filled out taskfile | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 748 |  * | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 749 |  *	Decode and dump the ATA error/status registers for the user so | 
 | 750 |  *	that they have some idea what really happened at the non | 
 | 751 |  *	make-believe layer. | 
 | 752 |  * | 
 | 753 |  *	LOCKING: | 
 | 754 |  *	inherited from caller | 
 | 755 |  */ | 
| Adrian Bunk | 7102d23 | 2007-01-04 00:09:36 +0100 | [diff] [blame] | 756 | static void ata_dump_status(unsigned id, struct ata_taskfile *tf) | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 757 | { | 
 | 758 | 	u8 stat = tf->command, err = tf->feature; | 
 | 759 |  | 
 | 760 | 	printk(KERN_WARNING "ata%u: status=0x%02x { ", id, stat); | 
 | 761 | 	if (stat & ATA_BUSY) { | 
 | 762 | 		printk("Busy }\n");	/* Data is not valid in this case */ | 
 | 763 | 	} else { | 
 | 764 | 		if (stat & 0x40)	printk("DriveReady "); | 
 | 765 | 		if (stat & 0x20)	printk("DeviceFault "); | 
 | 766 | 		if (stat & 0x10)	printk("SeekComplete "); | 
 | 767 | 		if (stat & 0x08)	printk("DataRequest "); | 
 | 768 | 		if (stat & 0x04)	printk("CorrectedError "); | 
 | 769 | 		if (stat & 0x02)	printk("Index "); | 
 | 770 | 		if (stat & 0x01)	printk("Error "); | 
 | 771 | 		printk("}\n"); | 
 | 772 |  | 
 | 773 | 		if (err) { | 
 | 774 | 			printk(KERN_WARNING "ata%u: error=0x%02x { ", id, err); | 
 | 775 | 			if (err & 0x04)		printk("DriveStatusError "); | 
 | 776 | 			if (err & 0x80) { | 
 | 777 | 				if (err & 0x04)	printk("BadCRC "); | 
 | 778 | 				else		printk("Sector "); | 
 | 779 | 			} | 
 | 780 | 			if (err & 0x40)		printk("UncorrectableError "); | 
 | 781 | 			if (err & 0x10)		printk("SectorIdNotFound "); | 
 | 782 | 			if (err & 0x02)		printk("TrackZeroNotFound "); | 
 | 783 | 			if (err & 0x01)		printk("AddrMarkNotFound "); | 
 | 784 | 			printk("}\n"); | 
 | 785 | 		} | 
 | 786 | 	} | 
 | 787 | } | 
 | 788 |  | 
 | 789 | /** | 
 | 790 |  *	ata_to_sense_error - convert ATA error to SCSI error | 
| Randy Dunlap | 8e8b77d | 2005-11-01 21:29:27 -0800 | [diff] [blame] | 791 |  *	@id: ATA device number | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 792 |  *	@drv_stat: value contained in ATA status register | 
 | 793 |  *	@drv_err: value contained in ATA error register | 
 | 794 |  *	@sk: the sense key we'll fill out | 
 | 795 |  *	@asc: the additional sense code we'll fill out | 
 | 796 |  *	@ascq: the additional sense code qualifier we'll fill out | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 797 |  *	@verbose: be verbose | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 798 |  * | 
 | 799 |  *	Converts an ATA error into a SCSI error.  Fill out pointers to | 
 | 800 |  *	SK, ASC, and ASCQ bytes for later use in fixed or descriptor | 
 | 801 |  *	format sense blocks. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 802 |  * | 
 | 803 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 804 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 805 |  */ | 
| Adrian Bunk | 7102d23 | 2007-01-04 00:09:36 +0100 | [diff] [blame] | 806 | static void ata_to_sense_error(unsigned id, u8 drv_stat, u8 drv_err, u8 *sk, | 
 | 807 | 			       u8 *asc, u8 *ascq, int verbose) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 808 | { | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 809 | 	int i; | 
| Jeff Garzik | ffe75ef | 2005-10-09 10:40:44 -0400 | [diff] [blame] | 810 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 811 | 	/* Based on the 3ware driver translation table */ | 
| Arjan van de Ven | 98ac62d | 2005-11-28 10:06:23 +0100 | [diff] [blame] | 812 | 	static const unsigned char sense_table[][4] = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 813 | 		/* BBD|ECC|ID|MAR */ | 
 | 814 | 		{0xd1, 		ABORTED_COMMAND, 0x00, 0x00}, 	// Device busy                  Aborted command | 
 | 815 | 		/* BBD|ECC|ID */ | 
 | 816 | 		{0xd0,  	ABORTED_COMMAND, 0x00, 0x00}, 	// Device busy                  Aborted command | 
 | 817 | 		/* ECC|MC|MARK */ | 
 | 818 | 		{0x61, 		HARDWARE_ERROR, 0x00, 0x00}, 	// Device fault                 Hardware error | 
 | 819 | 		/* ICRC|ABRT */		/* NB: ICRC & !ABRT is BBD */ | 
 | 820 | 		{0x84, 		ABORTED_COMMAND, 0x47, 0x00}, 	// Data CRC error               SCSI parity error | 
 | 821 | 		/* MC|ID|ABRT|TRK0|MARK */ | 
 | 822 | 		{0x37, 		NOT_READY, 0x04, 0x00}, 	// Unit offline                 Not ready | 
 | 823 | 		/* MCR|MARK */ | 
 | 824 | 		{0x09, 		NOT_READY, 0x04, 0x00}, 	// Unrecovered disk error       Not ready | 
 | 825 | 		/*  Bad address mark */ | 
 | 826 | 		{0x01, 		MEDIUM_ERROR, 0x13, 0x00}, 	// Address mark not found       Address mark not found for data field | 
 | 827 | 		/* TRK0 */ | 
 | 828 | 		{0x02, 		HARDWARE_ERROR, 0x00, 0x00}, 	// Track 0 not found		  Hardware error | 
 | 829 | 		/* Abort & !ICRC */ | 
 | 830 | 		{0x04, 		ABORTED_COMMAND, 0x00, 0x00}, 	// Aborted command              Aborted command | 
 | 831 | 		/* Media change request */ | 
 | 832 | 		{0x08, 		NOT_READY, 0x04, 0x00}, 	// Media change request	  FIXME: faking offline | 
 | 833 | 		/* SRV */ | 
 | 834 | 		{0x10, 		ABORTED_COMMAND, 0x14, 0x00}, 	// ID not found                 Recorded entity not found | 
 | 835 | 		/* Media change */ | 
 | 836 | 		{0x08,  	NOT_READY, 0x04, 0x00}, 	// Media change		  FIXME: faking offline | 
 | 837 | 		/* ECC */ | 
 | 838 | 		{0x40, 		MEDIUM_ERROR, 0x11, 0x04}, 	// Uncorrectable ECC error      Unrecovered read error | 
 | 839 | 		/* BBD - block marked bad */ | 
 | 840 | 		{0x80, 		MEDIUM_ERROR, 0x11, 0x04}, 	// Block marked bad		  Medium error, unrecovered read error | 
 | 841 | 		{0xFF, 0xFF, 0xFF, 0xFF}, // END mark | 
 | 842 | 	}; | 
| Arjan van de Ven | 98ac62d | 2005-11-28 10:06:23 +0100 | [diff] [blame] | 843 | 	static const unsigned char stat_table[][4] = { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 844 | 		/* Must be first because BUSY means no other bits valid */ | 
 | 845 | 		{0x80, 		ABORTED_COMMAND, 0x47, 0x00},	// Busy, fake parity for now | 
 | 846 | 		{0x20, 		HARDWARE_ERROR,  0x00, 0x00}, 	// Device fault | 
 | 847 | 		{0x08, 		ABORTED_COMMAND, 0x47, 0x00},	// Timed out in xfer, fake parity for now | 
 | 848 | 		{0x04, 		RECOVERED_ERROR, 0x11, 0x00},	// Recovered ECC error	  Medium error, recovered | 
 | 849 | 		{0xFF, 0xFF, 0xFF, 0xFF}, // END mark | 
 | 850 | 	}; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 851 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 852 | 	/* | 
 | 853 | 	 *	Is this an error we can process/parse | 
 | 854 | 	 */ | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 855 | 	if (drv_stat & ATA_BUSY) { | 
 | 856 | 		drv_err = 0;	/* Ignore the err bits, they're invalid */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 857 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 858 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 859 | 	if (drv_err) { | 
 | 860 | 		/* Look for drv_err */ | 
 | 861 | 		for (i = 0; sense_table[i][0] != 0xFF; i++) { | 
 | 862 | 			/* Look for best matches first */ | 
| Jeff Garzik | 2e9edbf | 2006-03-24 09:56:57 -0500 | [diff] [blame] | 863 | 			if ((sense_table[i][0] & drv_err) == | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 864 | 			    sense_table[i][0]) { | 
 | 865 | 				*sk = sense_table[i][1]; | 
 | 866 | 				*asc = sense_table[i][2]; | 
 | 867 | 				*ascq = sense_table[i][3]; | 
 | 868 | 				goto translate_done; | 
 | 869 | 			} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 870 | 		} | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 871 | 		/* No immediate match */ | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 872 | 		if (verbose) | 
 | 873 | 			printk(KERN_WARNING "ata%u: no sense translation for " | 
 | 874 | 			       "error 0x%02x\n", id, drv_err); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 875 | 	} | 
 | 876 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 877 | 	/* Fall back to interpreting status bits */ | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 878 | 	for (i = 0; stat_table[i][0] != 0xFF; i++) { | 
 | 879 | 		if (stat_table[i][0] & drv_stat) { | 
 | 880 | 			*sk = stat_table[i][1]; | 
 | 881 | 			*asc = stat_table[i][2]; | 
 | 882 | 			*ascq = stat_table[i][3]; | 
 | 883 | 			goto translate_done; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 884 | 		} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 885 | 	} | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 886 | 	/* No error?  Undecoded? */ | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 887 | 	if (verbose) | 
 | 888 | 		printk(KERN_WARNING "ata%u: no sense translation for " | 
 | 889 | 		       "status: 0x%02x\n", id, drv_stat); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 890 |  | 
| Alan Cox | 2d20202 | 2006-03-21 15:53:46 +0000 | [diff] [blame] | 891 | 	/* We need a sensible error return here, which is tricky, and one | 
 | 892 | 	   that won't cause people to do things like return a disk wrongly */ | 
 | 893 | 	*sk = ABORTED_COMMAND; | 
 | 894 | 	*asc = 0x00; | 
 | 895 | 	*ascq = 0x00; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 896 |  | 
 | 897 |  translate_done: | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 898 | 	if (verbose) | 
 | 899 | 		printk(KERN_ERR "ata%u: translated ATA stat/err 0x%02x/%02x " | 
 | 900 | 		       "to SCSI SK/ASC/ASCQ 0x%x/%02x/%02x\n", | 
 | 901 | 		       id, drv_stat, drv_err, *sk, *asc, *ascq); | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 902 | 	return; | 
 | 903 | } | 
 | 904 |  | 
 | 905 | /* | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 906 |  *	ata_gen_passthru_sense - Generate check condition sense block. | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 907 |  *	@qc: Command that completed. | 
 | 908 |  * | 
 | 909 |  *	This function is specific to the ATA descriptor format sense | 
 | 910 |  *	block specified for the ATA pass through commands.  Regardless | 
 | 911 |  *	of whether the command errored or not, return a sense | 
 | 912 |  *	block. Copy all controller registers into the sense | 
 | 913 |  *	block. Clear sense key, ASC & ASCQ if there is no error. | 
 | 914 |  * | 
 | 915 |  *	LOCKING: | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 916 |  *	None. | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 917 |  */ | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 918 | static void ata_gen_passthru_sense(struct ata_queued_cmd *qc) | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 919 | { | 
 | 920 | 	struct scsi_cmnd *cmd = qc->scsicmd; | 
| Tejun Heo | e61e067 | 2006-05-15 20:57:40 +0900 | [diff] [blame] | 921 | 	struct ata_taskfile *tf = &qc->result_tf; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 922 | 	unsigned char *sb = cmd->sense_buffer; | 
 | 923 | 	unsigned char *desc = sb + 8; | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 924 | 	int verbose = qc->ap->ops->error_handler == NULL; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 925 |  | 
 | 926 | 	memset(sb, 0, SCSI_SENSE_BUFFERSIZE); | 
 | 927 |  | 
| Jeff Garzik | 0e5dec4 | 2005-10-06 09:40:20 -0400 | [diff] [blame] | 928 | 	cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 929 |  | 
 | 930 | 	/* | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 931 | 	 * Use ata_to_sense_error() to map status register bits | 
 | 932 | 	 * onto sense key, asc & ascq. | 
 | 933 | 	 */ | 
| Tejun Heo | 058e55e | 2006-04-02 18:51:53 +0900 | [diff] [blame] | 934 | 	if (qc->err_mask || | 
 | 935 | 	    tf->command & (ATA_BUSY | ATA_DF | ATA_ERR | ATA_DRQ)) { | 
| Tejun Heo | 44877b4 | 2007-02-21 01:06:51 +0900 | [diff] [blame] | 936 | 		ata_to_sense_error(qc->ap->print_id, tf->command, tf->feature, | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 937 | 				   &sb[1], &sb[2], &sb[3], verbose); | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 938 | 		sb[1] &= 0x0f; | 
 | 939 | 	} | 
 | 940 |  | 
 | 941 | 	/* | 
 | 942 | 	 * Sense data is current and format is descriptor. | 
 | 943 | 	 */ | 
 | 944 | 	sb[0] = 0x72; | 
 | 945 |  | 
 | 946 | 	desc[0] = 0x09; | 
 | 947 |  | 
| Tejun Heo | f38621b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 948 | 	/* set length of additional sense data */ | 
 | 949 | 	sb[7] = 14; | 
 | 950 | 	desc[1] = 12; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 951 |  | 
 | 952 | 	/* | 
 | 953 | 	 * Copy registers into sense buffer. | 
 | 954 | 	 */ | 
 | 955 | 	desc[2] = 0x00; | 
 | 956 | 	desc[3] = tf->feature;	/* == error reg */ | 
 | 957 | 	desc[5] = tf->nsect; | 
 | 958 | 	desc[7] = tf->lbal; | 
 | 959 | 	desc[9] = tf->lbam; | 
 | 960 | 	desc[11] = tf->lbah; | 
 | 961 | 	desc[12] = tf->device; | 
 | 962 | 	desc[13] = tf->command; /* == status reg */ | 
 | 963 |  | 
 | 964 | 	/* | 
 | 965 | 	 * Fill in Extend bit, and the high order bytes | 
 | 966 | 	 * if applicable. | 
 | 967 | 	 */ | 
 | 968 | 	if (tf->flags & ATA_TFLAG_LBA48) { | 
 | 969 | 		desc[2] |= 0x01; | 
 | 970 | 		desc[4] = tf->hob_nsect; | 
 | 971 | 		desc[6] = tf->hob_lbal; | 
 | 972 | 		desc[8] = tf->hob_lbam; | 
 | 973 | 		desc[10] = tf->hob_lbah; | 
 | 974 | 	} | 
 | 975 | } | 
 | 976 |  | 
 | 977 | /** | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 978 |  *	ata_gen_ata_sense - generate a SCSI fixed sense block | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 979 |  *	@qc: Command that we are erroring out | 
 | 980 |  * | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 981 |  *	Generate sense block for a failed ATA command @qc.  Descriptor | 
 | 982 |  *	format is used to accomodate LBA48 block address. | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 983 |  * | 
 | 984 |  *	LOCKING: | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 985 |  *	None. | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 986 |  */ | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 987 | static void ata_gen_ata_sense(struct ata_queued_cmd *qc) | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 988 | { | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 989 | 	struct ata_device *dev = qc->dev; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 990 | 	struct scsi_cmnd *cmd = qc->scsicmd; | 
| Tejun Heo | e61e067 | 2006-05-15 20:57:40 +0900 | [diff] [blame] | 991 | 	struct ata_taskfile *tf = &qc->result_tf; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 992 | 	unsigned char *sb = cmd->sense_buffer; | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 993 | 	unsigned char *desc = sb + 8; | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 994 | 	int verbose = qc->ap->ops->error_handler == NULL; | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 995 | 	u64 block; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 996 |  | 
 | 997 | 	memset(sb, 0, SCSI_SENSE_BUFFERSIZE); | 
 | 998 |  | 
| Jeff Garzik | 0e5dec4 | 2005-10-06 09:40:20 -0400 | [diff] [blame] | 999 | 	cmd->result = (DRIVER_SENSE << 24) | SAM_STAT_CHECK_CONDITION; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 1000 |  | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 1001 | 	/* sense data is current and format is descriptor */ | 
 | 1002 | 	sb[0] = 0x72; | 
 | 1003 |  | 
 | 1004 | 	/* Use ata_to_sense_error() to map status register bits | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 1005 | 	 * onto sense key, asc & ascq. | 
 | 1006 | 	 */ | 
| Tejun Heo | 058e55e | 2006-04-02 18:51:53 +0900 | [diff] [blame] | 1007 | 	if (qc->err_mask || | 
 | 1008 | 	    tf->command & (ATA_BUSY | ATA_DF | ATA_ERR | ATA_DRQ)) { | 
| Tejun Heo | 44877b4 | 2007-02-21 01:06:51 +0900 | [diff] [blame] | 1009 | 		ata_to_sense_error(qc->ap->print_id, tf->command, tf->feature, | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 1010 | 				   &sb[1], &sb[2], &sb[3], verbose); | 
 | 1011 | 		sb[1] &= 0x0f; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 1012 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1013 |  | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 1014 | 	block = ata_tf_read_block(&qc->result_tf, dev); | 
| Jeff Garzik | 0274aa2 | 2005-06-22 13:50:56 -0400 | [diff] [blame] | 1015 |  | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 1016 | 	/* information sense data descriptor */ | 
 | 1017 | 	sb[7] = 12; | 
 | 1018 | 	desc[0] = 0x00; | 
 | 1019 | 	desc[1] = 10; | 
| Jeff Garzik | a7dac44 | 2005-10-30 04:44:42 -0500 | [diff] [blame] | 1020 |  | 
| Tejun Heo | d25614b | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 1021 | 	desc[2] |= 0x80;	/* valid */ | 
 | 1022 | 	desc[6] = block >> 40; | 
 | 1023 | 	desc[7] = block >> 32; | 
 | 1024 | 	desc[8] = block >> 24; | 
 | 1025 | 	desc[9] = block >> 16; | 
 | 1026 | 	desc[10] = block >> 8; | 
 | 1027 | 	desc[11] = block; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1028 | } | 
 | 1029 |  | 
| Brian King | a6cce2a | 2006-03-17 17:04:15 -0600 | [diff] [blame] | 1030 | static void ata_scsi_sdev_config(struct scsi_device *sdev) | 
 | 1031 | { | 
 | 1032 | 	sdev->use_10_for_rw = 1; | 
 | 1033 | 	sdev->use_10_for_ms = 1; | 
| Tejun Heo | 31cc23b | 2007-09-23 13:14:12 +0900 | [diff] [blame] | 1034 |  | 
 | 1035 | 	/* Schedule policy is determined by ->qc_defer() callback and | 
 | 1036 | 	 * it needs to see every deferred qc.  Set dev_blocked to 1 to | 
 | 1037 | 	 * prevent SCSI midlayer from automatically deferring | 
 | 1038 | 	 * requests. | 
 | 1039 | 	 */ | 
 | 1040 | 	sdev->max_device_blocked = 1; | 
| Brian King | a6cce2a | 2006-03-17 17:04:15 -0600 | [diff] [blame] | 1041 | } | 
 | 1042 |  | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1043 | /** | 
 | 1044 |  *	atapi_drain_needed - Check whether data transfer may overflow | 
| Randy Dunlap | 73fd8b6 | 2008-02-19 13:43:21 -0800 | [diff] [blame] | 1045 |  *	@rq: request to be checked | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1046 |  * | 
 | 1047 |  *	ATAPI commands which transfer variable length data to host | 
 | 1048 |  *	might overflow due to application error or hardare bug.  This | 
 | 1049 |  *	function checks whether overflow should be drained and ignored | 
 | 1050 |  *	for @request. | 
 | 1051 |  * | 
 | 1052 |  *	LOCKING: | 
 | 1053 |  *	None. | 
 | 1054 |  * | 
 | 1055 |  *	RETURNS: | 
 | 1056 |  *	1 if ; otherwise, 0. | 
 | 1057 |  */ | 
 | 1058 | static int atapi_drain_needed(struct request *rq) | 
 | 1059 | { | 
 | 1060 | 	if (likely(!blk_pc_request(rq))) | 
 | 1061 | 		return 0; | 
 | 1062 |  | 
 | 1063 | 	if (!rq->data_len || (rq->cmd_flags & REQ_RW)) | 
 | 1064 | 		return 0; | 
 | 1065 |  | 
 | 1066 | 	return atapi_cmd_type(rq->cmd[0]) == ATAPI_MISC; | 
 | 1067 | } | 
 | 1068 |  | 
 | 1069 | static int ata_scsi_dev_config(struct scsi_device *sdev, | 
 | 1070 | 			       struct ata_device *dev) | 
| Brian King | a6cce2a | 2006-03-17 17:04:15 -0600 | [diff] [blame] | 1071 | { | 
| Elias Oltmanns | 45fabbb | 2008-09-21 11:54:08 +0200 | [diff] [blame] | 1072 | 	if (!ata_id_has_unload(dev->id)) | 
 | 1073 | 		dev->flags |= ATA_DFLAG_NO_UNLOAD; | 
 | 1074 |  | 
| Tejun Heo | 914ed35 | 2006-11-01 18:39:55 +0900 | [diff] [blame] | 1075 | 	/* configure max sectors */ | 
 | 1076 | 	blk_queue_max_sectors(sdev->request_queue, dev->max_sectors); | 
| Brian King | a6cce2a | 2006-03-17 17:04:15 -0600 | [diff] [blame] | 1077 |  | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1078 | 	if (dev->class == ATA_DEV_ATAPI) { | 
 | 1079 | 		struct request_queue *q = sdev->request_queue; | 
 | 1080 | 		void *buf; | 
 | 1081 |  | 
| Tejun Heo | e3790c7 | 2008-03-04 11:18:17 +0100 | [diff] [blame] | 1082 | 		/* set the min alignment and padding */ | 
| James Bottomley | d0ad3bc | 2008-01-22 13:43:48 -0600 | [diff] [blame] | 1083 | 		blk_queue_update_dma_alignment(sdev->request_queue, | 
 | 1084 | 					       ATA_DMA_PAD_SZ - 1); | 
| FUJITA Tomonori | 27f8221 | 2008-07-04 09:30:03 +0200 | [diff] [blame] | 1085 | 		blk_queue_update_dma_pad(sdev->request_queue, | 
 | 1086 | 					 ATA_DMA_PAD_SZ - 1); | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1087 |  | 
 | 1088 | 		/* configure draining */ | 
 | 1089 | 		buf = kmalloc(ATAPI_MAX_DRAIN, q->bounce_gfp | GFP_KERNEL); | 
 | 1090 | 		if (!buf) { | 
 | 1091 | 			ata_dev_printk(dev, KERN_ERR, | 
 | 1092 | 				       "drain buffer allocation failed\n"); | 
 | 1093 | 			return -ENOMEM; | 
 | 1094 | 		} | 
 | 1095 |  | 
 | 1096 | 		blk_queue_dma_drain(q, atapi_drain_needed, buf, ATAPI_MAX_DRAIN); | 
 | 1097 | 	} else { | 
| Jens Axboe | 8bff7c6 | 2008-09-24 13:05:10 +0200 | [diff] [blame] | 1098 | 		if (ata_id_is_ssd(dev->id)) | 
 | 1099 | 			queue_flag_set_unlocked(QUEUE_FLAG_NONROT, | 
 | 1100 | 						sdev->request_queue); | 
 | 1101 |  | 
| James Bottomley | d0ad3bc | 2008-01-22 13:43:48 -0600 | [diff] [blame] | 1102 | 		/* ATA devices must be sector aligned */ | 
 | 1103 | 		blk_queue_update_dma_alignment(sdev->request_queue, | 
 | 1104 | 					       ATA_SECT_SIZE - 1); | 
| Tejun Heo | d8cf538 | 2008-01-15 08:46:59 +0900 | [diff] [blame] | 1105 | 		sdev->manage_start_stop = 1; | 
| James Bottomley | dde2020 | 2008-02-19 11:36:56 +0100 | [diff] [blame] | 1106 | 	} | 
| Tejun Heo | d8cf538 | 2008-01-15 08:46:59 +0900 | [diff] [blame] | 1107 |  | 
| Jeff Garzik | f26792d | 2007-10-29 17:18:39 -0400 | [diff] [blame] | 1108 | 	if (dev->flags & ATA_DFLAG_AN) | 
 | 1109 | 		set_bit(SDEV_EVT_MEDIA_CHANGE, sdev->supported_events); | 
 | 1110 |  | 
| Tejun Heo | a6e6ce8 | 2006-05-15 21:03:48 +0900 | [diff] [blame] | 1111 | 	if (dev->flags & ATA_DFLAG_NCQ) { | 
 | 1112 | 		int depth; | 
 | 1113 |  | 
 | 1114 | 		depth = min(sdev->host->can_queue, ata_id_queue_depth(dev->id)); | 
 | 1115 | 		depth = min(ATA_MAX_QUEUE - 1, depth); | 
| Tejun Heo | 8a8bc22 | 2008-11-10 14:48:21 +0900 | [diff] [blame] | 1116 | 		scsi_adjust_queue_depth(sdev, MSG_SIMPLE_TAG, depth); | 
| Tejun Heo | a6e6ce8 | 2006-05-15 21:03:48 +0900 | [diff] [blame] | 1117 | 	} | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1118 |  | 
 | 1119 | 	return 0; | 
| Brian King | a6cce2a | 2006-03-17 17:04:15 -0600 | [diff] [blame] | 1120 | } | 
 | 1121 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1122 | /** | 
 | 1123 |  *	ata_scsi_slave_config - Set SCSI device attributes | 
 | 1124 |  *	@sdev: SCSI device to examine | 
 | 1125 |  * | 
 | 1126 |  *	This is called before we actually start reading | 
 | 1127 |  *	and writing to the device, to configure certain | 
 | 1128 |  *	SCSI mid-layer behaviors. | 
 | 1129 |  * | 
 | 1130 |  *	LOCKING: | 
 | 1131 |  *	Defined by SCSI layer.  We don't really care. | 
 | 1132 |  */ | 
 | 1133 |  | 
 | 1134 | int ata_scsi_slave_config(struct scsi_device *sdev) | 
 | 1135 | { | 
| Tejun Heo | 3153436 | 2006-05-31 18:27:36 +0900 | [diff] [blame] | 1136 | 	struct ata_port *ap = ata_shost_to_port(sdev->host); | 
 | 1137 | 	struct ata_device *dev = __ata_scsi_find_dev(ap, sdev); | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1138 | 	int rc = 0; | 
| Tejun Heo | 3153436 | 2006-05-31 18:27:36 +0900 | [diff] [blame] | 1139 |  | 
| Brian King | a6cce2a | 2006-03-17 17:04:15 -0600 | [diff] [blame] | 1140 | 	ata_scsi_sdev_config(sdev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1141 |  | 
| Tejun Heo | 3153436 | 2006-05-31 18:27:36 +0900 | [diff] [blame] | 1142 | 	if (dev) | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1143 | 		rc = ata_scsi_dev_config(sdev, dev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1144 |  | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1145 | 	return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1146 | } | 
 | 1147 |  | 
 | 1148 | /** | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 1149 |  *	ata_scsi_slave_destroy - SCSI device is about to be destroyed | 
 | 1150 |  *	@sdev: SCSI device to be destroyed | 
 | 1151 |  * | 
 | 1152 |  *	@sdev is about to be destroyed for hot/warm unplugging.  If | 
 | 1153 |  *	this unplugging was initiated by libata as indicated by NULL | 
 | 1154 |  *	dev->sdev, this function doesn't have to do anything. | 
 | 1155 |  *	Otherwise, SCSI layer initiated warm-unplug is in progress. | 
 | 1156 |  *	Clear dev->sdev, schedule the device for ATA detach and invoke | 
 | 1157 |  *	EH. | 
 | 1158 |  * | 
 | 1159 |  *	LOCKING: | 
 | 1160 |  *	Defined by SCSI layer.  We don't really care. | 
 | 1161 |  */ | 
 | 1162 | void ata_scsi_slave_destroy(struct scsi_device *sdev) | 
 | 1163 | { | 
 | 1164 | 	struct ata_port *ap = ata_shost_to_port(sdev->host); | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1165 | 	struct request_queue *q = sdev->request_queue; | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 1166 | 	unsigned long flags; | 
 | 1167 | 	struct ata_device *dev; | 
 | 1168 |  | 
 | 1169 | 	if (!ap->ops->error_handler) | 
 | 1170 | 		return; | 
 | 1171 |  | 
| Jeff Garzik | ba6a130 | 2006-06-22 23:46:10 -0400 | [diff] [blame] | 1172 | 	spin_lock_irqsave(ap->lock, flags); | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 1173 | 	dev = __ata_scsi_find_dev(ap, sdev); | 
 | 1174 | 	if (dev && dev->sdev) { | 
 | 1175 | 		/* SCSI device already in CANCEL state, no need to offline it */ | 
 | 1176 | 		dev->sdev = NULL; | 
 | 1177 | 		dev->flags |= ATA_DFLAG_DETACH; | 
 | 1178 | 		ata_port_schedule_eh(ap); | 
 | 1179 | 	} | 
| Jeff Garzik | ba6a130 | 2006-06-22 23:46:10 -0400 | [diff] [blame] | 1180 | 	spin_unlock_irqrestore(ap->lock, flags); | 
| James Bottomley | fa2fc7f | 2008-02-19 11:36:57 +0100 | [diff] [blame] | 1181 |  | 
 | 1182 | 	kfree(q->dma_drain_buffer); | 
 | 1183 | 	q->dma_drain_buffer = NULL; | 
 | 1184 | 	q->dma_drain_size = 0; | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 1185 | } | 
 | 1186 |  | 
 | 1187 | /** | 
| Tejun Heo | a6e6ce8 | 2006-05-15 21:03:48 +0900 | [diff] [blame] | 1188 |  *	ata_scsi_change_queue_depth - SCSI callback for queue depth config | 
 | 1189 |  *	@sdev: SCSI device to configure queue depth for | 
 | 1190 |  *	@queue_depth: new queue depth | 
 | 1191 |  * | 
 | 1192 |  *	This is libata standard hostt->change_queue_depth callback. | 
 | 1193 |  *	SCSI will call into this callback when user tries to set queue | 
 | 1194 |  *	depth via sysfs. | 
 | 1195 |  * | 
 | 1196 |  *	LOCKING: | 
 | 1197 |  *	SCSI layer (we don't care) | 
 | 1198 |  * | 
 | 1199 |  *	RETURNS: | 
 | 1200 |  *	Newly configured queue depth. | 
 | 1201 |  */ | 
 | 1202 | int ata_scsi_change_queue_depth(struct scsi_device *sdev, int queue_depth) | 
 | 1203 | { | 
 | 1204 | 	struct ata_port *ap = ata_shost_to_port(sdev->host); | 
 | 1205 | 	struct ata_device *dev; | 
| Tejun Heo | 360f654 | 2006-09-30 19:45:00 +0900 | [diff] [blame] | 1206 | 	unsigned long flags; | 
| Tejun Heo | a6e6ce8 | 2006-05-15 21:03:48 +0900 | [diff] [blame] | 1207 |  | 
| Tejun Heo | c3c70c4 | 2007-02-20 23:31:22 +0900 | [diff] [blame] | 1208 | 	if (queue_depth < 1 || queue_depth == sdev->queue_depth) | 
| Tejun Heo | a6e6ce8 | 2006-05-15 21:03:48 +0900 | [diff] [blame] | 1209 | 		return sdev->queue_depth; | 
 | 1210 |  | 
 | 1211 | 	dev = ata_scsi_find_dev(ap, sdev); | 
 | 1212 | 	if (!dev || !ata_dev_enabled(dev)) | 
 | 1213 | 		return sdev->queue_depth; | 
 | 1214 |  | 
| Tejun Heo | c3c70c4 | 2007-02-20 23:31:22 +0900 | [diff] [blame] | 1215 | 	/* NCQ enabled? */ | 
| Tejun Heo | 360f654 | 2006-09-30 19:45:00 +0900 | [diff] [blame] | 1216 | 	spin_lock_irqsave(ap->lock, flags); | 
| Tejun Heo | c3c70c4 | 2007-02-20 23:31:22 +0900 | [diff] [blame] | 1217 | 	dev->flags &= ~ATA_DFLAG_NCQ_OFF; | 
 | 1218 | 	if (queue_depth == 1 || !ata_ncq_enabled(dev)) { | 
| Tejun Heo | 360f654 | 2006-09-30 19:45:00 +0900 | [diff] [blame] | 1219 | 		dev->flags |= ATA_DFLAG_NCQ_OFF; | 
| Tejun Heo | c3c70c4 | 2007-02-20 23:31:22 +0900 | [diff] [blame] | 1220 | 		queue_depth = 1; | 
 | 1221 | 	} | 
| Tejun Heo | 360f654 | 2006-09-30 19:45:00 +0900 | [diff] [blame] | 1222 | 	spin_unlock_irqrestore(ap->lock, flags); | 
 | 1223 |  | 
| Tejun Heo | c3c70c4 | 2007-02-20 23:31:22 +0900 | [diff] [blame] | 1224 | 	/* limit and apply queue depth */ | 
 | 1225 | 	queue_depth = min(queue_depth, sdev->host->can_queue); | 
 | 1226 | 	queue_depth = min(queue_depth, ata_id_queue_depth(dev->id)); | 
 | 1227 | 	queue_depth = min(queue_depth, ATA_MAX_QUEUE - 1); | 
 | 1228 |  | 
 | 1229 | 	if (sdev->queue_depth == queue_depth) | 
 | 1230 | 		return -EINVAL; | 
 | 1231 |  | 
 | 1232 | 	scsi_adjust_queue_depth(sdev, MSG_SIMPLE_TAG, queue_depth); | 
| Tejun Heo | a6e6ce8 | 2006-05-15 21:03:48 +0900 | [diff] [blame] | 1233 | 	return queue_depth; | 
 | 1234 | } | 
 | 1235 |  | 
| Tejun Heo | d9aca22 | 2007-05-17 16:43:26 +0200 | [diff] [blame] | 1236 | /* XXX: for spindown warning */ | 
| Tejun Heo | da071b4 | 2007-05-14 17:26:18 +0200 | [diff] [blame] | 1237 | static void ata_delayed_done_timerfn(unsigned long arg) | 
 | 1238 | { | 
 | 1239 | 	struct scsi_cmnd *scmd = (void *)arg; | 
 | 1240 |  | 
 | 1241 | 	scmd->scsi_done(scmd); | 
 | 1242 | } | 
 | 1243 |  | 
| Tejun Heo | d9aca22 | 2007-05-17 16:43:26 +0200 | [diff] [blame] | 1244 | /* XXX: for spindown warning */ | 
| Tejun Heo | da071b4 | 2007-05-14 17:26:18 +0200 | [diff] [blame] | 1245 | static void ata_delayed_done(struct scsi_cmnd *scmd) | 
 | 1246 | { | 
 | 1247 | 	static struct timer_list timer; | 
 | 1248 |  | 
 | 1249 | 	setup_timer(&timer, ata_delayed_done_timerfn, (unsigned long)scmd); | 
 | 1250 | 	mod_timer(&timer, jiffies + 5 * HZ); | 
 | 1251 | } | 
 | 1252 |  | 
| Tejun Heo | a6e6ce8 | 2006-05-15 21:03:48 +0900 | [diff] [blame] | 1253 | /** | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1254 |  *	ata_scsi_start_stop_xlat - Translate SCSI START STOP UNIT command | 
 | 1255 |  *	@qc: Storage for translated ATA taskfile | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1256 |  * | 
 | 1257 |  *	Sets up an ATA taskfile to issue STANDBY (to stop) or READ VERIFY | 
 | 1258 |  *	(to start). Perhaps these commands should be preceded by | 
 | 1259 |  *	CHECK POWER MODE to see what power mode the device is already in. | 
 | 1260 |  *	[See SAT revision 5 at www.t10.org] | 
 | 1261 |  * | 
 | 1262 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 1263 |  *	spin_lock_irqsave(host lock) | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1264 |  * | 
 | 1265 |  *	RETURNS: | 
 | 1266 |  *	Zero on success, non-zero on error. | 
 | 1267 |  */ | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 1268 | static unsigned int ata_scsi_start_stop_xlat(struct ata_queued_cmd *qc) | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1269 | { | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1270 | 	struct scsi_cmnd *scmd = qc->scsicmd; | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1271 | 	struct ata_taskfile *tf = &qc->tf; | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 1272 | 	const u8 *cdb = scmd->cmnd; | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1273 |  | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 1274 | 	if (scmd->cmd_len < 5) | 
 | 1275 | 		goto invalid_fld; | 
 | 1276 |  | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1277 | 	tf->flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR; | 
 | 1278 | 	tf->protocol = ATA_PROT_NODATA; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1279 | 	if (cdb[1] & 0x1) { | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1280 | 		;	/* ignore IMMED bit, violates sat-r05 */ | 
 | 1281 | 	} | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1282 | 	if (cdb[4] & 0x2) | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1283 | 		goto invalid_fld;       /* LOEJ bit set not supported */ | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1284 | 	if (((cdb[4] >> 4) & 0xf) != 0) | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1285 | 		goto invalid_fld;       /* power conditions not supported */ | 
| Tejun Heo | e31e853 | 2007-09-23 13:14:13 +0900 | [diff] [blame] | 1286 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1287 | 	if (cdb[4] & 0x1) { | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1288 | 		tf->nsect = 1;	/* 1 sector, lba=0 */ | 
| Albert Lee | 9d5b130 | 2005-10-04 08:48:17 -0400 | [diff] [blame] | 1289 |  | 
 | 1290 | 		if (qc->dev->flags & ATA_DFLAG_LBA) { | 
| Tejun Heo | c44078c | 2006-05-15 20:57:21 +0900 | [diff] [blame] | 1291 | 			tf->flags |= ATA_TFLAG_LBA; | 
| Albert Lee | 9d5b130 | 2005-10-04 08:48:17 -0400 | [diff] [blame] | 1292 |  | 
 | 1293 | 			tf->lbah = 0x0; | 
 | 1294 | 			tf->lbam = 0x0; | 
 | 1295 | 			tf->lbal = 0x0; | 
 | 1296 | 			tf->device |= ATA_LBA; | 
 | 1297 | 		} else { | 
 | 1298 | 			/* CHS */ | 
 | 1299 | 			tf->lbal = 0x1; /* sect */ | 
 | 1300 | 			tf->lbam = 0x0; /* cyl low */ | 
 | 1301 | 			tf->lbah = 0x0; /* cyl high */ | 
 | 1302 | 		} | 
 | 1303 |  | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1304 | 		tf->command = ATA_CMD_VERIFY;	/* READ VERIFY */ | 
| Tejun Heo | 920a4b1 | 2007-05-04 21:28:48 +0200 | [diff] [blame] | 1305 | 	} else { | 
 | 1306 | 		/* XXX: This is for backward compatibility, will be | 
 | 1307 | 		 * removed.  Read Documentation/feature-removal-schedule.txt | 
 | 1308 | 		 * for more info. | 
 | 1309 | 		 */ | 
| Tejun Heo | d9aca22 | 2007-05-17 16:43:26 +0200 | [diff] [blame] | 1310 | 		if ((qc->dev->flags & ATA_DFLAG_SPUNDOWN) && | 
| Tejun Heo | 920a4b1 | 2007-05-04 21:28:48 +0200 | [diff] [blame] | 1311 | 		    (system_state == SYSTEM_HALT || | 
 | 1312 | 		     system_state == SYSTEM_POWER_OFF)) { | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 1313 | 			static unsigned long warned; | 
| Tejun Heo | 920a4b1 | 2007-05-04 21:28:48 +0200 | [diff] [blame] | 1314 |  | 
| Tejun Heo | da071b4 | 2007-05-14 17:26:18 +0200 | [diff] [blame] | 1315 | 			if (!test_and_set_bit(0, &warned)) { | 
| Tejun Heo | 920a4b1 | 2007-05-04 21:28:48 +0200 | [diff] [blame] | 1316 | 				ata_dev_printk(qc->dev, KERN_WARNING, | 
 | 1317 | 					"DISK MIGHT NOT BE SPUN DOWN PROPERLY. " | 
 | 1318 | 					"UPDATE SHUTDOWN UTILITY\n"); | 
 | 1319 | 				ata_dev_printk(qc->dev, KERN_WARNING, | 
 | 1320 | 					"For more info, visit " | 
 | 1321 | 					"http://linux-ata.org/shutdown.html\n"); | 
| Tejun Heo | da071b4 | 2007-05-14 17:26:18 +0200 | [diff] [blame] | 1322 |  | 
 | 1323 | 				/* ->scsi_done is not used, use it for | 
 | 1324 | 				 * delayed completion. | 
 | 1325 | 				 */ | 
 | 1326 | 				scmd->scsi_done = qc->scsidone; | 
 | 1327 | 				qc->scsidone = ata_delayed_done; | 
| Tejun Heo | 920a4b1 | 2007-05-04 21:28:48 +0200 | [diff] [blame] | 1328 | 			} | 
 | 1329 | 			scmd->result = SAM_STAT_GOOD; | 
 | 1330 | 			return 1; | 
 | 1331 | 		} | 
 | 1332 |  | 
| Robert Hancock | 78981a7 | 2007-01-30 00:59:18 -0800 | [diff] [blame] | 1333 | 		/* Issue ATA STANDBY IMMEDIATE command */ | 
 | 1334 | 		tf->command = ATA_CMD_STANDBYNOW1; | 
| Tejun Heo | 920a4b1 | 2007-05-04 21:28:48 +0200 | [diff] [blame] | 1335 | 	} | 
| Robert Hancock | 78981a7 | 2007-01-30 00:59:18 -0800 | [diff] [blame] | 1336 |  | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1337 | 	/* | 
 | 1338 | 	 * Standby and Idle condition timers could be implemented but that | 
 | 1339 | 	 * would require libata to implement the Power condition mode page | 
 | 1340 | 	 * and allow the user to change it. Changing mode pages requires | 
 | 1341 | 	 * MODE SELECT to be implemented. | 
 | 1342 | 	 */ | 
 | 1343 |  | 
 | 1344 | 	return 0; | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1345 |  | 
 | 1346 | invalid_fld: | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1347 | 	ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x0); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1348 | 	/* "Invalid field in cbd" */ | 
 | 1349 | 	return 1; | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 1350 | } | 
 | 1351 |  | 
 | 1352 |  | 
 | 1353 | /** | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1354 |  *	ata_scsi_flush_xlat - Translate SCSI SYNCHRONIZE CACHE command | 
 | 1355 |  *	@qc: Storage for translated ATA taskfile | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1356 |  * | 
 | 1357 |  *	Sets up an ATA taskfile to issue FLUSH CACHE or | 
 | 1358 |  *	FLUSH CACHE EXT. | 
 | 1359 |  * | 
 | 1360 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 1361 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1362 |  * | 
 | 1363 |  *	RETURNS: | 
 | 1364 |  *	Zero on success, non-zero on error. | 
 | 1365 |  */ | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 1366 | static unsigned int ata_scsi_flush_xlat(struct ata_queued_cmd *qc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1367 | { | 
 | 1368 | 	struct ata_taskfile *tf = &qc->tf; | 
 | 1369 |  | 
 | 1370 | 	tf->flags |= ATA_TFLAG_DEVICE; | 
 | 1371 | 	tf->protocol = ATA_PROT_NODATA; | 
 | 1372 |  | 
| Tejun Heo | 6fc49ad | 2006-11-11 20:10:45 +0900 | [diff] [blame] | 1373 | 	if (qc->dev->flags & ATA_DFLAG_FLUSH_EXT) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1374 | 		tf->command = ATA_CMD_FLUSH_EXT; | 
 | 1375 | 	else | 
 | 1376 | 		tf->command = ATA_CMD_FLUSH; | 
 | 1377 |  | 
| Tejun Heo | b666da3 | 2007-10-26 15:53:59 +0900 | [diff] [blame] | 1378 | 	/* flush is critical for IO integrity, consider it an IO command */ | 
 | 1379 | 	qc->flags |= ATA_QCFLAG_IO; | 
 | 1380 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1381 | 	return 0; | 
 | 1382 | } | 
 | 1383 |  | 
 | 1384 | /** | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1385 |  *	scsi_6_lba_len - Get LBA and transfer length | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1386 |  *	@cdb: SCSI command to translate | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1387 |  * | 
 | 1388 |  *	Calculate LBA and transfer length for 6-byte commands. | 
 | 1389 |  * | 
 | 1390 |  *	RETURNS: | 
 | 1391 |  *	@plba: the LBA | 
 | 1392 |  *	@plen: the transfer length | 
 | 1393 |  */ | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1394 | static void scsi_6_lba_len(const u8 *cdb, u64 *plba, u32 *plen) | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1395 | { | 
 | 1396 | 	u64 lba = 0; | 
| Jeff Garzik | 6c7b7d2 | 2007-05-25 04:39:39 -0400 | [diff] [blame] | 1397 | 	u32 len; | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1398 |  | 
 | 1399 | 	VPRINTK("six-byte command\n"); | 
 | 1400 |  | 
| Jeff Garzik | 6c7b7d2 | 2007-05-25 04:39:39 -0400 | [diff] [blame] | 1401 | 	lba |= ((u64)(cdb[1] & 0x1f)) << 16; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1402 | 	lba |= ((u64)cdb[2]) << 8; | 
 | 1403 | 	lba |= ((u64)cdb[3]); | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1404 |  | 
| Jeff Garzik | 6c7b7d2 | 2007-05-25 04:39:39 -0400 | [diff] [blame] | 1405 | 	len = cdb[4]; | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1406 |  | 
 | 1407 | 	*plba = lba; | 
 | 1408 | 	*plen = len; | 
 | 1409 | } | 
 | 1410 |  | 
 | 1411 | /** | 
 | 1412 |  *	scsi_10_lba_len - Get LBA and transfer length | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1413 |  *	@cdb: SCSI command to translate | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1414 |  * | 
 | 1415 |  *	Calculate LBA and transfer length for 10-byte commands. | 
 | 1416 |  * | 
 | 1417 |  *	RETURNS: | 
 | 1418 |  *	@plba: the LBA | 
 | 1419 |  *	@plen: the transfer length | 
 | 1420 |  */ | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1421 | static void scsi_10_lba_len(const u8 *cdb, u64 *plba, u32 *plen) | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1422 | { | 
 | 1423 | 	u64 lba = 0; | 
 | 1424 | 	u32 len = 0; | 
 | 1425 |  | 
 | 1426 | 	VPRINTK("ten-byte command\n"); | 
 | 1427 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1428 | 	lba |= ((u64)cdb[2]) << 24; | 
 | 1429 | 	lba |= ((u64)cdb[3]) << 16; | 
 | 1430 | 	lba |= ((u64)cdb[4]) << 8; | 
 | 1431 | 	lba |= ((u64)cdb[5]); | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1432 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1433 | 	len |= ((u32)cdb[7]) << 8; | 
 | 1434 | 	len |= ((u32)cdb[8]); | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1435 |  | 
 | 1436 | 	*plba = lba; | 
 | 1437 | 	*plen = len; | 
 | 1438 | } | 
 | 1439 |  | 
 | 1440 | /** | 
 | 1441 |  *	scsi_16_lba_len - Get LBA and transfer length | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1442 |  *	@cdb: SCSI command to translate | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1443 |  * | 
 | 1444 |  *	Calculate LBA and transfer length for 16-byte commands. | 
 | 1445 |  * | 
 | 1446 |  *	RETURNS: | 
 | 1447 |  *	@plba: the LBA | 
 | 1448 |  *	@plen: the transfer length | 
 | 1449 |  */ | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1450 | static void scsi_16_lba_len(const u8 *cdb, u64 *plba, u32 *plen) | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1451 | { | 
 | 1452 | 	u64 lba = 0; | 
 | 1453 | 	u32 len = 0; | 
 | 1454 |  | 
 | 1455 | 	VPRINTK("sixteen-byte command\n"); | 
 | 1456 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1457 | 	lba |= ((u64)cdb[2]) << 56; | 
 | 1458 | 	lba |= ((u64)cdb[3]) << 48; | 
 | 1459 | 	lba |= ((u64)cdb[4]) << 40; | 
 | 1460 | 	lba |= ((u64)cdb[5]) << 32; | 
 | 1461 | 	lba |= ((u64)cdb[6]) << 24; | 
 | 1462 | 	lba |= ((u64)cdb[7]) << 16; | 
 | 1463 | 	lba |= ((u64)cdb[8]) << 8; | 
 | 1464 | 	lba |= ((u64)cdb[9]); | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1465 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1466 | 	len |= ((u32)cdb[10]) << 24; | 
 | 1467 | 	len |= ((u32)cdb[11]) << 16; | 
 | 1468 | 	len |= ((u32)cdb[12]) << 8; | 
 | 1469 | 	len |= ((u32)cdb[13]); | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1470 |  | 
 | 1471 | 	*plba = lba; | 
 | 1472 | 	*plen = len; | 
 | 1473 | } | 
 | 1474 |  | 
 | 1475 | /** | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1476 |  *	ata_scsi_verify_xlat - Translate SCSI VERIFY command into an ATA one | 
 | 1477 |  *	@qc: Storage for translated ATA taskfile | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1478 |  * | 
 | 1479 |  *	Converts SCSI VERIFY command to an ATA READ VERIFY command. | 
 | 1480 |  * | 
 | 1481 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 1482 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1483 |  * | 
 | 1484 |  *	RETURNS: | 
 | 1485 |  *	Zero on success, non-zero on error. | 
 | 1486 |  */ | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 1487 | static unsigned int ata_scsi_verify_xlat(struct ata_queued_cmd *qc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1488 | { | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1489 | 	struct scsi_cmnd *scmd = qc->scsicmd; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1490 | 	struct ata_taskfile *tf = &qc->tf; | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1491 | 	struct ata_device *dev = qc->dev; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1492 | 	u64 dev_sectors = qc->dev->n_sectors; | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 1493 | 	const u8 *cdb = scmd->cmnd; | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1494 | 	u64 block; | 
 | 1495 | 	u32 n_block; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1496 |  | 
 | 1497 | 	tf->flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; | 
 | 1498 | 	tf->protocol = ATA_PROT_NODATA; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1499 |  | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 1500 | 	if (cdb[0] == VERIFY) { | 
 | 1501 | 		if (scmd->cmd_len < 10) | 
 | 1502 | 			goto invalid_fld; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1503 | 		scsi_10_lba_len(cdb, &block, &n_block); | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 1504 | 	} else if (cdb[0] == VERIFY_16) { | 
 | 1505 | 		if (scmd->cmd_len < 16) | 
 | 1506 | 			goto invalid_fld; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1507 | 		scsi_16_lba_len(cdb, &block, &n_block); | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 1508 | 	} else | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1509 | 		goto invalid_fld; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1510 |  | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1511 | 	if (!n_block) | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1512 | 		goto nothing_to_do; | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1513 | 	if (block >= dev_sectors) | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1514 | 		goto out_of_range; | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1515 | 	if ((block + n_block) > dev_sectors) | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1516 | 		goto out_of_range; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1517 |  | 
| Albert Lee | 0750669 | 2005-10-12 15:04:18 +0800 | [diff] [blame] | 1518 | 	if (dev->flags & ATA_DFLAG_LBA) { | 
 | 1519 | 		tf->flags |= ATA_TFLAG_LBA; | 
 | 1520 |  | 
| Albert Lee | c6a33e2 | 2005-10-12 15:12:26 +0800 | [diff] [blame] | 1521 | 		if (lba_28_ok(block, n_block)) { | 
 | 1522 | 			/* use LBA28 */ | 
 | 1523 | 			tf->command = ATA_CMD_VERIFY; | 
 | 1524 | 			tf->device |= (block >> 24) & 0xf; | 
 | 1525 | 		} else if (lba_48_ok(block, n_block)) { | 
 | 1526 | 			if (!(dev->flags & ATA_DFLAG_LBA48)) | 
 | 1527 | 				goto out_of_range; | 
| Albert Lee | 0750669 | 2005-10-12 15:04:18 +0800 | [diff] [blame] | 1528 |  | 
 | 1529 | 			/* use LBA48 */ | 
 | 1530 | 			tf->flags |= ATA_TFLAG_LBA48; | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1531 | 			tf->command = ATA_CMD_VERIFY_EXT; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1532 |  | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1533 | 			tf->hob_nsect = (n_block >> 8) & 0xff; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1534 |  | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1535 | 			tf->hob_lbah = (block >> 40) & 0xff; | 
 | 1536 | 			tf->hob_lbam = (block >> 32) & 0xff; | 
 | 1537 | 			tf->hob_lbal = (block >> 24) & 0xff; | 
| Albert Lee | c6a33e2 | 2005-10-12 15:12:26 +0800 | [diff] [blame] | 1538 | 		} else | 
 | 1539 | 			/* request too large even for LBA48 */ | 
 | 1540 | 			goto out_of_range; | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1541 |  | 
 | 1542 | 		tf->nsect = n_block & 0xff; | 
 | 1543 |  | 
 | 1544 | 		tf->lbah = (block >> 16) & 0xff; | 
 | 1545 | 		tf->lbam = (block >> 8) & 0xff; | 
 | 1546 | 		tf->lbal = block & 0xff; | 
 | 1547 |  | 
 | 1548 | 		tf->device |= ATA_LBA; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1549 | 	} else { | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1550 | 		/* CHS */ | 
 | 1551 | 		u32 sect, head, cyl, track; | 
 | 1552 |  | 
| Albert Lee | c6a33e2 | 2005-10-12 15:12:26 +0800 | [diff] [blame] | 1553 | 		if (!lba_28_ok(block, n_block)) | 
 | 1554 | 			goto out_of_range; | 
| Albert Lee | 0750669 | 2005-10-12 15:04:18 +0800 | [diff] [blame] | 1555 |  | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1556 | 		/* Convert LBA to CHS */ | 
 | 1557 | 		track = (u32)block / dev->sectors; | 
 | 1558 | 		cyl   = track / dev->heads; | 
 | 1559 | 		head  = track % dev->heads; | 
 | 1560 | 		sect  = (u32)block % dev->sectors + 1; | 
 | 1561 |  | 
| Albert Lee | c187c4b | 2005-10-04 08:46:51 -0400 | [diff] [blame] | 1562 | 		DPRINTK("block %u track %u cyl %u head %u sect %u\n", | 
 | 1563 | 			(u32)block, track, cyl, head, sect); | 
| Jeff Garzik | 2e9edbf | 2006-03-24 09:56:57 -0500 | [diff] [blame] | 1564 |  | 
 | 1565 | 		/* Check whether the converted CHS can fit. | 
 | 1566 | 		   Cylinder: 0-65535 | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1567 | 		   Head: 0-15 | 
 | 1568 | 		   Sector: 1-255*/ | 
| Jeff Garzik | 2e9edbf | 2006-03-24 09:56:57 -0500 | [diff] [blame] | 1569 | 		if ((cyl >> 16) || (head >> 4) || (sect >> 8) || (!sect)) | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1570 | 			goto out_of_range; | 
| Jeff Garzik | 2e9edbf | 2006-03-24 09:56:57 -0500 | [diff] [blame] | 1571 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1572 | 		tf->command = ATA_CMD_VERIFY; | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1573 | 		tf->nsect = n_block & 0xff; /* Sector count 0 means 256 sectors */ | 
 | 1574 | 		tf->lbal = sect; | 
 | 1575 | 		tf->lbam = cyl; | 
 | 1576 | 		tf->lbah = cyl >> 8; | 
 | 1577 | 		tf->device |= head; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1578 | 	} | 
 | 1579 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1580 | 	return 0; | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1581 |  | 
 | 1582 | invalid_fld: | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1583 | 	ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x0); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1584 | 	/* "Invalid field in cbd" */ | 
 | 1585 | 	return 1; | 
 | 1586 |  | 
 | 1587 | out_of_range: | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1588 | 	ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x21, 0x0); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1589 | 	/* "Logical Block Address out of range" */ | 
 | 1590 | 	return 1; | 
 | 1591 |  | 
 | 1592 | nothing_to_do: | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1593 | 	scmd->result = SAM_STAT_GOOD; | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1594 | 	return 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1595 | } | 
 | 1596 |  | 
 | 1597 | /** | 
 | 1598 |  *	ata_scsi_rw_xlat - Translate SCSI r/w command into an ATA one | 
 | 1599 |  *	@qc: Storage for translated ATA taskfile | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1600 |  * | 
 | 1601 |  *	Converts any of six SCSI read/write commands into the | 
 | 1602 |  *	ATA counterpart, including starting sector (LBA), | 
 | 1603 |  *	sector count, and taking into account the device's LBA48 | 
 | 1604 |  *	support. | 
 | 1605 |  * | 
 | 1606 |  *	Commands %READ_6, %READ_10, %READ_16, %WRITE_6, %WRITE_10, and | 
 | 1607 |  *	%WRITE_16 are currently supported. | 
 | 1608 |  * | 
 | 1609 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 1610 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1611 |  * | 
 | 1612 |  *	RETURNS: | 
 | 1613 |  *	Zero on success, non-zero on error. | 
 | 1614 |  */ | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 1615 | static unsigned int ata_scsi_rw_xlat(struct ata_queued_cmd *qc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1616 | { | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1617 | 	struct scsi_cmnd *scmd = qc->scsicmd; | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 1618 | 	const u8 *cdb = scmd->cmnd; | 
| Tejun Heo | bd056d7 | 2006-11-14 22:47:10 +0900 | [diff] [blame] | 1619 | 	unsigned int tf_flags = 0; | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1620 | 	u64 block; | 
 | 1621 | 	u32 n_block; | 
| Tejun Heo | bd056d7 | 2006-11-14 22:47:10 +0900 | [diff] [blame] | 1622 | 	int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1623 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1624 | 	if (cdb[0] == WRITE_10 || cdb[0] == WRITE_6 || cdb[0] == WRITE_16) | 
| Tejun Heo | bd056d7 | 2006-11-14 22:47:10 +0900 | [diff] [blame] | 1625 | 		tf_flags |= ATA_TFLAG_WRITE; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1626 |  | 
| Tejun Heo | 9a3dccc | 2006-01-06 09:56:18 +0100 | [diff] [blame] | 1627 | 	/* Calculate the SCSI LBA, transfer length and FUA. */ | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1628 | 	switch (cdb[0]) { | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1629 | 	case READ_10: | 
 | 1630 | 	case WRITE_10: | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 1631 | 		if (unlikely(scmd->cmd_len < 10)) | 
 | 1632 | 			goto invalid_fld; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1633 | 		scsi_10_lba_len(cdb, &block, &n_block); | 
 | 1634 | 		if (unlikely(cdb[1] & (1 << 3))) | 
| Tejun Heo | bd056d7 | 2006-11-14 22:47:10 +0900 | [diff] [blame] | 1635 | 			tf_flags |= ATA_TFLAG_FUA; | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1636 | 		break; | 
 | 1637 | 	case READ_6: | 
 | 1638 | 	case WRITE_6: | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 1639 | 		if (unlikely(scmd->cmd_len < 6)) | 
 | 1640 | 			goto invalid_fld; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1641 | 		scsi_6_lba_len(cdb, &block, &n_block); | 
| Albert Lee | c187c4b | 2005-10-04 08:46:51 -0400 | [diff] [blame] | 1642 |  | 
 | 1643 | 		/* for 6-byte r/w commands, transfer length 0 | 
 | 1644 | 		 * means 256 blocks of data, not 0 block. | 
 | 1645 | 		 */ | 
| Jeff Garzik | 76b2bf9 | 2005-08-29 19:24:43 -0400 | [diff] [blame] | 1646 | 		if (!n_block) | 
 | 1647 | 			n_block = 256; | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1648 | 		break; | 
 | 1649 | 	case READ_16: | 
 | 1650 | 	case WRITE_16: | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 1651 | 		if (unlikely(scmd->cmd_len < 16)) | 
 | 1652 | 			goto invalid_fld; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1653 | 		scsi_16_lba_len(cdb, &block, &n_block); | 
 | 1654 | 		if (unlikely(cdb[1] & (1 << 3))) | 
| Tejun Heo | bd056d7 | 2006-11-14 22:47:10 +0900 | [diff] [blame] | 1655 | 			tf_flags |= ATA_TFLAG_FUA; | 
| Albert Lee | 3aef523 | 2005-10-04 08:47:43 -0400 | [diff] [blame] | 1656 | 		break; | 
 | 1657 | 	default: | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1658 | 		DPRINTK("no-byte command\n"); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1659 | 		goto invalid_fld; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1660 | 	} | 
 | 1661 |  | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1662 | 	/* Check and compose ATA command */ | 
 | 1663 | 	if (!n_block) | 
| Albert Lee | c187c4b | 2005-10-04 08:46:51 -0400 | [diff] [blame] | 1664 | 		/* For 10-byte and 16-byte SCSI R/W commands, transfer | 
 | 1665 | 		 * length 0 means transfer 0 block of data. | 
 | 1666 | 		 * However, for ATA R/W commands, sector count 0 means | 
 | 1667 | 		 * 256 or 65536 sectors, not 0 sectors as in SCSI. | 
| Alan Cox | f51750d | 2005-11-07 17:06:33 +0000 | [diff] [blame] | 1668 | 		 * | 
 | 1669 | 		 * WARNING: one or two older ATA drives treat 0 as 0... | 
| Albert Lee | c187c4b | 2005-10-04 08:46:51 -0400 | [diff] [blame] | 1670 | 		 */ | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1671 | 		goto nothing_to_do; | 
| Albert Lee | 8bf62ec | 2005-05-12 15:29:42 -0400 | [diff] [blame] | 1672 |  | 
| Tejun Heo | bd056d7 | 2006-11-14 22:47:10 +0900 | [diff] [blame] | 1673 | 	qc->flags |= ATA_QCFLAG_IO; | 
| Tejun Heo | 726f078 | 2007-01-03 17:30:39 +0900 | [diff] [blame] | 1674 | 	qc->nbytes = n_block * ATA_SECT_SIZE; | 
| Tejun Heo | 3dc1d88 | 2006-05-15 21:03:45 +0900 | [diff] [blame] | 1675 |  | 
| Tejun Heo | bd056d7 | 2006-11-14 22:47:10 +0900 | [diff] [blame] | 1676 | 	rc = ata_build_rw_tf(&qc->tf, qc->dev, block, n_block, tf_flags, | 
 | 1677 | 			     qc->tag); | 
 | 1678 | 	if (likely(rc == 0)) | 
 | 1679 | 		return 0; | 
| Tejun Heo | 3dc1d88 | 2006-05-15 21:03:45 +0900 | [diff] [blame] | 1680 |  | 
| Tejun Heo | bd056d7 | 2006-11-14 22:47:10 +0900 | [diff] [blame] | 1681 | 	if (rc == -ERANGE) | 
 | 1682 | 		goto out_of_range; | 
 | 1683 | 	/* treat all other errors as -EINVAL, fall through */ | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1684 | invalid_fld: | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1685 | 	ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x0); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1686 | 	/* "Invalid field in cbd" */ | 
 | 1687 | 	return 1; | 
 | 1688 |  | 
 | 1689 | out_of_range: | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1690 | 	ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x21, 0x0); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1691 | 	/* "Logical Block Address out of range" */ | 
 | 1692 | 	return 1; | 
 | 1693 |  | 
 | 1694 | nothing_to_do: | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 1695 | 	scmd->result = SAM_STAT_GOOD; | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1696 | 	return 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1697 | } | 
 | 1698 |  | 
| Tejun Heo | 77853bf | 2006-01-23 13:09:36 +0900 | [diff] [blame] | 1699 | static void ata_scsi_qc_complete(struct ata_queued_cmd *qc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1700 | { | 
| Tejun Heo | c31f571 | 2006-11-22 12:39:43 +0900 | [diff] [blame] | 1701 | 	struct ata_port *ap = qc->ap; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1702 | 	struct scsi_cmnd *cmd = qc->scsicmd; | 
| Jeff Garzik | a7dac44 | 2005-10-30 04:44:42 -0500 | [diff] [blame] | 1703 | 	u8 *cdb = cmd->cmnd; | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 1704 | 	int need_sense = (qc->err_mask != 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1705 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 1706 | 	/* For ATA pass thru (SAT) commands, generate a sense block if | 
 | 1707 | 	 * user mandated it or if there's an error.  Note that if we | 
 | 1708 | 	 * generate because the user forced us to, a check condition | 
 | 1709 | 	 * is generated and the ATA register values are returned | 
 | 1710 | 	 * whether the command completed successfully or not. If there | 
 | 1711 | 	 * was no error, SK, ASC and ASCQ will all be zero. | 
 | 1712 | 	 */ | 
| Jeff Garzik | a7dac44 | 2005-10-30 04:44:42 -0500 | [diff] [blame] | 1713 | 	if (((cdb[0] == ATA_16) || (cdb[0] == ATA_12)) && | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 1714 | 	    ((cdb[2] & 0x20) || need_sense)) { | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 1715 | 		ata_gen_passthru_sense(qc); | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 1716 | 	} else { | 
 | 1717 | 		if (!need_sense) { | 
 | 1718 | 			cmd->result = SAM_STAT_GOOD; | 
 | 1719 | 		} else { | 
 | 1720 | 			/* TODO: decide which descriptor format to use | 
 | 1721 | 			 * for 48b LBA devices and call that here | 
 | 1722 | 			 * instead of the fixed desc, which is only | 
 | 1723 | 			 * good for smaller LBA (and maybe CHS?) | 
 | 1724 | 			 * devices. | 
 | 1725 | 			 */ | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 1726 | 			ata_gen_ata_sense(qc); | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 1727 | 		} | 
 | 1728 | 	} | 
 | 1729 |  | 
| Tejun Heo | d9aca22 | 2007-05-17 16:43:26 +0200 | [diff] [blame] | 1730 | 	/* XXX: track spindown state for spindown skipping and warning */ | 
| Tejun Heo | 13b8d09 | 2007-05-15 12:29:22 +0200 | [diff] [blame] | 1731 | 	if (unlikely(qc->tf.command == ATA_CMD_STANDBY || | 
 | 1732 | 		     qc->tf.command == ATA_CMD_STANDBYNOW1)) | 
 | 1733 | 		qc->dev->flags |= ATA_DFLAG_SPUNDOWN; | 
 | 1734 | 	else if (likely(system_state != SYSTEM_HALT && | 
 | 1735 | 			system_state != SYSTEM_POWER_OFF)) | 
 | 1736 | 		qc->dev->flags &= ~ATA_DFLAG_SPUNDOWN; | 
 | 1737 |  | 
| Tejun Heo | c31f571 | 2006-11-22 12:39:43 +0900 | [diff] [blame] | 1738 | 	if (need_sense && !ap->ops->error_handler) | 
| Tejun Heo | 44877b4 | 2007-02-21 01:06:51 +0900 | [diff] [blame] | 1739 | 		ata_dump_status(ap->print_id, &qc->result_tf); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1740 |  | 
 | 1741 | 	qc->scsidone(cmd); | 
 | 1742 |  | 
| Tejun Heo | 77853bf | 2006-01-23 13:09:36 +0900 | [diff] [blame] | 1743 | 	ata_qc_free(qc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1744 | } | 
 | 1745 |  | 
 | 1746 | /** | 
 | 1747 |  *	ata_scsi_translate - Translate then issue SCSI command to ATA device | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1748 |  *	@dev: ATA device to which the command is addressed | 
 | 1749 |  *	@cmd: SCSI command to execute | 
 | 1750 |  *	@done: SCSI command completion function | 
 | 1751 |  *	@xlat_func: Actor which translates @cmd to an ATA taskfile | 
 | 1752 |  * | 
 | 1753 |  *	Our ->queuecommand() function has decided that the SCSI | 
 | 1754 |  *	command issued can be directly translated into an ATA | 
 | 1755 |  *	command, rather than handled internally. | 
 | 1756 |  * | 
 | 1757 |  *	This function sets up an ata_queued_cmd structure for the | 
 | 1758 |  *	SCSI command, and sends that ata_queued_cmd to the hardware. | 
 | 1759 |  * | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1760 |  *	The xlat_func argument (actor) returns 0 if ready to execute | 
 | 1761 |  *	ATA command, else 1 to finish translation. If 1 is returned | 
 | 1762 |  *	then cmd->result (and possibly cmd->sense_buffer) are assumed | 
 | 1763 |  *	to be set reflecting an error condition or clean (early) | 
 | 1764 |  *	termination. | 
 | 1765 |  * | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1766 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 1767 |  *	spin_lock_irqsave(host lock) | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 1768 |  * | 
 | 1769 |  *	RETURNS: | 
 | 1770 |  *	0 on success, SCSI_ML_QUEUE_DEVICE_BUSY if the command | 
 | 1771 |  *	needs to be deferred. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1772 |  */ | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 1773 | static int ata_scsi_translate(struct ata_device *dev, struct scsi_cmnd *cmd, | 
 | 1774 | 			      void (*done)(struct scsi_cmnd *), | 
 | 1775 | 			      ata_xlat_func_t xlat_func) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1776 | { | 
| Tejun Heo | 31cc23b | 2007-09-23 13:14:12 +0900 | [diff] [blame] | 1777 | 	struct ata_port *ap = dev->link->ap; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1778 | 	struct ata_queued_cmd *qc; | 
| Tejun Heo | 31cc23b | 2007-09-23 13:14:12 +0900 | [diff] [blame] | 1779 | 	int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1780 |  | 
 | 1781 | 	VPRINTK("ENTER\n"); | 
 | 1782 |  | 
| Tejun Heo | 3373efd | 2006-05-15 20:57:53 +0900 | [diff] [blame] | 1783 | 	qc = ata_scsi_qc_new(dev, cmd, done); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1784 | 	if (!qc) | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1785 | 		goto err_mem; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1786 |  | 
 | 1787 | 	/* data is present; dma-map it */ | 
 | be7db05 | 2005-04-17 15:26:13 -0500 | [diff] [blame] | 1788 | 	if (cmd->sc_data_direction == DMA_FROM_DEVICE || | 
 | 1789 | 	    cmd->sc_data_direction == DMA_TO_DEVICE) { | 
| Boaz Harrosh | 7120165 | 2007-09-18 17:48:50 +0200 | [diff] [blame] | 1790 | 		if (unlikely(scsi_bufflen(cmd) < 1)) { | 
| Tejun Heo | f15a1da | 2006-05-15 20:57:56 +0900 | [diff] [blame] | 1791 | 			ata_dev_printk(dev, KERN_WARNING, | 
 | 1792 | 				       "WARNING: zero len r/w req\n"); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1793 | 			goto err_did; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1794 | 		} | 
 | 1795 |  | 
| Boaz Harrosh | 7120165 | 2007-09-18 17:48:50 +0200 | [diff] [blame] | 1796 | 		ata_sg_init(qc, scsi_sglist(cmd), scsi_sg_count(cmd)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1797 |  | 
 | 1798 | 		qc->dma_dir = cmd->sc_data_direction; | 
 | 1799 | 	} | 
 | 1800 |  | 
 | 1801 | 	qc->complete_fn = ata_scsi_qc_complete; | 
 | 1802 |  | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 1803 | 	if (xlat_func(qc)) | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1804 | 		goto early_finish; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1805 |  | 
| Tejun Heo | 31cc23b | 2007-09-23 13:14:12 +0900 | [diff] [blame] | 1806 | 	if (ap->ops->qc_defer) { | 
 | 1807 | 		if ((rc = ap->ops->qc_defer(qc))) | 
 | 1808 | 			goto defer; | 
 | 1809 | 	} | 
 | 1810 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1811 | 	/* select device, send command to hardware */ | 
| Tejun Heo | 8e0e694 | 2006-03-31 20:41:11 +0900 | [diff] [blame] | 1812 | 	ata_qc_issue(qc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1813 |  | 
 | 1814 | 	VPRINTK("EXIT\n"); | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 1815 | 	return 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1816 |  | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1817 | early_finish: | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 1818 | 	ata_qc_free(qc); | 
| Tejun Heo | da071b4 | 2007-05-14 17:26:18 +0200 | [diff] [blame] | 1819 | 	qc->scsidone(cmd); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1820 | 	DPRINTK("EXIT - early finish (good or error)\n"); | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 1821 | 	return 0; | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1822 |  | 
 | 1823 | err_did: | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1824 | 	ata_qc_free(qc); | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1825 | 	cmd->result = (DID_ERROR << 16); | 
| Tejun Heo | da071b4 | 2007-05-14 17:26:18 +0200 | [diff] [blame] | 1826 | 	qc->scsidone(cmd); | 
| Darrick J. Wong | 253b92e | 2006-11-14 09:55:41 -0500 | [diff] [blame] | 1827 | err_mem: | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1828 | 	DPRINTK("EXIT - internal\n"); | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 1829 | 	return 0; | 
| Tejun Heo | 3dc1d88 | 2006-05-15 21:03:45 +0900 | [diff] [blame] | 1830 |  | 
 | 1831 | defer: | 
| Tejun Heo | 31cc23b | 2007-09-23 13:14:12 +0900 | [diff] [blame] | 1832 | 	ata_qc_free(qc); | 
| Tejun Heo | 3dc1d88 | 2006-05-15 21:03:45 +0900 | [diff] [blame] | 1833 | 	DPRINTK("EXIT - defer\n"); | 
| Tejun Heo | 31cc23b | 2007-09-23 13:14:12 +0900 | [diff] [blame] | 1834 | 	if (rc == ATA_DEFER_LINK) | 
 | 1835 | 		return SCSI_MLQUEUE_DEVICE_BUSY; | 
 | 1836 | 	else | 
 | 1837 | 		return SCSI_MLQUEUE_HOST_BUSY; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1838 | } | 
 | 1839 |  | 
 | 1840 | /** | 
 | 1841 |  *	ata_scsi_rbuf_get - Map response buffer. | 
| Randy Dunlap | ec2a20e | 2008-04-30 12:57:00 -0700 | [diff] [blame] | 1842 |  *	@cmd: SCSI command containing buffer to be mapped. | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1843 |  *	@flags: unsigned long variable to store irq enable status | 
 | 1844 |  *	@copy_in: copy in from user buffer | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1845 |  * | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1846 |  *	Prepare buffer for simulated SCSI commands. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1847 |  * | 
 | 1848 |  *	LOCKING: | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1849 |  *	spin_lock_irqsave(ata_scsi_rbuf_lock) on success | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1850 |  * | 
 | 1851 |  *	RETURNS: | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1852 |  *	Pointer to response buffer. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1853 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1854 | static void *ata_scsi_rbuf_get(struct scsi_cmnd *cmd, bool copy_in, | 
 | 1855 | 			       unsigned long *flags) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1856 | { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1857 | 	spin_lock_irqsave(&ata_scsi_rbuf_lock, *flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1858 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1859 | 	memset(ata_scsi_rbuf, 0, ATA_SCSI_RBUF_SIZE); | 
 | 1860 | 	if (copy_in) | 
 | 1861 | 		sg_copy_to_buffer(scsi_sglist(cmd), scsi_sg_count(cmd), | 
 | 1862 | 				  ata_scsi_rbuf, ATA_SCSI_RBUF_SIZE); | 
 | 1863 | 	return ata_scsi_rbuf; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1864 | } | 
 | 1865 |  | 
 | 1866 | /** | 
 | 1867 |  *	ata_scsi_rbuf_put - Unmap response buffer. | 
 | 1868 |  *	@cmd: SCSI command containing buffer to be unmapped. | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1869 |  *	@copy_out: copy out result | 
 | 1870 |  *	@flags: @flags passed to ata_scsi_rbuf_get() | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1871 |  * | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1872 |  *	Returns rbuf buffer.  The result is copied to @cmd's buffer if | 
 | 1873 |  *	@copy_back is true. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1874 |  * | 
 | 1875 |  *	LOCKING: | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1876 |  *	Unlocks ata_scsi_rbuf_lock. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1877 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1878 | static inline void ata_scsi_rbuf_put(struct scsi_cmnd *cmd, bool copy_out, | 
 | 1879 | 				     unsigned long *flags) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1880 | { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1881 | 	if (copy_out) | 
 | 1882 | 		sg_copy_from_buffer(scsi_sglist(cmd), scsi_sg_count(cmd), | 
 | 1883 | 				    ata_scsi_rbuf, ATA_SCSI_RBUF_SIZE); | 
 | 1884 | 	spin_unlock_irqrestore(&ata_scsi_rbuf_lock, *flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1885 | } | 
 | 1886 |  | 
 | 1887 | /** | 
 | 1888 |  *	ata_scsi_rbuf_fill - wrapper for SCSI command simulators | 
 | 1889 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 1890 |  *	@actor: Callback hook for desired SCSI command simulator | 
 | 1891 |  * | 
 | 1892 |  *	Takes care of the hard work of simulating a SCSI command... | 
 | 1893 |  *	Mapping the response buffer, calling the command's handler, | 
 | 1894 |  *	and handling the handler's return value.  This return value | 
 | 1895 |  *	indicates whether the handler wishes the SCSI command to be | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1896 |  *	completed successfully (0), or not (in which case cmd->result | 
 | 1897 |  *	and sense buffer are assumed to be set). | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1898 |  * | 
 | 1899 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 1900 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1901 |  */ | 
| Tejun Heo | f0761be | 2008-04-28 17:16:52 +0900 | [diff] [blame] | 1902 | static void ata_scsi_rbuf_fill(struct ata_scsi_args *args, | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1903 | 		unsigned int (*actor)(struct ata_scsi_args *args, u8 *rbuf)) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1904 | { | 
 | 1905 | 	u8 *rbuf; | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1906 | 	unsigned int rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1907 | 	struct scsi_cmnd *cmd = args->cmd; | 
| Jeff Garzik | b445c56 | 2008-02-29 19:10:51 -0500 | [diff] [blame] | 1908 | 	unsigned long flags; | 
 | 1909 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1910 | 	rbuf = ata_scsi_rbuf_get(cmd, false, &flags); | 
 | 1911 | 	rc = actor(args, rbuf); | 
 | 1912 | 	ata_scsi_rbuf_put(cmd, rc == 0, &flags); | 
| Jeff Garzik | b445c56 | 2008-02-29 19:10:51 -0500 | [diff] [blame] | 1913 |  | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1914 | 	if (rc == 0) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1915 | 		cmd->result = SAM_STAT_GOOD; | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 1916 | 	args->done(cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1917 | } | 
 | 1918 |  | 
 | 1919 | /** | 
 | 1920 |  *	ata_scsiop_inq_std - Simulate INQUIRY command | 
 | 1921 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 1922 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1923 |  * | 
 | 1924 |  *	Returns standard device identification data associated | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 1925 |  *	with non-VPD INQUIRY command output. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1926 |  * | 
 | 1927 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 1928 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1929 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1930 | static unsigned int ata_scsiop_inq_std(struct ata_scsi_args *args, u8 *rbuf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1931 | { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1932 | 	const u8 versions[] = { | 
 | 1933 | 		0x60,	/* SAM-3 (no version claimed) */ | 
 | 1934 |  | 
 | 1935 | 		0x03, | 
 | 1936 | 		0x20,	/* SBC-2 (no version claimed) */ | 
 | 1937 |  | 
 | 1938 | 		0x02, | 
 | 1939 | 		0x60	/* SPC-3 (no version claimed) */ | 
 | 1940 | 	}; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1941 | 	u8 hdr[] = { | 
 | 1942 | 		TYPE_DISK, | 
 | 1943 | 		0, | 
 | 1944 | 		0x5,	/* claim SPC-3 version compatibility */ | 
 | 1945 | 		2, | 
 | 1946 | 		95 - 4 | 
 | 1947 | 	}; | 
 | 1948 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1949 | 	VPRINTK("ENTER\n"); | 
 | 1950 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1951 | 	/* set scsi removeable (RMB) bit per ata bit */ | 
 | 1952 | 	if (ata_id_removeable(args->id)) | 
 | 1953 | 		hdr[1] |= (1 << 7); | 
 | 1954 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1955 | 	memcpy(rbuf, hdr, sizeof(hdr)); | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1956 | 	memcpy(&rbuf[8], "ATA     ", 8); | 
 | 1957 | 	ata_id_string(args->id, &rbuf[16], ATA_ID_PROD, 16); | 
 | 1958 | 	ata_id_string(args->id, &rbuf[32], ATA_ID_FW_REV, 4); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1959 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1960 | 	if (rbuf[32] == 0 || rbuf[32] == ' ') | 
 | 1961 | 		memcpy(&rbuf[32], "n/a ", 4); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1962 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1963 | 	memcpy(rbuf + 59, versions, sizeof(versions)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1964 |  | 
 | 1965 | 	return 0; | 
 | 1966 | } | 
 | 1967 |  | 
 | 1968 | /** | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 1969 |  *	ata_scsiop_inq_00 - Simulate INQUIRY VPD page 0, list of pages | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1970 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 1971 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1972 |  * | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 1973 |  *	Returns list of inquiry VPD pages available. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1974 |  * | 
 | 1975 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 1976 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1977 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1978 | static unsigned int ata_scsiop_inq_00(struct ata_scsi_args *args, u8 *rbuf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1979 | { | 
 | 1980 | 	const u8 pages[] = { | 
 | 1981 | 		0x00,	/* page 0x00, this page */ | 
 | 1982 | 		0x80,	/* page 0x80, unit serial no page */ | 
| Matthew Wilcox | 1e9dbc9 | 2008-06-19 13:13:38 -0600 | [diff] [blame] | 1983 | 		0x83,	/* page 0x83, device ident page */ | 
 | 1984 | 		0x89,	/* page 0x89, ata info page */ | 
 | 1985 | 		0xb1,	/* page 0xb1, block device characteristics page */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1986 | 	}; | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1987 |  | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 1988 | 	rbuf[3] = sizeof(pages);	/* number of supported VPD pages */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 1989 | 	memcpy(rbuf + 4, pages, sizeof(pages)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1990 | 	return 0; | 
 | 1991 | } | 
 | 1992 |  | 
 | 1993 | /** | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 1994 |  *	ata_scsiop_inq_80 - Simulate INQUIRY VPD page 80, device serial number | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1995 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 1996 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1997 |  * | 
 | 1998 |  *	Returns ATA device serial number. | 
 | 1999 |  * | 
 | 2000 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 2001 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2002 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2003 | static unsigned int ata_scsiop_inq_80(struct ata_scsi_args *args, u8 *rbuf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2004 | { | 
 | 2005 | 	const u8 hdr[] = { | 
 | 2006 | 		0, | 
 | 2007 | 		0x80,			/* this page code */ | 
 | 2008 | 		0, | 
| Tejun Heo | a0cf733 | 2007-01-02 20:18:49 +0900 | [diff] [blame] | 2009 | 		ATA_ID_SERNO_LEN,	/* page len */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2010 | 	}; | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2011 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2012 | 	memcpy(rbuf, hdr, sizeof(hdr)); | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2013 | 	ata_id_string(args->id, (unsigned char *) &rbuf[4], | 
 | 2014 | 		      ATA_ID_SERNO, ATA_ID_SERNO_LEN); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2015 | 	return 0; | 
 | 2016 | } | 
 | 2017 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2018 | /** | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 2019 |  *	ata_scsiop_inq_83 - Simulate INQUIRY VPD page 83, device identity | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2020 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 2021 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2022 |  * | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 2023 |  *	Yields two logical unit device identification designators: | 
 | 2024 |  *	 - vendor specific ASCII containing the ATA serial number | 
 | 2025 |  *	 - SAT defined "t10 vendor id based" containing ASCII vendor | 
 | 2026 |  *	   name ("ATA     "), model and serial numbers. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2027 |  * | 
 | 2028 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 2029 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2030 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2031 | static unsigned int ata_scsiop_inq_83(struct ata_scsi_args *args, u8 *rbuf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2032 | { | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 2033 | 	const int sat_model_serial_desc_len = 68; | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2034 | 	int num; | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 2035 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2036 | 	rbuf[1] = 0x83;			/* this page code */ | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 2037 | 	num = 4; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2038 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2039 | 	/* piv=0, assoc=lu, code_set=ACSII, designator=vendor */ | 
 | 2040 | 	rbuf[num + 0] = 2; | 
 | 2041 | 	rbuf[num + 3] = ATA_ID_SERNO_LEN; | 
 | 2042 | 	num += 4; | 
 | 2043 | 	ata_id_string(args->id, (unsigned char *) rbuf + num, | 
 | 2044 | 		      ATA_ID_SERNO, ATA_ID_SERNO_LEN); | 
 | 2045 | 	num += ATA_ID_SERNO_LEN; | 
 | 2046 |  | 
 | 2047 | 	/* SAT defined lu model and serial numbers descriptor */ | 
 | 2048 | 	/* piv=0, assoc=lu, code_set=ACSII, designator=t10 vendor id */ | 
 | 2049 | 	rbuf[num + 0] = 2; | 
 | 2050 | 	rbuf[num + 1] = 1; | 
 | 2051 | 	rbuf[num + 3] = sat_model_serial_desc_len; | 
 | 2052 | 	num += 4; | 
 | 2053 | 	memcpy(rbuf + num, "ATA     ", 8); | 
 | 2054 | 	num += 8; | 
 | 2055 | 	ata_id_string(args->id, (unsigned char *) rbuf + num, ATA_ID_PROD, | 
 | 2056 | 		      ATA_ID_PROD_LEN); | 
 | 2057 | 	num += ATA_ID_PROD_LEN; | 
 | 2058 | 	ata_id_string(args->id, (unsigned char *) rbuf + num, ATA_ID_SERNO, | 
 | 2059 | 		      ATA_ID_SERNO_LEN); | 
 | 2060 | 	num += ATA_ID_SERNO_LEN; | 
 | 2061 |  | 
| Jeff Garzik | b142eb6 | 2006-03-21 20:37:47 -0500 | [diff] [blame] | 2062 | 	rbuf[3] = num - 4;    /* page len (assume less than 256 bytes) */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2063 | 	return 0; | 
 | 2064 | } | 
 | 2065 |  | 
 | 2066 | /** | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2067 |  *	ata_scsiop_inq_89 - Simulate INQUIRY VPD page 89, ATA info | 
 | 2068 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 2069 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2070 |  * | 
 | 2071 |  *	Yields SAT-specified ATA VPD page. | 
 | 2072 |  * | 
 | 2073 |  *	LOCKING: | 
 | 2074 |  *	spin_lock_irqsave(host lock) | 
 | 2075 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2076 | static unsigned int ata_scsiop_inq_89(struct ata_scsi_args *args, u8 *rbuf) | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2077 | { | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2078 | 	struct ata_taskfile tf; | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2079 |  | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2080 | 	memset(&tf, 0, sizeof(tf)); | 
 | 2081 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2082 | 	rbuf[1] = 0x89;			/* our page code */ | 
 | 2083 | 	rbuf[2] = (0x238 >> 8);		/* page size fixed at 238h */ | 
 | 2084 | 	rbuf[3] = (0x238 & 0xff); | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2085 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2086 | 	memcpy(&rbuf[8], "linux   ", 8); | 
 | 2087 | 	memcpy(&rbuf[16], "libata          ", 16); | 
 | 2088 | 	memcpy(&rbuf[32], DRV_VERSION, 4); | 
 | 2089 | 	ata_id_string(args->id, &rbuf[32], ATA_ID_FW_REV, 4); | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2090 |  | 
 | 2091 | 	/* we don't store the ATA device signature, so we fake it */ | 
 | 2092 |  | 
 | 2093 | 	tf.command = ATA_DRDY;		/* really, this is Status reg */ | 
 | 2094 | 	tf.lbal = 0x1; | 
 | 2095 | 	tf.nsect = 0x1; | 
 | 2096 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2097 | 	ata_tf_to_fis(&tf, 0, 1, &rbuf[36]);	/* TODO: PMP? */ | 
 | 2098 | 	rbuf[36] = 0x34;		/* force D2H Reg FIS (34h) */ | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2099 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2100 | 	rbuf[56] = ATA_CMD_ID_ATA; | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2101 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2102 | 	memcpy(&rbuf[60], &args->id[0], 512); | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2103 | 	return 0; | 
 | 2104 | } | 
 | 2105 |  | 
| Matthew Wilcox | 1e9dbc9 | 2008-06-19 13:13:38 -0600 | [diff] [blame] | 2106 | static unsigned int ata_scsiop_inq_b1(struct ata_scsi_args *args, u8 *rbuf) | 
 | 2107 | { | 
 | 2108 | 	rbuf[1] = 0xb1; | 
 | 2109 | 	rbuf[3] = 0x3c; | 
 | 2110 | 	if (ata_id_major_version(args->id) > 7) { | 
 | 2111 | 		rbuf[4] = args->id[217] >> 8; | 
 | 2112 | 		rbuf[5] = args->id[217]; | 
 | 2113 | 		rbuf[7] = args->id[168] & 0xf; | 
 | 2114 | 	} | 
 | 2115 |  | 
 | 2116 | 	return 0; | 
 | 2117 | } | 
 | 2118 |  | 
| Jeff Garzik | ad355b4 | 2007-09-21 20:38:03 -0400 | [diff] [blame] | 2119 | /** | 
| Jeff Garzik | 0cba632 | 2005-05-30 19:49:12 -0400 | [diff] [blame] | 2120 |  *	ata_scsiop_noop - Command handler that simply returns success. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2121 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 2122 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2123 |  * | 
 | 2124 |  *	No operation.  Simply returns success to caller, to indicate | 
 | 2125 |  *	that the caller should successfully complete this SCSI command. | 
 | 2126 |  * | 
 | 2127 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 2128 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2129 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2130 | static unsigned int ata_scsiop_noop(struct ata_scsi_args *args, u8 *rbuf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2131 | { | 
 | 2132 | 	VPRINTK("ENTER\n"); | 
 | 2133 | 	return 0; | 
 | 2134 | } | 
 | 2135 |  | 
 | 2136 | /** | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2137 |  *	ata_msense_caching - Simulate MODE SENSE caching info page | 
 | 2138 |  *	@id: device IDENTIFY data | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2139 |  *	@buf: output buffer | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2140 |  * | 
 | 2141 |  *	Generate a caching info page, which conditionally indicates | 
 | 2142 |  *	write caching to the SCSI layer, depending on device | 
 | 2143 |  *	capabilities. | 
 | 2144 |  * | 
 | 2145 |  *	LOCKING: | 
 | 2146 |  *	None. | 
 | 2147 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2148 | static unsigned int ata_msense_caching(u16 *id, u8 *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2149 | { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2150 | 	memcpy(buf, def_cache_mpage, sizeof(def_cache_mpage)); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2151 | 	if (ata_id_wcache_enabled(id)) | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2152 | 		buf[2] |= (1 << 2);	/* write cache enable */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2153 | 	if (!ata_id_rahead_enabled(id)) | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2154 | 		buf[12] |= (1 << 5);	/* disable read ahead */ | 
 | 2155 | 	return sizeof(def_cache_mpage); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2156 | } | 
 | 2157 |  | 
 | 2158 | /** | 
 | 2159 |  *	ata_msense_ctl_mode - Simulate MODE SENSE control mode page | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2160 |  *	@buf: output buffer | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2161 |  * | 
 | 2162 |  *	Generate a generic MODE SENSE control mode page. | 
 | 2163 |  * | 
 | 2164 |  *	LOCKING: | 
 | 2165 |  *	None. | 
 | 2166 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2167 | static unsigned int ata_msense_ctl_mode(u8 *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2168 | { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2169 | 	memcpy(buf, def_control_mpage, sizeof(def_control_mpage)); | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2170 | 	return sizeof(def_control_mpage); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2171 | } | 
 | 2172 |  | 
 | 2173 | /** | 
 | 2174 |  *	ata_msense_rw_recovery - Simulate MODE SENSE r/w error recovery page | 
| Randy Dunlap | ec2a20e | 2008-04-30 12:57:00 -0700 | [diff] [blame] | 2175 |  *	@buf: output buffer | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2176 |  * | 
 | 2177 |  *	Generate a generic MODE SENSE r/w error recovery page. | 
 | 2178 |  * | 
 | 2179 |  *	LOCKING: | 
 | 2180 |  *	None. | 
 | 2181 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2182 | static unsigned int ata_msense_rw_recovery(u8 *buf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2183 | { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2184 | 	memcpy(buf, def_rw_recovery_mpage, sizeof(def_rw_recovery_mpage)); | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2185 | 	return sizeof(def_rw_recovery_mpage); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2186 | } | 
 | 2187 |  | 
| Jens Axboe | 48bdc8e | 2006-01-30 16:09:35 +0100 | [diff] [blame] | 2188 | /* | 
 | 2189 |  * We can turn this into a real blacklist if it's needed, for now just | 
 | 2190 |  * blacklist any Maxtor BANC1G10 revision firmware | 
 | 2191 |  */ | 
 | 2192 | static int ata_dev_supports_fua(u16 *id) | 
 | 2193 | { | 
| Tejun Heo | a0cf733 | 2007-01-02 20:18:49 +0900 | [diff] [blame] | 2194 | 	unsigned char model[ATA_ID_PROD_LEN + 1], fw[ATA_ID_FW_REV_LEN + 1]; | 
| Jens Axboe | 48bdc8e | 2006-01-30 16:09:35 +0100 | [diff] [blame] | 2195 |  | 
| Jeff Garzik | c3c013a | 2006-02-27 22:31:19 -0500 | [diff] [blame] | 2196 | 	if (!libata_fua) | 
 | 2197 | 		return 0; | 
| Jens Axboe | 48bdc8e | 2006-01-30 16:09:35 +0100 | [diff] [blame] | 2198 | 	if (!ata_id_has_fua(id)) | 
 | 2199 | 		return 0; | 
 | 2200 |  | 
| Tejun Heo | a0cf733 | 2007-01-02 20:18:49 +0900 | [diff] [blame] | 2201 | 	ata_id_c_string(id, model, ATA_ID_PROD, sizeof(model)); | 
 | 2202 | 	ata_id_c_string(id, fw, ATA_ID_FW_REV, sizeof(fw)); | 
| Jens Axboe | 48bdc8e | 2006-01-30 16:09:35 +0100 | [diff] [blame] | 2203 |  | 
| Tejun Heo | 2e02671 | 2006-02-12 22:47:04 +0900 | [diff] [blame] | 2204 | 	if (strcmp(model, "Maxtor")) | 
| Jens Axboe | 48bdc8e | 2006-01-30 16:09:35 +0100 | [diff] [blame] | 2205 | 		return 1; | 
| Tejun Heo | 2e02671 | 2006-02-12 22:47:04 +0900 | [diff] [blame] | 2206 | 	if (strcmp(fw, "BANC1G10")) | 
| Jens Axboe | 48bdc8e | 2006-01-30 16:09:35 +0100 | [diff] [blame] | 2207 | 		return 1; | 
 | 2208 |  | 
 | 2209 | 	return 0; /* blacklisted */ | 
 | 2210 | } | 
 | 2211 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2212 | /** | 
 | 2213 |  *	ata_scsiop_mode_sense - Simulate MODE SENSE 6, 10 commands | 
 | 2214 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 2215 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2216 |  * | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2217 |  *	Simulate MODE SENSE commands. Assume this is invoked for direct | 
 | 2218 |  *	access devices (e.g. disks) only. There should be no block | 
 | 2219 |  *	descriptor for other device types. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2220 |  * | 
 | 2221 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 2222 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2223 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2224 | static unsigned int ata_scsiop_mode_sense(struct ata_scsi_args *args, u8 *rbuf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2225 | { | 
| Tejun Heo | 9a3dccc | 2006-01-06 09:56:18 +0100 | [diff] [blame] | 2226 | 	struct ata_device *dev = args->dev; | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2227 | 	u8 *scsicmd = args->cmd->cmnd, *p = rbuf; | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2228 | 	const u8 sat_blk_desc[] = { | 
 | 2229 | 		0, 0, 0, 0,	/* number of blocks: sat unspecified */ | 
 | 2230 | 		0, | 
 | 2231 | 		0, 0x2, 0x0	/* block length: 512 bytes */ | 
 | 2232 | 	}; | 
 | 2233 | 	u8 pg, spg; | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2234 | 	unsigned int ebd, page_control, six_byte; | 
| Tejun Heo | 9a3dccc | 2006-01-06 09:56:18 +0100 | [diff] [blame] | 2235 | 	u8 dpofua; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2236 |  | 
 | 2237 | 	VPRINTK("ENTER\n"); | 
 | 2238 |  | 
 | 2239 | 	six_byte = (scsicmd[0] == MODE_SENSE); | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2240 | 	ebd = !(scsicmd[1] & 0x8);      /* dbd bit inverted == edb */ | 
 | 2241 | 	/* | 
 | 2242 | 	 * LLBA bit in msense(10) ignored (compliant) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2243 | 	 */ | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2244 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2245 | 	page_control = scsicmd[2] >> 6; | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 2246 | 	switch (page_control) { | 
 | 2247 | 	case 0: /* current */ | 
 | 2248 | 		break;  /* supported */ | 
 | 2249 | 	case 3: /* saved */ | 
 | 2250 | 		goto saving_not_supp; | 
 | 2251 | 	case 1: /* changeable */ | 
 | 2252 | 	case 2: /* defaults */ | 
 | 2253 | 	default: | 
 | 2254 | 		goto invalid_fld; | 
 | 2255 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2256 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2257 | 	if (six_byte) | 
 | 2258 | 		p += 4 + (ebd ? 8 : 0); | 
 | 2259 | 	else | 
 | 2260 | 		p += 8 + (ebd ? 8 : 0); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2261 |  | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2262 | 	pg = scsicmd[2] & 0x3f; | 
 | 2263 | 	spg = scsicmd[3]; | 
 | 2264 | 	/* | 
 | 2265 | 	 * No mode subpages supported (yet) but asking for _all_ | 
 | 2266 | 	 * subpages may be valid | 
 | 2267 | 	 */ | 
 | 2268 | 	if (spg && (spg != ALL_SUB_MPAGES)) | 
 | 2269 | 		goto invalid_fld; | 
 | 2270 |  | 
 | 2271 | 	switch(pg) { | 
 | 2272 | 	case RW_RECOVERY_MPAGE: | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2273 | 		p += ata_msense_rw_recovery(p); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2274 | 		break; | 
 | 2275 |  | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2276 | 	case CACHE_MPAGE: | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2277 | 		p += ata_msense_caching(args->id, p); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2278 | 		break; | 
 | 2279 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2280 | 	case CONTROL_MPAGE: | 
 | 2281 | 		p += ata_msense_ctl_mode(p); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2282 | 		break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2283 |  | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2284 | 	case ALL_MPAGES: | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2285 | 		p += ata_msense_rw_recovery(p); | 
 | 2286 | 		p += ata_msense_caching(args->id, p); | 
 | 2287 | 		p += ata_msense_ctl_mode(p); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2288 | 		break; | 
 | 2289 |  | 
 | 2290 | 	default:		/* invalid page code */ | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 2291 | 		goto invalid_fld; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2292 | 	} | 
 | 2293 |  | 
| Tejun Heo | 9a3dccc | 2006-01-06 09:56:18 +0100 | [diff] [blame] | 2294 | 	dpofua = 0; | 
| Alan Cox | f79d409 | 2006-05-22 16:55:11 +0100 | [diff] [blame] | 2295 | 	if (ata_dev_supports_fua(args->id) && (dev->flags & ATA_DFLAG_LBA48) && | 
| Tejun Heo | 9a3dccc | 2006-01-06 09:56:18 +0100 | [diff] [blame] | 2296 | 	    (!(dev->flags & ATA_DFLAG_PIO) || dev->multi_count)) | 
 | 2297 | 		dpofua = 1 << 4; | 
 | 2298 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2299 | 	if (six_byte) { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2300 | 		rbuf[0] = p - rbuf - 1; | 
 | 2301 | 		rbuf[2] |= dpofua; | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2302 | 		if (ebd) { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2303 | 			rbuf[3] = sizeof(sat_blk_desc); | 
 | 2304 | 			memcpy(rbuf + 4, sat_blk_desc, sizeof(sat_blk_desc)); | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2305 | 		} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2306 | 	} else { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2307 | 		unsigned int output_len = p - rbuf - 2; | 
 | 2308 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2309 | 		rbuf[0] = output_len >> 8; | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2310 | 		rbuf[1] = output_len; | 
 | 2311 | 		rbuf[3] |= dpofua; | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2312 | 		if (ebd) { | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2313 | 			rbuf[7] = sizeof(sat_blk_desc); | 
 | 2314 | 			memcpy(rbuf + 8, sat_blk_desc, sizeof(sat_blk_desc)); | 
| Douglas Gilbert | 00ac37f | 2005-10-28 15:58:28 -0400 | [diff] [blame] | 2315 | 		} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2316 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2317 | 	return 0; | 
| Douglas Gilbert | ae00651 | 2005-10-09 09:09:35 -0400 | [diff] [blame] | 2318 |  | 
 | 2319 | invalid_fld: | 
 | 2320 | 	ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x24, 0x0); | 
 | 2321 | 	/* "Invalid field in cbd" */ | 
 | 2322 | 	return 1; | 
 | 2323 |  | 
 | 2324 | saving_not_supp: | 
 | 2325 | 	ata_scsi_set_sense(args->cmd, ILLEGAL_REQUEST, 0x39, 0x0); | 
 | 2326 | 	 /* "Saving parameters not supported" */ | 
 | 2327 | 	return 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2328 | } | 
 | 2329 |  | 
 | 2330 | /** | 
 | 2331 |  *	ata_scsiop_read_cap - Simulate READ CAPACITY[ 16] commands | 
 | 2332 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 2333 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2334 |  * | 
 | 2335 |  *	Simulate READ CAPACITY commands. | 
 | 2336 |  * | 
 | 2337 |  *	LOCKING: | 
| Tejun Heo | 6a36261 | 2006-11-20 11:15:47 +0900 | [diff] [blame] | 2338 |  *	None. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2339 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2340 | static unsigned int ata_scsiop_read_cap(struct ata_scsi_args *args, u8 *rbuf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2341 | { | 
| Tejun Heo | 6a36261 | 2006-11-20 11:15:47 +0900 | [diff] [blame] | 2342 | 	u64 last_lba = args->dev->n_sectors - 1; /* LBA of the last block */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2343 |  | 
 | 2344 | 	VPRINTK("ENTER\n"); | 
 | 2345 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2346 | 	if (args->cmd->cmnd[0] == READ_CAPACITY) { | 
| Tejun Heo | 6a36261 | 2006-11-20 11:15:47 +0900 | [diff] [blame] | 2347 | 		if (last_lba >= 0xffffffffULL) | 
 | 2348 | 			last_lba = 0xffffffff; | 
| Philip Pokorny | 0c144d0 | 2005-05-28 01:24:47 -0700 | [diff] [blame] | 2349 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2350 | 		/* sector count, 32-bit */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2351 | 		rbuf[0] = last_lba >> (8 * 3); | 
 | 2352 | 		rbuf[1] = last_lba >> (8 * 2); | 
 | 2353 | 		rbuf[2] = last_lba >> (8 * 1); | 
 | 2354 | 		rbuf[3] = last_lba; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2355 |  | 
 | 2356 | 		/* sector size */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2357 | 		rbuf[6] = ATA_SECT_SIZE >> 8; | 
 | 2358 | 		rbuf[7] = ATA_SECT_SIZE & 0xff; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2359 | 	} else { | 
 | 2360 | 		/* sector count, 64-bit */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2361 | 		rbuf[0] = last_lba >> (8 * 7); | 
 | 2362 | 		rbuf[1] = last_lba >> (8 * 6); | 
 | 2363 | 		rbuf[2] = last_lba >> (8 * 5); | 
 | 2364 | 		rbuf[3] = last_lba >> (8 * 4); | 
 | 2365 | 		rbuf[4] = last_lba >> (8 * 3); | 
 | 2366 | 		rbuf[5] = last_lba >> (8 * 2); | 
 | 2367 | 		rbuf[6] = last_lba >> (8 * 1); | 
 | 2368 | 		rbuf[7] = last_lba; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2369 |  | 
 | 2370 | 		/* sector size */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2371 | 		rbuf[10] = ATA_SECT_SIZE >> 8; | 
 | 2372 | 		rbuf[11] = ATA_SECT_SIZE & 0xff; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2373 | 	} | 
 | 2374 |  | 
 | 2375 | 	return 0; | 
 | 2376 | } | 
 | 2377 |  | 
 | 2378 | /** | 
 | 2379 |  *	ata_scsiop_report_luns - Simulate REPORT LUNS command | 
 | 2380 |  *	@args: device IDENTIFY data / SCSI command of interest. | 
 | 2381 |  *	@rbuf: Response buffer, to which simulated SCSI cmd output is sent. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2382 |  * | 
 | 2383 |  *	Simulate REPORT LUNS command. | 
 | 2384 |  * | 
 | 2385 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 2386 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2387 |  */ | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2388 | static unsigned int ata_scsiop_report_luns(struct ata_scsi_args *args, u8 *rbuf) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2389 | { | 
 | 2390 | 	VPRINTK("ENTER\n"); | 
 | 2391 | 	rbuf[3] = 8;	/* just one lun, LUN 0, size 8 bytes */ | 
 | 2392 |  | 
 | 2393 | 	return 0; | 
 | 2394 | } | 
 | 2395 |  | 
| Tejun Heo | 77853bf | 2006-01-23 13:09:36 +0900 | [diff] [blame] | 2396 | static void atapi_sense_complete(struct ata_queued_cmd *qc) | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2397 | { | 
| Tejun Heo | 74e6c8c | 2006-04-02 18:51:53 +0900 | [diff] [blame] | 2398 | 	if (qc->err_mask && ((qc->err_mask & AC_ERR_DEV) == 0)) { | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2399 | 		/* FIXME: not quite right; we don't want the | 
 | 2400 | 		 * translation of taskfile registers into | 
 | 2401 | 		 * a sense descriptors, since that's only | 
 | 2402 | 		 * correct for ATA, not ATAPI | 
 | 2403 | 		 */ | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 2404 | 		ata_gen_passthru_sense(qc); | 
| Tejun Heo | 74e6c8c | 2006-04-02 18:51:53 +0900 | [diff] [blame] | 2405 | 	} | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2406 |  | 
 | 2407 | 	qc->scsidone(qc->scsicmd); | 
| Tejun Heo | 77853bf | 2006-01-23 13:09:36 +0900 | [diff] [blame] | 2408 | 	ata_qc_free(qc); | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2409 | } | 
 | 2410 |  | 
 | 2411 | /* is it pointless to prefer PIO for "safety reasons"? */ | 
 | 2412 | static inline int ata_pio_use_silly(struct ata_port *ap) | 
 | 2413 | { | 
 | 2414 | 	return (ap->flags & ATA_FLAG_PIO_DMA); | 
 | 2415 | } | 
 | 2416 |  | 
 | 2417 | static void atapi_request_sense(struct ata_queued_cmd *qc) | 
 | 2418 | { | 
 | 2419 | 	struct ata_port *ap = qc->ap; | 
 | 2420 | 	struct scsi_cmnd *cmd = qc->scsicmd; | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2421 |  | 
 | 2422 | 	DPRINTK("ATAPI request sense\n"); | 
 | 2423 |  | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2424 | 	/* FIXME: is this needed? */ | 
| James Bottomley | 7ccd720 | 2008-01-17 11:56:24 -0600 | [diff] [blame] | 2425 | 	memset(cmd->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE); | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2426 |  | 
| Tejun Heo | 127102a | 2008-04-07 22:47:21 +0900 | [diff] [blame] | 2427 | #ifdef CONFIG_ATA_SFF | 
| James Bottomley | 855d854 | 2008-04-18 13:18:48 -0500 | [diff] [blame] | 2428 | 	if (ap->ops->sff_tf_read) | 
 | 2429 | 		ap->ops->sff_tf_read(ap, &qc->tf); | 
| Tejun Heo | 127102a | 2008-04-07 22:47:21 +0900 | [diff] [blame] | 2430 | #endif | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2431 |  | 
 | 2432 | 	/* fill these in, for the case where they are -not- overwritten */ | 
 | 2433 | 	cmd->sense_buffer[0] = 0x70; | 
 | 2434 | 	cmd->sense_buffer[2] = qc->tf.feature >> 4; | 
 | 2435 |  | 
 | 2436 | 	ata_qc_reinit(qc); | 
 | 2437 |  | 
| Tejun Heo | 93f8fec | 2007-12-05 16:43:01 +0900 | [diff] [blame] | 2438 | 	/* setup sg table and init transfer direction */ | 
| akpm@linux-foundation.org | cadb734 | 2008-01-15 16:01:52 -0800 | [diff] [blame] | 2439 | 	sg_init_one(&qc->sgent, cmd->sense_buffer, SCSI_SENSE_BUFFERSIZE); | 
| Tejun Heo | 93f8fec | 2007-12-05 16:43:01 +0900 | [diff] [blame] | 2440 | 	ata_sg_init(qc, &qc->sgent, 1); | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2441 | 	qc->dma_dir = DMA_FROM_DEVICE; | 
 | 2442 |  | 
| Tejun Heo | 6e7846e | 2006-02-12 23:32:58 +0900 | [diff] [blame] | 2443 | 	memset(&qc->cdb, 0, qc->dev->cdb_len); | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2444 | 	qc->cdb[0] = REQUEST_SENSE; | 
 | 2445 | 	qc->cdb[4] = SCSI_SENSE_BUFFERSIZE; | 
 | 2446 |  | 
 | 2447 | 	qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; | 
 | 2448 | 	qc->tf.command = ATA_CMD_PACKET; | 
 | 2449 |  | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2450 | 	if (ata_pio_use_silly(ap)) { | 
| Tejun Heo | 0dc3688 | 2007-12-18 16:34:43 -0500 | [diff] [blame] | 2451 | 		qc->tf.protocol = ATAPI_PROT_DMA; | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2452 | 		qc->tf.feature |= ATAPI_PKT_DMA; | 
 | 2453 | 	} else { | 
| Tejun Heo | 0dc3688 | 2007-12-18 16:34:43 -0500 | [diff] [blame] | 2454 | 		qc->tf.protocol = ATAPI_PROT_PIO; | 
| Alan Cox | 2db78dd | 2007-10-02 13:53:04 -0700 | [diff] [blame] | 2455 | 		qc->tf.lbam = SCSI_SENSE_BUFFERSIZE; | 
 | 2456 | 		qc->tf.lbah = 0; | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2457 | 	} | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2458 | 	qc->nbytes = SCSI_SENSE_BUFFERSIZE; | 
 | 2459 |  | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2460 | 	qc->complete_fn = atapi_sense_complete; | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2461 |  | 
| Tejun Heo | 8e0e694 | 2006-03-31 20:41:11 +0900 | [diff] [blame] | 2462 | 	ata_qc_issue(qc); | 
| Jeff Garzik | a939c96 | 2005-10-05 17:09:16 -0400 | [diff] [blame] | 2463 |  | 
 | 2464 | 	DPRINTK("EXIT\n"); | 
 | 2465 | } | 
 | 2466 |  | 
| Tejun Heo | 77853bf | 2006-01-23 13:09:36 +0900 | [diff] [blame] | 2467 | static void atapi_qc_complete(struct ata_queued_cmd *qc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2468 | { | 
 | 2469 | 	struct scsi_cmnd *cmd = qc->scsicmd; | 
| Albert Lee | a22e2eb | 2005-12-05 15:38:02 +0800 | [diff] [blame] | 2470 | 	unsigned int err_mask = qc->err_mask; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2471 |  | 
| Jeff Garzik | a7dac44 | 2005-10-30 04:44:42 -0500 | [diff] [blame] | 2472 | 	VPRINTK("ENTER, err_mask 0x%X\n", err_mask); | 
| Jeff Garzik | e12669e | 2005-10-05 18:39:23 -0400 | [diff] [blame] | 2473 |  | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 2474 | 	/* handle completion from new EH */ | 
 | 2475 | 	if (unlikely(qc->ap->ops->error_handler && | 
 | 2476 | 		     (err_mask || qc->flags & ATA_QCFLAG_SENSE_VALID))) { | 
 | 2477 |  | 
 | 2478 | 		if (!(qc->flags & ATA_QCFLAG_SENSE_VALID)) { | 
 | 2479 | 			/* FIXME: not quite right; we don't want the | 
 | 2480 | 			 * translation of taskfile registers into a | 
 | 2481 | 			 * sense descriptors, since that's only | 
 | 2482 | 			 * correct for ATA, not ATAPI | 
 | 2483 | 			 */ | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 2484 | 			ata_gen_passthru_sense(qc); | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 2485 | 		} | 
 | 2486 |  | 
| Tejun Heo | 22aac08 | 2006-08-08 14:08:59 +0900 | [diff] [blame] | 2487 | 		/* SCSI EH automatically locks door if sdev->locked is | 
 | 2488 | 		 * set.  Sometimes door lock request continues to | 
 | 2489 | 		 * fail, for example, when no media is present.  This | 
 | 2490 | 		 * creates a loop - SCSI EH issues door lock which | 
 | 2491 | 		 * fails and gets invoked again to acquire sense data | 
 | 2492 | 		 * for the failed command. | 
 | 2493 | 		 * | 
 | 2494 | 		 * If door lock fails, always clear sdev->locked to | 
 | 2495 | 		 * avoid this infinite loop. | 
 | 2496 | 		 */ | 
 | 2497 | 		if (qc->cdb[0] == ALLOW_MEDIUM_REMOVAL) | 
 | 2498 | 			qc->dev->sdev->locked = 0; | 
 | 2499 |  | 
| Tejun Heo | 246619d | 2006-05-15 20:58:16 +0900 | [diff] [blame] | 2500 | 		qc->scsicmd->result = SAM_STAT_CHECK_CONDITION; | 
 | 2501 | 		qc->scsidone(cmd); | 
 | 2502 | 		ata_qc_free(qc); | 
 | 2503 | 		return; | 
 | 2504 | 	} | 
 | 2505 |  | 
 | 2506 | 	/* successful completion or old EH failure path */ | 
| Jeff Garzik | a7dac44 | 2005-10-30 04:44:42 -0500 | [diff] [blame] | 2507 | 	if (unlikely(err_mask & AC_ERR_DEV)) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2508 | 		cmd->result = SAM_STAT_CHECK_CONDITION; | 
| Jeff Garzik | c6e6e66 | 2005-11-14 14:50:05 -0500 | [diff] [blame] | 2509 | 		atapi_request_sense(qc); | 
| Tejun Heo | 77853bf | 2006-01-23 13:09:36 +0900 | [diff] [blame] | 2510 | 		return; | 
| Tejun Heo | 74e6c8c | 2006-04-02 18:51:53 +0900 | [diff] [blame] | 2511 | 	} else if (unlikely(err_mask)) { | 
| Jeff Garzik | a7dac44 | 2005-10-30 04:44:42 -0500 | [diff] [blame] | 2512 | 		/* FIXME: not quite right; we don't want the | 
 | 2513 | 		 * translation of taskfile registers into | 
 | 2514 | 		 * a sense descriptors, since that's only | 
 | 2515 | 		 * correct for ATA, not ATAPI | 
 | 2516 | 		 */ | 
| Tejun Heo | 750426a | 2006-11-14 22:37:35 +0900 | [diff] [blame] | 2517 | 		ata_gen_passthru_sense(qc); | 
| Tejun Heo | 74e6c8c | 2006-04-02 18:51:53 +0900 | [diff] [blame] | 2518 | 	} else { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2519 | 		u8 *scsicmd = cmd->cmnd; | 
 | 2520 |  | 
| Tony Battersby | fd71da4 | 2005-12-21 16:35:44 -0500 | [diff] [blame] | 2521 | 		if ((scsicmd[0] == INQUIRY) && ((scsicmd[1] & 0x03) == 0)) { | 
| Jeff Garzik | b445c56 | 2008-02-29 19:10:51 -0500 | [diff] [blame] | 2522 | 			unsigned long flags; | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2523 | 			u8 *buf; | 
| Jeff Garzik | b445c56 | 2008-02-29 19:10:51 -0500 | [diff] [blame] | 2524 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2525 | 			buf = ata_scsi_rbuf_get(cmd, true, &flags); | 
| Jeff Garzik | a15dbeb | 2005-10-05 15:02:14 -0400 | [diff] [blame] | 2526 |  | 
 | 2527 | 	/* ATAPI devices typically report zero for their SCSI version, | 
 | 2528 | 	 * and sometimes deviate from the spec WRT response data | 
 | 2529 | 	 * format.  If SCSI version is reported as zero like normal, | 
 | 2530 | 	 * then we make the following fixups:  1) Fake MMC-5 version, | 
 | 2531 | 	 * to indicate to the Linux scsi midlayer this is a modern | 
 | 2532 | 	 * device.  2) Ensure response data format / ATAPI information | 
 | 2533 | 	 * are always correct. | 
 | 2534 | 	 */ | 
| Jeff Garzik | a15dbeb | 2005-10-05 15:02:14 -0400 | [diff] [blame] | 2535 | 			if (buf[2] == 0) { | 
 | 2536 | 				buf[2] = 0x5; | 
 | 2537 | 				buf[3] = 0x32; | 
 | 2538 | 			} | 
 | 2539 |  | 
| Tejun Heo | 87340e9 | 2008-04-28 17:48:51 +0900 | [diff] [blame] | 2540 | 			ata_scsi_rbuf_put(cmd, true, &flags); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2541 | 		} | 
| Jeff Garzik | a15dbeb | 2005-10-05 15:02:14 -0400 | [diff] [blame] | 2542 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2543 | 		cmd->result = SAM_STAT_GOOD; | 
 | 2544 | 	} | 
 | 2545 |  | 
 | 2546 | 	qc->scsidone(cmd); | 
| Tejun Heo | 77853bf | 2006-01-23 13:09:36 +0900 | [diff] [blame] | 2547 | 	ata_qc_free(qc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2548 | } | 
 | 2549 | /** | 
 | 2550 |  *	atapi_xlat - Initialize PACKET taskfile | 
 | 2551 |  *	@qc: command structure to be initialized | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2552 |  * | 
 | 2553 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 2554 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2555 |  * | 
 | 2556 |  *	RETURNS: | 
 | 2557 |  *	Zero on success, non-zero on failure. | 
 | 2558 |  */ | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 2559 | static unsigned int atapi_xlat(struct ata_queued_cmd *qc) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2560 | { | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2561 | 	struct scsi_cmnd *scmd = qc->scsicmd; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2562 | 	struct ata_device *dev = qc->dev; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2563 | 	int nodata = (scmd->sc_data_direction == DMA_NONE); | 
| Tejun Heo | 5895ef9 | 2008-06-17 12:36:26 +0900 | [diff] [blame] | 2564 | 	int using_pio = !nodata && (dev->flags & ATA_DFLAG_PIO); | 
| Alan Cox | 2db78dd | 2007-10-02 13:53:04 -0700 | [diff] [blame] | 2565 | 	unsigned int nbytes; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2566 |  | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 2567 | 	memset(qc->cdb, 0, dev->cdb_len); | 
 | 2568 | 	memcpy(qc->cdb, scmd->cmnd, scmd->cmd_len); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2569 |  | 
 | 2570 | 	qc->complete_fn = atapi_qc_complete; | 
 | 2571 |  | 
 | 2572 | 	qc->tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2573 | 	if (scmd->sc_data_direction == DMA_TO_DEVICE) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2574 | 		qc->tf.flags |= ATA_TFLAG_WRITE; | 
 | 2575 | 		DPRINTK("direction: write\n"); | 
 | 2576 | 	} | 
 | 2577 |  | 
 | 2578 | 	qc->tf.command = ATA_CMD_PACKET; | 
| Tejun Heo | aacda37 | 2008-03-18 17:47:43 +0900 | [diff] [blame] | 2579 | 	ata_qc_set_pc_nbytes(qc); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2580 |  | 
| Tejun Heo | e00f1ff | 2007-06-27 02:47:35 +0900 | [diff] [blame] | 2581 | 	/* check whether ATAPI DMA is safe */ | 
| Tejun Heo | 5895ef9 | 2008-06-17 12:36:26 +0900 | [diff] [blame] | 2582 | 	if (!nodata && !using_pio && atapi_check_dma(qc)) | 
| Tejun Heo | e00f1ff | 2007-06-27 02:47:35 +0900 | [diff] [blame] | 2583 | 		using_pio = 1; | 
 | 2584 |  | 
| Tejun Heo | e190222 | 2007-11-26 20:58:02 +0900 | [diff] [blame] | 2585 | 	/* Some controller variants snoop this value for Packet | 
 | 2586 | 	 * transfers to do state machine and FIFO management.  Thus we | 
 | 2587 | 	 * want to set it properly, and for DMA where it is | 
 | 2588 | 	 * effectively meaningless. | 
 | 2589 | 	 */ | 
| Tejun Heo | aacda37 | 2008-03-18 17:47:43 +0900 | [diff] [blame] | 2590 | 	nbytes = min(ata_qc_raw_nbytes(qc), (unsigned int)63 * 1024); | 
| Alan Cox | 2db78dd | 2007-10-02 13:53:04 -0700 | [diff] [blame] | 2591 |  | 
| Tejun Heo | e190222 | 2007-11-26 20:58:02 +0900 | [diff] [blame] | 2592 | 	/* Most ATAPI devices which honor transfer chunk size don't | 
 | 2593 | 	 * behave according to the spec when odd chunk size which | 
 | 2594 | 	 * matches the transfer length is specified.  If the number of | 
 | 2595 | 	 * bytes to transfer is 2n+1.  According to the spec, what | 
 | 2596 | 	 * should happen is to indicate that 2n+1 is going to be | 
 | 2597 | 	 * transferred and transfer 2n+2 bytes where the last byte is | 
 | 2598 | 	 * padding. | 
 | 2599 | 	 * | 
 | 2600 | 	 * In practice, this doesn't happen.  ATAPI devices first | 
 | 2601 | 	 * indicate and transfer 2n bytes and then indicate and | 
 | 2602 | 	 * transfer 2 bytes where the last byte is padding. | 
 | 2603 | 	 * | 
 | 2604 | 	 * This inconsistency confuses several controllers which | 
 | 2605 | 	 * perform PIO using DMA such as Intel AHCIs and sil3124/32. | 
 | 2606 | 	 * These controllers use actual number of transferred bytes to | 
 | 2607 | 	 * update DMA poitner and transfer of 4n+2 bytes make those | 
 | 2608 | 	 * controller push DMA pointer by 4n+4 bytes because SATA data | 
 | 2609 | 	 * FISes are aligned to 4 bytes.  This causes data corruption | 
 | 2610 | 	 * and buffer overrun. | 
 | 2611 | 	 * | 
 | 2612 | 	 * Always setting nbytes to even number solves this problem | 
 | 2613 | 	 * because then ATAPI devices don't have to split data at 2n | 
 | 2614 | 	 * boundaries. | 
 | 2615 | 	 */ | 
 | 2616 | 	if (nbytes & 0x1) | 
 | 2617 | 		nbytes++; | 
 | 2618 |  | 
| Alan Cox | 2db78dd | 2007-10-02 13:53:04 -0700 | [diff] [blame] | 2619 | 	qc->tf.lbam = (nbytes & 0xFF); | 
 | 2620 | 	qc->tf.lbah = (nbytes >> 8); | 
 | 2621 |  | 
| Tejun Heo | 5895ef9 | 2008-06-17 12:36:26 +0900 | [diff] [blame] | 2622 | 	if (nodata) | 
 | 2623 | 		qc->tf.protocol = ATAPI_PROT_NODATA; | 
 | 2624 | 	else if (using_pio) | 
 | 2625 | 		qc->tf.protocol = ATAPI_PROT_PIO; | 
 | 2626 | 	else { | 
| Tejun Heo | e00f1ff | 2007-06-27 02:47:35 +0900 | [diff] [blame] | 2627 | 		/* DMA data xfer */ | 
| Tejun Heo | 0dc3688 | 2007-12-18 16:34:43 -0500 | [diff] [blame] | 2628 | 		qc->tf.protocol = ATAPI_PROT_DMA; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2629 | 		qc->tf.feature |= ATAPI_PKT_DMA; | 
 | 2630 |  | 
| Tejun Heo | 9116300 | 2008-02-21 13:25:50 +0900 | [diff] [blame] | 2631 | 		if ((dev->flags & ATA_DFLAG_DMADIR) && | 
 | 2632 | 		    (scmd->sc_data_direction != DMA_TO_DEVICE)) | 
| Albert Lee | 95de719 | 2006-04-04 10:57:18 +0800 | [diff] [blame] | 2633 | 			/* some SATA bridges need us to indicate data xfer direction */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2634 | 			qc->tf.feature |= ATAPI_DMADIR; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2635 | 	} | 
 | 2636 |  | 
| Alan Cox | 2db78dd | 2007-10-02 13:53:04 -0700 | [diff] [blame] | 2637 |  | 
 | 2638 | 	/* FIXME: We need to translate 0x05 READ_BLOCK_LIMITS to a MODE_SENSE | 
 | 2639 | 	   as ATAPI tape drives don't get this right otherwise */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2640 | 	return 0; | 
 | 2641 | } | 
 | 2642 |  | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 2643 | static struct ata_device *ata_find_dev(struct ata_port *ap, int devno) | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 2644 | { | 
| Tejun Heo | 071f44b | 2008-04-07 22:47:22 +0900 | [diff] [blame] | 2645 | 	if (!sata_pmp_attached(ap)) { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 2646 | 		if (likely(devno < ata_link_max_devices(&ap->link))) | 
 | 2647 | 			return &ap->link.device[devno]; | 
 | 2648 | 	} else { | 
 | 2649 | 		if (likely(devno < ap->nr_pmp_links)) | 
 | 2650 | 			return &ap->pmp_link[devno].device[0]; | 
 | 2651 | 	} | 
 | 2652 |  | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 2653 | 	return NULL; | 
 | 2654 | } | 
 | 2655 |  | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 2656 | static struct ata_device *__ata_scsi_find_dev(struct ata_port *ap, | 
 | 2657 | 					      const struct scsi_device *scsidev) | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 2658 | { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 2659 | 	int devno; | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 2660 |  | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 2661 | 	/* skip commands not addressed to targets we simulate */ | 
| Tejun Heo | 071f44b | 2008-04-07 22:47:22 +0900 | [diff] [blame] | 2662 | 	if (!sata_pmp_attached(ap)) { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 2663 | 		if (unlikely(scsidev->channel || scsidev->lun)) | 
 | 2664 | 			return NULL; | 
 | 2665 | 		devno = scsidev->id; | 
 | 2666 | 	} else { | 
 | 2667 | 		if (unlikely(scsidev->id || scsidev->lun)) | 
 | 2668 | 			return NULL; | 
 | 2669 | 		devno = scsidev->channel; | 
 | 2670 | 	} | 
 | 2671 |  | 
 | 2672 | 	return ata_find_dev(ap, devno); | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 2673 | } | 
 | 2674 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2675 | /** | 
 | 2676 |  *	ata_scsi_find_dev - lookup ata_device from scsi_cmnd | 
 | 2677 |  *	@ap: ATA port to which the device is attached | 
 | 2678 |  *	@scsidev: SCSI device from which we derive the ATA device | 
 | 2679 |  * | 
 | 2680 |  *	Given various information provided in struct scsi_cmnd, | 
 | 2681 |  *	map that onto an ATA bus, and using that mapping | 
 | 2682 |  *	determine which ata_device is associated with the | 
 | 2683 |  *	SCSI command to be sent. | 
 | 2684 |  * | 
 | 2685 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 2686 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2687 |  * | 
 | 2688 |  *	RETURNS: | 
 | 2689 |  *	Associated ATA device, or %NULL if not found. | 
 | 2690 |  */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2691 | static struct ata_device * | 
| Jeff Garzik | 057ace5 | 2005-10-22 14:27:05 -0400 | [diff] [blame] | 2692 | ata_scsi_find_dev(struct ata_port *ap, const struct scsi_device *scsidev) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2693 | { | 
| Tejun Heo | ab5b3a5 | 2006-05-31 18:27:34 +0900 | [diff] [blame] | 2694 | 	struct ata_device *dev = __ata_scsi_find_dev(ap, scsidev); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2695 |  | 
| Tejun Heo | 2486fa5 | 2008-07-31 07:52:40 +0900 | [diff] [blame] | 2696 | 	if (unlikely(!dev || !ata_dev_enabled(dev))) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2697 | 		return NULL; | 
 | 2698 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2699 | 	return dev; | 
 | 2700 | } | 
 | 2701 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2702 | /* | 
 | 2703 |  *	ata_scsi_map_proto - Map pass-thru protocol value to taskfile value. | 
 | 2704 |  *	@byte1: Byte 1 from pass-thru CDB. | 
 | 2705 |  * | 
 | 2706 |  *	RETURNS: | 
 | 2707 |  *	ATA_PROT_UNKNOWN if mapping failed/unimplemented, protocol otherwise. | 
 | 2708 |  */ | 
 | 2709 | static u8 | 
 | 2710 | ata_scsi_map_proto(u8 byte1) | 
 | 2711 | { | 
 | 2712 | 	switch((byte1 & 0x1e) >> 1) { | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 2713 | 	case 3:		/* Non-data */ | 
 | 2714 | 		return ATA_PROT_NODATA; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2715 |  | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 2716 | 	case 6:		/* DMA */ | 
 | 2717 | 	case 10:	/* UDMA Data-in */ | 
 | 2718 | 	case 11:	/* UDMA Data-Out */ | 
 | 2719 | 		return ATA_PROT_DMA; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2720 |  | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 2721 | 	case 4:		/* PIO Data-in */ | 
 | 2722 | 	case 5:		/* PIO Data-out */ | 
 | 2723 | 		return ATA_PROT_PIO; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2724 |  | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 2725 | 	case 0:		/* Hard Reset */ | 
 | 2726 | 	case 1:		/* SRST */ | 
 | 2727 | 	case 8:		/* Device Diagnostic */ | 
 | 2728 | 	case 9:		/* Device Reset */ | 
 | 2729 | 	case 7:		/* DMA Queued */ | 
 | 2730 | 	case 12:	/* FPDMA */ | 
 | 2731 | 	case 15:	/* Return Response Info */ | 
 | 2732 | 	default:	/* Reserved */ | 
 | 2733 | 		break; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2734 | 	} | 
 | 2735 |  | 
 | 2736 | 	return ATA_PROT_UNKNOWN; | 
 | 2737 | } | 
 | 2738 |  | 
 | 2739 | /** | 
 | 2740 |  *	ata_scsi_pass_thru - convert ATA pass-thru CDB to taskfile | 
 | 2741 |  *	@qc: command structure to be initialized | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2742 |  * | 
 | 2743 |  *	Handles either 12 or 16-byte versions of the CDB. | 
 | 2744 |  * | 
 | 2745 |  *	RETURNS: | 
 | 2746 |  *	Zero on success, non-zero on failure. | 
 | 2747 |  */ | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 2748 | static unsigned int ata_scsi_pass_thru(struct ata_queued_cmd *qc) | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2749 | { | 
 | 2750 | 	struct ata_taskfile *tf = &(qc->tf); | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2751 | 	struct scsi_cmnd *scmd = qc->scsicmd; | 
| Alan Cox | f79d409 | 2006-05-22 16:55:11 +0100 | [diff] [blame] | 2752 | 	struct ata_device *dev = qc->dev; | 
| Tejun Heo | ad70699 | 2006-12-17 10:45:57 +0900 | [diff] [blame] | 2753 | 	const u8 *cdb = scmd->cmnd; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2754 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2755 | 	if ((tf->protocol = ata_scsi_map_proto(cdb[1])) == ATA_PROT_UNKNOWN) | 
| Tejun Heo | 9a40525 | 2005-12-02 11:49:11 +0900 | [diff] [blame] | 2756 | 		goto invalid_fld; | 
| Jeff Garzik | 8190bdb | 2006-05-24 01:53:39 -0400 | [diff] [blame] | 2757 |  | 
| Alan Cox | ae8d4ee | 2007-11-04 22:05:49 -0500 | [diff] [blame] | 2758 | 	/* | 
 | 2759 | 	 * Filter TPM commands by default. These provide an | 
 | 2760 | 	 * essentially uncontrolled encrypted "back door" between | 
 | 2761 | 	 * applications and the disk. Set libata.allow_tpm=1 if you | 
 | 2762 | 	 * have a real reason for wanting to use them. This ensures | 
 | 2763 | 	 * that installed software cannot easily mess stuff up without | 
 | 2764 | 	 * user intent. DVR type users will probably ship with this enabled | 
 | 2765 | 	 * for movie content management. | 
 | 2766 | 	 * | 
 | 2767 | 	 * Note that for ATA8 we can issue a DCS change and DCS freeze lock | 
 | 2768 | 	 * for this and should do in future but that it is not sufficient as | 
 | 2769 | 	 * DCS is an optional feature set. Thus we also do the software filter | 
 | 2770 | 	 * so that we comply with the TC consortium stated goal that the user | 
 | 2771 | 	 * can turn off TC features of their system. | 
 | 2772 | 	 */ | 
 | 2773 | 	if (tf->command >= 0x5C && tf->command <= 0x5F && !libata_allow_tpm) | 
 | 2774 | 		goto invalid_fld; | 
 | 2775 |  | 
| Alan Cox | f79d409 | 2006-05-22 16:55:11 +0100 | [diff] [blame] | 2776 | 	/* We may not issue DMA commands if no DMA mode is set */ | 
 | 2777 | 	if (tf->protocol == ATA_PROT_DMA && dev->dma_mode == 0) | 
 | 2778 | 		goto invalid_fld; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2779 |  | 
 | 2780 | 	/* | 
 | 2781 | 	 * 12 and 16 byte CDBs use different offsets to | 
 | 2782 | 	 * provide the various register values. | 
 | 2783 | 	 */ | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2784 | 	if (cdb[0] == ATA_16) { | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2785 | 		/* | 
 | 2786 | 		 * 16-byte CDB - may contain extended commands. | 
 | 2787 | 		 * | 
 | 2788 | 		 * If that is the case, copy the upper byte register values. | 
 | 2789 | 		 */ | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2790 | 		if (cdb[1] & 0x01) { | 
 | 2791 | 			tf->hob_feature = cdb[3]; | 
 | 2792 | 			tf->hob_nsect = cdb[5]; | 
 | 2793 | 			tf->hob_lbal = cdb[7]; | 
 | 2794 | 			tf->hob_lbam = cdb[9]; | 
 | 2795 | 			tf->hob_lbah = cdb[11]; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2796 | 			tf->flags |= ATA_TFLAG_LBA48; | 
 | 2797 | 		} else | 
 | 2798 | 			tf->flags &= ~ATA_TFLAG_LBA48; | 
 | 2799 |  | 
 | 2800 | 		/* | 
 | 2801 | 		 * Always copy low byte, device and command registers. | 
 | 2802 | 		 */ | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2803 | 		tf->feature = cdb[4]; | 
 | 2804 | 		tf->nsect = cdb[6]; | 
 | 2805 | 		tf->lbal = cdb[8]; | 
 | 2806 | 		tf->lbam = cdb[10]; | 
 | 2807 | 		tf->lbah = cdb[12]; | 
 | 2808 | 		tf->device = cdb[13]; | 
 | 2809 | 		tf->command = cdb[14]; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2810 | 	} else { | 
 | 2811 | 		/* | 
 | 2812 | 		 * 12-byte CDB - incapable of extended commands. | 
 | 2813 | 		 */ | 
 | 2814 | 		tf->flags &= ~ATA_TFLAG_LBA48; | 
 | 2815 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2816 | 		tf->feature = cdb[3]; | 
 | 2817 | 		tf->nsect = cdb[4]; | 
 | 2818 | 		tf->lbal = cdb[5]; | 
 | 2819 | 		tf->lbam = cdb[6]; | 
 | 2820 | 		tf->lbah = cdb[7]; | 
 | 2821 | 		tf->device = cdb[8]; | 
 | 2822 | 		tf->command = cdb[9]; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2823 | 	} | 
| Albert Lee | fa4453c | 2007-06-07 15:52:07 +0800 | [diff] [blame] | 2824 |  | 
 | 2825 | 	/* enforce correct master/slave bit */ | 
 | 2826 | 	tf->device = dev->devno ? | 
 | 2827 | 		tf->device | ATA_DEV1 : tf->device & ~ATA_DEV1; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2828 |  | 
| Albert Lee | 1dce589 | 2007-06-07 15:49:22 +0800 | [diff] [blame] | 2829 | 	/* sanity check for pio multi commands */ | 
 | 2830 | 	if ((cdb[1] & 0xe0) && !is_multi_taskfile(tf)) | 
 | 2831 | 		goto invalid_fld; | 
 | 2832 |  | 
 | 2833 | 	if (is_multi_taskfile(tf)) { | 
 | 2834 | 		unsigned int multi_count = 1 << (cdb[1] >> 5); | 
 | 2835 |  | 
 | 2836 | 		/* compare the passed through multi_count | 
 | 2837 | 		 * with the cached multi_count of libata | 
 | 2838 | 		 */ | 
 | 2839 | 		if (multi_count != dev->multi_count) | 
 | 2840 | 			ata_dev_printk(dev, KERN_WARNING, | 
 | 2841 | 				       "invalid multi_count %u ignored\n", | 
 | 2842 | 				       multi_count); | 
| Alan Cox | d26fc95 | 2007-07-06 19:13:52 -0400 | [diff] [blame] | 2843 | 	} | 
| Albert Lee | 1dce589 | 2007-06-07 15:49:22 +0800 | [diff] [blame] | 2844 |  | 
| Mark Lord | 5a5dbd1 | 2007-03-16 10:22:26 -0400 | [diff] [blame] | 2845 | 	/* READ/WRITE LONG use a non-standard sect_size */ | 
 | 2846 | 	qc->sect_size = ATA_SECT_SIZE; | 
 | 2847 | 	switch (tf->command) { | 
 | 2848 | 	case ATA_CMD_READ_LONG: | 
 | 2849 | 	case ATA_CMD_READ_LONG_ONCE: | 
 | 2850 | 	case ATA_CMD_WRITE_LONG: | 
 | 2851 | 	case ATA_CMD_WRITE_LONG_ONCE: | 
 | 2852 | 		if (tf->protocol != ATA_PROT_PIO || tf->nsect != 1) | 
 | 2853 | 			goto invalid_fld; | 
| Boaz Harrosh | 7120165 | 2007-09-18 17:48:50 +0200 | [diff] [blame] | 2854 | 		qc->sect_size = scsi_bufflen(scmd); | 
| Mark Lord | 5a5dbd1 | 2007-03-16 10:22:26 -0400 | [diff] [blame] | 2855 | 	} | 
 | 2856 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2857 | 	/* | 
 | 2858 | 	 * Filter SET_FEATURES - XFER MODE command -- otherwise, | 
 | 2859 | 	 * SET_FEATURES - XFER MODE must be preceded/succeeded | 
 | 2860 | 	 * by an update to hardware-specific registers for each | 
 | 2861 | 	 * controller (i.e. the reason for ->set_piomode(), | 
 | 2862 | 	 * ->set_dmamode(), and ->post_set_mode() hooks). | 
 | 2863 | 	 */ | 
 | 2864 | 	if ((tf->command == ATA_CMD_SET_FEATURES) | 
 | 2865 | 	 && (tf->feature == SETFEATURES_XFER)) | 
| Tejun Heo | 9a40525 | 2005-12-02 11:49:11 +0900 | [diff] [blame] | 2866 | 		goto invalid_fld; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2867 |  | 
 | 2868 | 	/* | 
 | 2869 | 	 * Set flags so that all registers will be written, | 
 | 2870 | 	 * and pass on write indication (used for PIO/DMA | 
 | 2871 | 	 * setup.) | 
 | 2872 | 	 */ | 
 | 2873 | 	tf->flags |= (ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE); | 
 | 2874 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2875 | 	if (scmd->sc_data_direction == DMA_TO_DEVICE) | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2876 | 		tf->flags |= ATA_TFLAG_WRITE; | 
 | 2877 |  | 
 | 2878 | 	/* | 
 | 2879 | 	 * Set transfer length. | 
 | 2880 | 	 * | 
 | 2881 | 	 * TODO: find out if we need to do more here to | 
 | 2882 | 	 *       cover scatter/gather case. | 
 | 2883 | 	 */ | 
| Tejun Heo | aacda37 | 2008-03-18 17:47:43 +0900 | [diff] [blame] | 2884 | 	ata_qc_set_pc_nbytes(qc); | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2885 |  | 
| Tejun Heo | e027bd3 | 2007-10-26 16:19:26 +0900 | [diff] [blame] | 2886 | 	/* request result TF and be quiet about device error */ | 
 | 2887 | 	qc->flags |= ATA_QCFLAG_RESULT_TF | ATA_QCFLAG_QUIET; | 
| Tejun Heo | e61e067 | 2006-05-15 20:57:40 +0900 | [diff] [blame] | 2888 |  | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2889 | 	return 0; | 
| Tejun Heo | 9a40525 | 2005-12-02 11:49:11 +0900 | [diff] [blame] | 2890 |  | 
 | 2891 |  invalid_fld: | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2892 | 	ata_scsi_set_sense(scmd, ILLEGAL_REQUEST, 0x24, 0x00); | 
| Tejun Heo | 9a40525 | 2005-12-02 11:49:11 +0900 | [diff] [blame] | 2893 | 	/* "Invalid field in cdb" */ | 
 | 2894 | 	return 1; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2895 | } | 
 | 2896 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2897 | /** | 
 | 2898 |  *	ata_get_xlat_func - check if SCSI to ATA translation is possible | 
 | 2899 |  *	@dev: ATA device | 
 | 2900 |  *	@cmd: SCSI command opcode to consider | 
 | 2901 |  * | 
 | 2902 |  *	Look up the SCSI command given, and determine whether the | 
 | 2903 |  *	SCSI command is to be translated or simulated. | 
 | 2904 |  * | 
 | 2905 |  *	RETURNS: | 
 | 2906 |  *	Pointer to translation function if possible, %NULL if not. | 
 | 2907 |  */ | 
 | 2908 |  | 
 | 2909 | static inline ata_xlat_func_t ata_get_xlat_func(struct ata_device *dev, u8 cmd) | 
 | 2910 | { | 
 | 2911 | 	switch (cmd) { | 
 | 2912 | 	case READ_6: | 
 | 2913 | 	case READ_10: | 
 | 2914 | 	case READ_16: | 
 | 2915 |  | 
 | 2916 | 	case WRITE_6: | 
 | 2917 | 	case WRITE_10: | 
 | 2918 | 	case WRITE_16: | 
 | 2919 | 		return ata_scsi_rw_xlat; | 
 | 2920 |  | 
 | 2921 | 	case SYNCHRONIZE_CACHE: | 
 | 2922 | 		if (ata_try_flush_cache(dev)) | 
 | 2923 | 			return ata_scsi_flush_xlat; | 
 | 2924 | 		break; | 
 | 2925 |  | 
 | 2926 | 	case VERIFY: | 
 | 2927 | 	case VERIFY_16: | 
 | 2928 | 		return ata_scsi_verify_xlat; | 
| Jeff Garzik | b095518 | 2005-05-12 15:45:22 -0400 | [diff] [blame] | 2929 |  | 
 | 2930 | 	case ATA_12: | 
 | 2931 | 	case ATA_16: | 
 | 2932 | 		return ata_scsi_pass_thru; | 
| Jeff Garzik | da61396 | 2005-08-29 19:01:43 -0400 | [diff] [blame] | 2933 |  | 
| Douglas Gilbert | 972dcaf | 2005-08-11 03:35:53 -0400 | [diff] [blame] | 2934 | 	case START_STOP: | 
 | 2935 | 		return ata_scsi_start_stop_xlat; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2936 | 	} | 
 | 2937 |  | 
 | 2938 | 	return NULL; | 
 | 2939 | } | 
 | 2940 |  | 
 | 2941 | /** | 
 | 2942 |  *	ata_scsi_dump_cdb - dump SCSI command contents to dmesg | 
 | 2943 |  *	@ap: ATA port to which the command was being sent | 
 | 2944 |  *	@cmd: SCSI command to dump | 
 | 2945 |  * | 
 | 2946 |  *	Prints the contents of a SCSI command via printk(). | 
 | 2947 |  */ | 
 | 2948 |  | 
 | 2949 | static inline void ata_scsi_dump_cdb(struct ata_port *ap, | 
 | 2950 | 				     struct scsi_cmnd *cmd) | 
 | 2951 | { | 
 | 2952 | #ifdef ATA_DEBUG | 
 | 2953 | 	struct scsi_device *scsidev = cmd->device; | 
 | 2954 | 	u8 *scsicmd = cmd->cmnd; | 
 | 2955 |  | 
 | 2956 | 	DPRINTK("CDB (%u:%d,%d,%d) %02x %02x %02x %02x %02x %02x %02x %02x %02x\n", | 
| Tejun Heo | 44877b4 | 2007-02-21 01:06:51 +0900 | [diff] [blame] | 2957 | 		ap->print_id, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 2958 | 		scsidev->channel, scsidev->id, scsidev->lun, | 
 | 2959 | 		scsicmd[0], scsicmd[1], scsicmd[2], scsicmd[3], | 
 | 2960 | 		scsicmd[4], scsicmd[5], scsicmd[6], scsicmd[7], | 
 | 2961 | 		scsicmd[8]); | 
 | 2962 | #endif | 
 | 2963 | } | 
 | 2964 |  | 
| Tejun Heo | 542b144 | 2006-12-17 10:45:08 +0900 | [diff] [blame] | 2965 | static inline int __ata_scsi_queuecmd(struct scsi_cmnd *scmd, | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 2966 | 				      void (*done)(struct scsi_cmnd *), | 
 | 2967 | 				      struct ata_device *dev) | 
| Brian King | eb3f0f9 | 2006-03-23 17:30:02 -0600 | [diff] [blame] | 2968 | { | 
| Mark Lord | baf4fdf | 2007-08-08 01:08:45 +0900 | [diff] [blame] | 2969 | 	u8 scsi_op = scmd->cmnd[0]; | 
 | 2970 | 	ata_xlat_func_t xlat_func; | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 2971 | 	int rc = 0; | 
 | 2972 |  | 
| Mark Lord | baf4fdf | 2007-08-08 01:08:45 +0900 | [diff] [blame] | 2973 | 	if (dev->class == ATA_DEV_ATA) { | 
 | 2974 | 		if (unlikely(!scmd->cmd_len || scmd->cmd_len > dev->cdb_len)) | 
 | 2975 | 			goto bad_cdb_len; | 
 | 2976 |  | 
 | 2977 | 		xlat_func = ata_get_xlat_func(dev, scsi_op); | 
 | 2978 | 	} else { | 
 | 2979 | 		if (unlikely(!scmd->cmd_len)) | 
 | 2980 | 			goto bad_cdb_len; | 
 | 2981 |  | 
 | 2982 | 		xlat_func = NULL; | 
 | 2983 | 		if (likely((scsi_op != ATA_16) || !atapi_passthru16)) { | 
 | 2984 | 			/* relay SCSI command to ATAPI device */ | 
| Mark Lord | 607126c | 2007-11-15 13:13:59 +0900 | [diff] [blame] | 2985 | 			int len = COMMAND_SIZE(scsi_op); | 
 | 2986 | 			if (unlikely(len > scmd->cmd_len || len > dev->cdb_len)) | 
| Mark Lord | baf4fdf | 2007-08-08 01:08:45 +0900 | [diff] [blame] | 2987 | 				goto bad_cdb_len; | 
 | 2988 |  | 
 | 2989 | 			xlat_func = atapi_xlat; | 
 | 2990 | 		} else { | 
 | 2991 | 			/* ATA_16 passthru, treat as an ATA command */ | 
 | 2992 | 			if (unlikely(scmd->cmd_len > 16)) | 
 | 2993 | 				goto bad_cdb_len; | 
 | 2994 |  | 
 | 2995 | 			xlat_func = ata_get_xlat_func(dev, scsi_op); | 
 | 2996 | 		} | 
| Tejun Heo | 2e5704f | 2006-12-17 10:46:33 +0900 | [diff] [blame] | 2997 | 	} | 
 | 2998 |  | 
| Mark Lord | baf4fdf | 2007-08-08 01:08:45 +0900 | [diff] [blame] | 2999 | 	if (xlat_func) | 
 | 3000 | 		rc = ata_scsi_translate(dev, scmd, done, xlat_func); | 
 | 3001 | 	else | 
 | 3002 | 		ata_scsi_simulate(dev, scmd, done); | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 3003 |  | 
 | 3004 | 	return rc; | 
| Mark Lord | baf4fdf | 2007-08-08 01:08:45 +0900 | [diff] [blame] | 3005 |  | 
 | 3006 |  bad_cdb_len: | 
 | 3007 | 	DPRINTK("bad CDB len=%u, scsi_op=0x%02x, max=%u\n", | 
 | 3008 | 		scmd->cmd_len, scsi_op, dev->cdb_len); | 
 | 3009 | 	scmd->result = DID_ERROR << 16; | 
 | 3010 | 	done(scmd); | 
 | 3011 | 	return 0; | 
| Brian King | eb3f0f9 | 2006-03-23 17:30:02 -0600 | [diff] [blame] | 3012 | } | 
 | 3013 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3014 | /** | 
 | 3015 |  *	ata_scsi_queuecmd - Issue SCSI cdb to libata-managed device | 
 | 3016 |  *	@cmd: SCSI command to be sent | 
 | 3017 |  *	@done: Completion function, called when command is complete | 
 | 3018 |  * | 
 | 3019 |  *	In some cases, this function translates SCSI commands into | 
 | 3020 |  *	ATA taskfiles, and queues the taskfiles to be sent to | 
 | 3021 |  *	hardware.  In other cases, this function simulates a | 
 | 3022 |  *	SCSI device by evaluating and responding to certain | 
 | 3023 |  *	SCSI commands.  This creates the overall effect of | 
 | 3024 |  *	ATA and ATAPI devices appearing as SCSI devices. | 
 | 3025 |  * | 
 | 3026 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3027 |  *	Releases scsi-layer-held lock, and obtains host lock. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3028 |  * | 
 | 3029 |  *	RETURNS: | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 3030 |  *	Return value from __ata_scsi_queuecmd() if @cmd can be queued, | 
 | 3031 |  *	0 otherwise. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3032 |  */ | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3033 | int ata_scsi_queuecmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *)) | 
 | 3034 | { | 
 | 3035 | 	struct ata_port *ap; | 
 | 3036 | 	struct ata_device *dev; | 
 | 3037 | 	struct scsi_device *scsidev = cmd->device; | 
| Jeff Garzik | 005a5a0 | 2005-10-30 23:31:48 -0500 | [diff] [blame] | 3038 | 	struct Scsi_Host *shost = scsidev->host; | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 3039 | 	int rc = 0; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3040 |  | 
| Jeff Garzik | 35bb94b | 2006-04-11 13:12:34 -0400 | [diff] [blame] | 3041 | 	ap = ata_shost_to_port(shost); | 
| Jeff Garzik | 005a5a0 | 2005-10-30 23:31:48 -0500 | [diff] [blame] | 3042 |  | 
 | 3043 | 	spin_unlock(shost->host_lock); | 
| Jeff Garzik | ba6a130 | 2006-06-22 23:46:10 -0400 | [diff] [blame] | 3044 | 	spin_lock(ap->lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3045 |  | 
 | 3046 | 	ata_scsi_dump_cdb(ap, cmd); | 
 | 3047 |  | 
 | 3048 | 	dev = ata_scsi_find_dev(ap, scsidev); | 
| Brian King | eb3f0f9 | 2006-03-23 17:30:02 -0600 | [diff] [blame] | 3049 | 	if (likely(dev)) | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 3050 | 		rc = __ata_scsi_queuecmd(cmd, done, dev); | 
| Brian King | eb3f0f9 | 2006-03-23 17:30:02 -0600 | [diff] [blame] | 3051 | 	else { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3052 | 		cmd->result = (DID_BAD_TARGET << 16); | 
 | 3053 | 		done(cmd); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3054 | 	} | 
 | 3055 |  | 
| Jeff Garzik | ba6a130 | 2006-06-22 23:46:10 -0400 | [diff] [blame] | 3056 | 	spin_unlock(ap->lock); | 
| Jeff Garzik | 005a5a0 | 2005-10-30 23:31:48 -0500 | [diff] [blame] | 3057 | 	spin_lock(shost->host_lock); | 
| Tejun Heo | 2115ea9 | 2006-05-15 21:03:39 +0900 | [diff] [blame] | 3058 | 	return rc; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3059 | } | 
 | 3060 |  | 
 | 3061 | /** | 
 | 3062 |  *	ata_scsi_simulate - simulate SCSI command on ATA device | 
| Randy Dunlap | c893a3a | 2006-01-28 13:15:32 -0500 | [diff] [blame] | 3063 |  *	@dev: the target device | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3064 |  *	@cmd: SCSI command being sent to device. | 
 | 3065 |  *	@done: SCSI command completion function. | 
 | 3066 |  * | 
 | 3067 |  *	Interprets and directly executes a select list of SCSI commands | 
 | 3068 |  *	that can be handled internally. | 
 | 3069 |  * | 
 | 3070 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3071 |  *	spin_lock_irqsave(host lock) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3072 |  */ | 
 | 3073 |  | 
| Tejun Heo | 3373efd | 2006-05-15 20:57:53 +0900 | [diff] [blame] | 3074 | void ata_scsi_simulate(struct ata_device *dev, struct scsi_cmnd *cmd, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3075 | 		      void (*done)(struct scsi_cmnd *)) | 
 | 3076 | { | 
 | 3077 | 	struct ata_scsi_args args; | 
| Jeff Garzik | 057ace5 | 2005-10-22 14:27:05 -0400 | [diff] [blame] | 3078 | 	const u8 *scsicmd = cmd->cmnd; | 
| Jeff Garzik | 4539414 | 2007-09-21 06:23:42 -0400 | [diff] [blame] | 3079 | 	u8 tmp8; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3080 |  | 
| Tejun Heo | 9a3dccc | 2006-01-06 09:56:18 +0100 | [diff] [blame] | 3081 | 	args.dev = dev; | 
 | 3082 | 	args.id = dev->id; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3083 | 	args.cmd = cmd; | 
 | 3084 | 	args.done = done; | 
 | 3085 |  | 
 | 3086 | 	switch(scsicmd[0]) { | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 3087 | 	/* TODO: worth improving? */ | 
 | 3088 | 	case FORMAT_UNIT: | 
 | 3089 | 		ata_scsi_invalid_field(cmd, done); | 
 | 3090 | 		break; | 
 | 3091 |  | 
 | 3092 | 	case INQUIRY: | 
 | 3093 | 		if (scsicmd[1] & 2)	           /* is CmdDt set?  */ | 
| Jeff Garzik | 00bd020 | 2007-09-21 07:26:08 -0400 | [diff] [blame] | 3094 | 			ata_scsi_invalid_field(cmd, done); | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 3095 | 		else if ((scsicmd[1] & 1) == 0)    /* is EVPD clear? */ | 
 | 3096 | 			ata_scsi_rbuf_fill(&args, ata_scsiop_inq_std); | 
 | 3097 | 		else switch (scsicmd[2]) { | 
 | 3098 | 		case 0x00: | 
 | 3099 | 			ata_scsi_rbuf_fill(&args, ata_scsiop_inq_00); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3100 | 			break; | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 3101 | 		case 0x80: | 
 | 3102 | 			ata_scsi_rbuf_fill(&args, ata_scsiop_inq_80); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3103 | 			break; | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 3104 | 		case 0x83: | 
 | 3105 | 			ata_scsi_rbuf_fill(&args, ata_scsiop_inq_83); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3106 | 			break; | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 3107 | 		case 0x89: | 
 | 3108 | 			ata_scsi_rbuf_fill(&args, ata_scsiop_inq_89); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3109 | 			break; | 
| Matthew Wilcox | 1e9dbc9 | 2008-06-19 13:13:38 -0600 | [diff] [blame] | 3110 | 		case 0xb1: | 
 | 3111 | 			ata_scsi_rbuf_fill(&args, ata_scsiop_inq_b1); | 
 | 3112 | 			break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3113 | 		default: | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 3114 | 			ata_scsi_invalid_field(cmd, done); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3115 | 			break; | 
| Jeff Garzik | 2dcb407 | 2007-10-19 06:42:56 -0400 | [diff] [blame] | 3116 | 		} | 
 | 3117 | 		break; | 
 | 3118 |  | 
 | 3119 | 	case MODE_SENSE: | 
 | 3120 | 	case MODE_SENSE_10: | 
 | 3121 | 		ata_scsi_rbuf_fill(&args, ata_scsiop_mode_sense); | 
 | 3122 | 		break; | 
 | 3123 |  | 
 | 3124 | 	case MODE_SELECT:	/* unconditionally return */ | 
 | 3125 | 	case MODE_SELECT_10:	/* bad-field-in-cdb */ | 
 | 3126 | 		ata_scsi_invalid_field(cmd, done); | 
 | 3127 | 		break; | 
 | 3128 |  | 
 | 3129 | 	case READ_CAPACITY: | 
 | 3130 | 		ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap); | 
 | 3131 | 		break; | 
 | 3132 |  | 
 | 3133 | 	case SERVICE_ACTION_IN: | 
 | 3134 | 		if ((scsicmd[1] & 0x1f) == SAI_READ_CAPACITY_16) | 
 | 3135 | 			ata_scsi_rbuf_fill(&args, ata_scsiop_read_cap); | 
 | 3136 | 		else | 
 | 3137 | 			ata_scsi_invalid_field(cmd, done); | 
 | 3138 | 		break; | 
 | 3139 |  | 
 | 3140 | 	case REPORT_LUNS: | 
 | 3141 | 		ata_scsi_rbuf_fill(&args, ata_scsiop_report_luns); | 
 | 3142 | 		break; | 
 | 3143 |  | 
 | 3144 | 	case REQUEST_SENSE: | 
 | 3145 | 		ata_scsi_set_sense(cmd, 0, 0, 0); | 
 | 3146 | 		cmd->result = (DRIVER_SENSE << 24); | 
 | 3147 | 		done(cmd); | 
 | 3148 | 		break; | 
 | 3149 |  | 
 | 3150 | 	/* if we reach this, then writeback caching is disabled, | 
 | 3151 | 	 * turning this into a no-op. | 
 | 3152 | 	 */ | 
 | 3153 | 	case SYNCHRONIZE_CACHE: | 
 | 3154 | 		/* fall through */ | 
 | 3155 |  | 
 | 3156 | 	/* no-op's, complete with success */ | 
 | 3157 | 	case REZERO_UNIT: | 
 | 3158 | 	case SEEK_6: | 
 | 3159 | 	case SEEK_10: | 
 | 3160 | 	case TEST_UNIT_READY: | 
 | 3161 | 		ata_scsi_rbuf_fill(&args, ata_scsiop_noop); | 
 | 3162 | 		break; | 
 | 3163 |  | 
 | 3164 | 	case SEND_DIAGNOSTIC: | 
 | 3165 | 		tmp8 = scsicmd[1] & ~(1 << 3); | 
 | 3166 | 		if ((tmp8 == 0x4) && (!scsicmd[3]) && (!scsicmd[4])) | 
 | 3167 | 			ata_scsi_rbuf_fill(&args, ata_scsiop_noop); | 
 | 3168 | 		else | 
 | 3169 | 			ata_scsi_invalid_field(cmd, done); | 
 | 3170 | 		break; | 
 | 3171 |  | 
 | 3172 | 	/* all other commands */ | 
 | 3173 | 	default: | 
 | 3174 | 		ata_scsi_set_sense(cmd, ILLEGAL_REQUEST, 0x20, 0x0); | 
 | 3175 | 		/* "Invalid command operation code" */ | 
 | 3176 | 		done(cmd); | 
 | 3177 | 		break; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 3178 | 	} | 
 | 3179 | } | 
 | 3180 |  | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 3181 | int ata_scsi_add_hosts(struct ata_host *host, struct scsi_host_template *sht) | 
 | 3182 | { | 
 | 3183 | 	int i, rc; | 
 | 3184 |  | 
 | 3185 | 	for (i = 0; i < host->n_ports; i++) { | 
 | 3186 | 		struct ata_port *ap = host->ports[i]; | 
 | 3187 | 		struct Scsi_Host *shost; | 
 | 3188 |  | 
 | 3189 | 		rc = -ENOMEM; | 
 | 3190 | 		shost = scsi_host_alloc(sht, sizeof(struct ata_port *)); | 
 | 3191 | 		if (!shost) | 
 | 3192 | 			goto err_alloc; | 
 | 3193 |  | 
 | 3194 | 		*(struct ata_port **)&shost->hostdata[0] = ap; | 
 | 3195 | 		ap->scsi_host = shost; | 
 | 3196 |  | 
 | 3197 | 		shost->transportt = &ata_scsi_transport_template; | 
 | 3198 | 		shost->unique_id = ap->print_id; | 
 | 3199 | 		shost->max_id = 16; | 
 | 3200 | 		shost->max_lun = 1; | 
 | 3201 | 		shost->max_channel = 1; | 
 | 3202 | 		shost->max_cmd_len = 16; | 
 | 3203 |  | 
| Tejun Heo | 31cc23b | 2007-09-23 13:14:12 +0900 | [diff] [blame] | 3204 | 		/* Schedule policy is determined by ->qc_defer() | 
 | 3205 | 		 * callback and it needs to see every deferred qc. | 
 | 3206 | 		 * Set host_blocked to 1 to prevent SCSI midlayer from | 
 | 3207 | 		 * automatically deferring requests. | 
 | 3208 | 		 */ | 
 | 3209 | 		shost->max_host_blocked = 1; | 
 | 3210 |  | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 3211 | 		rc = scsi_add_host(ap->scsi_host, ap->host->dev); | 
 | 3212 | 		if (rc) | 
 | 3213 | 			goto err_add; | 
 | 3214 | 	} | 
 | 3215 |  | 
 | 3216 | 	return 0; | 
 | 3217 |  | 
 | 3218 |  err_add: | 
 | 3219 | 	scsi_host_put(host->ports[i]->scsi_host); | 
 | 3220 |  err_alloc: | 
 | 3221 | 	while (--i >= 0) { | 
 | 3222 | 		struct Scsi_Host *shost = host->ports[i]->scsi_host; | 
 | 3223 |  | 
 | 3224 | 		scsi_remove_host(shost); | 
 | 3225 | 		scsi_host_put(shost); | 
 | 3226 | 	} | 
 | 3227 | 	return rc; | 
 | 3228 | } | 
 | 3229 |  | 
| Tejun Heo | 1ae4631 | 2007-07-16 14:29:40 +0900 | [diff] [blame] | 3230 | void ata_scsi_scan_host(struct ata_port *ap, int sync) | 
| Jeff Garzik | 644dd0c | 2005-10-03 15:55:19 -0400 | [diff] [blame] | 3231 | { | 
| Tejun Heo | 1ae4631 | 2007-07-16 14:29:40 +0900 | [diff] [blame] | 3232 | 	int tries = 5; | 
 | 3233 | 	struct ata_device *last_failed_dev = NULL; | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3234 | 	struct ata_link *link; | 
| Tejun Heo | 1ae4631 | 2007-07-16 14:29:40 +0900 | [diff] [blame] | 3235 | 	struct ata_device *dev; | 
| Jeff Garzik | 644dd0c | 2005-10-03 15:55:19 -0400 | [diff] [blame] | 3236 |  | 
| Tejun Heo | 198e0fe | 2006-04-02 18:51:52 +0900 | [diff] [blame] | 3237 | 	if (ap->flags & ATA_FLAG_DISABLED) | 
| Jeff Garzik | 644dd0c | 2005-10-03 15:55:19 -0400 | [diff] [blame] | 3238 | 		return; | 
 | 3239 |  | 
| Tejun Heo | 1ae4631 | 2007-07-16 14:29:40 +0900 | [diff] [blame] | 3240 |  repeat: | 
| Tejun Heo | 1eca436 | 2008-11-03 20:03:17 +0900 | [diff] [blame] | 3241 | 	ata_for_each_link(link, ap, EDGE) { | 
 | 3242 | 		ata_for_each_dev(dev, link, ENABLED) { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3243 | 			struct scsi_device *sdev; | 
 | 3244 | 			int channel = 0, id = 0; | 
| Jeff Garzik | 3f19ee8 | 2005-10-03 21:36:41 -0400 | [diff] [blame] | 3245 |  | 
| Tejun Heo | 1eca436 | 2008-11-03 20:03:17 +0900 | [diff] [blame] | 3246 | 			if (dev->sdev) | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3247 | 				continue; | 
| Tejun Heo | 3edebac | 2006-05-31 18:27:40 +0900 | [diff] [blame] | 3248 |  | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3249 | 			if (ata_is_host_link(link)) | 
 | 3250 | 				id = dev->devno; | 
 | 3251 | 			else | 
 | 3252 | 				channel = link->pmp; | 
 | 3253 |  | 
 | 3254 | 			sdev = __scsi_add_device(ap->scsi_host, channel, id, 0, | 
 | 3255 | 						 NULL); | 
 | 3256 | 			if (!IS_ERR(sdev)) { | 
 | 3257 | 				dev->sdev = sdev; | 
 | 3258 | 				scsi_device_put(sdev); | 
 | 3259 | 			} | 
| Tejun Heo | 3edebac | 2006-05-31 18:27:40 +0900 | [diff] [blame] | 3260 | 		} | 
| Jeff Garzik | 3f19ee8 | 2005-10-03 21:36:41 -0400 | [diff] [blame] | 3261 | 	} | 
| Tejun Heo | 1ae4631 | 2007-07-16 14:29:40 +0900 | [diff] [blame] | 3262 |  | 
 | 3263 | 	/* If we scanned while EH was in progress or allocation | 
 | 3264 | 	 * failure occurred, scan would have failed silently.  Check | 
 | 3265 | 	 * whether all devices are attached. | 
 | 3266 | 	 */ | 
| Tejun Heo | 1eca436 | 2008-11-03 20:03:17 +0900 | [diff] [blame] | 3267 | 	ata_for_each_link(link, ap, EDGE) { | 
 | 3268 | 		ata_for_each_dev(dev, link, ENABLED) { | 
 | 3269 | 			if (!dev->sdev) | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3270 | 				goto exit_loop; | 
 | 3271 | 		} | 
| Tejun Heo | 1ae4631 | 2007-07-16 14:29:40 +0900 | [diff] [blame] | 3272 | 	} | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3273 |  exit_loop: | 
 | 3274 | 	if (!link) | 
| Tejun Heo | 1ae4631 | 2007-07-16 14:29:40 +0900 | [diff] [blame] | 3275 | 		return; | 
 | 3276 |  | 
 | 3277 | 	/* we're missing some SCSI devices */ | 
 | 3278 | 	if (sync) { | 
 | 3279 | 		/* If caller requested synchrnous scan && we've made | 
 | 3280 | 		 * any progress, sleep briefly and repeat. | 
 | 3281 | 		 */ | 
 | 3282 | 		if (dev != last_failed_dev) { | 
 | 3283 | 			msleep(100); | 
 | 3284 | 			last_failed_dev = dev; | 
 | 3285 | 			goto repeat; | 
 | 3286 | 		} | 
 | 3287 |  | 
 | 3288 | 		/* We might be failing to detect boot device, give it | 
 | 3289 | 		 * a few more chances. | 
 | 3290 | 		 */ | 
 | 3291 | 		if (--tries) { | 
 | 3292 | 			msleep(100); | 
 | 3293 | 			goto repeat; | 
 | 3294 | 		} | 
 | 3295 |  | 
 | 3296 | 		ata_port_printk(ap, KERN_ERR, "WARNING: synchronous SCSI scan " | 
 | 3297 | 				"failed without making any progress,\n" | 
 | 3298 | 				"                  switching to async\n"); | 
 | 3299 | 	} | 
 | 3300 |  | 
 | 3301 | 	queue_delayed_work(ata_aux_wq, &ap->hotplug_task, | 
 | 3302 | 			   round_jiffies_relative(HZ)); | 
| Jeff Garzik | 644dd0c | 2005-10-03 15:55:19 -0400 | [diff] [blame] | 3303 | } | 
| Tejun Heo | 0ea035a | 2006-05-31 18:28:01 +0900 | [diff] [blame] | 3304 |  | 
 | 3305 | /** | 
 | 3306 |  *	ata_scsi_offline_dev - offline attached SCSI device | 
 | 3307 |  *	@dev: ATA device to offline attached SCSI device for | 
 | 3308 |  * | 
 | 3309 |  *	This function is called from ata_eh_hotplug() and responsible | 
 | 3310 |  *	for taking the SCSI device attached to @dev offline.  This | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3311 |  *	function is called with host lock which protects dev->sdev | 
| Tejun Heo | 0ea035a | 2006-05-31 18:28:01 +0900 | [diff] [blame] | 3312 |  *	against clearing. | 
 | 3313 |  * | 
 | 3314 |  *	LOCKING: | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3315 |  *	spin_lock_irqsave(host lock) | 
| Tejun Heo | 0ea035a | 2006-05-31 18:28:01 +0900 | [diff] [blame] | 3316 |  * | 
 | 3317 |  *	RETURNS: | 
 | 3318 |  *	1 if attached SCSI device exists, 0 otherwise. | 
 | 3319 |  */ | 
 | 3320 | int ata_scsi_offline_dev(struct ata_device *dev) | 
 | 3321 | { | 
 | 3322 | 	if (dev->sdev) { | 
 | 3323 | 		scsi_device_set_state(dev->sdev, SDEV_OFFLINE); | 
 | 3324 | 		return 1; | 
 | 3325 | 	} | 
 | 3326 | 	return 0; | 
 | 3327 | } | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3328 |  | 
 | 3329 | /** | 
 | 3330 |  *	ata_scsi_remove_dev - remove attached SCSI device | 
 | 3331 |  *	@dev: ATA device to remove attached SCSI device for | 
 | 3332 |  * | 
 | 3333 |  *	This function is called from ata_eh_scsi_hotplug() and | 
 | 3334 |  *	responsible for removing the SCSI device attached to @dev. | 
 | 3335 |  * | 
 | 3336 |  *	LOCKING: | 
 | 3337 |  *	Kernel thread context (may sleep). | 
 | 3338 |  */ | 
 | 3339 | static void ata_scsi_remove_dev(struct ata_device *dev) | 
 | 3340 | { | 
| Tejun Heo | 9af5c9c | 2007-08-06 18:36:22 +0900 | [diff] [blame] | 3341 | 	struct ata_port *ap = dev->link->ap; | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3342 | 	struct scsi_device *sdev; | 
 | 3343 | 	unsigned long flags; | 
 | 3344 |  | 
 | 3345 | 	/* Alas, we need to grab scan_mutex to ensure SCSI device | 
 | 3346 | 	 * state doesn't change underneath us and thus | 
 | 3347 | 	 * scsi_device_get() always succeeds.  The mutex locking can | 
 | 3348 | 	 * be removed if there is __scsi_device_get() interface which | 
 | 3349 | 	 * increments reference counts regardless of device state. | 
 | 3350 | 	 */ | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3351 | 	mutex_lock(&ap->scsi_host->scan_mutex); | 
| Jeff Garzik | ba6a130 | 2006-06-22 23:46:10 -0400 | [diff] [blame] | 3352 | 	spin_lock_irqsave(ap->lock, flags); | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3353 |  | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3354 | 	/* clearing dev->sdev is protected by host lock */ | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3355 | 	sdev = dev->sdev; | 
 | 3356 | 	dev->sdev = NULL; | 
 | 3357 |  | 
 | 3358 | 	if (sdev) { | 
 | 3359 | 		/* If user initiated unplug races with us, sdev can go | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3360 | 		 * away underneath us after the host lock and | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3361 | 		 * scan_mutex are released.  Hold onto it. | 
 | 3362 | 		 */ | 
 | 3363 | 		if (scsi_device_get(sdev) == 0) { | 
 | 3364 | 			/* The following ensures the attached sdev is | 
 | 3365 | 			 * offline on return from ata_scsi_offline_dev() | 
 | 3366 | 			 * regardless it wins or loses the race | 
 | 3367 | 			 * against this function. | 
 | 3368 | 			 */ | 
 | 3369 | 			scsi_device_set_state(sdev, SDEV_OFFLINE); | 
 | 3370 | 		} else { | 
 | 3371 | 			WARN_ON(1); | 
 | 3372 | 			sdev = NULL; | 
 | 3373 | 		} | 
 | 3374 | 	} | 
 | 3375 |  | 
| Jeff Garzik | ba6a130 | 2006-06-22 23:46:10 -0400 | [diff] [blame] | 3376 | 	spin_unlock_irqrestore(ap->lock, flags); | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3377 | 	mutex_unlock(&ap->scsi_host->scan_mutex); | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3378 |  | 
 | 3379 | 	if (sdev) { | 
 | 3380 | 		ata_dev_printk(dev, KERN_INFO, "detaching (SCSI %s)\n", | 
| Kay Sievers | b9d5fc4 | 2009-01-06 10:44:43 -0800 | [diff] [blame] | 3381 | 			       dev_name(&sdev->sdev_gendev)); | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3382 |  | 
 | 3383 | 		scsi_remove_device(sdev); | 
 | 3384 | 		scsi_device_put(sdev); | 
 | 3385 | 	} | 
 | 3386 | } | 
 | 3387 |  | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3388 | static void ata_scsi_handle_link_detach(struct ata_link *link) | 
 | 3389 | { | 
 | 3390 | 	struct ata_port *ap = link->ap; | 
 | 3391 | 	struct ata_device *dev; | 
 | 3392 |  | 
| Tejun Heo | 1eca436 | 2008-11-03 20:03:17 +0900 | [diff] [blame] | 3393 | 	ata_for_each_dev(dev, link, ALL) { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3394 | 		unsigned long flags; | 
 | 3395 |  | 
 | 3396 | 		if (!(dev->flags & ATA_DFLAG_DETACHED)) | 
 | 3397 | 			continue; | 
 | 3398 |  | 
 | 3399 | 		spin_lock_irqsave(ap->lock, flags); | 
 | 3400 | 		dev->flags &= ~ATA_DFLAG_DETACHED; | 
 | 3401 | 		spin_unlock_irqrestore(ap->lock, flags); | 
 | 3402 |  | 
 | 3403 | 		ata_scsi_remove_dev(dev); | 
 | 3404 | 	} | 
 | 3405 | } | 
 | 3406 |  | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3407 | /** | 
| Kristen Carlson Accardi | 2f29496 | 2007-08-15 04:11:25 -0400 | [diff] [blame] | 3408 |  *	ata_scsi_media_change_notify - send media change event | 
| Randy Dunlap | c5d0e6a | 2007-10-15 17:29:46 -0700 | [diff] [blame] | 3409 |  *	@dev: Pointer to the disk device with media change event | 
| Kristen Carlson Accardi | 2f29496 | 2007-08-15 04:11:25 -0400 | [diff] [blame] | 3410 |  * | 
 | 3411 |  *	Tell the block layer to send a media change notification | 
 | 3412 |  *	event. | 
 | 3413 |  * | 
 | 3414 |  * 	LOCKING: | 
| Tejun Heo | 854c73a | 2007-09-23 13:14:11 +0900 | [diff] [blame] | 3415 |  * 	spin_lock_irqsave(host lock) | 
| Kristen Carlson Accardi | 2f29496 | 2007-08-15 04:11:25 -0400 | [diff] [blame] | 3416 |  */ | 
| Tejun Heo | 854c73a | 2007-09-23 13:14:11 +0900 | [diff] [blame] | 3417 | void ata_scsi_media_change_notify(struct ata_device *dev) | 
| Kristen Carlson Accardi | 2f29496 | 2007-08-15 04:11:25 -0400 | [diff] [blame] | 3418 | { | 
| Tejun Heo | 854c73a | 2007-09-23 13:14:11 +0900 | [diff] [blame] | 3419 | 	if (dev->sdev) | 
| Jeff Garzik | f26792d | 2007-10-29 17:18:39 -0400 | [diff] [blame] | 3420 | 		sdev_evt_send_simple(dev->sdev, SDEV_EVT_MEDIA_CHANGE, | 
 | 3421 | 				     GFP_ATOMIC); | 
| Kristen Carlson Accardi | 2f29496 | 2007-08-15 04:11:25 -0400 | [diff] [blame] | 3422 | } | 
| Kristen Carlson Accardi | 2f29496 | 2007-08-15 04:11:25 -0400 | [diff] [blame] | 3423 |  | 
 | 3424 | /** | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3425 |  *	ata_scsi_hotplug - SCSI part of hotplug | 
| David Howells | 65f27f3 | 2006-11-22 14:55:48 +0000 | [diff] [blame] | 3426 |  *	@work: Pointer to ATA port to perform SCSI hotplug on | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3427 |  * | 
 | 3428 |  *	Perform SCSI part of hotplug.  It's executed from a separate | 
 | 3429 |  *	workqueue after EH completes.  This is necessary because SCSI | 
 | 3430 |  *	hot plugging requires working EH and hot unplugging is | 
 | 3431 |  *	synchronized with hot plugging with a mutex. | 
 | 3432 |  * | 
 | 3433 |  *	LOCKING: | 
 | 3434 |  *	Kernel thread context (may sleep). | 
 | 3435 |  */ | 
| David Howells | 65f27f3 | 2006-11-22 14:55:48 +0000 | [diff] [blame] | 3436 | void ata_scsi_hotplug(struct work_struct *work) | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3437 | { | 
| David Howells | 65f27f3 | 2006-11-22 14:55:48 +0000 | [diff] [blame] | 3438 | 	struct ata_port *ap = | 
 | 3439 | 		container_of(work, struct ata_port, hotplug_task.work); | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3440 | 	int i; | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3441 |  | 
| Tejun Heo | b51e9e5 | 2006-06-29 01:29:30 +0900 | [diff] [blame] | 3442 | 	if (ap->pflags & ATA_PFLAG_UNLOADING) { | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3443 | 		DPRINTK("ENTER/EXIT - unloading\n"); | 
 | 3444 | 		return; | 
 | 3445 | 	} | 
 | 3446 |  | 
 | 3447 | 	DPRINTK("ENTER\n"); | 
 | 3448 |  | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3449 | 	/* Unplug detached devices.  We cannot use link iterator here | 
 | 3450 | 	 * because PMP links have to be scanned even if PMP is | 
 | 3451 | 	 * currently not attached.  Iterate manually. | 
 | 3452 | 	 */ | 
 | 3453 | 	ata_scsi_handle_link_detach(&ap->link); | 
 | 3454 | 	if (ap->pmp_link) | 
 | 3455 | 		for (i = 0; i < SATA_PMP_MAX_PORTS; i++) | 
 | 3456 | 			ata_scsi_handle_link_detach(&ap->pmp_link[i]); | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3457 |  | 
 | 3458 | 	/* scan for new ones */ | 
| Tejun Heo | 1ae4631 | 2007-07-16 14:29:40 +0900 | [diff] [blame] | 3459 | 	ata_scsi_scan_host(ap, 0); | 
| Tejun Heo | 580b210 | 2006-05-31 18:28:05 +0900 | [diff] [blame] | 3460 |  | 
 | 3461 | 	DPRINTK("EXIT\n"); | 
 | 3462 | } | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3463 |  | 
 | 3464 | /** | 
 | 3465 |  *	ata_scsi_user_scan - indication for user-initiated bus scan | 
 | 3466 |  *	@shost: SCSI host to scan | 
 | 3467 |  *	@channel: Channel to scan | 
 | 3468 |  *	@id: ID to scan | 
 | 3469 |  *	@lun: LUN to scan | 
 | 3470 |  * | 
 | 3471 |  *	This function is called when user explicitly requests bus | 
 | 3472 |  *	scan.  Set probe pending flag and invoke EH. | 
 | 3473 |  * | 
 | 3474 |  *	LOCKING: | 
 | 3475 |  *	SCSI layer (we don't care) | 
 | 3476 |  * | 
 | 3477 |  *	RETURNS: | 
 | 3478 |  *	Zero. | 
 | 3479 |  */ | 
 | 3480 | static int ata_scsi_user_scan(struct Scsi_Host *shost, unsigned int channel, | 
 | 3481 | 			      unsigned int id, unsigned int lun) | 
 | 3482 | { | 
 | 3483 | 	struct ata_port *ap = ata_shost_to_port(shost); | 
 | 3484 | 	unsigned long flags; | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3485 | 	int devno, rc = 0; | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3486 |  | 
 | 3487 | 	if (!ap->ops->error_handler) | 
 | 3488 | 		return -EOPNOTSUPP; | 
 | 3489 |  | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3490 | 	if (lun != SCAN_WILD_CARD && lun) | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3491 | 		return -EINVAL; | 
 | 3492 |  | 
| Tejun Heo | 071f44b | 2008-04-07 22:47:22 +0900 | [diff] [blame] | 3493 | 	if (!sata_pmp_attached(ap)) { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3494 | 		if (channel != SCAN_WILD_CARD && channel) | 
 | 3495 | 			return -EINVAL; | 
 | 3496 | 		devno = id; | 
 | 3497 | 	} else { | 
 | 3498 | 		if (id != SCAN_WILD_CARD && id) | 
 | 3499 | 			return -EINVAL; | 
 | 3500 | 		devno = channel; | 
 | 3501 | 	} | 
 | 3502 |  | 
| Jeff Garzik | ba6a130 | 2006-06-22 23:46:10 -0400 | [diff] [blame] | 3503 | 	spin_lock_irqsave(ap->lock, flags); | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3504 |  | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3505 | 	if (devno == SCAN_WILD_CARD) { | 
 | 3506 | 		struct ata_link *link; | 
 | 3507 |  | 
| Tejun Heo | 1eca436 | 2008-11-03 20:03:17 +0900 | [diff] [blame] | 3508 | 		ata_for_each_link(link, ap, EDGE) { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3509 | 			struct ata_eh_info *ehi = &link->eh_info; | 
| Tejun Heo | b558edd | 2008-01-24 00:05:14 +0900 | [diff] [blame] | 3510 | 			ehi->probe_mask |= ATA_ALL_DEVICES; | 
| Tejun Heo | cf48062 | 2008-01-24 00:05:14 +0900 | [diff] [blame] | 3511 | 			ehi->action |= ATA_EH_RESET; | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3512 | 		} | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3513 | 	} else { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3514 | 		struct ata_device *dev = ata_find_dev(ap, devno); | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3515 |  | 
 | 3516 | 		if (dev) { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3517 | 			struct ata_eh_info *ehi = &dev->link->eh_info; | 
| Tejun Heo | 9af5c9c | 2007-08-06 18:36:22 +0900 | [diff] [blame] | 3518 | 			ehi->probe_mask |= 1 << dev->devno; | 
| Tejun Heo | cf48062 | 2008-01-24 00:05:14 +0900 | [diff] [blame] | 3519 | 			ehi->action |= ATA_EH_RESET; | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3520 | 		} else | 
 | 3521 | 			rc = -EINVAL; | 
 | 3522 | 	} | 
 | 3523 |  | 
| Tejun Heo | 309afcb | 2006-09-30 18:07:17 +0900 | [diff] [blame] | 3524 | 	if (rc == 0) { | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3525 | 		ata_port_schedule_eh(ap); | 
| Tejun Heo | 309afcb | 2006-09-30 18:07:17 +0900 | [diff] [blame] | 3526 | 		spin_unlock_irqrestore(ap->lock, flags); | 
 | 3527 | 		ata_port_wait_eh(ap); | 
 | 3528 | 	} else | 
 | 3529 | 		spin_unlock_irqrestore(ap->lock, flags); | 
| Tejun Heo | 83c47bc | 2006-05-31 18:28:07 +0900 | [diff] [blame] | 3530 |  | 
 | 3531 | 	return rc; | 
 | 3532 | } | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3533 |  | 
 | 3534 | /** | 
| Tejun Heo | d017126 | 2006-06-12 22:51:14 +0900 | [diff] [blame] | 3535 |  *	ata_scsi_dev_rescan - initiate scsi_rescan_device() | 
| David Howells | 65f27f3 | 2006-11-22 14:55:48 +0000 | [diff] [blame] | 3536 |  *	@work: Pointer to ATA port to perform scsi_rescan_device() | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3537 |  * | 
| Tejun Heo | d017126 | 2006-06-12 22:51:14 +0900 | [diff] [blame] | 3538 |  *	After ATA pass thru (SAT) commands are executed successfully, | 
 | 3539 |  *	libata need to propagate the changes to SCSI layer.  This | 
 | 3540 |  *	function must be executed from ata_aux_wq such that sdev | 
 | 3541 |  *	attach/detach don't race with rescan. | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3542 |  * | 
| Tejun Heo | d017126 | 2006-06-12 22:51:14 +0900 | [diff] [blame] | 3543 |  *	LOCKING: | 
 | 3544 |  *	Kernel thread context (may sleep). | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3545 |  */ | 
| David Howells | 65f27f3 | 2006-11-22 14:55:48 +0000 | [diff] [blame] | 3546 | void ata_scsi_dev_rescan(struct work_struct *work) | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3547 | { | 
| David Howells | 65f27f3 | 2006-11-22 14:55:48 +0000 | [diff] [blame] | 3548 | 	struct ata_port *ap = | 
 | 3549 | 		container_of(work, struct ata_port, scsi_rescan_task); | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3550 | 	struct ata_link *link; | 
| Tejun Heo | f58229f | 2007-08-06 18:36:23 +0900 | [diff] [blame] | 3551 | 	struct ata_device *dev; | 
| Tejun Heo | f84e7e4 | 2006-11-22 11:21:31 +0900 | [diff] [blame] | 3552 | 	unsigned long flags; | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3553 |  | 
| Tejun Heo | f84e7e4 | 2006-11-22 11:21:31 +0900 | [diff] [blame] | 3554 | 	spin_lock_irqsave(ap->lock, flags); | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3555 |  | 
| Tejun Heo | 1eca436 | 2008-11-03 20:03:17 +0900 | [diff] [blame] | 3556 | 	ata_for_each_link(link, ap, EDGE) { | 
 | 3557 | 		ata_for_each_dev(dev, link, ENABLED) { | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3558 | 			struct scsi_device *sdev = dev->sdev; | 
| Tejun Heo | f84e7e4 | 2006-11-22 11:21:31 +0900 | [diff] [blame] | 3559 |  | 
| Tejun Heo | 1eca436 | 2008-11-03 20:03:17 +0900 | [diff] [blame] | 3560 | 			if (!sdev) | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3561 | 				continue; | 
 | 3562 | 			if (scsi_device_get(sdev)) | 
 | 3563 | 				continue; | 
| Tejun Heo | f84e7e4 | 2006-11-22 11:21:31 +0900 | [diff] [blame] | 3564 |  | 
| Tejun Heo | 41bda9c | 2007-08-06 18:36:24 +0900 | [diff] [blame] | 3565 | 			spin_unlock_irqrestore(ap->lock, flags); | 
 | 3566 | 			scsi_rescan_device(&(sdev->sdev_gendev)); | 
 | 3567 | 			scsi_device_put(sdev); | 
 | 3568 | 			spin_lock_irqsave(ap->lock, flags); | 
 | 3569 | 		} | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3570 | 	} | 
| Tejun Heo | f84e7e4 | 2006-11-22 11:21:31 +0900 | [diff] [blame] | 3571 |  | 
 | 3572 | 	spin_unlock_irqrestore(ap->lock, flags); | 
| zhao, forrest | 3057ac3 | 2006-06-12 12:01:34 +0800 | [diff] [blame] | 3573 | } | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3574 |  | 
 | 3575 | /** | 
 | 3576 |  *	ata_sas_port_alloc - Allocate port for a SAS attached SATA device | 
| Jeff Garzik | 4f93137 | 2006-09-29 05:07:25 -0400 | [diff] [blame] | 3577 |  *	@host: ATA host container for all SAS ports | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3578 |  *	@port_info: Information from low-level host driver | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3579 |  *	@shost: SCSI host that the scsi device is attached to | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3580 |  * | 
 | 3581 |  *	LOCKING: | 
 | 3582 |  *	PCI/etc. bus probe sem. | 
 | 3583 |  * | 
 | 3584 |  *	RETURNS: | 
 | 3585 |  *	ata_port pointer on success / NULL on failure. | 
 | 3586 |  */ | 
 | 3587 |  | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3588 | struct ata_port *ata_sas_port_alloc(struct ata_host *host, | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3589 | 				    struct ata_port_info *port_info, | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3590 | 				    struct Scsi_Host *shost) | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3591 | { | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 3592 | 	struct ata_port *ap; | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3593 |  | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 3594 | 	ap = ata_port_alloc(host); | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3595 | 	if (!ap) | 
 | 3596 | 		return NULL; | 
 | 3597 |  | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 3598 | 	ap->port_no = 0; | 
| Jeff Garzik | cca3974 | 2006-08-24 03:19:22 -0400 | [diff] [blame] | 3599 | 	ap->lock = shost->host_lock; | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 3600 | 	ap->pio_mask = port_info->pio_mask; | 
 | 3601 | 	ap->mwdma_mask = port_info->mwdma_mask; | 
 | 3602 | 	ap->udma_mask = port_info->udma_mask; | 
 | 3603 | 	ap->flags |= port_info->flags; | 
 | 3604 | 	ap->ops = port_info->port_ops; | 
 | 3605 | 	ap->cbl = ATA_CBL_SATA; | 
 | 3606 |  | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3607 | 	return ap; | 
 | 3608 | } | 
 | 3609 | EXPORT_SYMBOL_GPL(ata_sas_port_alloc); | 
 | 3610 |  | 
 | 3611 | /** | 
 | 3612 |  *	ata_sas_port_start - Set port up for dma. | 
 | 3613 |  *	@ap: Port to initialize | 
 | 3614 |  * | 
 | 3615 |  *	Called just after data structures for each port are | 
| James Bottomley | dde2020 | 2008-02-19 11:36:56 +0100 | [diff] [blame] | 3616 |  *	initialized. | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3617 |  * | 
 | 3618 |  *	May be used as the port_start() entry in ata_port_operations. | 
 | 3619 |  * | 
 | 3620 |  *	LOCKING: | 
 | 3621 |  *	Inherited from caller. | 
 | 3622 |  */ | 
 | 3623 | int ata_sas_port_start(struct ata_port *ap) | 
 | 3624 | { | 
| James Bottomley | dde2020 | 2008-02-19 11:36:56 +0100 | [diff] [blame] | 3625 | 	return 0; | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3626 | } | 
 | 3627 | EXPORT_SYMBOL_GPL(ata_sas_port_start); | 
 | 3628 |  | 
 | 3629 | /** | 
 | 3630 |  *	ata_port_stop - Undo ata_sas_port_start() | 
 | 3631 |  *	@ap: Port to shut down | 
 | 3632 |  * | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3633 |  *	May be used as the port_stop() entry in ata_port_operations. | 
 | 3634 |  * | 
 | 3635 |  *	LOCKING: | 
 | 3636 |  *	Inherited from caller. | 
 | 3637 |  */ | 
 | 3638 |  | 
 | 3639 | void ata_sas_port_stop(struct ata_port *ap) | 
 | 3640 | { | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3641 | } | 
 | 3642 | EXPORT_SYMBOL_GPL(ata_sas_port_stop); | 
 | 3643 |  | 
 | 3644 | /** | 
 | 3645 |  *	ata_sas_port_init - Initialize a SATA device | 
 | 3646 |  *	@ap: SATA port to initialize | 
 | 3647 |  * | 
 | 3648 |  *	LOCKING: | 
 | 3649 |  *	PCI/etc. bus probe sem. | 
 | 3650 |  * | 
 | 3651 |  *	RETURNS: | 
 | 3652 |  *	Zero on success, non-zero on error. | 
 | 3653 |  */ | 
 | 3654 |  | 
 | 3655 | int ata_sas_port_init(struct ata_port *ap) | 
 | 3656 | { | 
 | 3657 | 	int rc = ap->ops->port_start(ap); | 
 | 3658 |  | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 3659 | 	if (!rc) { | 
 | 3660 | 		ap->print_id = ata_print_id++; | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3661 | 		rc = ata_bus_probe(ap); | 
| Tejun Heo | f318719 | 2007-04-17 23:44:07 +0900 | [diff] [blame] | 3662 | 	} | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3663 |  | 
 | 3664 | 	return rc; | 
 | 3665 | } | 
 | 3666 | EXPORT_SYMBOL_GPL(ata_sas_port_init); | 
 | 3667 |  | 
 | 3668 | /** | 
 | 3669 |  *	ata_sas_port_destroy - Destroy a SATA port allocated by ata_sas_port_alloc | 
 | 3670 |  *	@ap: SATA port to destroy | 
 | 3671 |  * | 
 | 3672 |  */ | 
 | 3673 |  | 
 | 3674 | void ata_sas_port_destroy(struct ata_port *ap) | 
 | 3675 | { | 
| Tejun Heo | f0d36ef | 2007-01-20 16:00:28 +0900 | [diff] [blame] | 3676 | 	if (ap->ops->port_stop) | 
 | 3677 | 		ap->ops->port_stop(ap); | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3678 | 	kfree(ap); | 
 | 3679 | } | 
 | 3680 | EXPORT_SYMBOL_GPL(ata_sas_port_destroy); | 
 | 3681 |  | 
 | 3682 | /** | 
 | 3683 |  *	ata_sas_slave_configure - Default slave_config routine for libata devices | 
 | 3684 |  *	@sdev: SCSI device to configure | 
 | 3685 |  *	@ap: ATA port to which SCSI device is attached | 
 | 3686 |  * | 
 | 3687 |  *	RETURNS: | 
 | 3688 |  *	Zero. | 
 | 3689 |  */ | 
 | 3690 |  | 
 | 3691 | int ata_sas_slave_configure(struct scsi_device *sdev, struct ata_port *ap) | 
 | 3692 | { | 
 | 3693 | 	ata_scsi_sdev_config(sdev); | 
| Tejun Heo | 9af5c9c | 2007-08-06 18:36:22 +0900 | [diff] [blame] | 3694 | 	ata_scsi_dev_config(sdev, ap->link.device); | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3695 | 	return 0; | 
 | 3696 | } | 
 | 3697 | EXPORT_SYMBOL_GPL(ata_sas_slave_configure); | 
 | 3698 |  | 
 | 3699 | /** | 
 | 3700 |  *	ata_sas_queuecmd - Issue SCSI cdb to libata-managed device | 
 | 3701 |  *	@cmd: SCSI command to be sent | 
 | 3702 |  *	@done: Completion function, called when command is complete | 
 | 3703 |  *	@ap:	ATA port to which the command is being sent | 
 | 3704 |  * | 
 | 3705 |  *	RETURNS: | 
| Brian King | 08475a1 | 2006-11-20 13:51:56 -0600 | [diff] [blame] | 3706 |  *	Return value from __ata_scsi_queuecmd() if @cmd can be queued, | 
 | 3707 |  *	0 otherwise. | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3708 |  */ | 
 | 3709 |  | 
 | 3710 | int ata_sas_queuecmd(struct scsi_cmnd *cmd, void (*done)(struct scsi_cmnd *), | 
 | 3711 | 		     struct ata_port *ap) | 
 | 3712 | { | 
| Brian King | 08475a1 | 2006-11-20 13:51:56 -0600 | [diff] [blame] | 3713 | 	int rc = 0; | 
 | 3714 |  | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3715 | 	ata_scsi_dump_cdb(ap, cmd); | 
 | 3716 |  | 
| Tejun Heo | 2486fa5 | 2008-07-31 07:52:40 +0900 | [diff] [blame] | 3717 | 	if (likely(ata_dev_enabled(ap->link.device))) | 
| Tejun Heo | 9af5c9c | 2007-08-06 18:36:22 +0900 | [diff] [blame] | 3718 | 		rc = __ata_scsi_queuecmd(cmd, done, ap->link.device); | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3719 | 	else { | 
 | 3720 | 		cmd->result = (DID_BAD_TARGET << 16); | 
 | 3721 | 		done(cmd); | 
 | 3722 | 	} | 
| Brian King | 08475a1 | 2006-11-20 13:51:56 -0600 | [diff] [blame] | 3723 | 	return rc; | 
| Brian King | 8028916 | 2006-08-07 14:27:31 -0500 | [diff] [blame] | 3724 | } | 
 | 3725 | EXPORT_SYMBOL_GPL(ata_sas_queuecmd); |