xref: /openbmc/linux/drivers/ata/libata-eh.c (revision 258c4e5c65b21bdbe9735f49ea584b3059c810e4)
1c6fd2807SJeff Garzik /*
2c6fd2807SJeff Garzik  *  libata-eh.c - libata error handling
3c6fd2807SJeff Garzik  *
48c3d3d4bSTejun Heo  *  Maintained by:  Tejun Heo <tj@kernel.org>
5c6fd2807SJeff Garzik  *    		    Please ALWAYS copy linux-ide@vger.kernel.org
6c6fd2807SJeff Garzik  *		    on emails.
7c6fd2807SJeff Garzik  *
8c6fd2807SJeff Garzik  *  Copyright 2006 Tejun Heo <htejun@gmail.com>
9c6fd2807SJeff Garzik  *
10c6fd2807SJeff Garzik  *
11c6fd2807SJeff Garzik  *  This program is free software; you can redistribute it and/or
12c6fd2807SJeff Garzik  *  modify it under the terms of the GNU General Public License as
13c6fd2807SJeff Garzik  *  published by the Free Software Foundation; either version 2, or
14c6fd2807SJeff Garzik  *  (at your option) any later version.
15c6fd2807SJeff Garzik  *
16c6fd2807SJeff Garzik  *  This program is distributed in the hope that it will be useful,
17c6fd2807SJeff Garzik  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
18c6fd2807SJeff Garzik  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
19c6fd2807SJeff Garzik  *  General Public License for more details.
20c6fd2807SJeff Garzik  *
21c6fd2807SJeff Garzik  *  You should have received a copy of the GNU General Public License
22c6fd2807SJeff Garzik  *  along with this program; see the file COPYING.  If not, write to
23c6fd2807SJeff Garzik  *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139,
24c6fd2807SJeff Garzik  *  USA.
25c6fd2807SJeff Garzik  *
26c6fd2807SJeff Garzik  *
27c6fd2807SJeff Garzik  *  libata documentation is available via 'make {ps|pdf}docs',
289bb9a39cSMauro Carvalho Chehab  *  as Documentation/driver-api/libata.rst
29c6fd2807SJeff Garzik  *
30c6fd2807SJeff Garzik  *  Hardware documentation available from http://www.t13.org/ and
31c6fd2807SJeff Garzik  *  http://www.sata-io.org/
32c6fd2807SJeff Garzik  *
33c6fd2807SJeff Garzik  */
34c6fd2807SJeff Garzik 
35c6fd2807SJeff Garzik #include <linux/kernel.h>
36242f9dcbSJens Axboe #include <linux/blkdev.h>
3738789fdaSPaul Gortmaker #include <linux/export.h>
382855568bSJeff Garzik #include <linux/pci.h>
39c6fd2807SJeff Garzik #include <scsi/scsi.h>
40c6fd2807SJeff Garzik #include <scsi/scsi_host.h>
41c6fd2807SJeff Garzik #include <scsi/scsi_eh.h>
42c6fd2807SJeff Garzik #include <scsi/scsi_device.h>
43c6fd2807SJeff Garzik #include <scsi/scsi_cmnd.h>
446521148cSRobert Hancock #include <scsi/scsi_dbg.h>
45c6fd2807SJeff Garzik #include "../scsi/scsi_transport_api.h"
46c6fd2807SJeff Garzik 
47c6fd2807SJeff Garzik #include <linux/libata.h>
48c6fd2807SJeff Garzik 
49255c03d1SHannes Reinecke #include <trace/events/libata.h>
50c6fd2807SJeff Garzik #include "libata.h"
51c6fd2807SJeff Garzik 
527d47e8d4STejun Heo enum {
533884f7b0STejun Heo 	/* speed down verdicts */
547d47e8d4STejun Heo 	ATA_EH_SPDN_NCQ_OFF		= (1 << 0),
557d47e8d4STejun Heo 	ATA_EH_SPDN_SPEED_DOWN		= (1 << 1),
567d47e8d4STejun Heo 	ATA_EH_SPDN_FALLBACK_TO_PIO	= (1 << 2),
5776326ac1STejun Heo 	ATA_EH_SPDN_KEEP_ERRORS		= (1 << 3),
583884f7b0STejun Heo 
593884f7b0STejun Heo 	/* error flags */
603884f7b0STejun Heo 	ATA_EFLAG_IS_IO			= (1 << 0),
6176326ac1STejun Heo 	ATA_EFLAG_DUBIOUS_XFER		= (1 << 1),
62d9027470SGwendal Grignou 	ATA_EFLAG_OLD_ER                = (1 << 31),
633884f7b0STejun Heo 
643884f7b0STejun Heo 	/* error categories */
653884f7b0STejun Heo 	ATA_ECAT_NONE			= 0,
663884f7b0STejun Heo 	ATA_ECAT_ATA_BUS		= 1,
673884f7b0STejun Heo 	ATA_ECAT_TOUT_HSM		= 2,
683884f7b0STejun Heo 	ATA_ECAT_UNK_DEV		= 3,
6975f9cafcSTejun Heo 	ATA_ECAT_DUBIOUS_NONE		= 4,
7075f9cafcSTejun Heo 	ATA_ECAT_DUBIOUS_ATA_BUS	= 5,
7175f9cafcSTejun Heo 	ATA_ECAT_DUBIOUS_TOUT_HSM	= 6,
7275f9cafcSTejun Heo 	ATA_ECAT_DUBIOUS_UNK_DEV	= 7,
7375f9cafcSTejun Heo 	ATA_ECAT_NR			= 8,
747d47e8d4STejun Heo 
7587fbc5a0STejun Heo 	ATA_EH_CMD_DFL_TIMEOUT		=  5000,
7687fbc5a0STejun Heo 
770a2c0f56STejun Heo 	/* always put at least this amount of time between resets */
780a2c0f56STejun Heo 	ATA_EH_RESET_COOL_DOWN		=  5000,
790a2c0f56STejun Heo 
80341c2c95STejun Heo 	/* Waiting in ->prereset can never be reliable.  It's
81341c2c95STejun Heo 	 * sometimes nice to wait there but it can't be depended upon;
82341c2c95STejun Heo 	 * otherwise, we wouldn't be resetting.  Just give it enough
83341c2c95STejun Heo 	 * time for most drives to spin up.
8431daabdaSTejun Heo 	 */
85341c2c95STejun Heo 	ATA_EH_PRERESET_TIMEOUT		= 10000,
86341c2c95STejun Heo 	ATA_EH_FASTDRAIN_INTERVAL	=  3000,
8711fc33daSTejun Heo 
8811fc33daSTejun Heo 	ATA_EH_UA_TRIES			= 5,
89c2c7a89cSTejun Heo 
90c2c7a89cSTejun Heo 	/* probe speed down parameters, see ata_eh_schedule_probe() */
91c2c7a89cSTejun Heo 	ATA_EH_PROBE_TRIAL_INTERVAL	= 60000,	/* 1 min */
92c2c7a89cSTejun Heo 	ATA_EH_PROBE_TRIALS		= 2,
9331daabdaSTejun Heo };
9431daabdaSTejun Heo 
9531daabdaSTejun Heo /* The following table determines how we sequence resets.  Each entry
9631daabdaSTejun Heo  * represents timeout for that try.  The first try can be soft or
9731daabdaSTejun Heo  * hardreset.  All others are hardreset if available.  In most cases
9831daabdaSTejun Heo  * the first reset w/ 10sec timeout should succeed.  Following entries
9935bf8821SDan Williams  * are mostly for error handling, hotplug and those outlier devices that
10035bf8821SDan Williams  * take an exceptionally long time to recover from reset.
10131daabdaSTejun Heo  */
10231daabdaSTejun Heo static const unsigned long ata_eh_reset_timeouts[] = {
103341c2c95STejun Heo 	10000,	/* most drives spin up by 10sec */
104341c2c95STejun Heo 	10000,	/* > 99% working drives spin up before 20sec */
10535bf8821SDan Williams 	35000,	/* give > 30 secs of idleness for outlier devices */
106341c2c95STejun Heo 	 5000,	/* and sweet one last chance */
107d8af0eb6STejun Heo 	ULONG_MAX, /* > 1 min has elapsed, give up */
10831daabdaSTejun Heo };
10931daabdaSTejun Heo 
11087fbc5a0STejun Heo static const unsigned long ata_eh_identify_timeouts[] = {
11187fbc5a0STejun Heo 	 5000,	/* covers > 99% of successes and not too boring on failures */
11287fbc5a0STejun Heo 	10000,  /* combined time till here is enough even for media access */
11387fbc5a0STejun Heo 	30000,	/* for true idiots */
11487fbc5a0STejun Heo 	ULONG_MAX,
11587fbc5a0STejun Heo };
11687fbc5a0STejun Heo 
1176013efd8STejun Heo static const unsigned long ata_eh_flush_timeouts[] = {
1186013efd8STejun Heo 	15000,	/* be generous with flush */
1196013efd8STejun Heo 	15000,  /* ditto */
1206013efd8STejun Heo 	30000,	/* and even more generous */
1216013efd8STejun Heo 	ULONG_MAX,
1226013efd8STejun Heo };
1236013efd8STejun Heo 
12487fbc5a0STejun Heo static const unsigned long ata_eh_other_timeouts[] = {
12587fbc5a0STejun Heo 	 5000,	/* same rationale as identify timeout */
12687fbc5a0STejun Heo 	10000,	/* ditto */
12787fbc5a0STejun Heo 	/* but no merciful 30sec for other commands, it just isn't worth it */
12887fbc5a0STejun Heo 	ULONG_MAX,
12987fbc5a0STejun Heo };
13087fbc5a0STejun Heo 
13187fbc5a0STejun Heo struct ata_eh_cmd_timeout_ent {
13287fbc5a0STejun Heo 	const u8		*commands;
13387fbc5a0STejun Heo 	const unsigned long	*timeouts;
13487fbc5a0STejun Heo };
13587fbc5a0STejun Heo 
13687fbc5a0STejun Heo /* The following table determines timeouts to use for EH internal
13787fbc5a0STejun Heo  * commands.  Each table entry is a command class and matches the
13887fbc5a0STejun Heo  * commands the entry applies to and the timeout table to use.
13987fbc5a0STejun Heo  *
14087fbc5a0STejun Heo  * On the retry after a command timed out, the next timeout value from
14187fbc5a0STejun Heo  * the table is used.  If the table doesn't contain further entries,
14287fbc5a0STejun Heo  * the last value is used.
14387fbc5a0STejun Heo  *
14487fbc5a0STejun Heo  * ehc->cmd_timeout_idx keeps track of which timeout to use per
14587fbc5a0STejun Heo  * command class, so if SET_FEATURES times out on the first try, the
14687fbc5a0STejun Heo  * next try will use the second timeout value only for that class.
14787fbc5a0STejun Heo  */
14887fbc5a0STejun Heo #define CMDS(cmds...)	(const u8 []){ cmds, 0 }
14987fbc5a0STejun Heo static const struct ata_eh_cmd_timeout_ent
15087fbc5a0STejun Heo ata_eh_cmd_timeout_table[ATA_EH_CMD_TIMEOUT_TABLE_SIZE] = {
15187fbc5a0STejun Heo 	{ .commands = CMDS(ATA_CMD_ID_ATA, ATA_CMD_ID_ATAPI),
15287fbc5a0STejun Heo 	  .timeouts = ata_eh_identify_timeouts, },
15387fbc5a0STejun Heo 	{ .commands = CMDS(ATA_CMD_READ_NATIVE_MAX, ATA_CMD_READ_NATIVE_MAX_EXT),
15487fbc5a0STejun Heo 	  .timeouts = ata_eh_other_timeouts, },
15587fbc5a0STejun Heo 	{ .commands = CMDS(ATA_CMD_SET_MAX, ATA_CMD_SET_MAX_EXT),
15687fbc5a0STejun Heo 	  .timeouts = ata_eh_other_timeouts, },
15787fbc5a0STejun Heo 	{ .commands = CMDS(ATA_CMD_SET_FEATURES),
15887fbc5a0STejun Heo 	  .timeouts = ata_eh_other_timeouts, },
15987fbc5a0STejun Heo 	{ .commands = CMDS(ATA_CMD_INIT_DEV_PARAMS),
16087fbc5a0STejun Heo 	  .timeouts = ata_eh_other_timeouts, },
1616013efd8STejun Heo 	{ .commands = CMDS(ATA_CMD_FLUSH, ATA_CMD_FLUSH_EXT),
1626013efd8STejun Heo 	  .timeouts = ata_eh_flush_timeouts },
16387fbc5a0STejun Heo };
16487fbc5a0STejun Heo #undef CMDS
16587fbc5a0STejun Heo 
166c6fd2807SJeff Garzik static void __ata_port_freeze(struct ata_port *ap);
1676ffa01d8STejun Heo #ifdef CONFIG_PM
168c6fd2807SJeff Garzik static void ata_eh_handle_port_suspend(struct ata_port *ap);
169c6fd2807SJeff Garzik static void ata_eh_handle_port_resume(struct ata_port *ap);
1706ffa01d8STejun Heo #else /* CONFIG_PM */
1716ffa01d8STejun Heo static void ata_eh_handle_port_suspend(struct ata_port *ap)
1726ffa01d8STejun Heo { }
1736ffa01d8STejun Heo 
1746ffa01d8STejun Heo static void ata_eh_handle_port_resume(struct ata_port *ap)
1756ffa01d8STejun Heo { }
1766ffa01d8STejun Heo #endif /* CONFIG_PM */
177c6fd2807SJeff Garzik 
1780d74d872SMathieu Malaterre static __printf(2, 0) void __ata_ehi_pushv_desc(struct ata_eh_info *ehi,
1790d74d872SMathieu Malaterre 				 const char *fmt, va_list args)
180b64bbc39STejun Heo {
181b64bbc39STejun Heo 	ehi->desc_len += vscnprintf(ehi->desc + ehi->desc_len,
182b64bbc39STejun Heo 				     ATA_EH_DESC_LEN - ehi->desc_len,
183b64bbc39STejun Heo 				     fmt, args);
184b64bbc39STejun Heo }
185b64bbc39STejun Heo 
186b64bbc39STejun Heo /**
187b64bbc39STejun Heo  *	__ata_ehi_push_desc - push error description without adding separator
188b64bbc39STejun Heo  *	@ehi: target EHI
189b64bbc39STejun Heo  *	@fmt: printf format string
190b64bbc39STejun Heo  *
191b64bbc39STejun Heo  *	Format string according to @fmt and append it to @ehi->desc.
192b64bbc39STejun Heo  *
193b64bbc39STejun Heo  *	LOCKING:
194b64bbc39STejun Heo  *	spin_lock_irqsave(host lock)
195b64bbc39STejun Heo  */
196b64bbc39STejun Heo void __ata_ehi_push_desc(struct ata_eh_info *ehi, const char *fmt, ...)
197b64bbc39STejun Heo {
198b64bbc39STejun Heo 	va_list args;
199b64bbc39STejun Heo 
200b64bbc39STejun Heo 	va_start(args, fmt);
201b64bbc39STejun Heo 	__ata_ehi_pushv_desc(ehi, fmt, args);
202b64bbc39STejun Heo 	va_end(args);
203b64bbc39STejun Heo }
204b64bbc39STejun Heo 
205b64bbc39STejun Heo /**
206b64bbc39STejun Heo  *	ata_ehi_push_desc - push error description with separator
207b64bbc39STejun Heo  *	@ehi: target EHI
208b64bbc39STejun Heo  *	@fmt: printf format string
209b64bbc39STejun Heo  *
210b64bbc39STejun Heo  *	Format string according to @fmt and append it to @ehi->desc.
211b64bbc39STejun Heo  *	If @ehi->desc is not empty, ", " is added in-between.
212b64bbc39STejun Heo  *
213b64bbc39STejun Heo  *	LOCKING:
214b64bbc39STejun Heo  *	spin_lock_irqsave(host lock)
215b64bbc39STejun Heo  */
216b64bbc39STejun Heo void ata_ehi_push_desc(struct ata_eh_info *ehi, const char *fmt, ...)
217b64bbc39STejun Heo {
218b64bbc39STejun Heo 	va_list args;
219b64bbc39STejun Heo 
220b64bbc39STejun Heo 	if (ehi->desc_len)
221b64bbc39STejun Heo 		__ata_ehi_push_desc(ehi, ", ");
222b64bbc39STejun Heo 
223b64bbc39STejun Heo 	va_start(args, fmt);
224b64bbc39STejun Heo 	__ata_ehi_pushv_desc(ehi, fmt, args);
225b64bbc39STejun Heo 	va_end(args);
226b64bbc39STejun Heo }
227b64bbc39STejun Heo 
228b64bbc39STejun Heo /**
229b64bbc39STejun Heo  *	ata_ehi_clear_desc - clean error description
230b64bbc39STejun Heo  *	@ehi: target EHI
231b64bbc39STejun Heo  *
232b64bbc39STejun Heo  *	Clear @ehi->desc.
233b64bbc39STejun Heo  *
234b64bbc39STejun Heo  *	LOCKING:
235b64bbc39STejun Heo  *	spin_lock_irqsave(host lock)
236b64bbc39STejun Heo  */
237b64bbc39STejun Heo void ata_ehi_clear_desc(struct ata_eh_info *ehi)
238b64bbc39STejun Heo {
239b64bbc39STejun Heo 	ehi->desc[0] = '\0';
240b64bbc39STejun Heo 	ehi->desc_len = 0;
241b64bbc39STejun Heo }
242b64bbc39STejun Heo 
243cbcdd875STejun Heo /**
244cbcdd875STejun Heo  *	ata_port_desc - append port description
245cbcdd875STejun Heo  *	@ap: target ATA port
246cbcdd875STejun Heo  *	@fmt: printf format string
247cbcdd875STejun Heo  *
248cbcdd875STejun Heo  *	Format string according to @fmt and append it to port
249cbcdd875STejun Heo  *	description.  If port description is not empty, " " is added
250cbcdd875STejun Heo  *	in-between.  This function is to be used while initializing
251cbcdd875STejun Heo  *	ata_host.  The description is printed on host registration.
252cbcdd875STejun Heo  *
253cbcdd875STejun Heo  *	LOCKING:
254cbcdd875STejun Heo  *	None.
255cbcdd875STejun Heo  */
256cbcdd875STejun Heo void ata_port_desc(struct ata_port *ap, const char *fmt, ...)
257cbcdd875STejun Heo {
258cbcdd875STejun Heo 	va_list args;
259cbcdd875STejun Heo 
260cbcdd875STejun Heo 	WARN_ON(!(ap->pflags & ATA_PFLAG_INITIALIZING));
261cbcdd875STejun Heo 
262cbcdd875STejun Heo 	if (ap->link.eh_info.desc_len)
263cbcdd875STejun Heo 		__ata_ehi_push_desc(&ap->link.eh_info, " ");
264cbcdd875STejun Heo 
265cbcdd875STejun Heo 	va_start(args, fmt);
266cbcdd875STejun Heo 	__ata_ehi_pushv_desc(&ap->link.eh_info, fmt, args);
267cbcdd875STejun Heo 	va_end(args);
268cbcdd875STejun Heo }
269cbcdd875STejun Heo 
270cbcdd875STejun Heo #ifdef CONFIG_PCI
271cbcdd875STejun Heo 
272cbcdd875STejun Heo /**
273cbcdd875STejun Heo  *	ata_port_pbar_desc - append PCI BAR description
274cbcdd875STejun Heo  *	@ap: target ATA port
275cbcdd875STejun Heo  *	@bar: target PCI BAR
276cbcdd875STejun Heo  *	@offset: offset into PCI BAR
277cbcdd875STejun Heo  *	@name: name of the area
278cbcdd875STejun Heo  *
279cbcdd875STejun Heo  *	If @offset is negative, this function formats a string which
280cbcdd875STejun Heo  *	contains the name, address, size and type of the BAR and
281cbcdd875STejun Heo  *	appends it to the port description.  If @offset is zero or
282cbcdd875STejun Heo  *	positive, only name and offsetted address is appended.
283cbcdd875STejun Heo  *
284cbcdd875STejun Heo  *	LOCKING:
285cbcdd875STejun Heo  *	None.
286cbcdd875STejun Heo  */
287cbcdd875STejun Heo void ata_port_pbar_desc(struct ata_port *ap, int bar, ssize_t offset,
288cbcdd875STejun Heo 			const char *name)
289cbcdd875STejun Heo {
290cbcdd875STejun Heo 	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
291cbcdd875STejun Heo 	char *type = "";
292cbcdd875STejun Heo 	unsigned long long start, len;
293cbcdd875STejun Heo 
294cbcdd875STejun Heo 	if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM)
295cbcdd875STejun Heo 		type = "m";
296cbcdd875STejun Heo 	else if (pci_resource_flags(pdev, bar) & IORESOURCE_IO)
297cbcdd875STejun Heo 		type = "i";
298cbcdd875STejun Heo 
299cbcdd875STejun Heo 	start = (unsigned long long)pci_resource_start(pdev, bar);
300cbcdd875STejun Heo 	len = (unsigned long long)pci_resource_len(pdev, bar);
301cbcdd875STejun Heo 
302cbcdd875STejun Heo 	if (offset < 0)
303cbcdd875STejun Heo 		ata_port_desc(ap, "%s %s%llu@0x%llx", name, type, len, start);
304cbcdd875STejun Heo 	else
305e6a73ab1SAndrew Morton 		ata_port_desc(ap, "%s 0x%llx", name,
306e6a73ab1SAndrew Morton 				start + (unsigned long long)offset);
307cbcdd875STejun Heo }
308cbcdd875STejun Heo 
309cbcdd875STejun Heo #endif /* CONFIG_PCI */
310cbcdd875STejun Heo 
31187fbc5a0STejun Heo static int ata_lookup_timeout_table(u8 cmd)
31287fbc5a0STejun Heo {
31387fbc5a0STejun Heo 	int i;
31487fbc5a0STejun Heo 
31587fbc5a0STejun Heo 	for (i = 0; i < ATA_EH_CMD_TIMEOUT_TABLE_SIZE; i++) {
31687fbc5a0STejun Heo 		const u8 *cur;
31787fbc5a0STejun Heo 
31887fbc5a0STejun Heo 		for (cur = ata_eh_cmd_timeout_table[i].commands; *cur; cur++)
31987fbc5a0STejun Heo 			if (*cur == cmd)
32087fbc5a0STejun Heo 				return i;
32187fbc5a0STejun Heo 	}
32287fbc5a0STejun Heo 
32387fbc5a0STejun Heo 	return -1;
32487fbc5a0STejun Heo }
32587fbc5a0STejun Heo 
32687fbc5a0STejun Heo /**
32787fbc5a0STejun Heo  *	ata_internal_cmd_timeout - determine timeout for an internal command
32887fbc5a0STejun Heo  *	@dev: target device
32987fbc5a0STejun Heo  *	@cmd: internal command to be issued
33087fbc5a0STejun Heo  *
33187fbc5a0STejun Heo  *	Determine timeout for internal command @cmd for @dev.
33287fbc5a0STejun Heo  *
33387fbc5a0STejun Heo  *	LOCKING:
33487fbc5a0STejun Heo  *	EH context.
33587fbc5a0STejun Heo  *
33687fbc5a0STejun Heo  *	RETURNS:
33787fbc5a0STejun Heo  *	Determined timeout.
33887fbc5a0STejun Heo  */
33987fbc5a0STejun Heo unsigned long ata_internal_cmd_timeout(struct ata_device *dev, u8 cmd)
34087fbc5a0STejun Heo {
34187fbc5a0STejun Heo 	struct ata_eh_context *ehc = &dev->link->eh_context;
34287fbc5a0STejun Heo 	int ent = ata_lookup_timeout_table(cmd);
34387fbc5a0STejun Heo 	int idx;
34487fbc5a0STejun Heo 
34587fbc5a0STejun Heo 	if (ent < 0)
34687fbc5a0STejun Heo 		return ATA_EH_CMD_DFL_TIMEOUT;
34787fbc5a0STejun Heo 
34887fbc5a0STejun Heo 	idx = ehc->cmd_timeout_idx[dev->devno][ent];
34987fbc5a0STejun Heo 	return ata_eh_cmd_timeout_table[ent].timeouts[idx];
35087fbc5a0STejun Heo }
35187fbc5a0STejun Heo 
35287fbc5a0STejun Heo /**
35387fbc5a0STejun Heo  *	ata_internal_cmd_timed_out - notification for internal command timeout
35487fbc5a0STejun Heo  *	@dev: target device
35587fbc5a0STejun Heo  *	@cmd: internal command which timed out
35687fbc5a0STejun Heo  *
35787fbc5a0STejun Heo  *	Notify EH that internal command @cmd for @dev timed out.  This
35887fbc5a0STejun Heo  *	function should be called only for commands whose timeouts are
35987fbc5a0STejun Heo  *	determined using ata_internal_cmd_timeout().
36087fbc5a0STejun Heo  *
36187fbc5a0STejun Heo  *	LOCKING:
36287fbc5a0STejun Heo  *	EH context.
36387fbc5a0STejun Heo  */
36487fbc5a0STejun Heo void ata_internal_cmd_timed_out(struct ata_device *dev, u8 cmd)
36587fbc5a0STejun Heo {
36687fbc5a0STejun Heo 	struct ata_eh_context *ehc = &dev->link->eh_context;
36787fbc5a0STejun Heo 	int ent = ata_lookup_timeout_table(cmd);
36887fbc5a0STejun Heo 	int idx;
36987fbc5a0STejun Heo 
37087fbc5a0STejun Heo 	if (ent < 0)
37187fbc5a0STejun Heo 		return;
37287fbc5a0STejun Heo 
37387fbc5a0STejun Heo 	idx = ehc->cmd_timeout_idx[dev->devno][ent];
37487fbc5a0STejun Heo 	if (ata_eh_cmd_timeout_table[ent].timeouts[idx + 1] != ULONG_MAX)
37587fbc5a0STejun Heo 		ehc->cmd_timeout_idx[dev->devno][ent]++;
37687fbc5a0STejun Heo }
37787fbc5a0STejun Heo 
3783884f7b0STejun Heo static void ata_ering_record(struct ata_ering *ering, unsigned int eflags,
379c6fd2807SJeff Garzik 			     unsigned int err_mask)
380c6fd2807SJeff Garzik {
381c6fd2807SJeff Garzik 	struct ata_ering_entry *ent;
382c6fd2807SJeff Garzik 
383c6fd2807SJeff Garzik 	WARN_ON(!err_mask);
384c6fd2807SJeff Garzik 
385c6fd2807SJeff Garzik 	ering->cursor++;
386c6fd2807SJeff Garzik 	ering->cursor %= ATA_ERING_SIZE;
387c6fd2807SJeff Garzik 
388c6fd2807SJeff Garzik 	ent = &ering->ring[ering->cursor];
3893884f7b0STejun Heo 	ent->eflags = eflags;
390c6fd2807SJeff Garzik 	ent->err_mask = err_mask;
391c6fd2807SJeff Garzik 	ent->timestamp = get_jiffies_64();
392c6fd2807SJeff Garzik }
393c6fd2807SJeff Garzik 
39476326ac1STejun Heo static struct ata_ering_entry *ata_ering_top(struct ata_ering *ering)
39576326ac1STejun Heo {
39676326ac1STejun Heo 	struct ata_ering_entry *ent = &ering->ring[ering->cursor];
39776326ac1STejun Heo 
39876326ac1STejun Heo 	if (ent->err_mask)
39976326ac1STejun Heo 		return ent;
40076326ac1STejun Heo 	return NULL;
40176326ac1STejun Heo }
40276326ac1STejun Heo 
403d9027470SGwendal Grignou int ata_ering_map(struct ata_ering *ering,
404c6fd2807SJeff Garzik 		  int (*map_fn)(struct ata_ering_entry *, void *),
405c6fd2807SJeff Garzik 		  void *arg)
406c6fd2807SJeff Garzik {
407c6fd2807SJeff Garzik 	int idx, rc = 0;
408c6fd2807SJeff Garzik 	struct ata_ering_entry *ent;
409c6fd2807SJeff Garzik 
410c6fd2807SJeff Garzik 	idx = ering->cursor;
411c6fd2807SJeff Garzik 	do {
412c6fd2807SJeff Garzik 		ent = &ering->ring[idx];
413c6fd2807SJeff Garzik 		if (!ent->err_mask)
414c6fd2807SJeff Garzik 			break;
415c6fd2807SJeff Garzik 		rc = map_fn(ent, arg);
416c6fd2807SJeff Garzik 		if (rc)
417c6fd2807SJeff Garzik 			break;
418c6fd2807SJeff Garzik 		idx = (idx - 1 + ATA_ERING_SIZE) % ATA_ERING_SIZE;
419c6fd2807SJeff Garzik 	} while (idx != ering->cursor);
420c6fd2807SJeff Garzik 
421c6fd2807SJeff Garzik 	return rc;
422c6fd2807SJeff Garzik }
423c6fd2807SJeff Garzik 
42460428407SH Hartley Sweeten static int ata_ering_clear_cb(struct ata_ering_entry *ent, void *void_arg)
425d9027470SGwendal Grignou {
426d9027470SGwendal Grignou 	ent->eflags |= ATA_EFLAG_OLD_ER;
427d9027470SGwendal Grignou 	return 0;
428d9027470SGwendal Grignou }
429d9027470SGwendal Grignou 
430d9027470SGwendal Grignou static void ata_ering_clear(struct ata_ering *ering)
431d9027470SGwendal Grignou {
432d9027470SGwendal Grignou 	ata_ering_map(ering, ata_ering_clear_cb, NULL);
433d9027470SGwendal Grignou }
434d9027470SGwendal Grignou 
435c6fd2807SJeff Garzik static unsigned int ata_eh_dev_action(struct ata_device *dev)
436c6fd2807SJeff Garzik {
4379af5c9c9STejun Heo 	struct ata_eh_context *ehc = &dev->link->eh_context;
438c6fd2807SJeff Garzik 
439c6fd2807SJeff Garzik 	return ehc->i.action | ehc->i.dev_action[dev->devno];
440c6fd2807SJeff Garzik }
441c6fd2807SJeff Garzik 
442f58229f8STejun Heo static void ata_eh_clear_action(struct ata_link *link, struct ata_device *dev,
443c6fd2807SJeff Garzik 				struct ata_eh_info *ehi, unsigned int action)
444c6fd2807SJeff Garzik {
445f58229f8STejun Heo 	struct ata_device *tdev;
446c6fd2807SJeff Garzik 
447c6fd2807SJeff Garzik 	if (!dev) {
448c6fd2807SJeff Garzik 		ehi->action &= ~action;
4491eca4365STejun Heo 		ata_for_each_dev(tdev, link, ALL)
450f58229f8STejun Heo 			ehi->dev_action[tdev->devno] &= ~action;
451c6fd2807SJeff Garzik 	} else {
452c6fd2807SJeff Garzik 		/* doesn't make sense for port-wide EH actions */
453c6fd2807SJeff Garzik 		WARN_ON(!(action & ATA_EH_PERDEV_MASK));
454c6fd2807SJeff Garzik 
455c6fd2807SJeff Garzik 		/* break ehi->action into ehi->dev_action */
456c6fd2807SJeff Garzik 		if (ehi->action & action) {
4571eca4365STejun Heo 			ata_for_each_dev(tdev, link, ALL)
458f58229f8STejun Heo 				ehi->dev_action[tdev->devno] |=
459f58229f8STejun Heo 					ehi->action & action;
460c6fd2807SJeff Garzik 			ehi->action &= ~action;
461c6fd2807SJeff Garzik 		}
462c6fd2807SJeff Garzik 
463c6fd2807SJeff Garzik 		/* turn off the specified per-dev action */
464c6fd2807SJeff Garzik 		ehi->dev_action[dev->devno] &= ~action;
465c6fd2807SJeff Garzik 	}
466c6fd2807SJeff Garzik }
467c6fd2807SJeff Garzik 
468c6fd2807SJeff Garzik /**
469c0c362b6STejun Heo  *	ata_eh_acquire - acquire EH ownership
470c0c362b6STejun Heo  *	@ap: ATA port to acquire EH ownership for
471c0c362b6STejun Heo  *
472c0c362b6STejun Heo  *	Acquire EH ownership for @ap.  This is the basic exclusion
473c0c362b6STejun Heo  *	mechanism for ports sharing a host.  Only one port hanging off
474c0c362b6STejun Heo  *	the same host can claim the ownership of EH.
475c0c362b6STejun Heo  *
476c0c362b6STejun Heo  *	LOCKING:
477c0c362b6STejun Heo  *	EH context.
478c0c362b6STejun Heo  */
479c0c362b6STejun Heo void ata_eh_acquire(struct ata_port *ap)
480c0c362b6STejun Heo {
481c0c362b6STejun Heo 	mutex_lock(&ap->host->eh_mutex);
482c0c362b6STejun Heo 	WARN_ON_ONCE(ap->host->eh_owner);
483c0c362b6STejun Heo 	ap->host->eh_owner = current;
484c0c362b6STejun Heo }
485c0c362b6STejun Heo 
486c0c362b6STejun Heo /**
487c0c362b6STejun Heo  *	ata_eh_release - release EH ownership
488c0c362b6STejun Heo  *	@ap: ATA port to release EH ownership for
489c0c362b6STejun Heo  *
490c0c362b6STejun Heo  *	Release EH ownership for @ap if the caller.  The caller must
491c0c362b6STejun Heo  *	have acquired EH ownership using ata_eh_acquire() previously.
492c0c362b6STejun Heo  *
493c0c362b6STejun Heo  *	LOCKING:
494c0c362b6STejun Heo  *	EH context.
495c0c362b6STejun Heo  */
496c0c362b6STejun Heo void ata_eh_release(struct ata_port *ap)
497c0c362b6STejun Heo {
498c0c362b6STejun Heo 	WARN_ON_ONCE(ap->host->eh_owner != current);
499c0c362b6STejun Heo 	ap->host->eh_owner = NULL;
500c0c362b6STejun Heo 	mutex_unlock(&ap->host->eh_mutex);
501c0c362b6STejun Heo }
502c0c362b6STejun Heo 
503ece180d1STejun Heo static void ata_eh_unload(struct ata_port *ap)
504ece180d1STejun Heo {
505ece180d1STejun Heo 	struct ata_link *link;
506ece180d1STejun Heo 	struct ata_device *dev;
507ece180d1STejun Heo 	unsigned long flags;
508ece180d1STejun Heo 
509ece180d1STejun Heo 	/* Restore SControl IPM and SPD for the next driver and
510ece180d1STejun Heo 	 * disable attached devices.
511ece180d1STejun Heo 	 */
512ece180d1STejun Heo 	ata_for_each_link(link, ap, PMP_FIRST) {
513ece180d1STejun Heo 		sata_scr_write(link, SCR_CONTROL, link->saved_scontrol & 0xff0);
514ece180d1STejun Heo 		ata_for_each_dev(dev, link, ALL)
515ece180d1STejun Heo 			ata_dev_disable(dev);
516ece180d1STejun Heo 	}
517ece180d1STejun Heo 
518ece180d1STejun Heo 	/* freeze and set UNLOADED */
519ece180d1STejun Heo 	spin_lock_irqsave(ap->lock, flags);
520ece180d1STejun Heo 
521ece180d1STejun Heo 	ata_port_freeze(ap);			/* won't be thawed */
522ece180d1STejun Heo 	ap->pflags &= ~ATA_PFLAG_EH_PENDING;	/* clear pending from freeze */
523ece180d1STejun Heo 	ap->pflags |= ATA_PFLAG_UNLOADED;
524ece180d1STejun Heo 
525ece180d1STejun Heo 	spin_unlock_irqrestore(ap->lock, flags);
526ece180d1STejun Heo }
527ece180d1STejun Heo 
528c6fd2807SJeff Garzik /**
529c6fd2807SJeff Garzik  *	ata_scsi_error - SCSI layer error handler callback
530c6fd2807SJeff Garzik  *	@host: SCSI host on which error occurred
531c6fd2807SJeff Garzik  *
532c6fd2807SJeff Garzik  *	Handles SCSI-layer-thrown error events.
533c6fd2807SJeff Garzik  *
534c6fd2807SJeff Garzik  *	LOCKING:
535c6fd2807SJeff Garzik  *	Inherited from SCSI layer (none, can sleep)
536c6fd2807SJeff Garzik  *
537c6fd2807SJeff Garzik  *	RETURNS:
538c6fd2807SJeff Garzik  *	Zero.
539c6fd2807SJeff Garzik  */
540c6fd2807SJeff Garzik void ata_scsi_error(struct Scsi_Host *host)
541c6fd2807SJeff Garzik {
542c6fd2807SJeff Garzik 	struct ata_port *ap = ata_shost_to_port(host);
543c6fd2807SJeff Garzik 	unsigned long flags;
544c34aeebcSJames Bottomley 	LIST_HEAD(eh_work_q);
545c6fd2807SJeff Garzik 
546c6fd2807SJeff Garzik 	DPRINTK("ENTER\n");
547c6fd2807SJeff Garzik 
548c34aeebcSJames Bottomley 	spin_lock_irqsave(host->host_lock, flags);
549c34aeebcSJames Bottomley 	list_splice_init(&host->eh_cmd_q, &eh_work_q);
550c34aeebcSJames Bottomley 	spin_unlock_irqrestore(host->host_lock, flags);
551c34aeebcSJames Bottomley 
5520e0b494cSJames Bottomley 	ata_scsi_cmd_error_handler(host, ap, &eh_work_q);
5530e0b494cSJames Bottomley 
5540e0b494cSJames Bottomley 	/* If we timed raced normal completion and there is nothing to
5550e0b494cSJames Bottomley 	   recover nr_timedout == 0 why exactly are we doing error recovery ? */
5560e0b494cSJames Bottomley 	ata_scsi_port_error_handler(host, ap);
5570e0b494cSJames Bottomley 
5580e0b494cSJames Bottomley 	/* finish or retry handled scmd's and clean up */
55972d8c36eSWei Fang 	WARN_ON(!list_empty(&eh_work_q));
5600e0b494cSJames Bottomley 
5610e0b494cSJames Bottomley 	DPRINTK("EXIT\n");
5620e0b494cSJames Bottomley }
5630e0b494cSJames Bottomley 
5640e0b494cSJames Bottomley /**
5650e0b494cSJames Bottomley  * ata_scsi_cmd_error_handler - error callback for a list of commands
5660e0b494cSJames Bottomley  * @host:	scsi host containing the port
5670e0b494cSJames Bottomley  * @ap:		ATA port within the host
5680e0b494cSJames Bottomley  * @eh_work_q:	list of commands to process
5690e0b494cSJames Bottomley  *
5700e0b494cSJames Bottomley  * process the given list of commands and return those finished to the
5710e0b494cSJames Bottomley  * ap->eh_done_q.  This function is the first part of the libata error
5720e0b494cSJames Bottomley  * handler which processes a given list of failed commands.
5730e0b494cSJames Bottomley  */
5740e0b494cSJames Bottomley void ata_scsi_cmd_error_handler(struct Scsi_Host *host, struct ata_port *ap,
5750e0b494cSJames Bottomley 				struct list_head *eh_work_q)
5760e0b494cSJames Bottomley {
5770e0b494cSJames Bottomley 	int i;
5780e0b494cSJames Bottomley 	unsigned long flags;
5790e0b494cSJames Bottomley 
580c429137aSTejun Heo 	/* make sure sff pio task is not running */
581c429137aSTejun Heo 	ata_sff_flush_pio_task(ap);
582c6fd2807SJeff Garzik 
583cca3974eSJeff Garzik 	/* synchronize with host lock and sort out timeouts */
584c6fd2807SJeff Garzik 
585c6fd2807SJeff Garzik 	/* For new EH, all qcs are finished in one of three ways -
586c6fd2807SJeff Garzik 	 * normal completion, error completion, and SCSI timeout.
587c96f1732SAlan Cox 	 * Both completions can race against SCSI timeout.  When normal
588c6fd2807SJeff Garzik 	 * completion wins, the qc never reaches EH.  When error
589c6fd2807SJeff Garzik 	 * completion wins, the qc has ATA_QCFLAG_FAILED set.
590c6fd2807SJeff Garzik 	 *
591c6fd2807SJeff Garzik 	 * When SCSI timeout wins, things are a bit more complex.
592c6fd2807SJeff Garzik 	 * Normal or error completion can occur after the timeout but
593c6fd2807SJeff Garzik 	 * before this point.  In such cases, both types of
594c6fd2807SJeff Garzik 	 * completions are honored.  A scmd is determined to have
595c6fd2807SJeff Garzik 	 * timed out iff its associated qc is active and not failed.
596c6fd2807SJeff Garzik 	 */
597a4f08141SPaul E. McKenney 	spin_lock_irqsave(ap->lock, flags);
598c6fd2807SJeff Garzik 	if (ap->ops->error_handler) {
599c6fd2807SJeff Garzik 		struct scsi_cmnd *scmd, *tmp;
600c6fd2807SJeff Garzik 		int nr_timedout = 0;
601c6fd2807SJeff Garzik 
602c96f1732SAlan Cox 		/* This must occur under the ap->lock as we don't want
603c96f1732SAlan Cox 		   a polled recovery to race the real interrupt handler
604c96f1732SAlan Cox 
605c96f1732SAlan Cox 		   The lost_interrupt handler checks for any completed but
606c96f1732SAlan Cox 		   non-notified command and completes much like an IRQ handler.
607c96f1732SAlan Cox 
608c96f1732SAlan Cox 		   We then fall into the error recovery code which will treat
609c96f1732SAlan Cox 		   this as if normal completion won the race */
610c96f1732SAlan Cox 
611c96f1732SAlan Cox 		if (ap->ops->lost_interrupt)
612c96f1732SAlan Cox 			ap->ops->lost_interrupt(ap);
613c96f1732SAlan Cox 
6140e0b494cSJames Bottomley 		list_for_each_entry_safe(scmd, tmp, eh_work_q, eh_entry) {
615c6fd2807SJeff Garzik 			struct ata_queued_cmd *qc;
616c6fd2807SJeff Garzik 
617*258c4e5cSJens Axboe 			ata_qc_for_each_raw(ap, qc, i) {
618c6fd2807SJeff Garzik 				if (qc->flags & ATA_QCFLAG_ACTIVE &&
619c6fd2807SJeff Garzik 				    qc->scsicmd == scmd)
620c6fd2807SJeff Garzik 					break;
621c6fd2807SJeff Garzik 			}
622c6fd2807SJeff Garzik 
623c6fd2807SJeff Garzik 			if (i < ATA_MAX_QUEUE) {
624c6fd2807SJeff Garzik 				/* the scmd has an associated qc */
625c6fd2807SJeff Garzik 				if (!(qc->flags & ATA_QCFLAG_FAILED)) {
626c6fd2807SJeff Garzik 					/* which hasn't failed yet, timeout */
627c6fd2807SJeff Garzik 					qc->err_mask |= AC_ERR_TIMEOUT;
628c6fd2807SJeff Garzik 					qc->flags |= ATA_QCFLAG_FAILED;
629c6fd2807SJeff Garzik 					nr_timedout++;
630c6fd2807SJeff Garzik 				}
631c6fd2807SJeff Garzik 			} else {
632c6fd2807SJeff Garzik 				/* Normal completion occurred after
633c6fd2807SJeff Garzik 				 * SCSI timeout but before this point.
634c6fd2807SJeff Garzik 				 * Successfully complete it.
635c6fd2807SJeff Garzik 				 */
636c6fd2807SJeff Garzik 				scmd->retries = scmd->allowed;
637c6fd2807SJeff Garzik 				scsi_eh_finish_cmd(scmd, &ap->eh_done_q);
638c6fd2807SJeff Garzik 			}
639c6fd2807SJeff Garzik 		}
640c6fd2807SJeff Garzik 
641c6fd2807SJeff Garzik 		/* If we have timed out qcs.  They belong to EH from
642c6fd2807SJeff Garzik 		 * this point but the state of the controller is
643c6fd2807SJeff Garzik 		 * unknown.  Freeze the port to make sure the IRQ
644c6fd2807SJeff Garzik 		 * handler doesn't diddle with those qcs.  This must
645c6fd2807SJeff Garzik 		 * be done atomically w.r.t. setting QCFLAG_FAILED.
646c6fd2807SJeff Garzik 		 */
647c6fd2807SJeff Garzik 		if (nr_timedout)
648c6fd2807SJeff Garzik 			__ata_port_freeze(ap);
649c6fd2807SJeff Garzik 
650a1e10f7eSTejun Heo 
651a1e10f7eSTejun Heo 		/* initialize eh_tries */
652a1e10f7eSTejun Heo 		ap->eh_tries = ATA_EH_MAX_TRIES;
653a4f08141SPaul E. McKenney 	}
654a4f08141SPaul E. McKenney 	spin_unlock_irqrestore(ap->lock, flags);
655c6fd2807SJeff Garzik 
6560e0b494cSJames Bottomley }
6570e0b494cSJames Bottomley EXPORT_SYMBOL(ata_scsi_cmd_error_handler);
6580e0b494cSJames Bottomley 
6590e0b494cSJames Bottomley /**
6600e0b494cSJames Bottomley  * ata_scsi_port_error_handler - recover the port after the commands
6610e0b494cSJames Bottomley  * @host:	SCSI host containing the port
6620e0b494cSJames Bottomley  * @ap:		the ATA port
6630e0b494cSJames Bottomley  *
6640e0b494cSJames Bottomley  * Handle the recovery of the port @ap after all the commands
6650e0b494cSJames Bottomley  * have been recovered.
6660e0b494cSJames Bottomley  */
6670e0b494cSJames Bottomley void ata_scsi_port_error_handler(struct Scsi_Host *host, struct ata_port *ap)
6680e0b494cSJames Bottomley {
6690e0b494cSJames Bottomley 	unsigned long flags;
670c96f1732SAlan Cox 
671c6fd2807SJeff Garzik 	/* invoke error handler */
672c6fd2807SJeff Garzik 	if (ap->ops->error_handler) {
673cf1b86c8STejun Heo 		struct ata_link *link;
674cf1b86c8STejun Heo 
675c0c362b6STejun Heo 		/* acquire EH ownership */
676c0c362b6STejun Heo 		ata_eh_acquire(ap);
677c0c362b6STejun Heo  repeat:
6785ddf24c5STejun Heo 		/* kill fast drain timer */
6795ddf24c5STejun Heo 		del_timer_sync(&ap->fastdrain_timer);
6805ddf24c5STejun Heo 
681c6fd2807SJeff Garzik 		/* process port resume request */
682c6fd2807SJeff Garzik 		ata_eh_handle_port_resume(ap);
683c6fd2807SJeff Garzik 
684c6fd2807SJeff Garzik 		/* fetch & clear EH info */
685c6fd2807SJeff Garzik 		spin_lock_irqsave(ap->lock, flags);
686c6fd2807SJeff Garzik 
6871eca4365STejun Heo 		ata_for_each_link(link, ap, HOST_FIRST) {
68800115e0fSTejun Heo 			struct ata_eh_context *ehc = &link->eh_context;
68900115e0fSTejun Heo 			struct ata_device *dev;
69000115e0fSTejun Heo 
691cf1b86c8STejun Heo 			memset(&link->eh_context, 0, sizeof(link->eh_context));
692cf1b86c8STejun Heo 			link->eh_context.i = link->eh_info;
693cf1b86c8STejun Heo 			memset(&link->eh_info, 0, sizeof(link->eh_info));
69400115e0fSTejun Heo 
6951eca4365STejun Heo 			ata_for_each_dev(dev, link, ENABLED) {
69600115e0fSTejun Heo 				int devno = dev->devno;
69700115e0fSTejun Heo 
69800115e0fSTejun Heo 				ehc->saved_xfer_mode[devno] = dev->xfer_mode;
69900115e0fSTejun Heo 				if (ata_ncq_enabled(dev))
70000115e0fSTejun Heo 					ehc->saved_ncq_enabled |= 1 << devno;
70100115e0fSTejun Heo 			}
702cf1b86c8STejun Heo 		}
703c6fd2807SJeff Garzik 
704c6fd2807SJeff Garzik 		ap->pflags |= ATA_PFLAG_EH_IN_PROGRESS;
705c6fd2807SJeff Garzik 		ap->pflags &= ~ATA_PFLAG_EH_PENDING;
706da917d69STejun Heo 		ap->excl_link = NULL;	/* don't maintain exclusion over EH */
707c6fd2807SJeff Garzik 
708c6fd2807SJeff Garzik 		spin_unlock_irqrestore(ap->lock, flags);
709c6fd2807SJeff Garzik 
710c6fd2807SJeff Garzik 		/* invoke EH, skip if unloading or suspended */
711c6fd2807SJeff Garzik 		if (!(ap->pflags & (ATA_PFLAG_UNLOADING | ATA_PFLAG_SUSPENDED)))
712c6fd2807SJeff Garzik 			ap->ops->error_handler(ap);
713ece180d1STejun Heo 		else {
714ece180d1STejun Heo 			/* if unloading, commence suicide */
715ece180d1STejun Heo 			if ((ap->pflags & ATA_PFLAG_UNLOADING) &&
716ece180d1STejun Heo 			    !(ap->pflags & ATA_PFLAG_UNLOADED))
717ece180d1STejun Heo 				ata_eh_unload(ap);
718c6fd2807SJeff Garzik 			ata_eh_finish(ap);
719ece180d1STejun Heo 		}
720c6fd2807SJeff Garzik 
721c6fd2807SJeff Garzik 		/* process port suspend request */
722c6fd2807SJeff Garzik 		ata_eh_handle_port_suspend(ap);
723c6fd2807SJeff Garzik 
72425985edcSLucas De Marchi 		/* Exception might have happened after ->error_handler
725c6fd2807SJeff Garzik 		 * recovered the port but before this point.  Repeat
726c6fd2807SJeff Garzik 		 * EH in such case.
727c6fd2807SJeff Garzik 		 */
728c6fd2807SJeff Garzik 		spin_lock_irqsave(ap->lock, flags);
729c6fd2807SJeff Garzik 
730c6fd2807SJeff Garzik 		if (ap->pflags & ATA_PFLAG_EH_PENDING) {
731a1e10f7eSTejun Heo 			if (--ap->eh_tries) {
732c6fd2807SJeff Garzik 				spin_unlock_irqrestore(ap->lock, flags);
733c6fd2807SJeff Garzik 				goto repeat;
734c6fd2807SJeff Garzik 			}
735a9a79dfeSJoe Perches 			ata_port_err(ap,
736a9a79dfeSJoe Perches 				     "EH pending after %d tries, giving up\n",
737a9a79dfeSJoe Perches 				     ATA_EH_MAX_TRIES);
738914616a3STejun Heo 			ap->pflags &= ~ATA_PFLAG_EH_PENDING;
739c6fd2807SJeff Garzik 		}
740c6fd2807SJeff Garzik 
741c6fd2807SJeff Garzik 		/* this run is complete, make sure EH info is clear */
7421eca4365STejun Heo 		ata_for_each_link(link, ap, HOST_FIRST)
743cf1b86c8STejun Heo 			memset(&link->eh_info, 0, sizeof(link->eh_info));
744c6fd2807SJeff Garzik 
745e4a9c373SDan Williams 		/* end eh (clear host_eh_scheduled) while holding
746e4a9c373SDan Williams 		 * ap->lock such that if exception occurs after this
747e4a9c373SDan Williams 		 * point but before EH completion, SCSI midlayer will
748c6fd2807SJeff Garzik 		 * re-initiate EH.
749c6fd2807SJeff Garzik 		 */
750e4a9c373SDan Williams 		ap->ops->end_eh(ap);
751c6fd2807SJeff Garzik 
752c6fd2807SJeff Garzik 		spin_unlock_irqrestore(ap->lock, flags);
753c0c362b6STejun Heo 		ata_eh_release(ap);
754c6fd2807SJeff Garzik 	} else {
7559af5c9c9STejun Heo 		WARN_ON(ata_qc_from_tag(ap, ap->link.active_tag) == NULL);
756c6fd2807SJeff Garzik 		ap->ops->eng_timeout(ap);
757c6fd2807SJeff Garzik 	}
758c6fd2807SJeff Garzik 
759c6fd2807SJeff Garzik 	scsi_eh_flush_done_q(&ap->eh_done_q);
760c6fd2807SJeff Garzik 
761c6fd2807SJeff Garzik 	/* clean up */
762c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
763c6fd2807SJeff Garzik 
764c6fd2807SJeff Garzik 	if (ap->pflags & ATA_PFLAG_LOADING)
765c6fd2807SJeff Garzik 		ap->pflags &= ~ATA_PFLAG_LOADING;
7666f54120eSJason Yan 	else if ((ap->pflags & ATA_PFLAG_SCSI_HOTPLUG) &&
7676f54120eSJason Yan 		!(ap->flags & ATA_FLAG_SAS_HOST))
768ad72cf98STejun Heo 		schedule_delayed_work(&ap->hotplug_task, 0);
769c6fd2807SJeff Garzik 
770c6fd2807SJeff Garzik 	if (ap->pflags & ATA_PFLAG_RECOVERED)
771a9a79dfeSJoe Perches 		ata_port_info(ap, "EH complete\n");
772c6fd2807SJeff Garzik 
773c6fd2807SJeff Garzik 	ap->pflags &= ~(ATA_PFLAG_SCSI_HOTPLUG | ATA_PFLAG_RECOVERED);
774c6fd2807SJeff Garzik 
775c6fd2807SJeff Garzik 	/* tell wait_eh that we're done */
776c6fd2807SJeff Garzik 	ap->pflags &= ~ATA_PFLAG_EH_IN_PROGRESS;
777c6fd2807SJeff Garzik 	wake_up_all(&ap->eh_wait_q);
778c6fd2807SJeff Garzik 
779c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
780c6fd2807SJeff Garzik }
7810e0b494cSJames Bottomley EXPORT_SYMBOL_GPL(ata_scsi_port_error_handler);
782c6fd2807SJeff Garzik 
783c6fd2807SJeff Garzik /**
784c6fd2807SJeff Garzik  *	ata_port_wait_eh - Wait for the currently pending EH to complete
785c6fd2807SJeff Garzik  *	@ap: Port to wait EH for
786c6fd2807SJeff Garzik  *
787c6fd2807SJeff Garzik  *	Wait until the currently pending EH is complete.
788c6fd2807SJeff Garzik  *
789c6fd2807SJeff Garzik  *	LOCKING:
790c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
791c6fd2807SJeff Garzik  */
792c6fd2807SJeff Garzik void ata_port_wait_eh(struct ata_port *ap)
793c6fd2807SJeff Garzik {
794c6fd2807SJeff Garzik 	unsigned long flags;
795c6fd2807SJeff Garzik 	DEFINE_WAIT(wait);
796c6fd2807SJeff Garzik 
797c6fd2807SJeff Garzik  retry:
798c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
799c6fd2807SJeff Garzik 
800c6fd2807SJeff Garzik 	while (ap->pflags & (ATA_PFLAG_EH_PENDING | ATA_PFLAG_EH_IN_PROGRESS)) {
801c6fd2807SJeff Garzik 		prepare_to_wait(&ap->eh_wait_q, &wait, TASK_UNINTERRUPTIBLE);
802c6fd2807SJeff Garzik 		spin_unlock_irqrestore(ap->lock, flags);
803c6fd2807SJeff Garzik 		schedule();
804c6fd2807SJeff Garzik 		spin_lock_irqsave(ap->lock, flags);
805c6fd2807SJeff Garzik 	}
806c6fd2807SJeff Garzik 	finish_wait(&ap->eh_wait_q, &wait);
807c6fd2807SJeff Garzik 
808c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
809c6fd2807SJeff Garzik 
810c6fd2807SJeff Garzik 	/* make sure SCSI EH is complete */
811cca3974eSJeff Garzik 	if (scsi_host_in_recovery(ap->scsi_host)) {
81297750cebSTejun Heo 		ata_msleep(ap, 10);
813c6fd2807SJeff Garzik 		goto retry;
814c6fd2807SJeff Garzik 	}
815c6fd2807SJeff Garzik }
81681c757bcSDan Williams EXPORT_SYMBOL_GPL(ata_port_wait_eh);
817c6fd2807SJeff Garzik 
8185ddf24c5STejun Heo static int ata_eh_nr_in_flight(struct ata_port *ap)
8195ddf24c5STejun Heo {
820*258c4e5cSJens Axboe 	struct ata_queued_cmd *qc;
8215ddf24c5STejun Heo 	unsigned int tag;
8225ddf24c5STejun Heo 	int nr = 0;
8235ddf24c5STejun Heo 
8245ddf24c5STejun Heo 	/* count only non-internal commands */
825*258c4e5cSJens Axboe 	ata_qc_for_each(ap, qc, tag) {
826*258c4e5cSJens Axboe 		if (qc)
8275ddf24c5STejun Heo 			nr++;
8289d207accSJens Axboe 	}
8295ddf24c5STejun Heo 
8305ddf24c5STejun Heo 	return nr;
8315ddf24c5STejun Heo }
8325ddf24c5STejun Heo 
833b93ab338SKees Cook void ata_eh_fastdrain_timerfn(struct timer_list *t)
8345ddf24c5STejun Heo {
835b93ab338SKees Cook 	struct ata_port *ap = from_timer(ap, t, fastdrain_timer);
8365ddf24c5STejun Heo 	unsigned long flags;
8375ddf24c5STejun Heo 	int cnt;
8385ddf24c5STejun Heo 
8395ddf24c5STejun Heo 	spin_lock_irqsave(ap->lock, flags);
8405ddf24c5STejun Heo 
8415ddf24c5STejun Heo 	cnt = ata_eh_nr_in_flight(ap);
8425ddf24c5STejun Heo 
8435ddf24c5STejun Heo 	/* are we done? */
8445ddf24c5STejun Heo 	if (!cnt)
8455ddf24c5STejun Heo 		goto out_unlock;
8465ddf24c5STejun Heo 
8475ddf24c5STejun Heo 	if (cnt == ap->fastdrain_cnt) {
848*258c4e5cSJens Axboe 		struct ata_queued_cmd *qc;
8495ddf24c5STejun Heo 		unsigned int tag;
8505ddf24c5STejun Heo 
8515ddf24c5STejun Heo 		/* No progress during the last interval, tag all
8525ddf24c5STejun Heo 		 * in-flight qcs as timed out and freeze the port.
8535ddf24c5STejun Heo 		 */
854*258c4e5cSJens Axboe 		ata_qc_for_each(ap, qc, tag) {
8555ddf24c5STejun Heo 			if (qc)
8565ddf24c5STejun Heo 				qc->err_mask |= AC_ERR_TIMEOUT;
8575ddf24c5STejun Heo 		}
8585ddf24c5STejun Heo 
8595ddf24c5STejun Heo 		ata_port_freeze(ap);
8605ddf24c5STejun Heo 	} else {
8615ddf24c5STejun Heo 		/* some qcs have finished, give it another chance */
8625ddf24c5STejun Heo 		ap->fastdrain_cnt = cnt;
8635ddf24c5STejun Heo 		ap->fastdrain_timer.expires =
864341c2c95STejun Heo 			ata_deadline(jiffies, ATA_EH_FASTDRAIN_INTERVAL);
8655ddf24c5STejun Heo 		add_timer(&ap->fastdrain_timer);
8665ddf24c5STejun Heo 	}
8675ddf24c5STejun Heo 
8685ddf24c5STejun Heo  out_unlock:
8695ddf24c5STejun Heo 	spin_unlock_irqrestore(ap->lock, flags);
8705ddf24c5STejun Heo }
8715ddf24c5STejun Heo 
8725ddf24c5STejun Heo /**
8735ddf24c5STejun Heo  *	ata_eh_set_pending - set ATA_PFLAG_EH_PENDING and activate fast drain
8745ddf24c5STejun Heo  *	@ap: target ATA port
8755ddf24c5STejun Heo  *	@fastdrain: activate fast drain
8765ddf24c5STejun Heo  *
8775ddf24c5STejun Heo  *	Set ATA_PFLAG_EH_PENDING and activate fast drain if @fastdrain
8785ddf24c5STejun Heo  *	is non-zero and EH wasn't pending before.  Fast drain ensures
8795ddf24c5STejun Heo  *	that EH kicks in in timely manner.
8805ddf24c5STejun Heo  *
8815ddf24c5STejun Heo  *	LOCKING:
8825ddf24c5STejun Heo  *	spin_lock_irqsave(host lock)
8835ddf24c5STejun Heo  */
8845ddf24c5STejun Heo static void ata_eh_set_pending(struct ata_port *ap, int fastdrain)
8855ddf24c5STejun Heo {
8865ddf24c5STejun Heo 	int cnt;
8875ddf24c5STejun Heo 
8885ddf24c5STejun Heo 	/* already scheduled? */
8895ddf24c5STejun Heo 	if (ap->pflags & ATA_PFLAG_EH_PENDING)
8905ddf24c5STejun Heo 		return;
8915ddf24c5STejun Heo 
8925ddf24c5STejun Heo 	ap->pflags |= ATA_PFLAG_EH_PENDING;
8935ddf24c5STejun Heo 
8945ddf24c5STejun Heo 	if (!fastdrain)
8955ddf24c5STejun Heo 		return;
8965ddf24c5STejun Heo 
8975ddf24c5STejun Heo 	/* do we have in-flight qcs? */
8985ddf24c5STejun Heo 	cnt = ata_eh_nr_in_flight(ap);
8995ddf24c5STejun Heo 	if (!cnt)
9005ddf24c5STejun Heo 		return;
9015ddf24c5STejun Heo 
9025ddf24c5STejun Heo 	/* activate fast drain */
9035ddf24c5STejun Heo 	ap->fastdrain_cnt = cnt;
904341c2c95STejun Heo 	ap->fastdrain_timer.expires =
905341c2c95STejun Heo 		ata_deadline(jiffies, ATA_EH_FASTDRAIN_INTERVAL);
9065ddf24c5STejun Heo 	add_timer(&ap->fastdrain_timer);
9075ddf24c5STejun Heo }
9085ddf24c5STejun Heo 
909c6fd2807SJeff Garzik /**
910c6fd2807SJeff Garzik  *	ata_qc_schedule_eh - schedule qc for error handling
911c6fd2807SJeff Garzik  *	@qc: command to schedule error handling for
912c6fd2807SJeff Garzik  *
913c6fd2807SJeff Garzik  *	Schedule error handling for @qc.  EH will kick in as soon as
914c6fd2807SJeff Garzik  *	other commands are drained.
915c6fd2807SJeff Garzik  *
916c6fd2807SJeff Garzik  *	LOCKING:
917cca3974eSJeff Garzik  *	spin_lock_irqsave(host lock)
918c6fd2807SJeff Garzik  */
919c6fd2807SJeff Garzik void ata_qc_schedule_eh(struct ata_queued_cmd *qc)
920c6fd2807SJeff Garzik {
921c6fd2807SJeff Garzik 	struct ata_port *ap = qc->ap;
922fa41efdaSTejun Heo 	struct request_queue *q = qc->scsicmd->device->request_queue;
923fa41efdaSTejun Heo 	unsigned long flags;
924c6fd2807SJeff Garzik 
925c6fd2807SJeff Garzik 	WARN_ON(!ap->ops->error_handler);
926c6fd2807SJeff Garzik 
927c6fd2807SJeff Garzik 	qc->flags |= ATA_QCFLAG_FAILED;
9285ddf24c5STejun Heo 	ata_eh_set_pending(ap, 1);
929c6fd2807SJeff Garzik 
930c6fd2807SJeff Garzik 	/* The following will fail if timeout has already expired.
931c6fd2807SJeff Garzik 	 * ata_scsi_error() takes care of such scmds on EH entry.
932c6fd2807SJeff Garzik 	 * Note that ATA_QCFLAG_FAILED is unconditionally set after
933c6fd2807SJeff Garzik 	 * this function completes.
934c6fd2807SJeff Garzik 	 */
935fa41efdaSTejun Heo 	spin_lock_irqsave(q->queue_lock, flags);
936242f9dcbSJens Axboe 	blk_abort_request(qc->scsicmd->request);
937fa41efdaSTejun Heo 	spin_unlock_irqrestore(q->queue_lock, flags);
938c6fd2807SJeff Garzik }
939c6fd2807SJeff Garzik 
940c6fd2807SJeff Garzik /**
941e4a9c373SDan Williams  * ata_std_sched_eh - non-libsas ata_ports issue eh with this common routine
942e4a9c373SDan Williams  * @ap: ATA port to schedule EH for
943e4a9c373SDan Williams  *
944e4a9c373SDan Williams  *	LOCKING: inherited from ata_port_schedule_eh
945e4a9c373SDan Williams  *	spin_lock_irqsave(host lock)
946e4a9c373SDan Williams  */
947e4a9c373SDan Williams void ata_std_sched_eh(struct ata_port *ap)
948e4a9c373SDan Williams {
949e4a9c373SDan Williams 	WARN_ON(!ap->ops->error_handler);
950e4a9c373SDan Williams 
951e4a9c373SDan Williams 	if (ap->pflags & ATA_PFLAG_INITIALIZING)
952e4a9c373SDan Williams 		return;
953e4a9c373SDan Williams 
954e4a9c373SDan Williams 	ata_eh_set_pending(ap, 1);
955e4a9c373SDan Williams 	scsi_schedule_eh(ap->scsi_host);
956e4a9c373SDan Williams 
957e4a9c373SDan Williams 	DPRINTK("port EH scheduled\n");
958e4a9c373SDan Williams }
959e4a9c373SDan Williams EXPORT_SYMBOL_GPL(ata_std_sched_eh);
960e4a9c373SDan Williams 
961e4a9c373SDan Williams /**
962e4a9c373SDan Williams  * ata_std_end_eh - non-libsas ata_ports complete eh with this common routine
963e4a9c373SDan Williams  * @ap: ATA port to end EH for
964e4a9c373SDan Williams  *
965e4a9c373SDan Williams  * In the libata object model there is a 1:1 mapping of ata_port to
966e4a9c373SDan Williams  * shost, so host fields can be directly manipulated under ap->lock, in
967e4a9c373SDan Williams  * the libsas case we need to hold a lock at the ha->level to coordinate
968e4a9c373SDan Williams  * these events.
969e4a9c373SDan Williams  *
970e4a9c373SDan Williams  *	LOCKING:
971e4a9c373SDan Williams  *	spin_lock_irqsave(host lock)
972e4a9c373SDan Williams  */
973e4a9c373SDan Williams void ata_std_end_eh(struct ata_port *ap)
974e4a9c373SDan Williams {
975e4a9c373SDan Williams 	struct Scsi_Host *host = ap->scsi_host;
976e4a9c373SDan Williams 
977e4a9c373SDan Williams 	host->host_eh_scheduled = 0;
978e4a9c373SDan Williams }
979e4a9c373SDan Williams EXPORT_SYMBOL(ata_std_end_eh);
980e4a9c373SDan Williams 
981e4a9c373SDan Williams 
982e4a9c373SDan Williams /**
983c6fd2807SJeff Garzik  *	ata_port_schedule_eh - schedule error handling without a qc
984c6fd2807SJeff Garzik  *	@ap: ATA port to schedule EH for
985c6fd2807SJeff Garzik  *
986c6fd2807SJeff Garzik  *	Schedule error handling for @ap.  EH will kick in as soon as
987c6fd2807SJeff Garzik  *	all commands are drained.
988c6fd2807SJeff Garzik  *
989c6fd2807SJeff Garzik  *	LOCKING:
990cca3974eSJeff Garzik  *	spin_lock_irqsave(host lock)
991c6fd2807SJeff Garzik  */
992c6fd2807SJeff Garzik void ata_port_schedule_eh(struct ata_port *ap)
993c6fd2807SJeff Garzik {
994e4a9c373SDan Williams 	/* see: ata_std_sched_eh, unless you know better */
995e4a9c373SDan Williams 	ap->ops->sched_eh(ap);
996c6fd2807SJeff Garzik }
997c6fd2807SJeff Garzik 
998dbd82616STejun Heo static int ata_do_link_abort(struct ata_port *ap, struct ata_link *link)
999c6fd2807SJeff Garzik {
1000*258c4e5cSJens Axboe 	struct ata_queued_cmd *qc;
1001c6fd2807SJeff Garzik 	int tag, nr_aborted = 0;
1002c6fd2807SJeff Garzik 
1003c6fd2807SJeff Garzik 	WARN_ON(!ap->ops->error_handler);
1004c6fd2807SJeff Garzik 
10055ddf24c5STejun Heo 	/* we're gonna abort all commands, no need for fast drain */
10065ddf24c5STejun Heo 	ata_eh_set_pending(ap, 0);
10075ddf24c5STejun Heo 
100828361c40SJens Axboe 	/* include internal tag in iteration */
1009*258c4e5cSJens Axboe 	ata_qc_for_each_with_internal(ap, qc, tag) {
1010dbd82616STejun Heo 		if (qc && (!link || qc->dev->link == link)) {
1011c6fd2807SJeff Garzik 			qc->flags |= ATA_QCFLAG_FAILED;
1012c6fd2807SJeff Garzik 			ata_qc_complete(qc);
1013c6fd2807SJeff Garzik 			nr_aborted++;
1014c6fd2807SJeff Garzik 		}
1015c6fd2807SJeff Garzik 	}
1016c6fd2807SJeff Garzik 
1017c6fd2807SJeff Garzik 	if (!nr_aborted)
1018c6fd2807SJeff Garzik 		ata_port_schedule_eh(ap);
1019c6fd2807SJeff Garzik 
1020c6fd2807SJeff Garzik 	return nr_aborted;
1021c6fd2807SJeff Garzik }
1022c6fd2807SJeff Garzik 
1023c6fd2807SJeff Garzik /**
1024dbd82616STejun Heo  *	ata_link_abort - abort all qc's on the link
1025dbd82616STejun Heo  *	@link: ATA link to abort qc's for
1026dbd82616STejun Heo  *
1027dbd82616STejun Heo  *	Abort all active qc's active on @link and schedule EH.
1028dbd82616STejun Heo  *
1029dbd82616STejun Heo  *	LOCKING:
1030dbd82616STejun Heo  *	spin_lock_irqsave(host lock)
1031dbd82616STejun Heo  *
1032dbd82616STejun Heo  *	RETURNS:
1033dbd82616STejun Heo  *	Number of aborted qc's.
1034dbd82616STejun Heo  */
1035dbd82616STejun Heo int ata_link_abort(struct ata_link *link)
1036dbd82616STejun Heo {
1037dbd82616STejun Heo 	return ata_do_link_abort(link->ap, link);
1038dbd82616STejun Heo }
1039dbd82616STejun Heo 
1040dbd82616STejun Heo /**
1041dbd82616STejun Heo  *	ata_port_abort - abort all qc's on the port
1042dbd82616STejun Heo  *	@ap: ATA port to abort qc's for
1043dbd82616STejun Heo  *
1044dbd82616STejun Heo  *	Abort all active qc's of @ap and schedule EH.
1045dbd82616STejun Heo  *
1046dbd82616STejun Heo  *	LOCKING:
1047dbd82616STejun Heo  *	spin_lock_irqsave(host_set lock)
1048dbd82616STejun Heo  *
1049dbd82616STejun Heo  *	RETURNS:
1050dbd82616STejun Heo  *	Number of aborted qc's.
1051dbd82616STejun Heo  */
1052dbd82616STejun Heo int ata_port_abort(struct ata_port *ap)
1053dbd82616STejun Heo {
1054dbd82616STejun Heo 	return ata_do_link_abort(ap, NULL);
1055dbd82616STejun Heo }
1056dbd82616STejun Heo 
1057dbd82616STejun Heo /**
1058c6fd2807SJeff Garzik  *	__ata_port_freeze - freeze port
1059c6fd2807SJeff Garzik  *	@ap: ATA port to freeze
1060c6fd2807SJeff Garzik  *
1061c6fd2807SJeff Garzik  *	This function is called when HSM violation or some other
1062c6fd2807SJeff Garzik  *	condition disrupts normal operation of the port.  Frozen port
1063c6fd2807SJeff Garzik  *	is not allowed to perform any operation until the port is
1064c6fd2807SJeff Garzik  *	thawed, which usually follows a successful reset.
1065c6fd2807SJeff Garzik  *
1066c6fd2807SJeff Garzik  *	ap->ops->freeze() callback can be used for freezing the port
1067c6fd2807SJeff Garzik  *	hardware-wise (e.g. mask interrupt and stop DMA engine).  If a
1068c6fd2807SJeff Garzik  *	port cannot be frozen hardware-wise, the interrupt handler
1069c6fd2807SJeff Garzik  *	must ack and clear interrupts unconditionally while the port
1070c6fd2807SJeff Garzik  *	is frozen.
1071c6fd2807SJeff Garzik  *
1072c6fd2807SJeff Garzik  *	LOCKING:
1073cca3974eSJeff Garzik  *	spin_lock_irqsave(host lock)
1074c6fd2807SJeff Garzik  */
1075c6fd2807SJeff Garzik static void __ata_port_freeze(struct ata_port *ap)
1076c6fd2807SJeff Garzik {
1077c6fd2807SJeff Garzik 	WARN_ON(!ap->ops->error_handler);
1078c6fd2807SJeff Garzik 
1079c6fd2807SJeff Garzik 	if (ap->ops->freeze)
1080c6fd2807SJeff Garzik 		ap->ops->freeze(ap);
1081c6fd2807SJeff Garzik 
1082c6fd2807SJeff Garzik 	ap->pflags |= ATA_PFLAG_FROZEN;
1083c6fd2807SJeff Garzik 
108444877b4eSTejun Heo 	DPRINTK("ata%u port frozen\n", ap->print_id);
1085c6fd2807SJeff Garzik }
1086c6fd2807SJeff Garzik 
1087c6fd2807SJeff Garzik /**
1088c6fd2807SJeff Garzik  *	ata_port_freeze - abort & freeze port
1089c6fd2807SJeff Garzik  *	@ap: ATA port to freeze
1090c6fd2807SJeff Garzik  *
109154c38444SJeff Garzik  *	Abort and freeze @ap.  The freeze operation must be called
109254c38444SJeff Garzik  *	first, because some hardware requires special operations
109354c38444SJeff Garzik  *	before the taskfile registers are accessible.
1094c6fd2807SJeff Garzik  *
1095c6fd2807SJeff Garzik  *	LOCKING:
1096cca3974eSJeff Garzik  *	spin_lock_irqsave(host lock)
1097c6fd2807SJeff Garzik  *
1098c6fd2807SJeff Garzik  *	RETURNS:
1099c6fd2807SJeff Garzik  *	Number of aborted commands.
1100c6fd2807SJeff Garzik  */
1101c6fd2807SJeff Garzik int ata_port_freeze(struct ata_port *ap)
1102c6fd2807SJeff Garzik {
1103c6fd2807SJeff Garzik 	int nr_aborted;
1104c6fd2807SJeff Garzik 
1105c6fd2807SJeff Garzik 	WARN_ON(!ap->ops->error_handler);
1106c6fd2807SJeff Garzik 
1107c6fd2807SJeff Garzik 	__ata_port_freeze(ap);
110854c38444SJeff Garzik 	nr_aborted = ata_port_abort(ap);
1109c6fd2807SJeff Garzik 
1110c6fd2807SJeff Garzik 	return nr_aborted;
1111c6fd2807SJeff Garzik }
1112c6fd2807SJeff Garzik 
1113c6fd2807SJeff Garzik /**
11147d77b247STejun Heo  *	sata_async_notification - SATA async notification handler
11157d77b247STejun Heo  *	@ap: ATA port where async notification is received
11167d77b247STejun Heo  *
11177d77b247STejun Heo  *	Handler to be called when async notification via SDB FIS is
11187d77b247STejun Heo  *	received.  This function schedules EH if necessary.
11197d77b247STejun Heo  *
11207d77b247STejun Heo  *	LOCKING:
11217d77b247STejun Heo  *	spin_lock_irqsave(host lock)
11227d77b247STejun Heo  *
11237d77b247STejun Heo  *	RETURNS:
11247d77b247STejun Heo  *	1 if EH is scheduled, 0 otherwise.
11257d77b247STejun Heo  */
11267d77b247STejun Heo int sata_async_notification(struct ata_port *ap)
11277d77b247STejun Heo {
11287d77b247STejun Heo 	u32 sntf;
11297d77b247STejun Heo 	int rc;
11307d77b247STejun Heo 
11317d77b247STejun Heo 	if (!(ap->flags & ATA_FLAG_AN))
11327d77b247STejun Heo 		return 0;
11337d77b247STejun Heo 
11347d77b247STejun Heo 	rc = sata_scr_read(&ap->link, SCR_NOTIFICATION, &sntf);
11357d77b247STejun Heo 	if (rc == 0)
11367d77b247STejun Heo 		sata_scr_write(&ap->link, SCR_NOTIFICATION, sntf);
11377d77b247STejun Heo 
1138071f44b1STejun Heo 	if (!sata_pmp_attached(ap) || rc) {
11397d77b247STejun Heo 		/* PMP is not attached or SNTF is not available */
1140071f44b1STejun Heo 		if (!sata_pmp_attached(ap)) {
11417d77b247STejun Heo 			/* PMP is not attached.  Check whether ATAPI
11427d77b247STejun Heo 			 * AN is configured.  If so, notify media
11437d77b247STejun Heo 			 * change.
11447d77b247STejun Heo 			 */
11457d77b247STejun Heo 			struct ata_device *dev = ap->link.device;
11467d77b247STejun Heo 
11477d77b247STejun Heo 			if ((dev->class == ATA_DEV_ATAPI) &&
11487d77b247STejun Heo 			    (dev->flags & ATA_DFLAG_AN))
11497d77b247STejun Heo 				ata_scsi_media_change_notify(dev);
11507d77b247STejun Heo 			return 0;
11517d77b247STejun Heo 		} else {
11527d77b247STejun Heo 			/* PMP is attached but SNTF is not available.
11537d77b247STejun Heo 			 * ATAPI async media change notification is
11547d77b247STejun Heo 			 * not used.  The PMP must be reporting PHY
11557d77b247STejun Heo 			 * status change, schedule EH.
11567d77b247STejun Heo 			 */
11577d77b247STejun Heo 			ata_port_schedule_eh(ap);
11587d77b247STejun Heo 			return 1;
11597d77b247STejun Heo 		}
11607d77b247STejun Heo 	} else {
11617d77b247STejun Heo 		/* PMP is attached and SNTF is available */
11627d77b247STejun Heo 		struct ata_link *link;
11637d77b247STejun Heo 
11647d77b247STejun Heo 		/* check and notify ATAPI AN */
11651eca4365STejun Heo 		ata_for_each_link(link, ap, EDGE) {
11667d77b247STejun Heo 			if (!(sntf & (1 << link->pmp)))
11677d77b247STejun Heo 				continue;
11687d77b247STejun Heo 
11697d77b247STejun Heo 			if ((link->device->class == ATA_DEV_ATAPI) &&
11707d77b247STejun Heo 			    (link->device->flags & ATA_DFLAG_AN))
11717d77b247STejun Heo 				ata_scsi_media_change_notify(link->device);
11727d77b247STejun Heo 		}
11737d77b247STejun Heo 
11747d77b247STejun Heo 		/* If PMP is reporting that PHY status of some
11757d77b247STejun Heo 		 * downstream ports has changed, schedule EH.
11767d77b247STejun Heo 		 */
11777d77b247STejun Heo 		if (sntf & (1 << SATA_PMP_CTRL_PORT)) {
11787d77b247STejun Heo 			ata_port_schedule_eh(ap);
11797d77b247STejun Heo 			return 1;
11807d77b247STejun Heo 		}
11817d77b247STejun Heo 
11827d77b247STejun Heo 		return 0;
11837d77b247STejun Heo 	}
11847d77b247STejun Heo }
11857d77b247STejun Heo 
11867d77b247STejun Heo /**
1187c6fd2807SJeff Garzik  *	ata_eh_freeze_port - EH helper to freeze port
1188c6fd2807SJeff Garzik  *	@ap: ATA port to freeze
1189c6fd2807SJeff Garzik  *
1190c6fd2807SJeff Garzik  *	Freeze @ap.
1191c6fd2807SJeff Garzik  *
1192c6fd2807SJeff Garzik  *	LOCKING:
1193c6fd2807SJeff Garzik  *	None.
1194c6fd2807SJeff Garzik  */
1195c6fd2807SJeff Garzik void ata_eh_freeze_port(struct ata_port *ap)
1196c6fd2807SJeff Garzik {
1197c6fd2807SJeff Garzik 	unsigned long flags;
1198c6fd2807SJeff Garzik 
1199c6fd2807SJeff Garzik 	if (!ap->ops->error_handler)
1200c6fd2807SJeff Garzik 		return;
1201c6fd2807SJeff Garzik 
1202c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
1203c6fd2807SJeff Garzik 	__ata_port_freeze(ap);
1204c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
1205c6fd2807SJeff Garzik }
1206c6fd2807SJeff Garzik 
1207c6fd2807SJeff Garzik /**
1208c6fd2807SJeff Garzik  *	ata_port_thaw_port - EH helper to thaw port
1209c6fd2807SJeff Garzik  *	@ap: ATA port to thaw
1210c6fd2807SJeff Garzik  *
1211c6fd2807SJeff Garzik  *	Thaw frozen port @ap.
1212c6fd2807SJeff Garzik  *
1213c6fd2807SJeff Garzik  *	LOCKING:
1214c6fd2807SJeff Garzik  *	None.
1215c6fd2807SJeff Garzik  */
1216c6fd2807SJeff Garzik void ata_eh_thaw_port(struct ata_port *ap)
1217c6fd2807SJeff Garzik {
1218c6fd2807SJeff Garzik 	unsigned long flags;
1219c6fd2807SJeff Garzik 
1220c6fd2807SJeff Garzik 	if (!ap->ops->error_handler)
1221c6fd2807SJeff Garzik 		return;
1222c6fd2807SJeff Garzik 
1223c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
1224c6fd2807SJeff Garzik 
1225c6fd2807SJeff Garzik 	ap->pflags &= ~ATA_PFLAG_FROZEN;
1226c6fd2807SJeff Garzik 
1227c6fd2807SJeff Garzik 	if (ap->ops->thaw)
1228c6fd2807SJeff Garzik 		ap->ops->thaw(ap);
1229c6fd2807SJeff Garzik 
1230c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
1231c6fd2807SJeff Garzik 
123244877b4eSTejun Heo 	DPRINTK("ata%u port thawed\n", ap->print_id);
1233c6fd2807SJeff Garzik }
1234c6fd2807SJeff Garzik 
1235c6fd2807SJeff Garzik static void ata_eh_scsidone(struct scsi_cmnd *scmd)
1236c6fd2807SJeff Garzik {
1237c6fd2807SJeff Garzik 	/* nada */
1238c6fd2807SJeff Garzik }
1239c6fd2807SJeff Garzik 
1240c6fd2807SJeff Garzik static void __ata_eh_qc_complete(struct ata_queued_cmd *qc)
1241c6fd2807SJeff Garzik {
1242c6fd2807SJeff Garzik 	struct ata_port *ap = qc->ap;
1243c6fd2807SJeff Garzik 	struct scsi_cmnd *scmd = qc->scsicmd;
1244c6fd2807SJeff Garzik 	unsigned long flags;
1245c6fd2807SJeff Garzik 
1246c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
1247c6fd2807SJeff Garzik 	qc->scsidone = ata_eh_scsidone;
1248c6fd2807SJeff Garzik 	__ata_qc_complete(qc);
1249c6fd2807SJeff Garzik 	WARN_ON(ata_tag_valid(qc->tag));
1250c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
1251c6fd2807SJeff Garzik 
1252c6fd2807SJeff Garzik 	scsi_eh_finish_cmd(scmd, &ap->eh_done_q);
1253c6fd2807SJeff Garzik }
1254c6fd2807SJeff Garzik 
1255c6fd2807SJeff Garzik /**
1256c6fd2807SJeff Garzik  *	ata_eh_qc_complete - Complete an active ATA command from EH
1257c6fd2807SJeff Garzik  *	@qc: Command to complete
1258c6fd2807SJeff Garzik  *
1259c6fd2807SJeff Garzik  *	Indicate to the mid and upper layers that an ATA command has
1260c6fd2807SJeff Garzik  *	completed.  To be used from EH.
1261c6fd2807SJeff Garzik  */
1262c6fd2807SJeff Garzik void ata_eh_qc_complete(struct ata_queued_cmd *qc)
1263c6fd2807SJeff Garzik {
1264c6fd2807SJeff Garzik 	struct scsi_cmnd *scmd = qc->scsicmd;
1265c6fd2807SJeff Garzik 	scmd->retries = scmd->allowed;
1266c6fd2807SJeff Garzik 	__ata_eh_qc_complete(qc);
1267c6fd2807SJeff Garzik }
1268c6fd2807SJeff Garzik 
1269c6fd2807SJeff Garzik /**
1270c6fd2807SJeff Garzik  *	ata_eh_qc_retry - Tell midlayer to retry an ATA command after EH
1271c6fd2807SJeff Garzik  *	@qc: Command to retry
1272c6fd2807SJeff Garzik  *
1273c6fd2807SJeff Garzik  *	Indicate to the mid and upper layers that an ATA command
1274c6fd2807SJeff Garzik  *	should be retried.  To be used from EH.
1275c6fd2807SJeff Garzik  *
1276c6fd2807SJeff Garzik  *	SCSI midlayer limits the number of retries to scmd->allowed.
1277f13e2201SGwendal Grignou  *	scmd->allowed is incremented for commands which get retried
1278c6fd2807SJeff Garzik  *	due to unrelated failures (qc->err_mask is zero).
1279c6fd2807SJeff Garzik  */
1280c6fd2807SJeff Garzik void ata_eh_qc_retry(struct ata_queued_cmd *qc)
1281c6fd2807SJeff Garzik {
1282c6fd2807SJeff Garzik 	struct scsi_cmnd *scmd = qc->scsicmd;
1283f13e2201SGwendal Grignou 	if (!qc->err_mask)
1284f13e2201SGwendal Grignou 		scmd->allowed++;
1285c6fd2807SJeff Garzik 	__ata_eh_qc_complete(qc);
1286c6fd2807SJeff Garzik }
1287c6fd2807SJeff Garzik 
1288c6fd2807SJeff Garzik /**
1289678afac6STejun Heo  *	ata_dev_disable - disable ATA device
1290678afac6STejun Heo  *	@dev: ATA device to disable
1291678afac6STejun Heo  *
1292678afac6STejun Heo  *	Disable @dev.
1293678afac6STejun Heo  *
1294678afac6STejun Heo  *	Locking:
1295678afac6STejun Heo  *	EH context.
1296678afac6STejun Heo  */
1297678afac6STejun Heo void ata_dev_disable(struct ata_device *dev)
1298678afac6STejun Heo {
1299678afac6STejun Heo 	if (!ata_dev_enabled(dev))
1300678afac6STejun Heo 		return;
1301678afac6STejun Heo 
1302678afac6STejun Heo 	if (ata_msg_drv(dev->link->ap))
1303a9a79dfeSJoe Perches 		ata_dev_warn(dev, "disabled\n");
1304678afac6STejun Heo 	ata_acpi_on_disable(dev);
1305678afac6STejun Heo 	ata_down_xfermask_limit(dev, ATA_DNXFER_FORCE_PIO0 | ATA_DNXFER_QUIET);
1306678afac6STejun Heo 	dev->class++;
130799cf610aSTejun Heo 
130899cf610aSTejun Heo 	/* From now till the next successful probe, ering is used to
130999cf610aSTejun Heo 	 * track probe failures.  Clear accumulated device error info.
131099cf610aSTejun Heo 	 */
131199cf610aSTejun Heo 	ata_ering_clear(&dev->ering);
1312678afac6STejun Heo }
1313678afac6STejun Heo 
1314678afac6STejun Heo /**
1315c6fd2807SJeff Garzik  *	ata_eh_detach_dev - detach ATA device
1316c6fd2807SJeff Garzik  *	@dev: ATA device to detach
1317c6fd2807SJeff Garzik  *
1318c6fd2807SJeff Garzik  *	Detach @dev.
1319c6fd2807SJeff Garzik  *
1320c6fd2807SJeff Garzik  *	LOCKING:
1321c6fd2807SJeff Garzik  *	None.
1322c6fd2807SJeff Garzik  */
1323fb7fd614STejun Heo void ata_eh_detach_dev(struct ata_device *dev)
1324c6fd2807SJeff Garzik {
1325f58229f8STejun Heo 	struct ata_link *link = dev->link;
1326f58229f8STejun Heo 	struct ata_port *ap = link->ap;
132790484ebfSTejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
1328c6fd2807SJeff Garzik 	unsigned long flags;
1329c6fd2807SJeff Garzik 
1330c6fd2807SJeff Garzik 	ata_dev_disable(dev);
1331c6fd2807SJeff Garzik 
1332c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
1333c6fd2807SJeff Garzik 
1334c6fd2807SJeff Garzik 	dev->flags &= ~ATA_DFLAG_DETACH;
1335c6fd2807SJeff Garzik 
1336c6fd2807SJeff Garzik 	if (ata_scsi_offline_dev(dev)) {
1337c6fd2807SJeff Garzik 		dev->flags |= ATA_DFLAG_DETACHED;
1338c6fd2807SJeff Garzik 		ap->pflags |= ATA_PFLAG_SCSI_HOTPLUG;
1339c6fd2807SJeff Garzik 	}
1340c6fd2807SJeff Garzik 
134190484ebfSTejun Heo 	/* clear per-dev EH info */
1342f58229f8STejun Heo 	ata_eh_clear_action(link, dev, &link->eh_info, ATA_EH_PERDEV_MASK);
1343f58229f8STejun Heo 	ata_eh_clear_action(link, dev, &link->eh_context.i, ATA_EH_PERDEV_MASK);
134490484ebfSTejun Heo 	ehc->saved_xfer_mode[dev->devno] = 0;
134590484ebfSTejun Heo 	ehc->saved_ncq_enabled &= ~(1 << dev->devno);
1346c6fd2807SJeff Garzik 
1347c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
1348c6fd2807SJeff Garzik }
1349c6fd2807SJeff Garzik 
1350c6fd2807SJeff Garzik /**
1351c6fd2807SJeff Garzik  *	ata_eh_about_to_do - about to perform eh_action
1352955e57dfSTejun Heo  *	@link: target ATA link
1353c6fd2807SJeff Garzik  *	@dev: target ATA dev for per-dev action (can be NULL)
1354c6fd2807SJeff Garzik  *	@action: action about to be performed
1355c6fd2807SJeff Garzik  *
1356c6fd2807SJeff Garzik  *	Called just before performing EH actions to clear related bits
1357955e57dfSTejun Heo  *	in @link->eh_info such that eh actions are not unnecessarily
1358955e57dfSTejun Heo  *	repeated.
1359c6fd2807SJeff Garzik  *
1360c6fd2807SJeff Garzik  *	LOCKING:
1361c6fd2807SJeff Garzik  *	None.
1362c6fd2807SJeff Garzik  */
1363fb7fd614STejun Heo void ata_eh_about_to_do(struct ata_link *link, struct ata_device *dev,
1364c6fd2807SJeff Garzik 			unsigned int action)
1365c6fd2807SJeff Garzik {
1366955e57dfSTejun Heo 	struct ata_port *ap = link->ap;
1367955e57dfSTejun Heo 	struct ata_eh_info *ehi = &link->eh_info;
1368955e57dfSTejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
1369c6fd2807SJeff Garzik 	unsigned long flags;
1370c6fd2807SJeff Garzik 
1371c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
1372c6fd2807SJeff Garzik 
1373955e57dfSTejun Heo 	ata_eh_clear_action(link, dev, ehi, action);
1374c6fd2807SJeff Garzik 
1375a568d1d2STejun Heo 	/* About to take EH action, set RECOVERED.  Ignore actions on
1376a568d1d2STejun Heo 	 * slave links as master will do them again.
1377a568d1d2STejun Heo 	 */
1378a568d1d2STejun Heo 	if (!(ehc->i.flags & ATA_EHI_QUIET) && link != ap->slave_link)
1379c6fd2807SJeff Garzik 		ap->pflags |= ATA_PFLAG_RECOVERED;
1380c6fd2807SJeff Garzik 
1381c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
1382c6fd2807SJeff Garzik }
1383c6fd2807SJeff Garzik 
1384c6fd2807SJeff Garzik /**
1385c6fd2807SJeff Garzik  *	ata_eh_done - EH action complete
13862f60e1abSJonathan Corbet  *	@link: ATA link for which EH actions are complete
1387c6fd2807SJeff Garzik  *	@dev: target ATA dev for per-dev action (can be NULL)
1388c6fd2807SJeff Garzik  *	@action: action just completed
1389c6fd2807SJeff Garzik  *
1390c6fd2807SJeff Garzik  *	Called right after performing EH actions to clear related bits
1391955e57dfSTejun Heo  *	in @link->eh_context.
1392c6fd2807SJeff Garzik  *
1393c6fd2807SJeff Garzik  *	LOCKING:
1394c6fd2807SJeff Garzik  *	None.
1395c6fd2807SJeff Garzik  */
1396fb7fd614STejun Heo void ata_eh_done(struct ata_link *link, struct ata_device *dev,
1397c6fd2807SJeff Garzik 		 unsigned int action)
1398c6fd2807SJeff Garzik {
1399955e57dfSTejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
14009af5c9c9STejun Heo 
1401955e57dfSTejun Heo 	ata_eh_clear_action(link, dev, &ehc->i, action);
1402c6fd2807SJeff Garzik }
1403c6fd2807SJeff Garzik 
1404c6fd2807SJeff Garzik /**
1405c6fd2807SJeff Garzik  *	ata_err_string - convert err_mask to descriptive string
1406c6fd2807SJeff Garzik  *	@err_mask: error mask to convert to string
1407c6fd2807SJeff Garzik  *
1408c6fd2807SJeff Garzik  *	Convert @err_mask to descriptive string.  Errors are
1409c6fd2807SJeff Garzik  *	prioritized according to severity and only the most severe
1410c6fd2807SJeff Garzik  *	error is reported.
1411c6fd2807SJeff Garzik  *
1412c6fd2807SJeff Garzik  *	LOCKING:
1413c6fd2807SJeff Garzik  *	None.
1414c6fd2807SJeff Garzik  *
1415c6fd2807SJeff Garzik  *	RETURNS:
1416c6fd2807SJeff Garzik  *	Descriptive string for @err_mask
1417c6fd2807SJeff Garzik  */
1418c6fd2807SJeff Garzik static const char *ata_err_string(unsigned int err_mask)
1419c6fd2807SJeff Garzik {
1420c6fd2807SJeff Garzik 	if (err_mask & AC_ERR_HOST_BUS)
1421c6fd2807SJeff Garzik 		return "host bus error";
1422c6fd2807SJeff Garzik 	if (err_mask & AC_ERR_ATA_BUS)
1423c6fd2807SJeff Garzik 		return "ATA bus error";
1424c6fd2807SJeff Garzik 	if (err_mask & AC_ERR_TIMEOUT)
1425c6fd2807SJeff Garzik 		return "timeout";
1426c6fd2807SJeff Garzik 	if (err_mask & AC_ERR_HSM)
1427c6fd2807SJeff Garzik 		return "HSM violation";
1428c6fd2807SJeff Garzik 	if (err_mask & AC_ERR_SYSTEM)
1429c6fd2807SJeff Garzik 		return "internal error";
1430c6fd2807SJeff Garzik 	if (err_mask & AC_ERR_MEDIA)
1431c6fd2807SJeff Garzik 		return "media error";
1432c6fd2807SJeff Garzik 	if (err_mask & AC_ERR_INVALID)
1433c6fd2807SJeff Garzik 		return "invalid argument";
1434c6fd2807SJeff Garzik 	if (err_mask & AC_ERR_DEV)
1435c6fd2807SJeff Garzik 		return "device error";
143654fb131bSDamien Le Moal 	if (err_mask & AC_ERR_NCQ)
143754fb131bSDamien Le Moal 		return "NCQ error";
143854fb131bSDamien Le Moal 	if (err_mask & AC_ERR_NODEV_HINT)
143954fb131bSDamien Le Moal 		return "Polling detection error";
1440c6fd2807SJeff Garzik 	return "unknown error";
1441c6fd2807SJeff Garzik }
1442c6fd2807SJeff Garzik 
1443c6fd2807SJeff Garzik /**
1444c6fd2807SJeff Garzik  *	ata_eh_read_log_10h - Read log page 10h for NCQ error details
1445c6fd2807SJeff Garzik  *	@dev: Device to read log page 10h from
1446c6fd2807SJeff Garzik  *	@tag: Resulting tag of the failed command
1447c6fd2807SJeff Garzik  *	@tf: Resulting taskfile registers of the failed command
1448c6fd2807SJeff Garzik  *
1449c6fd2807SJeff Garzik  *	Read log page 10h to obtain NCQ error details and clear error
1450c6fd2807SJeff Garzik  *	condition.
1451c6fd2807SJeff Garzik  *
1452c6fd2807SJeff Garzik  *	LOCKING:
1453c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
1454c6fd2807SJeff Garzik  *
1455c6fd2807SJeff Garzik  *	RETURNS:
1456c6fd2807SJeff Garzik  *	0 on success, -errno otherwise.
1457c6fd2807SJeff Garzik  */
1458c6fd2807SJeff Garzik static int ata_eh_read_log_10h(struct ata_device *dev,
1459c6fd2807SJeff Garzik 			       int *tag, struct ata_taskfile *tf)
1460c6fd2807SJeff Garzik {
14619af5c9c9STejun Heo 	u8 *buf = dev->link->ap->sector_buf;
1462c6fd2807SJeff Garzik 	unsigned int err_mask;
1463c6fd2807SJeff Garzik 	u8 csum;
1464c6fd2807SJeff Garzik 	int i;
1465c6fd2807SJeff Garzik 
146665fe1f0fSShane Huang 	err_mask = ata_read_log_page(dev, ATA_LOG_SATA_NCQ, 0, buf, 1);
1467c6fd2807SJeff Garzik 	if (err_mask)
1468c6fd2807SJeff Garzik 		return -EIO;
1469c6fd2807SJeff Garzik 
1470c6fd2807SJeff Garzik 	csum = 0;
1471c6fd2807SJeff Garzik 	for (i = 0; i < ATA_SECT_SIZE; i++)
1472c6fd2807SJeff Garzik 		csum += buf[i];
1473c6fd2807SJeff Garzik 	if (csum)
1474a9a79dfeSJoe Perches 		ata_dev_warn(dev, "invalid checksum 0x%x on log page 10h\n",
1475a9a79dfeSJoe Perches 			     csum);
1476c6fd2807SJeff Garzik 
1477c6fd2807SJeff Garzik 	if (buf[0] & 0x80)
1478c6fd2807SJeff Garzik 		return -ENOENT;
1479c6fd2807SJeff Garzik 
1480c6fd2807SJeff Garzik 	*tag = buf[0] & 0x1f;
1481c6fd2807SJeff Garzik 
1482c6fd2807SJeff Garzik 	tf->command = buf[2];
1483c6fd2807SJeff Garzik 	tf->feature = buf[3];
1484c6fd2807SJeff Garzik 	tf->lbal = buf[4];
1485c6fd2807SJeff Garzik 	tf->lbam = buf[5];
1486c6fd2807SJeff Garzik 	tf->lbah = buf[6];
1487c6fd2807SJeff Garzik 	tf->device = buf[7];
1488c6fd2807SJeff Garzik 	tf->hob_lbal = buf[8];
1489c6fd2807SJeff Garzik 	tf->hob_lbam = buf[9];
1490c6fd2807SJeff Garzik 	tf->hob_lbah = buf[10];
1491c6fd2807SJeff Garzik 	tf->nsect = buf[12];
1492c6fd2807SJeff Garzik 	tf->hob_nsect = buf[13];
14935b01e4b9SHannes Reinecke 	if (ata_id_has_ncq_autosense(dev->id))
14945b01e4b9SHannes Reinecke 		tf->auxiliary = buf[14] << 16 | buf[15] << 8 | buf[16];
1495c6fd2807SJeff Garzik 
1496c6fd2807SJeff Garzik 	return 0;
1497c6fd2807SJeff Garzik }
1498c6fd2807SJeff Garzik 
1499c6fd2807SJeff Garzik /**
150011fc33daSTejun Heo  *	atapi_eh_tur - perform ATAPI TEST_UNIT_READY
150111fc33daSTejun Heo  *	@dev: target ATAPI device
150211fc33daSTejun Heo  *	@r_sense_key: out parameter for sense_key
150311fc33daSTejun Heo  *
150411fc33daSTejun Heo  *	Perform ATAPI TEST_UNIT_READY.
150511fc33daSTejun Heo  *
150611fc33daSTejun Heo  *	LOCKING:
150711fc33daSTejun Heo  *	EH context (may sleep).
150811fc33daSTejun Heo  *
150911fc33daSTejun Heo  *	RETURNS:
151011fc33daSTejun Heo  *	0 on success, AC_ERR_* mask on failure.
151111fc33daSTejun Heo  */
15123dc67440SAaron Lu unsigned int atapi_eh_tur(struct ata_device *dev, u8 *r_sense_key)
151311fc33daSTejun Heo {
151411fc33daSTejun Heo 	u8 cdb[ATAPI_CDB_LEN] = { TEST_UNIT_READY, 0, 0, 0, 0, 0 };
151511fc33daSTejun Heo 	struct ata_taskfile tf;
151611fc33daSTejun Heo 	unsigned int err_mask;
151711fc33daSTejun Heo 
151811fc33daSTejun Heo 	ata_tf_init(dev, &tf);
151911fc33daSTejun Heo 
152011fc33daSTejun Heo 	tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
152111fc33daSTejun Heo 	tf.command = ATA_CMD_PACKET;
152211fc33daSTejun Heo 	tf.protocol = ATAPI_PROT_NODATA;
152311fc33daSTejun Heo 
152411fc33daSTejun Heo 	err_mask = ata_exec_internal(dev, &tf, cdb, DMA_NONE, NULL, 0, 0);
152511fc33daSTejun Heo 	if (err_mask == AC_ERR_DEV)
152611fc33daSTejun Heo 		*r_sense_key = tf.feature >> 4;
152711fc33daSTejun Heo 	return err_mask;
152811fc33daSTejun Heo }
152911fc33daSTejun Heo 
153011fc33daSTejun Heo /**
1531e87fd28cSHannes Reinecke  *	ata_eh_request_sense - perform REQUEST_SENSE_DATA_EXT
15322f60e1abSJonathan Corbet  *	@qc: qc to perform REQUEST_SENSE_SENSE_DATA_EXT to
1533e87fd28cSHannes Reinecke  *	@cmd: scsi command for which the sense code should be set
1534e87fd28cSHannes Reinecke  *
1535e87fd28cSHannes Reinecke  *	Perform REQUEST_SENSE_DATA_EXT after the device reported CHECK
1536e87fd28cSHannes Reinecke  *	SENSE.  This function is an EH helper.
1537e87fd28cSHannes Reinecke  *
1538e87fd28cSHannes Reinecke  *	LOCKING:
1539e87fd28cSHannes Reinecke  *	Kernel thread context (may sleep).
1540e87fd28cSHannes Reinecke  */
1541e87fd28cSHannes Reinecke static void ata_eh_request_sense(struct ata_queued_cmd *qc,
1542e87fd28cSHannes Reinecke 				 struct scsi_cmnd *cmd)
1543e87fd28cSHannes Reinecke {
1544e87fd28cSHannes Reinecke 	struct ata_device *dev = qc->dev;
1545e87fd28cSHannes Reinecke 	struct ata_taskfile tf;
1546e87fd28cSHannes Reinecke 	unsigned int err_mask;
1547e87fd28cSHannes Reinecke 
1548e87fd28cSHannes Reinecke 	if (qc->ap->pflags & ATA_PFLAG_FROZEN) {
1549e87fd28cSHannes Reinecke 		ata_dev_warn(dev, "sense data available but port frozen\n");
1550e87fd28cSHannes Reinecke 		return;
1551e87fd28cSHannes Reinecke 	}
1552e87fd28cSHannes Reinecke 
1553d238ffd5SHannes Reinecke 	if (!cmd || qc->flags & ATA_QCFLAG_SENSE_VALID)
1554e87fd28cSHannes Reinecke 		return;
1555e87fd28cSHannes Reinecke 
1556e87fd28cSHannes Reinecke 	if (!ata_id_sense_reporting_enabled(dev->id)) {
1557e87fd28cSHannes Reinecke 		ata_dev_warn(qc->dev, "sense data reporting disabled\n");
1558e87fd28cSHannes Reinecke 		return;
1559e87fd28cSHannes Reinecke 	}
1560e87fd28cSHannes Reinecke 
1561e87fd28cSHannes Reinecke 	DPRINTK("ATA request sense\n");
1562e87fd28cSHannes Reinecke 
1563e87fd28cSHannes Reinecke 	ata_tf_init(dev, &tf);
1564e87fd28cSHannes Reinecke 	tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1565e87fd28cSHannes Reinecke 	tf.flags |= ATA_TFLAG_LBA | ATA_TFLAG_LBA48;
1566e87fd28cSHannes Reinecke 	tf.command = ATA_CMD_REQ_SENSE_DATA;
1567e87fd28cSHannes Reinecke 	tf.protocol = ATA_PROT_NODATA;
1568e87fd28cSHannes Reinecke 
1569e87fd28cSHannes Reinecke 	err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
1570e87fd28cSHannes Reinecke 	/* Ignore err_mask; ATA_ERR might be set */
1571e87fd28cSHannes Reinecke 	if (tf.command & ATA_SENSE) {
157206dbde5fSHannes Reinecke 		ata_scsi_set_sense(dev, cmd, tf.lbah, tf.lbam, tf.lbal);
1573e87fd28cSHannes Reinecke 		qc->flags |= ATA_QCFLAG_SENSE_VALID;
1574e87fd28cSHannes Reinecke 	} else {
1575e87fd28cSHannes Reinecke 		ata_dev_warn(dev, "request sense failed stat %02x emask %x\n",
1576e87fd28cSHannes Reinecke 			     tf.command, err_mask);
1577e87fd28cSHannes Reinecke 	}
1578e87fd28cSHannes Reinecke }
1579e87fd28cSHannes Reinecke 
1580e87fd28cSHannes Reinecke /**
1581c6fd2807SJeff Garzik  *	atapi_eh_request_sense - perform ATAPI REQUEST_SENSE
1582c6fd2807SJeff Garzik  *	@dev: device to perform REQUEST_SENSE to
1583c6fd2807SJeff Garzik  *	@sense_buf: result sense data buffer (SCSI_SENSE_BUFFERSIZE bytes long)
15843eabddb8STejun Heo  *	@dfl_sense_key: default sense key to use
1585c6fd2807SJeff Garzik  *
1586c6fd2807SJeff Garzik  *	Perform ATAPI REQUEST_SENSE after the device reported CHECK
1587c6fd2807SJeff Garzik  *	SENSE.  This function is EH helper.
1588c6fd2807SJeff Garzik  *
1589c6fd2807SJeff Garzik  *	LOCKING:
1590c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
1591c6fd2807SJeff Garzik  *
1592c6fd2807SJeff Garzik  *	RETURNS:
1593c6fd2807SJeff Garzik  *	0 on success, AC_ERR_* mask on failure
1594c6fd2807SJeff Garzik  */
15953dc67440SAaron Lu unsigned int atapi_eh_request_sense(struct ata_device *dev,
15963eabddb8STejun Heo 					   u8 *sense_buf, u8 dfl_sense_key)
1597c6fd2807SJeff Garzik {
15983eabddb8STejun Heo 	u8 cdb[ATAPI_CDB_LEN] =
15993eabddb8STejun Heo 		{ REQUEST_SENSE, 0, 0, 0, SCSI_SENSE_BUFFERSIZE, 0 };
16009af5c9c9STejun Heo 	struct ata_port *ap = dev->link->ap;
1601c6fd2807SJeff Garzik 	struct ata_taskfile tf;
1602c6fd2807SJeff Garzik 
1603c6fd2807SJeff Garzik 	DPRINTK("ATAPI request sense\n");
1604c6fd2807SJeff Garzik 
1605c6fd2807SJeff Garzik 	memset(sense_buf, 0, SCSI_SENSE_BUFFERSIZE);
1606c6fd2807SJeff Garzik 
160756287768SAlbert Lee 	/* initialize sense_buf with the error register,
160856287768SAlbert Lee 	 * for the case where they are -not- overwritten
160956287768SAlbert Lee 	 */
1610c6fd2807SJeff Garzik 	sense_buf[0] = 0x70;
16113eabddb8STejun Heo 	sense_buf[2] = dfl_sense_key;
161256287768SAlbert Lee 
161356287768SAlbert Lee 	/* some devices time out if garbage left in tf */
161456287768SAlbert Lee 	ata_tf_init(dev, &tf);
1615c6fd2807SJeff Garzik 
1616c6fd2807SJeff Garzik 	tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1617c6fd2807SJeff Garzik 	tf.command = ATA_CMD_PACKET;
1618c6fd2807SJeff Garzik 
1619c6fd2807SJeff Garzik 	/* is it pointless to prefer PIO for "safety reasons"? */
1620c6fd2807SJeff Garzik 	if (ap->flags & ATA_FLAG_PIO_DMA) {
16210dc36888STejun Heo 		tf.protocol = ATAPI_PROT_DMA;
1622c6fd2807SJeff Garzik 		tf.feature |= ATAPI_PKT_DMA;
1623c6fd2807SJeff Garzik 	} else {
16240dc36888STejun Heo 		tf.protocol = ATAPI_PROT_PIO;
1625f2dfc1a1STejun Heo 		tf.lbam = SCSI_SENSE_BUFFERSIZE;
1626f2dfc1a1STejun Heo 		tf.lbah = 0;
1627c6fd2807SJeff Garzik 	}
1628c6fd2807SJeff Garzik 
1629c6fd2807SJeff Garzik 	return ata_exec_internal(dev, &tf, cdb, DMA_FROM_DEVICE,
16302b789108STejun Heo 				 sense_buf, SCSI_SENSE_BUFFERSIZE, 0);
1631c6fd2807SJeff Garzik }
1632c6fd2807SJeff Garzik 
1633c6fd2807SJeff Garzik /**
1634c6fd2807SJeff Garzik  *	ata_eh_analyze_serror - analyze SError for a failed port
16350260731fSTejun Heo  *	@link: ATA link to analyze SError for
1636c6fd2807SJeff Garzik  *
1637c6fd2807SJeff Garzik  *	Analyze SError if available and further determine cause of
1638c6fd2807SJeff Garzik  *	failure.
1639c6fd2807SJeff Garzik  *
1640c6fd2807SJeff Garzik  *	LOCKING:
1641c6fd2807SJeff Garzik  *	None.
1642c6fd2807SJeff Garzik  */
16430260731fSTejun Heo static void ata_eh_analyze_serror(struct ata_link *link)
1644c6fd2807SJeff Garzik {
16450260731fSTejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
1646c6fd2807SJeff Garzik 	u32 serror = ehc->i.serror;
1647c6fd2807SJeff Garzik 	unsigned int err_mask = 0, action = 0;
1648f9df58cbSTejun Heo 	u32 hotplug_mask;
1649c6fd2807SJeff Garzik 
1650e0614db2STejun Heo 	if (serror & (SERR_PERSISTENT | SERR_DATA)) {
1651c6fd2807SJeff Garzik 		err_mask |= AC_ERR_ATA_BUS;
1652cf480626STejun Heo 		action |= ATA_EH_RESET;
1653c6fd2807SJeff Garzik 	}
1654c6fd2807SJeff Garzik 	if (serror & SERR_PROTOCOL) {
1655c6fd2807SJeff Garzik 		err_mask |= AC_ERR_HSM;
1656cf480626STejun Heo 		action |= ATA_EH_RESET;
1657c6fd2807SJeff Garzik 	}
1658c6fd2807SJeff Garzik 	if (serror & SERR_INTERNAL) {
1659c6fd2807SJeff Garzik 		err_mask |= AC_ERR_SYSTEM;
1660cf480626STejun Heo 		action |= ATA_EH_RESET;
1661c6fd2807SJeff Garzik 	}
1662f9df58cbSTejun Heo 
1663f9df58cbSTejun Heo 	/* Determine whether a hotplug event has occurred.  Both
1664f9df58cbSTejun Heo 	 * SError.N/X are considered hotplug events for enabled or
1665f9df58cbSTejun Heo 	 * host links.  For disabled PMP links, only N bit is
1666f9df58cbSTejun Heo 	 * considered as X bit is left at 1 for link plugging.
1667f9df58cbSTejun Heo 	 */
1668eb0e85e3STejun Heo 	if (link->lpm_policy > ATA_LPM_MAX_POWER)
16696b7ae954STejun Heo 		hotplug_mask = 0;	/* hotplug doesn't work w/ LPM */
16706b7ae954STejun Heo 	else if (!(link->flags & ATA_LFLAG_DISABLED) || ata_is_host_link(link))
1671f9df58cbSTejun Heo 		hotplug_mask = SERR_PHYRDY_CHG | SERR_DEV_XCHG;
1672f9df58cbSTejun Heo 	else
1673f9df58cbSTejun Heo 		hotplug_mask = SERR_PHYRDY_CHG;
1674f9df58cbSTejun Heo 
1675f9df58cbSTejun Heo 	if (serror & hotplug_mask)
1676c6fd2807SJeff Garzik 		ata_ehi_hotplugged(&ehc->i);
1677c6fd2807SJeff Garzik 
1678c6fd2807SJeff Garzik 	ehc->i.err_mask |= err_mask;
1679c6fd2807SJeff Garzik 	ehc->i.action |= action;
1680c6fd2807SJeff Garzik }
1681c6fd2807SJeff Garzik 
1682c6fd2807SJeff Garzik /**
1683c6fd2807SJeff Garzik  *	ata_eh_analyze_ncq_error - analyze NCQ error
16840260731fSTejun Heo  *	@link: ATA link to analyze NCQ error for
1685c6fd2807SJeff Garzik  *
1686c6fd2807SJeff Garzik  *	Read log page 10h, determine the offending qc and acquire
1687c6fd2807SJeff Garzik  *	error status TF.  For NCQ device errors, all LLDDs have to do
1688c6fd2807SJeff Garzik  *	is setting AC_ERR_DEV in ehi->err_mask.  This function takes
1689c6fd2807SJeff Garzik  *	care of the rest.
1690c6fd2807SJeff Garzik  *
1691c6fd2807SJeff Garzik  *	LOCKING:
1692c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
1693c6fd2807SJeff Garzik  */
169410acf3b0SMark Lord void ata_eh_analyze_ncq_error(struct ata_link *link)
1695c6fd2807SJeff Garzik {
16960260731fSTejun Heo 	struct ata_port *ap = link->ap;
16970260731fSTejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
16980260731fSTejun Heo 	struct ata_device *dev = link->device;
1699c6fd2807SJeff Garzik 	struct ata_queued_cmd *qc;
1700c6fd2807SJeff Garzik 	struct ata_taskfile tf;
1701c6fd2807SJeff Garzik 	int tag, rc;
1702c6fd2807SJeff Garzik 
1703c6fd2807SJeff Garzik 	/* if frozen, we can't do much */
1704c6fd2807SJeff Garzik 	if (ap->pflags & ATA_PFLAG_FROZEN)
1705c6fd2807SJeff Garzik 		return;
1706c6fd2807SJeff Garzik 
1707c6fd2807SJeff Garzik 	/* is it NCQ device error? */
17080260731fSTejun Heo 	if (!link->sactive || !(ehc->i.err_mask & AC_ERR_DEV))
1709c6fd2807SJeff Garzik 		return;
1710c6fd2807SJeff Garzik 
1711c6fd2807SJeff Garzik 	/* has LLDD analyzed already? */
1712*258c4e5cSJens Axboe 	ata_qc_for_each_raw(ap, qc, tag) {
1713c6fd2807SJeff Garzik 		if (!(qc->flags & ATA_QCFLAG_FAILED))
1714c6fd2807SJeff Garzik 			continue;
1715c6fd2807SJeff Garzik 
1716c6fd2807SJeff Garzik 		if (qc->err_mask)
1717c6fd2807SJeff Garzik 			return;
1718c6fd2807SJeff Garzik 	}
1719c6fd2807SJeff Garzik 
1720c6fd2807SJeff Garzik 	/* okay, this error is ours */
1721a09bf4cdSJeff Garzik 	memset(&tf, 0, sizeof(tf));
1722c6fd2807SJeff Garzik 	rc = ata_eh_read_log_10h(dev, &tag, &tf);
1723c6fd2807SJeff Garzik 	if (rc) {
1724a9a79dfeSJoe Perches 		ata_link_err(link, "failed to read log page 10h (errno=%d)\n",
1725a9a79dfeSJoe Perches 			     rc);
1726c6fd2807SJeff Garzik 		return;
1727c6fd2807SJeff Garzik 	}
1728c6fd2807SJeff Garzik 
17290260731fSTejun Heo 	if (!(link->sactive & (1 << tag))) {
1730a9a79dfeSJoe Perches 		ata_link_err(link, "log page 10h reported inactive tag %d\n",
1731a9a79dfeSJoe Perches 			     tag);
1732c6fd2807SJeff Garzik 		return;
1733c6fd2807SJeff Garzik 	}
1734c6fd2807SJeff Garzik 
1735c6fd2807SJeff Garzik 	/* we've got the perpetrator, condemn it */
1736c6fd2807SJeff Garzik 	qc = __ata_qc_from_tag(ap, tag);
1737c6fd2807SJeff Garzik 	memcpy(&qc->result_tf, &tf, sizeof(tf));
1738a6116c9eSMark Lord 	qc->result_tf.flags = ATA_TFLAG_ISADDR | ATA_TFLAG_LBA | ATA_TFLAG_LBA48;
17395335b729STejun Heo 	qc->err_mask |= AC_ERR_DEV | AC_ERR_NCQ;
1740d238ffd5SHannes Reinecke 	if ((qc->result_tf.command & ATA_SENSE) || qc->result_tf.auxiliary) {
17415b01e4b9SHannes Reinecke 		char sense_key, asc, ascq;
17425b01e4b9SHannes Reinecke 
17435b01e4b9SHannes Reinecke 		sense_key = (qc->result_tf.auxiliary >> 16) & 0xff;
17445b01e4b9SHannes Reinecke 		asc = (qc->result_tf.auxiliary >> 8) & 0xff;
17455b01e4b9SHannes Reinecke 		ascq = qc->result_tf.auxiliary & 0xff;
174606dbde5fSHannes Reinecke 		ata_scsi_set_sense(dev, qc->scsicmd, sense_key, asc, ascq);
1747492bf621SHannes Reinecke 		ata_scsi_set_sense_information(dev, qc->scsicmd,
1748492bf621SHannes Reinecke 					       &qc->result_tf);
17495b01e4b9SHannes Reinecke 		qc->flags |= ATA_QCFLAG_SENSE_VALID;
17505b01e4b9SHannes Reinecke 	}
17515b01e4b9SHannes Reinecke 
1752c6fd2807SJeff Garzik 	ehc->i.err_mask &= ~AC_ERR_DEV;
1753c6fd2807SJeff Garzik }
1754c6fd2807SJeff Garzik 
1755c6fd2807SJeff Garzik /**
1756c6fd2807SJeff Garzik  *	ata_eh_analyze_tf - analyze taskfile of a failed qc
1757c6fd2807SJeff Garzik  *	@qc: qc to analyze
1758c6fd2807SJeff Garzik  *	@tf: Taskfile registers to analyze
1759c6fd2807SJeff Garzik  *
1760c6fd2807SJeff Garzik  *	Analyze taskfile of @qc and further determine cause of
1761c6fd2807SJeff Garzik  *	failure.  This function also requests ATAPI sense data if
176225985edcSLucas De Marchi  *	available.
1763c6fd2807SJeff Garzik  *
1764c6fd2807SJeff Garzik  *	LOCKING:
1765c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
1766c6fd2807SJeff Garzik  *
1767c6fd2807SJeff Garzik  *	RETURNS:
1768c6fd2807SJeff Garzik  *	Determined recovery action
1769c6fd2807SJeff Garzik  */
1770c6fd2807SJeff Garzik static unsigned int ata_eh_analyze_tf(struct ata_queued_cmd *qc,
1771c6fd2807SJeff Garzik 				      const struct ata_taskfile *tf)
1772c6fd2807SJeff Garzik {
1773c6fd2807SJeff Garzik 	unsigned int tmp, action = 0;
1774c6fd2807SJeff Garzik 	u8 stat = tf->command, err = tf->feature;
1775c6fd2807SJeff Garzik 
1776c6fd2807SJeff Garzik 	if ((stat & (ATA_BUSY | ATA_DRQ | ATA_DRDY)) != ATA_DRDY) {
1777c6fd2807SJeff Garzik 		qc->err_mask |= AC_ERR_HSM;
1778cf480626STejun Heo 		return ATA_EH_RESET;
1779c6fd2807SJeff Garzik 	}
1780c6fd2807SJeff Garzik 
1781e87fd28cSHannes Reinecke 	if (stat & (ATA_ERR | ATA_DF)) {
1782a51d644aSTejun Heo 		qc->err_mask |= AC_ERR_DEV;
1783e87fd28cSHannes Reinecke 		/*
1784e87fd28cSHannes Reinecke 		 * Sense data reporting does not work if the
1785e87fd28cSHannes Reinecke 		 * device fault bit is set.
1786e87fd28cSHannes Reinecke 		 */
1787e87fd28cSHannes Reinecke 		if (stat & ATA_DF)
1788e87fd28cSHannes Reinecke 			stat &= ~ATA_SENSE;
1789e87fd28cSHannes Reinecke 	} else {
1790c6fd2807SJeff Garzik 		return 0;
1791e87fd28cSHannes Reinecke 	}
1792c6fd2807SJeff Garzik 
1793c6fd2807SJeff Garzik 	switch (qc->dev->class) {
1794c6fd2807SJeff Garzik 	case ATA_DEV_ATA:
17959162c657SHannes Reinecke 	case ATA_DEV_ZAC:
1796e87fd28cSHannes Reinecke 		if (stat & ATA_SENSE)
1797e87fd28cSHannes Reinecke 			ata_eh_request_sense(qc, qc->scsicmd);
1798c6fd2807SJeff Garzik 		if (err & ATA_ICRC)
1799c6fd2807SJeff Garzik 			qc->err_mask |= AC_ERR_ATA_BUS;
1800eec7e1c1SAlexey Asemov 		if (err & (ATA_UNC | ATA_AMNF))
1801c6fd2807SJeff Garzik 			qc->err_mask |= AC_ERR_MEDIA;
1802c6fd2807SJeff Garzik 		if (err & ATA_IDNF)
1803c6fd2807SJeff Garzik 			qc->err_mask |= AC_ERR_INVALID;
1804c6fd2807SJeff Garzik 		break;
1805c6fd2807SJeff Garzik 
1806c6fd2807SJeff Garzik 	case ATA_DEV_ATAPI:
1807a569a30dSTejun Heo 		if (!(qc->ap->pflags & ATA_PFLAG_FROZEN)) {
18083eabddb8STejun Heo 			tmp = atapi_eh_request_sense(qc->dev,
18093eabddb8STejun Heo 						qc->scsicmd->sense_buffer,
18103eabddb8STejun Heo 						qc->result_tf.feature >> 4);
18113852e373SHannes Reinecke 			if (!tmp)
1812c6fd2807SJeff Garzik 				qc->flags |= ATA_QCFLAG_SENSE_VALID;
18133852e373SHannes Reinecke 			else
1814c6fd2807SJeff Garzik 				qc->err_mask |= tmp;
1815c6fd2807SJeff Garzik 		}
1816a569a30dSTejun Heo 	}
1817c6fd2807SJeff Garzik 
18183852e373SHannes Reinecke 	if (qc->flags & ATA_QCFLAG_SENSE_VALID) {
18193852e373SHannes Reinecke 		int ret = scsi_check_sense(qc->scsicmd);
18203852e373SHannes Reinecke 		/*
182179487259SDamien Le Moal 		 * SUCCESS here means that the sense code could be
18223852e373SHannes Reinecke 		 * evaluated and should be passed to the upper layers
18233852e373SHannes Reinecke 		 * for correct evaluation.
182479487259SDamien Le Moal 		 * FAILED means the sense code could not be interpreted
18253852e373SHannes Reinecke 		 * and the device would need to be reset.
18263852e373SHannes Reinecke 		 * NEEDS_RETRY and ADD_TO_MLQUEUE means that the
18273852e373SHannes Reinecke 		 * command would need to be retried.
18283852e373SHannes Reinecke 		 */
18293852e373SHannes Reinecke 		if (ret == NEEDS_RETRY || ret == ADD_TO_MLQUEUE) {
18303852e373SHannes Reinecke 			qc->flags |= ATA_QCFLAG_RETRY;
18313852e373SHannes Reinecke 			qc->err_mask |= AC_ERR_OTHER;
18323852e373SHannes Reinecke 		} else if (ret != SUCCESS) {
18333852e373SHannes Reinecke 			qc->err_mask |= AC_ERR_HSM;
18343852e373SHannes Reinecke 		}
18353852e373SHannes Reinecke 	}
1836c6fd2807SJeff Garzik 	if (qc->err_mask & (AC_ERR_HSM | AC_ERR_TIMEOUT | AC_ERR_ATA_BUS))
1837cf480626STejun Heo 		action |= ATA_EH_RESET;
1838c6fd2807SJeff Garzik 
1839c6fd2807SJeff Garzik 	return action;
1840c6fd2807SJeff Garzik }
1841c6fd2807SJeff Garzik 
184276326ac1STejun Heo static int ata_eh_categorize_error(unsigned int eflags, unsigned int err_mask,
184376326ac1STejun Heo 				   int *xfer_ok)
1844c6fd2807SJeff Garzik {
184576326ac1STejun Heo 	int base = 0;
184676326ac1STejun Heo 
184776326ac1STejun Heo 	if (!(eflags & ATA_EFLAG_DUBIOUS_XFER))
184876326ac1STejun Heo 		*xfer_ok = 1;
184976326ac1STejun Heo 
185076326ac1STejun Heo 	if (!*xfer_ok)
185175f9cafcSTejun Heo 		base = ATA_ECAT_DUBIOUS_NONE;
185276326ac1STejun Heo 
18537d47e8d4STejun Heo 	if (err_mask & AC_ERR_ATA_BUS)
185476326ac1STejun Heo 		return base + ATA_ECAT_ATA_BUS;
1855c6fd2807SJeff Garzik 
18567d47e8d4STejun Heo 	if (err_mask & AC_ERR_TIMEOUT)
185776326ac1STejun Heo 		return base + ATA_ECAT_TOUT_HSM;
18587d47e8d4STejun Heo 
18593884f7b0STejun Heo 	if (eflags & ATA_EFLAG_IS_IO) {
18607d47e8d4STejun Heo 		if (err_mask & AC_ERR_HSM)
186176326ac1STejun Heo 			return base + ATA_ECAT_TOUT_HSM;
18627d47e8d4STejun Heo 		if ((err_mask &
18637d47e8d4STejun Heo 		     (AC_ERR_DEV|AC_ERR_MEDIA|AC_ERR_INVALID)) == AC_ERR_DEV)
186476326ac1STejun Heo 			return base + ATA_ECAT_UNK_DEV;
1865c6fd2807SJeff Garzik 	}
1866c6fd2807SJeff Garzik 
1867c6fd2807SJeff Garzik 	return 0;
1868c6fd2807SJeff Garzik }
1869c6fd2807SJeff Garzik 
18707d47e8d4STejun Heo struct speed_down_verdict_arg {
1871c6fd2807SJeff Garzik 	u64 since;
187276326ac1STejun Heo 	int xfer_ok;
18733884f7b0STejun Heo 	int nr_errors[ATA_ECAT_NR];
1874c6fd2807SJeff Garzik };
1875c6fd2807SJeff Garzik 
18767d47e8d4STejun Heo static int speed_down_verdict_cb(struct ata_ering_entry *ent, void *void_arg)
1877c6fd2807SJeff Garzik {
18787d47e8d4STejun Heo 	struct speed_down_verdict_arg *arg = void_arg;
187976326ac1STejun Heo 	int cat;
1880c6fd2807SJeff Garzik 
1881d9027470SGwendal Grignou 	if ((ent->eflags & ATA_EFLAG_OLD_ER) || (ent->timestamp < arg->since))
1882c6fd2807SJeff Garzik 		return -1;
1883c6fd2807SJeff Garzik 
188476326ac1STejun Heo 	cat = ata_eh_categorize_error(ent->eflags, ent->err_mask,
188576326ac1STejun Heo 				      &arg->xfer_ok);
18867d47e8d4STejun Heo 	arg->nr_errors[cat]++;
188776326ac1STejun Heo 
1888c6fd2807SJeff Garzik 	return 0;
1889c6fd2807SJeff Garzik }
1890c6fd2807SJeff Garzik 
1891c6fd2807SJeff Garzik /**
18927d47e8d4STejun Heo  *	ata_eh_speed_down_verdict - Determine speed down verdict
1893c6fd2807SJeff Garzik  *	@dev: Device of interest
1894c6fd2807SJeff Garzik  *
1895c6fd2807SJeff Garzik  *	This function examines error ring of @dev and determines
18967d47e8d4STejun Heo  *	whether NCQ needs to be turned off, transfer speed should be
18977d47e8d4STejun Heo  *	stepped down, or falling back to PIO is necessary.
1898c6fd2807SJeff Garzik  *
18993884f7b0STejun Heo  *	ECAT_ATA_BUS	: ATA_BUS error for any command
1900c6fd2807SJeff Garzik  *
19013884f7b0STejun Heo  *	ECAT_TOUT_HSM	: TIMEOUT for any command or HSM violation for
19023884f7b0STejun Heo  *			  IO commands
19037d47e8d4STejun Heo  *
19043884f7b0STejun Heo  *	ECAT_UNK_DEV	: Unknown DEV error for IO commands
1905c6fd2807SJeff Garzik  *
190676326ac1STejun Heo  *	ECAT_DUBIOUS_*	: Identical to above three but occurred while
190776326ac1STejun Heo  *			  data transfer hasn't been verified.
190876326ac1STejun Heo  *
19093884f7b0STejun Heo  *	Verdicts are
19107d47e8d4STejun Heo  *
19113884f7b0STejun Heo  *	NCQ_OFF		: Turn off NCQ.
19127d47e8d4STejun Heo  *
19133884f7b0STejun Heo  *	SPEED_DOWN	: Speed down transfer speed but don't fall back
19143884f7b0STejun Heo  *			  to PIO.
19153884f7b0STejun Heo  *
19163884f7b0STejun Heo  *	FALLBACK_TO_PIO	: Fall back to PIO.
19173884f7b0STejun Heo  *
19183884f7b0STejun Heo  *	Even if multiple verdicts are returned, only one action is
191976326ac1STejun Heo  *	taken per error.  An action triggered by non-DUBIOUS errors
192076326ac1STejun Heo  *	clears ering, while one triggered by DUBIOUS_* errors doesn't.
192176326ac1STejun Heo  *	This is to expedite speed down decisions right after device is
192276326ac1STejun Heo  *	initially configured.
19233884f7b0STejun Heo  *
19244091fb95SMasahiro Yamada  *	The following are speed down rules.  #1 and #2 deal with
192576326ac1STejun Heo  *	DUBIOUS errors.
192676326ac1STejun Heo  *
192776326ac1STejun Heo  *	1. If more than one DUBIOUS_ATA_BUS or DUBIOUS_TOUT_HSM errors
192876326ac1STejun Heo  *	   occurred during last 5 mins, SPEED_DOWN and FALLBACK_TO_PIO.
192976326ac1STejun Heo  *
193076326ac1STejun Heo  *	2. If more than one DUBIOUS_TOUT_HSM or DUBIOUS_UNK_DEV errors
193176326ac1STejun Heo  *	   occurred during last 5 mins, NCQ_OFF.
193276326ac1STejun Heo  *
193376326ac1STejun Heo  *	3. If more than 8 ATA_BUS, TOUT_HSM or UNK_DEV errors
193425985edcSLucas De Marchi  *	   occurred during last 5 mins, FALLBACK_TO_PIO
19353884f7b0STejun Heo  *
193676326ac1STejun Heo  *	4. If more than 3 TOUT_HSM or UNK_DEV errors occurred
19373884f7b0STejun Heo  *	   during last 10 mins, NCQ_OFF.
19383884f7b0STejun Heo  *
193976326ac1STejun Heo  *	5. If more than 3 ATA_BUS or TOUT_HSM errors, or more than 6
19403884f7b0STejun Heo  *	   UNK_DEV errors occurred during last 10 mins, SPEED_DOWN.
19417d47e8d4STejun Heo  *
1942c6fd2807SJeff Garzik  *	LOCKING:
1943c6fd2807SJeff Garzik  *	Inherited from caller.
1944c6fd2807SJeff Garzik  *
1945c6fd2807SJeff Garzik  *	RETURNS:
19467d47e8d4STejun Heo  *	OR of ATA_EH_SPDN_* flags.
1947c6fd2807SJeff Garzik  */
19487d47e8d4STejun Heo static unsigned int ata_eh_speed_down_verdict(struct ata_device *dev)
1949c6fd2807SJeff Garzik {
19507d47e8d4STejun Heo 	const u64 j5mins = 5LLU * 60 * HZ, j10mins = 10LLU * 60 * HZ;
19517d47e8d4STejun Heo 	u64 j64 = get_jiffies_64();
19527d47e8d4STejun Heo 	struct speed_down_verdict_arg arg;
19537d47e8d4STejun Heo 	unsigned int verdict = 0;
1954c6fd2807SJeff Garzik 
19553884f7b0STejun Heo 	/* scan past 5 mins of error history */
19563884f7b0STejun Heo 	memset(&arg, 0, sizeof(arg));
19573884f7b0STejun Heo 	arg.since = j64 - min(j64, j5mins);
19583884f7b0STejun Heo 	ata_ering_map(&dev->ering, speed_down_verdict_cb, &arg);
19593884f7b0STejun Heo 
196076326ac1STejun Heo 	if (arg.nr_errors[ATA_ECAT_DUBIOUS_ATA_BUS] +
196176326ac1STejun Heo 	    arg.nr_errors[ATA_ECAT_DUBIOUS_TOUT_HSM] > 1)
196276326ac1STejun Heo 		verdict |= ATA_EH_SPDN_SPEED_DOWN |
196376326ac1STejun Heo 			ATA_EH_SPDN_FALLBACK_TO_PIO | ATA_EH_SPDN_KEEP_ERRORS;
196476326ac1STejun Heo 
196576326ac1STejun Heo 	if (arg.nr_errors[ATA_ECAT_DUBIOUS_TOUT_HSM] +
196676326ac1STejun Heo 	    arg.nr_errors[ATA_ECAT_DUBIOUS_UNK_DEV] > 1)
196776326ac1STejun Heo 		verdict |= ATA_EH_SPDN_NCQ_OFF | ATA_EH_SPDN_KEEP_ERRORS;
196876326ac1STejun Heo 
19693884f7b0STejun Heo 	if (arg.nr_errors[ATA_ECAT_ATA_BUS] +
19703884f7b0STejun Heo 	    arg.nr_errors[ATA_ECAT_TOUT_HSM] +
1971663f99b8STejun Heo 	    arg.nr_errors[ATA_ECAT_UNK_DEV] > 6)
19723884f7b0STejun Heo 		verdict |= ATA_EH_SPDN_FALLBACK_TO_PIO;
19733884f7b0STejun Heo 
19747d47e8d4STejun Heo 	/* scan past 10 mins of error history */
1975c6fd2807SJeff Garzik 	memset(&arg, 0, sizeof(arg));
19767d47e8d4STejun Heo 	arg.since = j64 - min(j64, j10mins);
19777d47e8d4STejun Heo 	ata_ering_map(&dev->ering, speed_down_verdict_cb, &arg);
1978c6fd2807SJeff Garzik 
19793884f7b0STejun Heo 	if (arg.nr_errors[ATA_ECAT_TOUT_HSM] +
19803884f7b0STejun Heo 	    arg.nr_errors[ATA_ECAT_UNK_DEV] > 3)
19817d47e8d4STejun Heo 		verdict |= ATA_EH_SPDN_NCQ_OFF;
19823884f7b0STejun Heo 
19833884f7b0STejun Heo 	if (arg.nr_errors[ATA_ECAT_ATA_BUS] +
19843884f7b0STejun Heo 	    arg.nr_errors[ATA_ECAT_TOUT_HSM] > 3 ||
1985663f99b8STejun Heo 	    arg.nr_errors[ATA_ECAT_UNK_DEV] > 6)
19867d47e8d4STejun Heo 		verdict |= ATA_EH_SPDN_SPEED_DOWN;
1987c6fd2807SJeff Garzik 
19887d47e8d4STejun Heo 	return verdict;
1989c6fd2807SJeff Garzik }
1990c6fd2807SJeff Garzik 
1991c6fd2807SJeff Garzik /**
1992c6fd2807SJeff Garzik  *	ata_eh_speed_down - record error and speed down if necessary
1993c6fd2807SJeff Garzik  *	@dev: Failed device
19943884f7b0STejun Heo  *	@eflags: mask of ATA_EFLAG_* flags
1995c6fd2807SJeff Garzik  *	@err_mask: err_mask of the error
1996c6fd2807SJeff Garzik  *
1997c6fd2807SJeff Garzik  *	Record error and examine error history to determine whether
1998c6fd2807SJeff Garzik  *	adjusting transmission speed is necessary.  It also sets
1999c6fd2807SJeff Garzik  *	transmission limits appropriately if such adjustment is
2000c6fd2807SJeff Garzik  *	necessary.
2001c6fd2807SJeff Garzik  *
2002c6fd2807SJeff Garzik  *	LOCKING:
2003c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
2004c6fd2807SJeff Garzik  *
2005c6fd2807SJeff Garzik  *	RETURNS:
20067d47e8d4STejun Heo  *	Determined recovery action.
2007c6fd2807SJeff Garzik  */
20083884f7b0STejun Heo static unsigned int ata_eh_speed_down(struct ata_device *dev,
20093884f7b0STejun Heo 				unsigned int eflags, unsigned int err_mask)
2010c6fd2807SJeff Garzik {
2011b1c72916STejun Heo 	struct ata_link *link = ata_dev_phys_link(dev);
201276326ac1STejun Heo 	int xfer_ok = 0;
20137d47e8d4STejun Heo 	unsigned int verdict;
20147d47e8d4STejun Heo 	unsigned int action = 0;
20157d47e8d4STejun Heo 
20167d47e8d4STejun Heo 	/* don't bother if Cat-0 error */
201776326ac1STejun Heo 	if (ata_eh_categorize_error(eflags, err_mask, &xfer_ok) == 0)
2018c6fd2807SJeff Garzik 		return 0;
2019c6fd2807SJeff Garzik 
2020c6fd2807SJeff Garzik 	/* record error and determine whether speed down is necessary */
20213884f7b0STejun Heo 	ata_ering_record(&dev->ering, eflags, err_mask);
20227d47e8d4STejun Heo 	verdict = ata_eh_speed_down_verdict(dev);
2023c6fd2807SJeff Garzik 
20247d47e8d4STejun Heo 	/* turn off NCQ? */
20257d47e8d4STejun Heo 	if ((verdict & ATA_EH_SPDN_NCQ_OFF) &&
20267d47e8d4STejun Heo 	    (dev->flags & (ATA_DFLAG_PIO | ATA_DFLAG_NCQ |
20277d47e8d4STejun Heo 			   ATA_DFLAG_NCQ_OFF)) == ATA_DFLAG_NCQ) {
20287d47e8d4STejun Heo 		dev->flags |= ATA_DFLAG_NCQ_OFF;
2029a9a79dfeSJoe Perches 		ata_dev_warn(dev, "NCQ disabled due to excessive errors\n");
20307d47e8d4STejun Heo 		goto done;
20317d47e8d4STejun Heo 	}
2032c6fd2807SJeff Garzik 
20337d47e8d4STejun Heo 	/* speed down? */
20347d47e8d4STejun Heo 	if (verdict & ATA_EH_SPDN_SPEED_DOWN) {
2035c6fd2807SJeff Garzik 		/* speed down SATA link speed if possible */
2036a07d499bSTejun Heo 		if (sata_down_spd_limit(link, 0) == 0) {
2037cf480626STejun Heo 			action |= ATA_EH_RESET;
20387d47e8d4STejun Heo 			goto done;
20397d47e8d4STejun Heo 		}
2040c6fd2807SJeff Garzik 
2041c6fd2807SJeff Garzik 		/* lower transfer mode */
20427d47e8d4STejun Heo 		if (dev->spdn_cnt < 2) {
20437d47e8d4STejun Heo 			static const int dma_dnxfer_sel[] =
20447d47e8d4STejun Heo 				{ ATA_DNXFER_DMA, ATA_DNXFER_40C };
20457d47e8d4STejun Heo 			static const int pio_dnxfer_sel[] =
20467d47e8d4STejun Heo 				{ ATA_DNXFER_PIO, ATA_DNXFER_FORCE_PIO0 };
20477d47e8d4STejun Heo 			int sel;
2048c6fd2807SJeff Garzik 
20497d47e8d4STejun Heo 			if (dev->xfer_shift != ATA_SHIFT_PIO)
20507d47e8d4STejun Heo 				sel = dma_dnxfer_sel[dev->spdn_cnt];
20517d47e8d4STejun Heo 			else
20527d47e8d4STejun Heo 				sel = pio_dnxfer_sel[dev->spdn_cnt];
20537d47e8d4STejun Heo 
20547d47e8d4STejun Heo 			dev->spdn_cnt++;
20557d47e8d4STejun Heo 
20567d47e8d4STejun Heo 			if (ata_down_xfermask_limit(dev, sel) == 0) {
2057cf480626STejun Heo 				action |= ATA_EH_RESET;
20587d47e8d4STejun Heo 				goto done;
20597d47e8d4STejun Heo 			}
20607d47e8d4STejun Heo 		}
20617d47e8d4STejun Heo 	}
20627d47e8d4STejun Heo 
20637d47e8d4STejun Heo 	/* Fall back to PIO?  Slowing down to PIO is meaningless for
2064663f99b8STejun Heo 	 * SATA ATA devices.  Consider it only for PATA and SATAPI.
20657d47e8d4STejun Heo 	 */
20667d47e8d4STejun Heo 	if ((verdict & ATA_EH_SPDN_FALLBACK_TO_PIO) && (dev->spdn_cnt >= 2) &&
2067663f99b8STejun Heo 	    (link->ap->cbl != ATA_CBL_SATA || dev->class == ATA_DEV_ATAPI) &&
20687d47e8d4STejun Heo 	    (dev->xfer_shift != ATA_SHIFT_PIO)) {
20697d47e8d4STejun Heo 		if (ata_down_xfermask_limit(dev, ATA_DNXFER_FORCE_PIO) == 0) {
20707d47e8d4STejun Heo 			dev->spdn_cnt = 0;
2071cf480626STejun Heo 			action |= ATA_EH_RESET;
20727d47e8d4STejun Heo 			goto done;
20737d47e8d4STejun Heo 		}
20747d47e8d4STejun Heo 	}
20757d47e8d4STejun Heo 
2076c6fd2807SJeff Garzik 	return 0;
20777d47e8d4STejun Heo  done:
20787d47e8d4STejun Heo 	/* device has been slowed down, blow error history */
207976326ac1STejun Heo 	if (!(verdict & ATA_EH_SPDN_KEEP_ERRORS))
20807d47e8d4STejun Heo 		ata_ering_clear(&dev->ering);
20817d47e8d4STejun Heo 	return action;
2082c6fd2807SJeff Garzik }
2083c6fd2807SJeff Garzik 
2084c6fd2807SJeff Garzik /**
20858d899e70SMark Lord  *	ata_eh_worth_retry - analyze error and decide whether to retry
20868d899e70SMark Lord  *	@qc: qc to possibly retry
20878d899e70SMark Lord  *
20888d899e70SMark Lord  *	Look at the cause of the error and decide if a retry
20898d899e70SMark Lord  * 	might be useful or not.  We don't want to retry media errors
20908d899e70SMark Lord  *	because the drive itself has probably already taken 10-30 seconds
20918d899e70SMark Lord  *	doing its own internal retries before reporting the failure.
20928d899e70SMark Lord  */
20938d899e70SMark Lord static inline int ata_eh_worth_retry(struct ata_queued_cmd *qc)
20948d899e70SMark Lord {
20951eaca39aSBian Yu 	if (qc->err_mask & AC_ERR_MEDIA)
20968d899e70SMark Lord 		return 0;	/* don't retry media errors */
20978d899e70SMark Lord 	if (qc->flags & ATA_QCFLAG_IO)
20988d899e70SMark Lord 		return 1;	/* otherwise retry anything from fs stack */
20998d899e70SMark Lord 	if (qc->err_mask & AC_ERR_INVALID)
21008d899e70SMark Lord 		return 0;	/* don't retry these */
21018d899e70SMark Lord 	return qc->err_mask != AC_ERR_DEV;  /* retry if not dev error */
21028d899e70SMark Lord }
21038d899e70SMark Lord 
21048d899e70SMark Lord /**
21057eb49509SDamien Le Moal  *      ata_eh_quiet - check if we need to be quiet about a command error
21067eb49509SDamien Le Moal  *      @qc: qc to check
21077eb49509SDamien Le Moal  *
21087eb49509SDamien Le Moal  *      Look at the qc flags anbd its scsi command request flags to determine
21097eb49509SDamien Le Moal  *      if we need to be quiet about the command failure.
21107eb49509SDamien Le Moal  */
21117eb49509SDamien Le Moal static inline bool ata_eh_quiet(struct ata_queued_cmd *qc)
21127eb49509SDamien Le Moal {
21137eb49509SDamien Le Moal 	if (qc->scsicmd &&
21147eb49509SDamien Le Moal 	    qc->scsicmd->request->rq_flags & RQF_QUIET)
21157eb49509SDamien Le Moal 		qc->flags |= ATA_QCFLAG_QUIET;
21167eb49509SDamien Le Moal 	return qc->flags & ATA_QCFLAG_QUIET;
21177eb49509SDamien Le Moal }
21187eb49509SDamien Le Moal 
21197eb49509SDamien Le Moal /**
21209b1e2658STejun Heo  *	ata_eh_link_autopsy - analyze error and determine recovery action
21219b1e2658STejun Heo  *	@link: host link to perform autopsy on
2122c6fd2807SJeff Garzik  *
21230260731fSTejun Heo  *	Analyze why @link failed and determine which recovery actions
21240260731fSTejun Heo  *	are needed.  This function also sets more detailed AC_ERR_*
21250260731fSTejun Heo  *	values and fills sense data for ATAPI CHECK SENSE.
2126c6fd2807SJeff Garzik  *
2127c6fd2807SJeff Garzik  *	LOCKING:
2128c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
2129c6fd2807SJeff Garzik  */
21309b1e2658STejun Heo static void ata_eh_link_autopsy(struct ata_link *link)
2131c6fd2807SJeff Garzik {
21320260731fSTejun Heo 	struct ata_port *ap = link->ap;
2133936fd732STejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
2134*258c4e5cSJens Axboe 	struct ata_queued_cmd *qc;
2135dfcc173dSTejun Heo 	struct ata_device *dev;
21363884f7b0STejun Heo 	unsigned int all_err_mask = 0, eflags = 0;
21377eb49509SDamien Le Moal 	int tag, nr_failed = 0, nr_quiet = 0;
2138c6fd2807SJeff Garzik 	u32 serror;
2139c6fd2807SJeff Garzik 	int rc;
2140c6fd2807SJeff Garzik 
2141c6fd2807SJeff Garzik 	DPRINTK("ENTER\n");
2142c6fd2807SJeff Garzik 
2143c6fd2807SJeff Garzik 	if (ehc->i.flags & ATA_EHI_NO_AUTOPSY)
2144c6fd2807SJeff Garzik 		return;
2145c6fd2807SJeff Garzik 
2146c6fd2807SJeff Garzik 	/* obtain and analyze SError */
2147936fd732STejun Heo 	rc = sata_scr_read(link, SCR_ERROR, &serror);
2148c6fd2807SJeff Garzik 	if (rc == 0) {
2149c6fd2807SJeff Garzik 		ehc->i.serror |= serror;
21500260731fSTejun Heo 		ata_eh_analyze_serror(link);
21514e57c517STejun Heo 	} else if (rc != -EOPNOTSUPP) {
2152cf480626STejun Heo 		/* SError read failed, force reset and probing */
2153b558edddSTejun Heo 		ehc->i.probe_mask |= ATA_ALL_DEVICES;
2154cf480626STejun Heo 		ehc->i.action |= ATA_EH_RESET;
21554e57c517STejun Heo 		ehc->i.err_mask |= AC_ERR_OTHER;
21564e57c517STejun Heo 	}
2157c6fd2807SJeff Garzik 
2158c6fd2807SJeff Garzik 	/* analyze NCQ failure */
21590260731fSTejun Heo 	ata_eh_analyze_ncq_error(link);
2160c6fd2807SJeff Garzik 
2161c6fd2807SJeff Garzik 	/* any real error trumps AC_ERR_OTHER */
2162c6fd2807SJeff Garzik 	if (ehc->i.err_mask & ~AC_ERR_OTHER)
2163c6fd2807SJeff Garzik 		ehc->i.err_mask &= ~AC_ERR_OTHER;
2164c6fd2807SJeff Garzik 
2165c6fd2807SJeff Garzik 	all_err_mask |= ehc->i.err_mask;
2166c6fd2807SJeff Garzik 
2167*258c4e5cSJens Axboe 	ata_qc_for_each_raw(ap, qc, tag) {
2168b1c72916STejun Heo 		if (!(qc->flags & ATA_QCFLAG_FAILED) ||
2169b1c72916STejun Heo 		    ata_dev_phys_link(qc->dev) != link)
2170c6fd2807SJeff Garzik 			continue;
2171c6fd2807SJeff Garzik 
2172c6fd2807SJeff Garzik 		/* inherit upper level err_mask */
2173c6fd2807SJeff Garzik 		qc->err_mask |= ehc->i.err_mask;
2174c6fd2807SJeff Garzik 
2175c6fd2807SJeff Garzik 		/* analyze TF */
2176c6fd2807SJeff Garzik 		ehc->i.action |= ata_eh_analyze_tf(qc, &qc->result_tf);
2177c6fd2807SJeff Garzik 
2178c6fd2807SJeff Garzik 		/* DEV errors are probably spurious in case of ATA_BUS error */
2179c6fd2807SJeff Garzik 		if (qc->err_mask & AC_ERR_ATA_BUS)
2180c6fd2807SJeff Garzik 			qc->err_mask &= ~(AC_ERR_DEV | AC_ERR_MEDIA |
2181c6fd2807SJeff Garzik 					  AC_ERR_INVALID);
2182c6fd2807SJeff Garzik 
2183c6fd2807SJeff Garzik 		/* any real error trumps unknown error */
2184c6fd2807SJeff Garzik 		if (qc->err_mask & ~AC_ERR_OTHER)
2185c6fd2807SJeff Garzik 			qc->err_mask &= ~AC_ERR_OTHER;
2186c6fd2807SJeff Garzik 
2187804689adSDamien Le Moal 		/*
2188804689adSDamien Le Moal 		 * SENSE_VALID trumps dev/unknown error and revalidation. Upper
2189804689adSDamien Le Moal 		 * layers will determine whether the command is worth retrying
2190804689adSDamien Le Moal 		 * based on the sense data and device class/type. Otherwise,
2191804689adSDamien Le Moal 		 * determine directly if the command is worth retrying using its
2192804689adSDamien Le Moal 		 * error mask and flags.
2193804689adSDamien Le Moal 		 */
2194f90f0828STejun Heo 		if (qc->flags & ATA_QCFLAG_SENSE_VALID)
2195c6fd2807SJeff Garzik 			qc->err_mask &= ~(AC_ERR_DEV | AC_ERR_OTHER);
2196804689adSDamien Le Moal 		else if (ata_eh_worth_retry(qc))
219703faab78STejun Heo 			qc->flags |= ATA_QCFLAG_RETRY;
219803faab78STejun Heo 
2199c6fd2807SJeff Garzik 		/* accumulate error info */
2200c6fd2807SJeff Garzik 		ehc->i.dev = qc->dev;
2201c6fd2807SJeff Garzik 		all_err_mask |= qc->err_mask;
2202c6fd2807SJeff Garzik 		if (qc->flags & ATA_QCFLAG_IO)
22033884f7b0STejun Heo 			eflags |= ATA_EFLAG_IS_IO;
2204255c03d1SHannes Reinecke 		trace_ata_eh_link_autopsy_qc(qc);
22057eb49509SDamien Le Moal 
22067eb49509SDamien Le Moal 		/* Count quiet errors */
22077eb49509SDamien Le Moal 		if (ata_eh_quiet(qc))
22087eb49509SDamien Le Moal 			nr_quiet++;
22097eb49509SDamien Le Moal 		nr_failed++;
2210c6fd2807SJeff Garzik 	}
2211c6fd2807SJeff Garzik 
22127eb49509SDamien Le Moal 	/* If all failed commands requested silence, then be quiet */
22137eb49509SDamien Le Moal 	if (nr_quiet == nr_failed)
22147eb49509SDamien Le Moal 		ehc->i.flags |= ATA_EHI_QUIET;
22157eb49509SDamien Le Moal 
2216c6fd2807SJeff Garzik 	/* enforce default EH actions */
2217c6fd2807SJeff Garzik 	if (ap->pflags & ATA_PFLAG_FROZEN ||
2218c6fd2807SJeff Garzik 	    all_err_mask & (AC_ERR_HSM | AC_ERR_TIMEOUT))
2219cf480626STejun Heo 		ehc->i.action |= ATA_EH_RESET;
22203884f7b0STejun Heo 	else if (((eflags & ATA_EFLAG_IS_IO) && all_err_mask) ||
22213884f7b0STejun Heo 		 (!(eflags & ATA_EFLAG_IS_IO) && (all_err_mask & ~AC_ERR_DEV)))
2222c6fd2807SJeff Garzik 		ehc->i.action |= ATA_EH_REVALIDATE;
2223c6fd2807SJeff Garzik 
2224dfcc173dSTejun Heo 	/* If we have offending qcs and the associated failed device,
2225dfcc173dSTejun Heo 	 * perform per-dev EH action only on the offending device.
2226dfcc173dSTejun Heo 	 */
2227c6fd2807SJeff Garzik 	if (ehc->i.dev) {
2228c6fd2807SJeff Garzik 		ehc->i.dev_action[ehc->i.dev->devno] |=
2229c6fd2807SJeff Garzik 			ehc->i.action & ATA_EH_PERDEV_MASK;
2230c6fd2807SJeff Garzik 		ehc->i.action &= ~ATA_EH_PERDEV_MASK;
2231c6fd2807SJeff Garzik 	}
2232c6fd2807SJeff Garzik 
22332695e366STejun Heo 	/* propagate timeout to host link */
22342695e366STejun Heo 	if ((all_err_mask & AC_ERR_TIMEOUT) && !ata_is_host_link(link))
22352695e366STejun Heo 		ap->link.eh_context.i.err_mask |= AC_ERR_TIMEOUT;
22362695e366STejun Heo 
22372695e366STejun Heo 	/* record error and consider speeding down */
2238dfcc173dSTejun Heo 	dev = ehc->i.dev;
22392695e366STejun Heo 	if (!dev && ((ata_link_max_devices(link) == 1 &&
22402695e366STejun Heo 		      ata_dev_enabled(link->device))))
2241dfcc173dSTejun Heo 	    dev = link->device;
2242dfcc173dSTejun Heo 
224376326ac1STejun Heo 	if (dev) {
224476326ac1STejun Heo 		if (dev->flags & ATA_DFLAG_DUBIOUS_XFER)
224576326ac1STejun Heo 			eflags |= ATA_EFLAG_DUBIOUS_XFER;
22463884f7b0STejun Heo 		ehc->i.action |= ata_eh_speed_down(dev, eflags, all_err_mask);
2247255c03d1SHannes Reinecke 		trace_ata_eh_link_autopsy(dev, ehc->i.action, all_err_mask);
2248f1601113SRameshwar Prasad Sahu 	}
2249c6fd2807SJeff Garzik 	DPRINTK("EXIT\n");
2250c6fd2807SJeff Garzik }
2251c6fd2807SJeff Garzik 
2252c6fd2807SJeff Garzik /**
22539b1e2658STejun Heo  *	ata_eh_autopsy - analyze error and determine recovery action
22549b1e2658STejun Heo  *	@ap: host port to perform autopsy on
22559b1e2658STejun Heo  *
22569b1e2658STejun Heo  *	Analyze all links of @ap and determine why they failed and
22579b1e2658STejun Heo  *	which recovery actions are needed.
22589b1e2658STejun Heo  *
22599b1e2658STejun Heo  *	LOCKING:
22609b1e2658STejun Heo  *	Kernel thread context (may sleep).
22619b1e2658STejun Heo  */
2262fb7fd614STejun Heo void ata_eh_autopsy(struct ata_port *ap)
22639b1e2658STejun Heo {
22649b1e2658STejun Heo 	struct ata_link *link;
22659b1e2658STejun Heo 
22661eca4365STejun Heo 	ata_for_each_link(link, ap, EDGE)
22679b1e2658STejun Heo 		ata_eh_link_autopsy(link);
22682695e366STejun Heo 
2269b1c72916STejun Heo 	/* Handle the frigging slave link.  Autopsy is done similarly
2270b1c72916STejun Heo 	 * but actions and flags are transferred over to the master
2271b1c72916STejun Heo 	 * link and handled from there.
2272b1c72916STejun Heo 	 */
2273b1c72916STejun Heo 	if (ap->slave_link) {
2274b1c72916STejun Heo 		struct ata_eh_context *mehc = &ap->link.eh_context;
2275b1c72916STejun Heo 		struct ata_eh_context *sehc = &ap->slave_link->eh_context;
2276b1c72916STejun Heo 
2277848e4c68STejun Heo 		/* transfer control flags from master to slave */
2278848e4c68STejun Heo 		sehc->i.flags |= mehc->i.flags & ATA_EHI_TO_SLAVE_MASK;
2279848e4c68STejun Heo 
2280848e4c68STejun Heo 		/* perform autopsy on the slave link */
2281b1c72916STejun Heo 		ata_eh_link_autopsy(ap->slave_link);
2282b1c72916STejun Heo 
2283848e4c68STejun Heo 		/* transfer actions from slave to master and clear slave */
2284b1c72916STejun Heo 		ata_eh_about_to_do(ap->slave_link, NULL, ATA_EH_ALL_ACTIONS);
2285b1c72916STejun Heo 		mehc->i.action		|= sehc->i.action;
2286b1c72916STejun Heo 		mehc->i.dev_action[1]	|= sehc->i.dev_action[1];
2287b1c72916STejun Heo 		mehc->i.flags		|= sehc->i.flags;
2288b1c72916STejun Heo 		ata_eh_done(ap->slave_link, NULL, ATA_EH_ALL_ACTIONS);
2289b1c72916STejun Heo 	}
2290b1c72916STejun Heo 
22912695e366STejun Heo 	/* Autopsy of fanout ports can affect host link autopsy.
22922695e366STejun Heo 	 * Perform host link autopsy last.
22932695e366STejun Heo 	 */
2294071f44b1STejun Heo 	if (sata_pmp_attached(ap))
22952695e366STejun Heo 		ata_eh_link_autopsy(&ap->link);
22969b1e2658STejun Heo }
22979b1e2658STejun Heo 
22989b1e2658STejun Heo /**
22996521148cSRobert Hancock  *	ata_get_cmd_descript - get description for ATA command
23006521148cSRobert Hancock  *	@command: ATA command code to get description for
23016521148cSRobert Hancock  *
23026521148cSRobert Hancock  *	Return a textual description of the given command, or NULL if the
23036521148cSRobert Hancock  *	command is not known.
23046521148cSRobert Hancock  *
23056521148cSRobert Hancock  *	LOCKING:
23066521148cSRobert Hancock  *	None
23076521148cSRobert Hancock  */
23086521148cSRobert Hancock const char *ata_get_cmd_descript(u8 command)
23096521148cSRobert Hancock {
23106521148cSRobert Hancock #ifdef CONFIG_ATA_VERBOSE_ERROR
23116521148cSRobert Hancock 	static const struct
23126521148cSRobert Hancock 	{
23136521148cSRobert Hancock 		u8 command;
23146521148cSRobert Hancock 		const char *text;
23156521148cSRobert Hancock 	} cmd_descr[] = {
23166521148cSRobert Hancock 		{ ATA_CMD_DEV_RESET,		"DEVICE RESET" },
23176521148cSRobert Hancock 		{ ATA_CMD_CHK_POWER,		"CHECK POWER MODE" },
23186521148cSRobert Hancock 		{ ATA_CMD_STANDBY,		"STANDBY" },
23196521148cSRobert Hancock 		{ ATA_CMD_IDLE,			"IDLE" },
23206521148cSRobert Hancock 		{ ATA_CMD_EDD,			"EXECUTE DEVICE DIAGNOSTIC" },
23216521148cSRobert Hancock 		{ ATA_CMD_DOWNLOAD_MICRO,	"DOWNLOAD MICROCODE" },
23223915c3b5SRobert Hancock 		{ ATA_CMD_DOWNLOAD_MICRO_DMA,	"DOWNLOAD MICROCODE DMA" },
23236521148cSRobert Hancock 		{ ATA_CMD_NOP,			"NOP" },
23246521148cSRobert Hancock 		{ ATA_CMD_FLUSH,		"FLUSH CACHE" },
23256521148cSRobert Hancock 		{ ATA_CMD_FLUSH_EXT,		"FLUSH CACHE EXT" },
23266521148cSRobert Hancock 		{ ATA_CMD_ID_ATA,		"IDENTIFY DEVICE" },
23276521148cSRobert Hancock 		{ ATA_CMD_ID_ATAPI,		"IDENTIFY PACKET DEVICE" },
23286521148cSRobert Hancock 		{ ATA_CMD_SERVICE,		"SERVICE" },
23296521148cSRobert Hancock 		{ ATA_CMD_READ,			"READ DMA" },
23306521148cSRobert Hancock 		{ ATA_CMD_READ_EXT,		"READ DMA EXT" },
23316521148cSRobert Hancock 		{ ATA_CMD_READ_QUEUED,		"READ DMA QUEUED" },
23326521148cSRobert Hancock 		{ ATA_CMD_READ_STREAM_EXT,	"READ STREAM EXT" },
23336521148cSRobert Hancock 		{ ATA_CMD_READ_STREAM_DMA_EXT,  "READ STREAM DMA EXT" },
23346521148cSRobert Hancock 		{ ATA_CMD_WRITE,		"WRITE DMA" },
23356521148cSRobert Hancock 		{ ATA_CMD_WRITE_EXT,		"WRITE DMA EXT" },
23366521148cSRobert Hancock 		{ ATA_CMD_WRITE_QUEUED,		"WRITE DMA QUEUED EXT" },
23376521148cSRobert Hancock 		{ ATA_CMD_WRITE_STREAM_EXT,	"WRITE STREAM EXT" },
23386521148cSRobert Hancock 		{ ATA_CMD_WRITE_STREAM_DMA_EXT, "WRITE STREAM DMA EXT" },
23396521148cSRobert Hancock 		{ ATA_CMD_WRITE_FUA_EXT,	"WRITE DMA FUA EXT" },
23406521148cSRobert Hancock 		{ ATA_CMD_WRITE_QUEUED_FUA_EXT, "WRITE DMA QUEUED FUA EXT" },
23416521148cSRobert Hancock 		{ ATA_CMD_FPDMA_READ,		"READ FPDMA QUEUED" },
23426521148cSRobert Hancock 		{ ATA_CMD_FPDMA_WRITE,		"WRITE FPDMA QUEUED" },
23433915c3b5SRobert Hancock 		{ ATA_CMD_FPDMA_SEND,		"SEND FPDMA QUEUED" },
23443915c3b5SRobert Hancock 		{ ATA_CMD_FPDMA_RECV,		"RECEIVE FPDMA QUEUED" },
23456521148cSRobert Hancock 		{ ATA_CMD_PIO_READ,		"READ SECTOR(S)" },
23466521148cSRobert Hancock 		{ ATA_CMD_PIO_READ_EXT,		"READ SECTOR(S) EXT" },
23476521148cSRobert Hancock 		{ ATA_CMD_PIO_WRITE,		"WRITE SECTOR(S)" },
23486521148cSRobert Hancock 		{ ATA_CMD_PIO_WRITE_EXT,	"WRITE SECTOR(S) EXT" },
23496521148cSRobert Hancock 		{ ATA_CMD_READ_MULTI,		"READ MULTIPLE" },
23506521148cSRobert Hancock 		{ ATA_CMD_READ_MULTI_EXT,	"READ MULTIPLE EXT" },
23516521148cSRobert Hancock 		{ ATA_CMD_WRITE_MULTI,		"WRITE MULTIPLE" },
23526521148cSRobert Hancock 		{ ATA_CMD_WRITE_MULTI_EXT,	"WRITE MULTIPLE EXT" },
23536521148cSRobert Hancock 		{ ATA_CMD_WRITE_MULTI_FUA_EXT,	"WRITE MULTIPLE FUA EXT" },
23546521148cSRobert Hancock 		{ ATA_CMD_SET_FEATURES,		"SET FEATURES" },
23556521148cSRobert Hancock 		{ ATA_CMD_SET_MULTI,		"SET MULTIPLE MODE" },
23566521148cSRobert Hancock 		{ ATA_CMD_VERIFY,		"READ VERIFY SECTOR(S)" },
23576521148cSRobert Hancock 		{ ATA_CMD_VERIFY_EXT,		"READ VERIFY SECTOR(S) EXT" },
23586521148cSRobert Hancock 		{ ATA_CMD_WRITE_UNCORR_EXT,	"WRITE UNCORRECTABLE EXT" },
23596521148cSRobert Hancock 		{ ATA_CMD_STANDBYNOW1,		"STANDBY IMMEDIATE" },
23606521148cSRobert Hancock 		{ ATA_CMD_IDLEIMMEDIATE,	"IDLE IMMEDIATE" },
23616521148cSRobert Hancock 		{ ATA_CMD_SLEEP,		"SLEEP" },
23626521148cSRobert Hancock 		{ ATA_CMD_INIT_DEV_PARAMS,	"INITIALIZE DEVICE PARAMETERS" },
23636521148cSRobert Hancock 		{ ATA_CMD_READ_NATIVE_MAX,	"READ NATIVE MAX ADDRESS" },
23646521148cSRobert Hancock 		{ ATA_CMD_READ_NATIVE_MAX_EXT,	"READ NATIVE MAX ADDRESS EXT" },
23656521148cSRobert Hancock 		{ ATA_CMD_SET_MAX,		"SET MAX ADDRESS" },
23666521148cSRobert Hancock 		{ ATA_CMD_SET_MAX_EXT,		"SET MAX ADDRESS EXT" },
23676521148cSRobert Hancock 		{ ATA_CMD_READ_LOG_EXT,		"READ LOG EXT" },
23686521148cSRobert Hancock 		{ ATA_CMD_WRITE_LOG_EXT,	"WRITE LOG EXT" },
23696521148cSRobert Hancock 		{ ATA_CMD_READ_LOG_DMA_EXT,	"READ LOG DMA EXT" },
23706521148cSRobert Hancock 		{ ATA_CMD_WRITE_LOG_DMA_EXT,	"WRITE LOG DMA EXT" },
23713915c3b5SRobert Hancock 		{ ATA_CMD_TRUSTED_NONDATA,	"TRUSTED NON-DATA" },
23726521148cSRobert Hancock 		{ ATA_CMD_TRUSTED_RCV,		"TRUSTED RECEIVE" },
23736521148cSRobert Hancock 		{ ATA_CMD_TRUSTED_RCV_DMA,	"TRUSTED RECEIVE DMA" },
23746521148cSRobert Hancock 		{ ATA_CMD_TRUSTED_SND,		"TRUSTED SEND" },
23756521148cSRobert Hancock 		{ ATA_CMD_TRUSTED_SND_DMA,	"TRUSTED SEND DMA" },
23766521148cSRobert Hancock 		{ ATA_CMD_PMP_READ,		"READ BUFFER" },
23773915c3b5SRobert Hancock 		{ ATA_CMD_PMP_READ_DMA,		"READ BUFFER DMA" },
23786521148cSRobert Hancock 		{ ATA_CMD_PMP_WRITE,		"WRITE BUFFER" },
23793915c3b5SRobert Hancock 		{ ATA_CMD_PMP_WRITE_DMA,	"WRITE BUFFER DMA" },
23806521148cSRobert Hancock 		{ ATA_CMD_CONF_OVERLAY,		"DEVICE CONFIGURATION OVERLAY" },
23816521148cSRobert Hancock 		{ ATA_CMD_SEC_SET_PASS,		"SECURITY SET PASSWORD" },
23826521148cSRobert Hancock 		{ ATA_CMD_SEC_UNLOCK,		"SECURITY UNLOCK" },
23836521148cSRobert Hancock 		{ ATA_CMD_SEC_ERASE_PREP,	"SECURITY ERASE PREPARE" },
23846521148cSRobert Hancock 		{ ATA_CMD_SEC_ERASE_UNIT,	"SECURITY ERASE UNIT" },
23856521148cSRobert Hancock 		{ ATA_CMD_SEC_FREEZE_LOCK,	"SECURITY FREEZE LOCK" },
23866521148cSRobert Hancock 		{ ATA_CMD_SEC_DISABLE_PASS,	"SECURITY DISABLE PASSWORD" },
23876521148cSRobert Hancock 		{ ATA_CMD_CONFIG_STREAM,	"CONFIGURE STREAM" },
23886521148cSRobert Hancock 		{ ATA_CMD_SMART,		"SMART" },
23896521148cSRobert Hancock 		{ ATA_CMD_MEDIA_LOCK,		"DOOR LOCK" },
23906521148cSRobert Hancock 		{ ATA_CMD_MEDIA_UNLOCK,		"DOOR UNLOCK" },
2391acad7627SFUJITA Tomonori 		{ ATA_CMD_DSM,			"DATA SET MANAGEMENT" },
23926521148cSRobert Hancock 		{ ATA_CMD_CHK_MED_CRD_TYP,	"CHECK MEDIA CARD TYPE" },
23936521148cSRobert Hancock 		{ ATA_CMD_CFA_REQ_EXT_ERR,	"CFA REQUEST EXTENDED ERROR" },
23946521148cSRobert Hancock 		{ ATA_CMD_CFA_WRITE_NE,		"CFA WRITE SECTORS WITHOUT ERASE" },
23956521148cSRobert Hancock 		{ ATA_CMD_CFA_TRANS_SECT,	"CFA TRANSLATE SECTOR" },
23966521148cSRobert Hancock 		{ ATA_CMD_CFA_ERASE,		"CFA ERASE SECTORS" },
23976521148cSRobert Hancock 		{ ATA_CMD_CFA_WRITE_MULT_NE,	"CFA WRITE MULTIPLE WITHOUT ERASE" },
23983915c3b5SRobert Hancock 		{ ATA_CMD_REQ_SENSE_DATA,	"REQUEST SENSE DATA EXT" },
23993915c3b5SRobert Hancock 		{ ATA_CMD_SANITIZE_DEVICE,	"SANITIZE DEVICE" },
240028a3fc22SHannes Reinecke 		{ ATA_CMD_ZAC_MGMT_IN,		"ZAC MANAGEMENT IN" },
240127708a95SHannes Reinecke 		{ ATA_CMD_ZAC_MGMT_OUT,		"ZAC MANAGEMENT OUT" },
24026521148cSRobert Hancock 		{ ATA_CMD_READ_LONG,		"READ LONG (with retries)" },
24036521148cSRobert Hancock 		{ ATA_CMD_READ_LONG_ONCE,	"READ LONG (without retries)" },
24046521148cSRobert Hancock 		{ ATA_CMD_WRITE_LONG,		"WRITE LONG (with retries)" },
24056521148cSRobert Hancock 		{ ATA_CMD_WRITE_LONG_ONCE,	"WRITE LONG (without retries)" },
24066521148cSRobert Hancock 		{ ATA_CMD_RESTORE,		"RECALIBRATE" },
24076521148cSRobert Hancock 		{ 0,				NULL } /* terminate list */
24086521148cSRobert Hancock 	};
24096521148cSRobert Hancock 
24106521148cSRobert Hancock 	unsigned int i;
24116521148cSRobert Hancock 	for (i = 0; cmd_descr[i].text; i++)
24126521148cSRobert Hancock 		if (cmd_descr[i].command == command)
24136521148cSRobert Hancock 			return cmd_descr[i].text;
24146521148cSRobert Hancock #endif
24156521148cSRobert Hancock 
24166521148cSRobert Hancock 	return NULL;
24176521148cSRobert Hancock }
241836aae28eSAndy Shevchenko EXPORT_SYMBOL_GPL(ata_get_cmd_descript);
24196521148cSRobert Hancock 
24206521148cSRobert Hancock /**
24219b1e2658STejun Heo  *	ata_eh_link_report - report error handling to user
24220260731fSTejun Heo  *	@link: ATA link EH is going on
2423c6fd2807SJeff Garzik  *
2424c6fd2807SJeff Garzik  *	Report EH to user.
2425c6fd2807SJeff Garzik  *
2426c6fd2807SJeff Garzik  *	LOCKING:
2427c6fd2807SJeff Garzik  *	None.
2428c6fd2807SJeff Garzik  */
24299b1e2658STejun Heo static void ata_eh_link_report(struct ata_link *link)
2430c6fd2807SJeff Garzik {
24310260731fSTejun Heo 	struct ata_port *ap = link->ap;
24320260731fSTejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
2433*258c4e5cSJens Axboe 	struct ata_queued_cmd *qc;
2434c6fd2807SJeff Garzik 	const char *frozen, *desc;
2435462098b0SLevente Kurusa 	char tries_buf[6] = "";
2436c6fd2807SJeff Garzik 	int tag, nr_failed = 0;
2437c6fd2807SJeff Garzik 
243894ff3d54STejun Heo 	if (ehc->i.flags & ATA_EHI_QUIET)
243994ff3d54STejun Heo 		return;
244094ff3d54STejun Heo 
2441c6fd2807SJeff Garzik 	desc = NULL;
2442c6fd2807SJeff Garzik 	if (ehc->i.desc[0] != '\0')
2443c6fd2807SJeff Garzik 		desc = ehc->i.desc;
2444c6fd2807SJeff Garzik 
2445*258c4e5cSJens Axboe 	ata_qc_for_each_raw(ap, qc, tag) {
2446b1c72916STejun Heo 		if (!(qc->flags & ATA_QCFLAG_FAILED) ||
2447b1c72916STejun Heo 		    ata_dev_phys_link(qc->dev) != link ||
2448e027bd36STejun Heo 		    ((qc->flags & ATA_QCFLAG_QUIET) &&
2449e027bd36STejun Heo 		     qc->err_mask == AC_ERR_DEV))
2450c6fd2807SJeff Garzik 			continue;
2451c6fd2807SJeff Garzik 		if (qc->flags & ATA_QCFLAG_SENSE_VALID && !qc->err_mask)
2452c6fd2807SJeff Garzik 			continue;
2453c6fd2807SJeff Garzik 
2454c6fd2807SJeff Garzik 		nr_failed++;
2455c6fd2807SJeff Garzik 	}
2456c6fd2807SJeff Garzik 
2457c6fd2807SJeff Garzik 	if (!nr_failed && !ehc->i.err_mask)
2458c6fd2807SJeff Garzik 		return;
2459c6fd2807SJeff Garzik 
2460c6fd2807SJeff Garzik 	frozen = "";
2461c6fd2807SJeff Garzik 	if (ap->pflags & ATA_PFLAG_FROZEN)
2462c6fd2807SJeff Garzik 		frozen = " frozen";
2463c6fd2807SJeff Garzik 
2464a1e10f7eSTejun Heo 	if (ap->eh_tries < ATA_EH_MAX_TRIES)
2465462098b0SLevente Kurusa 		snprintf(tries_buf, sizeof(tries_buf), " t%d",
2466a1e10f7eSTejun Heo 			 ap->eh_tries);
2467a1e10f7eSTejun Heo 
2468c6fd2807SJeff Garzik 	if (ehc->i.dev) {
2469a9a79dfeSJoe Perches 		ata_dev_err(ehc->i.dev, "exception Emask 0x%x "
2470a1e10f7eSTejun Heo 			    "SAct 0x%x SErr 0x%x action 0x%x%s%s\n",
2471a1e10f7eSTejun Heo 			    ehc->i.err_mask, link->sactive, ehc->i.serror,
2472a1e10f7eSTejun Heo 			    ehc->i.action, frozen, tries_buf);
2473c6fd2807SJeff Garzik 		if (desc)
2474a9a79dfeSJoe Perches 			ata_dev_err(ehc->i.dev, "%s\n", desc);
2475c6fd2807SJeff Garzik 	} else {
2476a9a79dfeSJoe Perches 		ata_link_err(link, "exception Emask 0x%x "
2477a1e10f7eSTejun Heo 			     "SAct 0x%x SErr 0x%x action 0x%x%s%s\n",
2478a1e10f7eSTejun Heo 			     ehc->i.err_mask, link->sactive, ehc->i.serror,
2479a1e10f7eSTejun Heo 			     ehc->i.action, frozen, tries_buf);
2480c6fd2807SJeff Garzik 		if (desc)
2481a9a79dfeSJoe Perches 			ata_link_err(link, "%s\n", desc);
2482c6fd2807SJeff Garzik 	}
2483c6fd2807SJeff Garzik 
24846521148cSRobert Hancock #ifdef CONFIG_ATA_VERBOSE_ERROR
24851333e194SRobert Hancock 	if (ehc->i.serror)
2486a9a79dfeSJoe Perches 		ata_link_err(link,
24871333e194SRobert Hancock 		  "SError: { %s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s}\n",
24881333e194SRobert Hancock 		  ehc->i.serror & SERR_DATA_RECOVERED ? "RecovData " : "",
24891333e194SRobert Hancock 		  ehc->i.serror & SERR_COMM_RECOVERED ? "RecovComm " : "",
24901333e194SRobert Hancock 		  ehc->i.serror & SERR_DATA ? "UnrecovData " : "",
24911333e194SRobert Hancock 		  ehc->i.serror & SERR_PERSISTENT ? "Persist " : "",
24921333e194SRobert Hancock 		  ehc->i.serror & SERR_PROTOCOL ? "Proto " : "",
24931333e194SRobert Hancock 		  ehc->i.serror & SERR_INTERNAL ? "HostInt " : "",
24941333e194SRobert Hancock 		  ehc->i.serror & SERR_PHYRDY_CHG ? "PHYRdyChg " : "",
24951333e194SRobert Hancock 		  ehc->i.serror & SERR_PHY_INT_ERR ? "PHYInt " : "",
24961333e194SRobert Hancock 		  ehc->i.serror & SERR_COMM_WAKE ? "CommWake " : "",
24971333e194SRobert Hancock 		  ehc->i.serror & SERR_10B_8B_ERR ? "10B8B " : "",
24981333e194SRobert Hancock 		  ehc->i.serror & SERR_DISPARITY ? "Dispar " : "",
24991333e194SRobert Hancock 		  ehc->i.serror & SERR_CRC ? "BadCRC " : "",
25001333e194SRobert Hancock 		  ehc->i.serror & SERR_HANDSHAKE ? "Handshk " : "",
25011333e194SRobert Hancock 		  ehc->i.serror & SERR_LINK_SEQ_ERR ? "LinkSeq " : "",
25021333e194SRobert Hancock 		  ehc->i.serror & SERR_TRANS_ST_ERROR ? "TrStaTrns " : "",
25031333e194SRobert Hancock 		  ehc->i.serror & SERR_UNRECOG_FIS ? "UnrecFIS " : "",
25041333e194SRobert Hancock 		  ehc->i.serror & SERR_DEV_XCHG ? "DevExch " : "");
25056521148cSRobert Hancock #endif
25061333e194SRobert Hancock 
2507*258c4e5cSJens Axboe 	ata_qc_for_each_raw(ap, qc, tag) {
25088a937581STejun Heo 		struct ata_taskfile *cmd = &qc->tf, *res = &qc->result_tf;
2509abb6a889STejun Heo 		char data_buf[20] = "";
2510abb6a889STejun Heo 		char cdb_buf[70] = "";
2511c6fd2807SJeff Garzik 
25120260731fSTejun Heo 		if (!(qc->flags & ATA_QCFLAG_FAILED) ||
2513b1c72916STejun Heo 		    ata_dev_phys_link(qc->dev) != link || !qc->err_mask)
2514c6fd2807SJeff Garzik 			continue;
2515c6fd2807SJeff Garzik 
2516abb6a889STejun Heo 		if (qc->dma_dir != DMA_NONE) {
2517abb6a889STejun Heo 			static const char *dma_str[] = {
2518abb6a889STejun Heo 				[DMA_BIDIRECTIONAL]	= "bidi",
2519abb6a889STejun Heo 				[DMA_TO_DEVICE]		= "out",
2520abb6a889STejun Heo 				[DMA_FROM_DEVICE]	= "in",
2521abb6a889STejun Heo 			};
2522fb1b8b11SGeert Uytterhoeven 			const char *prot_str = NULL;
2523abb6a889STejun Heo 
2524fb1b8b11SGeert Uytterhoeven 			switch (qc->tf.protocol) {
2525fb1b8b11SGeert Uytterhoeven 			case ATA_PROT_UNKNOWN:
2526fb1b8b11SGeert Uytterhoeven 				prot_str = "unknown";
2527fb1b8b11SGeert Uytterhoeven 				break;
2528fb1b8b11SGeert Uytterhoeven 			case ATA_PROT_NODATA:
2529fb1b8b11SGeert Uytterhoeven 				prot_str = "nodata";
2530fb1b8b11SGeert Uytterhoeven 				break;
2531fb1b8b11SGeert Uytterhoeven 			case ATA_PROT_PIO:
2532fb1b8b11SGeert Uytterhoeven 				prot_str = "pio";
2533fb1b8b11SGeert Uytterhoeven 				break;
2534fb1b8b11SGeert Uytterhoeven 			case ATA_PROT_DMA:
2535fb1b8b11SGeert Uytterhoeven 				prot_str = "dma";
2536fb1b8b11SGeert Uytterhoeven 				break;
2537fb1b8b11SGeert Uytterhoeven 			case ATA_PROT_NCQ:
2538fb1b8b11SGeert Uytterhoeven 				prot_str = "ncq dma";
2539fb1b8b11SGeert Uytterhoeven 				break;
2540fb1b8b11SGeert Uytterhoeven 			case ATA_PROT_NCQ_NODATA:
2541fb1b8b11SGeert Uytterhoeven 				prot_str = "ncq nodata";
2542fb1b8b11SGeert Uytterhoeven 				break;
2543fb1b8b11SGeert Uytterhoeven 			case ATAPI_PROT_NODATA:
2544fb1b8b11SGeert Uytterhoeven 				prot_str = "nodata";
2545fb1b8b11SGeert Uytterhoeven 				break;
2546fb1b8b11SGeert Uytterhoeven 			case ATAPI_PROT_PIO:
2547fb1b8b11SGeert Uytterhoeven 				prot_str = "pio";
2548fb1b8b11SGeert Uytterhoeven 				break;
2549fb1b8b11SGeert Uytterhoeven 			case ATAPI_PROT_DMA:
2550fb1b8b11SGeert Uytterhoeven 				prot_str = "dma";
2551fb1b8b11SGeert Uytterhoeven 				break;
2552fb1b8b11SGeert Uytterhoeven 			}
2553abb6a889STejun Heo 			snprintf(data_buf, sizeof(data_buf), " %s %u %s",
2554fb1b8b11SGeert Uytterhoeven 				 prot_str, qc->nbytes, dma_str[qc->dma_dir]);
2555abb6a889STejun Heo 		}
2556abb6a889STejun Heo 
25576521148cSRobert Hancock 		if (ata_is_atapi(qc->tf.protocol)) {
2558a13b0c9dSHannes Reinecke 			const u8 *cdb = qc->cdb;
2559a13b0c9dSHannes Reinecke 			size_t cdb_len = qc->dev->cdb_len;
2560a13b0c9dSHannes Reinecke 
2561cbba5b0eSHannes Reinecke 			if (qc->scsicmd) {
2562cbba5b0eSHannes Reinecke 				cdb = qc->scsicmd->cmnd;
2563cbba5b0eSHannes Reinecke 				cdb_len = qc->scsicmd->cmd_len;
2564cbba5b0eSHannes Reinecke 			}
2565cbba5b0eSHannes Reinecke 			__scsi_format_command(cdb_buf, sizeof(cdb_buf),
2566cbba5b0eSHannes Reinecke 					      cdb, cdb_len);
25676521148cSRobert Hancock 		} else {
25686521148cSRobert Hancock 			const char *descr = ata_get_cmd_descript(cmd->command);
25696521148cSRobert Hancock 			if (descr)
2570a9a79dfeSJoe Perches 				ata_dev_err(qc->dev, "failed command: %s\n",
2571a9a79dfeSJoe Perches 					    descr);
25726521148cSRobert Hancock 		}
2573abb6a889STejun Heo 
2574a9a79dfeSJoe Perches 		ata_dev_err(qc->dev,
25758a937581STejun Heo 			"cmd %02x/%02x:%02x:%02x:%02x:%02x/%02x:%02x:%02x:%02x:%02x/%02x "
2576abb6a889STejun Heo 			"tag %d%s\n         %s"
25778a937581STejun Heo 			"res %02x/%02x:%02x:%02x:%02x:%02x/%02x:%02x:%02x:%02x:%02x/%02x "
25785335b729STejun Heo 			"Emask 0x%x (%s)%s\n",
25798a937581STejun Heo 			cmd->command, cmd->feature, cmd->nsect,
25808a937581STejun Heo 			cmd->lbal, cmd->lbam, cmd->lbah,
25818a937581STejun Heo 			cmd->hob_feature, cmd->hob_nsect,
25828a937581STejun Heo 			cmd->hob_lbal, cmd->hob_lbam, cmd->hob_lbah,
2583abb6a889STejun Heo 			cmd->device, qc->tag, data_buf, cdb_buf,
25848a937581STejun Heo 			res->command, res->feature, res->nsect,
25858a937581STejun Heo 			res->lbal, res->lbam, res->lbah,
25868a937581STejun Heo 			res->hob_feature, res->hob_nsect,
25878a937581STejun Heo 			res->hob_lbal, res->hob_lbam, res->hob_lbah,
25885335b729STejun Heo 			res->device, qc->err_mask, ata_err_string(qc->err_mask),
25895335b729STejun Heo 			qc->err_mask & AC_ERR_NCQ ? " <F>" : "");
25901333e194SRobert Hancock 
25916521148cSRobert Hancock #ifdef CONFIG_ATA_VERBOSE_ERROR
25921333e194SRobert Hancock 		if (res->command & (ATA_BUSY | ATA_DRDY | ATA_DF | ATA_DRQ |
2593e87fd28cSHannes Reinecke 				    ATA_SENSE | ATA_ERR)) {
25941333e194SRobert Hancock 			if (res->command & ATA_BUSY)
2595a9a79dfeSJoe Perches 				ata_dev_err(qc->dev, "status: { Busy }\n");
25961333e194SRobert Hancock 			else
2597e87fd28cSHannes Reinecke 				ata_dev_err(qc->dev, "status: { %s%s%s%s%s}\n",
25981333e194SRobert Hancock 				  res->command & ATA_DRDY ? "DRDY " : "",
25991333e194SRobert Hancock 				  res->command & ATA_DF ? "DF " : "",
26001333e194SRobert Hancock 				  res->command & ATA_DRQ ? "DRQ " : "",
2601e87fd28cSHannes Reinecke 				  res->command & ATA_SENSE ? "SENSE " : "",
26021333e194SRobert Hancock 				  res->command & ATA_ERR ? "ERR " : "");
26031333e194SRobert Hancock 		}
26041333e194SRobert Hancock 
26051333e194SRobert Hancock 		if (cmd->command != ATA_CMD_PACKET &&
2606eec7e1c1SAlexey Asemov 		    (res->feature & (ATA_ICRC | ATA_UNC | ATA_AMNF |
2607eec7e1c1SAlexey Asemov 				     ATA_IDNF | ATA_ABORTED)))
2608eec7e1c1SAlexey Asemov 			ata_dev_err(qc->dev, "error: { %s%s%s%s%s}\n",
26091333e194SRobert Hancock 			  res->feature & ATA_ICRC ? "ICRC " : "",
26101333e194SRobert Hancock 			  res->feature & ATA_UNC ? "UNC " : "",
2611eec7e1c1SAlexey Asemov 			  res->feature & ATA_AMNF ? "AMNF " : "",
26121333e194SRobert Hancock 			  res->feature & ATA_IDNF ? "IDNF " : "",
26131333e194SRobert Hancock 			  res->feature & ATA_ABORTED ? "ABRT " : "");
26146521148cSRobert Hancock #endif
2615c6fd2807SJeff Garzik 	}
2616c6fd2807SJeff Garzik }
2617c6fd2807SJeff Garzik 
26189b1e2658STejun Heo /**
26199b1e2658STejun Heo  *	ata_eh_report - report error handling to user
26209b1e2658STejun Heo  *	@ap: ATA port to report EH about
26219b1e2658STejun Heo  *
26229b1e2658STejun Heo  *	Report EH to user.
26239b1e2658STejun Heo  *
26249b1e2658STejun Heo  *	LOCKING:
26259b1e2658STejun Heo  *	None.
26269b1e2658STejun Heo  */
2627fb7fd614STejun Heo void ata_eh_report(struct ata_port *ap)
26289b1e2658STejun Heo {
26299b1e2658STejun Heo 	struct ata_link *link;
26309b1e2658STejun Heo 
26311eca4365STejun Heo 	ata_for_each_link(link, ap, HOST_FIRST)
26329b1e2658STejun Heo 		ata_eh_link_report(link);
26339b1e2658STejun Heo }
26349b1e2658STejun Heo 
2635cc0680a5STejun Heo static int ata_do_reset(struct ata_link *link, ata_reset_fn_t reset,
2636b1c72916STejun Heo 			unsigned int *classes, unsigned long deadline,
2637b1c72916STejun Heo 			bool clear_classes)
2638c6fd2807SJeff Garzik {
2639f58229f8STejun Heo 	struct ata_device *dev;
2640c6fd2807SJeff Garzik 
2641b1c72916STejun Heo 	if (clear_classes)
26421eca4365STejun Heo 		ata_for_each_dev(dev, link, ALL)
2643f58229f8STejun Heo 			classes[dev->devno] = ATA_DEV_UNKNOWN;
2644c6fd2807SJeff Garzik 
2645f046519fSTejun Heo 	return reset(link, classes, deadline);
2646c6fd2807SJeff Garzik }
2647c6fd2807SJeff Garzik 
2648e8411fbaSSergei Shtylyov static int ata_eh_followup_srst_needed(struct ata_link *link, int rc)
2649c6fd2807SJeff Garzik {
265045db2f6cSTejun Heo 	if ((link->flags & ATA_LFLAG_NO_SRST) || ata_link_offline(link))
2651ae791c05STejun Heo 		return 0;
26525dbfc9cbSTejun Heo 	if (rc == -EAGAIN)
2653c6fd2807SJeff Garzik 		return 1;
2654071f44b1STejun Heo 	if (sata_pmp_supported(link->ap) && ata_is_host_link(link))
26553495de73STejun Heo 		return 1;
2656c6fd2807SJeff Garzik 	return 0;
2657c6fd2807SJeff Garzik }
2658c6fd2807SJeff Garzik 
2659fb7fd614STejun Heo int ata_eh_reset(struct ata_link *link, int classify,
2660c6fd2807SJeff Garzik 		 ata_prereset_fn_t prereset, ata_reset_fn_t softreset,
2661c6fd2807SJeff Garzik 		 ata_reset_fn_t hardreset, ata_postreset_fn_t postreset)
2662c6fd2807SJeff Garzik {
2663afaa5c37STejun Heo 	struct ata_port *ap = link->ap;
2664b1c72916STejun Heo 	struct ata_link *slave = ap->slave_link;
2665936fd732STejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
2666705d2014SBartlomiej Zolnierkiewicz 	struct ata_eh_context *sehc = slave ? &slave->eh_context : NULL;
2667c6fd2807SJeff Garzik 	unsigned int *classes = ehc->classes;
2668416dc9edSTejun Heo 	unsigned int lflags = link->flags;
2669c6fd2807SJeff Garzik 	int verbose = !(ehc->i.flags & ATA_EHI_QUIET);
2670d8af0eb6STejun Heo 	int max_tries = 0, try = 0;
2671b1c72916STejun Heo 	struct ata_link *failed_link;
2672f58229f8STejun Heo 	struct ata_device *dev;
2673416dc9edSTejun Heo 	unsigned long deadline, now;
2674c6fd2807SJeff Garzik 	ata_reset_fn_t reset;
2675afaa5c37STejun Heo 	unsigned long flags;
2676416dc9edSTejun Heo 	u32 sstatus;
2677b1c72916STejun Heo 	int nr_unknown, rc;
2678c6fd2807SJeff Garzik 
2679932648b0STejun Heo 	/*
2680932648b0STejun Heo 	 * Prepare to reset
2681932648b0STejun Heo 	 */
2682d8af0eb6STejun Heo 	while (ata_eh_reset_timeouts[max_tries] != ULONG_MAX)
2683d8af0eb6STejun Heo 		max_tries++;
2684ca6d43b0SDan Williams 	if (link->flags & ATA_LFLAG_RST_ONCE)
2685ca6d43b0SDan Williams 		max_tries = 1;
268605944bdfSTejun Heo 	if (link->flags & ATA_LFLAG_NO_HRST)
268705944bdfSTejun Heo 		hardreset = NULL;
268805944bdfSTejun Heo 	if (link->flags & ATA_LFLAG_NO_SRST)
268905944bdfSTejun Heo 		softreset = NULL;
2690d8af0eb6STejun Heo 
269125985edcSLucas De Marchi 	/* make sure each reset attempt is at least COOL_DOWN apart */
269219b72321STejun Heo 	if (ehc->i.flags & ATA_EHI_DID_RESET) {
26930a2c0f56STejun Heo 		now = jiffies;
269419b72321STejun Heo 		WARN_ON(time_after(ehc->last_reset, now));
269519b72321STejun Heo 		deadline = ata_deadline(ehc->last_reset,
269619b72321STejun Heo 					ATA_EH_RESET_COOL_DOWN);
26970a2c0f56STejun Heo 		if (time_before(now, deadline))
26980a2c0f56STejun Heo 			schedule_timeout_uninterruptible(deadline - now);
269919b72321STejun Heo 	}
27000a2c0f56STejun Heo 
2701afaa5c37STejun Heo 	spin_lock_irqsave(ap->lock, flags);
2702afaa5c37STejun Heo 	ap->pflags |= ATA_PFLAG_RESETTING;
2703afaa5c37STejun Heo 	spin_unlock_irqrestore(ap->lock, flags);
2704afaa5c37STejun Heo 
2705cf480626STejun Heo 	ata_eh_about_to_do(link, NULL, ATA_EH_RESET);
2706c6fd2807SJeff Garzik 
27071eca4365STejun Heo 	ata_for_each_dev(dev, link, ALL) {
2708cdeab114STejun Heo 		/* If we issue an SRST then an ATA drive (not ATAPI)
2709cdeab114STejun Heo 		 * may change configuration and be in PIO0 timing. If
2710cdeab114STejun Heo 		 * we do a hard reset (or are coming from power on)
2711cdeab114STejun Heo 		 * this is true for ATA or ATAPI. Until we've set a
2712cdeab114STejun Heo 		 * suitable controller mode we should not touch the
2713cdeab114STejun Heo 		 * bus as we may be talking too fast.
2714cdeab114STejun Heo 		 */
2715cdeab114STejun Heo 		dev->pio_mode = XFER_PIO_0;
27165416912aSAaron Lu 		dev->dma_mode = 0xff;
2717cdeab114STejun Heo 
2718cdeab114STejun Heo 		/* If the controller has a pio mode setup function
2719cdeab114STejun Heo 		 * then use it to set the chipset to rights. Don't
2720cdeab114STejun Heo 		 * touch the DMA setup as that will be dealt with when
2721cdeab114STejun Heo 		 * configuring devices.
2722cdeab114STejun Heo 		 */
2723cdeab114STejun Heo 		if (ap->ops->set_piomode)
2724cdeab114STejun Heo 			ap->ops->set_piomode(ap, dev);
2725cdeab114STejun Heo 	}
2726cdeab114STejun Heo 
2727cf480626STejun Heo 	/* prefer hardreset */
2728932648b0STejun Heo 	reset = NULL;
2729cf480626STejun Heo 	ehc->i.action &= ~ATA_EH_RESET;
2730cf480626STejun Heo 	if (hardreset) {
2731cf480626STejun Heo 		reset = hardreset;
2732a674050eSTejun Heo 		ehc->i.action |= ATA_EH_HARDRESET;
27334f7faa3fSTejun Heo 	} else if (softreset) {
2734cf480626STejun Heo 		reset = softreset;
2735a674050eSTejun Heo 		ehc->i.action |= ATA_EH_SOFTRESET;
2736cf480626STejun Heo 	}
2737c6fd2807SJeff Garzik 
2738c6fd2807SJeff Garzik 	if (prereset) {
2739b1c72916STejun Heo 		unsigned long deadline = ata_deadline(jiffies,
2740b1c72916STejun Heo 						      ATA_EH_PRERESET_TIMEOUT);
2741b1c72916STejun Heo 
2742b1c72916STejun Heo 		if (slave) {
2743b1c72916STejun Heo 			sehc->i.action &= ~ATA_EH_RESET;
2744b1c72916STejun Heo 			sehc->i.action |= ehc->i.action;
2745b1c72916STejun Heo 		}
2746b1c72916STejun Heo 
2747b1c72916STejun Heo 		rc = prereset(link, deadline);
2748b1c72916STejun Heo 
2749b1c72916STejun Heo 		/* If present, do prereset on slave link too.  Reset
2750b1c72916STejun Heo 		 * is skipped iff both master and slave links report
2751b1c72916STejun Heo 		 * -ENOENT or clear ATA_EH_RESET.
2752b1c72916STejun Heo 		 */
2753b1c72916STejun Heo 		if (slave && (rc == 0 || rc == -ENOENT)) {
2754b1c72916STejun Heo 			int tmp;
2755b1c72916STejun Heo 
2756b1c72916STejun Heo 			tmp = prereset(slave, deadline);
2757b1c72916STejun Heo 			if (tmp != -ENOENT)
2758b1c72916STejun Heo 				rc = tmp;
2759b1c72916STejun Heo 
2760b1c72916STejun Heo 			ehc->i.action |= sehc->i.action;
2761b1c72916STejun Heo 		}
2762b1c72916STejun Heo 
2763c6fd2807SJeff Garzik 		if (rc) {
2764c961922bSAlan Cox 			if (rc == -ENOENT) {
2765a9a79dfeSJoe Perches 				ata_link_dbg(link, "port disabled--ignoring\n");
2766cf480626STejun Heo 				ehc->i.action &= ~ATA_EH_RESET;
27674aa9ab67STejun Heo 
27681eca4365STejun Heo 				ata_for_each_dev(dev, link, ALL)
2769f58229f8STejun Heo 					classes[dev->devno] = ATA_DEV_NONE;
27704aa9ab67STejun Heo 
27714aa9ab67STejun Heo 				rc = 0;
2772c961922bSAlan Cox 			} else
2773a9a79dfeSJoe Perches 				ata_link_err(link,
2774a9a79dfeSJoe Perches 					     "prereset failed (errno=%d)\n",
2775a9a79dfeSJoe Perches 					     rc);
2776fccb6ea5STejun Heo 			goto out;
2777c6fd2807SJeff Garzik 		}
2778c6fd2807SJeff Garzik 
2779932648b0STejun Heo 		/* prereset() might have cleared ATA_EH_RESET.  If so,
2780d6515e6fSTejun Heo 		 * bang classes, thaw and return.
2781932648b0STejun Heo 		 */
2782932648b0STejun Heo 		if (reset && !(ehc->i.action & ATA_EH_RESET)) {
27831eca4365STejun Heo 			ata_for_each_dev(dev, link, ALL)
2784f58229f8STejun Heo 				classes[dev->devno] = ATA_DEV_NONE;
2785d6515e6fSTejun Heo 			if ((ap->pflags & ATA_PFLAG_FROZEN) &&
2786d6515e6fSTejun Heo 			    ata_is_host_link(link))
2787d6515e6fSTejun Heo 				ata_eh_thaw_port(ap);
2788fccb6ea5STejun Heo 			rc = 0;
2789fccb6ea5STejun Heo 			goto out;
2790c6fd2807SJeff Garzik 		}
2791932648b0STejun Heo 	}
2792c6fd2807SJeff Garzik 
2793c6fd2807SJeff Garzik  retry:
2794932648b0STejun Heo 	/*
2795932648b0STejun Heo 	 * Perform reset
2796932648b0STejun Heo 	 */
2797dc98c32cSTejun Heo 	if (ata_is_host_link(link))
2798dc98c32cSTejun Heo 		ata_eh_freeze_port(ap);
2799dc98c32cSTejun Heo 
2800341c2c95STejun Heo 	deadline = ata_deadline(jiffies, ata_eh_reset_timeouts[try++]);
280131daabdaSTejun Heo 
2802932648b0STejun Heo 	if (reset) {
2803c6fd2807SJeff Garzik 		if (verbose)
2804a9a79dfeSJoe Perches 			ata_link_info(link, "%s resetting link\n",
2805c6fd2807SJeff Garzik 				      reset == softreset ? "soft" : "hard");
2806c6fd2807SJeff Garzik 
2807c6fd2807SJeff Garzik 		/* mark that this EH session started with reset */
280819b72321STejun Heo 		ehc->last_reset = jiffies;
28090d64a233STejun Heo 		if (reset == hardreset)
28100d64a233STejun Heo 			ehc->i.flags |= ATA_EHI_DID_HARDRESET;
28110d64a233STejun Heo 		else
28120d64a233STejun Heo 			ehc->i.flags |= ATA_EHI_DID_SOFTRESET;
2813c6fd2807SJeff Garzik 
2814b1c72916STejun Heo 		rc = ata_do_reset(link, reset, classes, deadline, true);
2815b1c72916STejun Heo 		if (rc && rc != -EAGAIN) {
2816b1c72916STejun Heo 			failed_link = link;
28175dbfc9cbSTejun Heo 			goto fail;
2818b1c72916STejun Heo 		}
2819c6fd2807SJeff Garzik 
2820b1c72916STejun Heo 		/* hardreset slave link if existent */
2821b1c72916STejun Heo 		if (slave && reset == hardreset) {
2822b1c72916STejun Heo 			int tmp;
2823b1c72916STejun Heo 
2824b1c72916STejun Heo 			if (verbose)
2825a9a79dfeSJoe Perches 				ata_link_info(slave, "hard resetting link\n");
2826b1c72916STejun Heo 
2827b1c72916STejun Heo 			ata_eh_about_to_do(slave, NULL, ATA_EH_RESET);
2828b1c72916STejun Heo 			tmp = ata_do_reset(slave, reset, classes, deadline,
2829b1c72916STejun Heo 					   false);
2830b1c72916STejun Heo 			switch (tmp) {
2831b1c72916STejun Heo 			case -EAGAIN:
2832b1c72916STejun Heo 				rc = -EAGAIN;
2833b1c72916STejun Heo 			case 0:
2834b1c72916STejun Heo 				break;
2835b1c72916STejun Heo 			default:
2836b1c72916STejun Heo 				failed_link = slave;
2837b1c72916STejun Heo 				rc = tmp;
2838b1c72916STejun Heo 				goto fail;
2839b1c72916STejun Heo 			}
2840b1c72916STejun Heo 		}
2841b1c72916STejun Heo 
2842b1c72916STejun Heo 		/* perform follow-up SRST if necessary */
2843c6fd2807SJeff Garzik 		if (reset == hardreset &&
2844e8411fbaSSergei Shtylyov 		    ata_eh_followup_srst_needed(link, rc)) {
2845c6fd2807SJeff Garzik 			reset = softreset;
2846c6fd2807SJeff Garzik 
2847c6fd2807SJeff Garzik 			if (!reset) {
2848a9a79dfeSJoe Perches 				ata_link_err(link,
2849a9a79dfeSJoe Perches 	     "follow-up softreset required but no softreset available\n");
2850b1c72916STejun Heo 				failed_link = link;
2851fccb6ea5STejun Heo 				rc = -EINVAL;
285208cf69d0STejun Heo 				goto fail;
2853c6fd2807SJeff Garzik 			}
2854c6fd2807SJeff Garzik 
2855cf480626STejun Heo 			ata_eh_about_to_do(link, NULL, ATA_EH_RESET);
2856b1c72916STejun Heo 			rc = ata_do_reset(link, reset, classes, deadline, true);
2857fe2c4d01STejun Heo 			if (rc) {
2858fe2c4d01STejun Heo 				failed_link = link;
2859fe2c4d01STejun Heo 				goto fail;
2860fe2c4d01STejun Heo 			}
2861c6fd2807SJeff Garzik 		}
2862932648b0STejun Heo 	} else {
2863932648b0STejun Heo 		if (verbose)
2864a9a79dfeSJoe Perches 			ata_link_info(link,
2865a9a79dfeSJoe Perches 	"no reset method available, skipping reset\n");
2866932648b0STejun Heo 		if (!(lflags & ATA_LFLAG_ASSUME_CLASS))
2867932648b0STejun Heo 			lflags |= ATA_LFLAG_ASSUME_ATA;
2868932648b0STejun Heo 	}
2869008a7896STejun Heo 
2870932648b0STejun Heo 	/*
2871932648b0STejun Heo 	 * Post-reset processing
2872932648b0STejun Heo 	 */
28731eca4365STejun Heo 	ata_for_each_dev(dev, link, ALL) {
2874416dc9edSTejun Heo 		/* After the reset, the device state is PIO 0 and the
2875416dc9edSTejun Heo 		 * controller state is undefined.  Reset also wakes up
2876416dc9edSTejun Heo 		 * drives from sleeping mode.
2877c6fd2807SJeff Garzik 		 */
2878f58229f8STejun Heo 		dev->pio_mode = XFER_PIO_0;
2879054a5fbaSTejun Heo 		dev->flags &= ~ATA_DFLAG_SLEEPING;
2880c6fd2807SJeff Garzik 
28813b761d3dSTejun Heo 		if (ata_phys_link_offline(ata_dev_phys_link(dev)))
28823b761d3dSTejun Heo 			continue;
28833b761d3dSTejun Heo 
28844ccd3329STejun Heo 		/* apply class override */
2885416dc9edSTejun Heo 		if (lflags & ATA_LFLAG_ASSUME_ATA)
2886ae791c05STejun Heo 			classes[dev->devno] = ATA_DEV_ATA;
2887416dc9edSTejun Heo 		else if (lflags & ATA_LFLAG_ASSUME_SEMB)
2888816ab897STejun Heo 			classes[dev->devno] = ATA_DEV_SEMB_UNSUP;
2889ae791c05STejun Heo 	}
2890ae791c05STejun Heo 
2891008a7896STejun Heo 	/* record current link speed */
2892936fd732STejun Heo 	if (sata_scr_read(link, SCR_STATUS, &sstatus) == 0)
2893936fd732STejun Heo 		link->sata_spd = (sstatus >> 4) & 0xf;
2894b1c72916STejun Heo 	if (slave && sata_scr_read(slave, SCR_STATUS, &sstatus) == 0)
2895b1c72916STejun Heo 		slave->sata_spd = (sstatus >> 4) & 0xf;
2896008a7896STejun Heo 
2897dc98c32cSTejun Heo 	/* thaw the port */
2898dc98c32cSTejun Heo 	if (ata_is_host_link(link))
2899dc98c32cSTejun Heo 		ata_eh_thaw_port(ap);
2900dc98c32cSTejun Heo 
2901f046519fSTejun Heo 	/* postreset() should clear hardware SError.  Although SError
2902f046519fSTejun Heo 	 * is cleared during link resume, clearing SError here is
2903f046519fSTejun Heo 	 * necessary as some PHYs raise hotplug events after SRST.
2904f046519fSTejun Heo 	 * This introduces race condition where hotplug occurs between
2905f046519fSTejun Heo 	 * reset and here.  This race is mediated by cross checking
2906f046519fSTejun Heo 	 * link onlineness and classification result later.
2907f046519fSTejun Heo 	 */
2908b1c72916STejun Heo 	if (postreset) {
2909cc0680a5STejun Heo 		postreset(link, classes);
2910b1c72916STejun Heo 		if (slave)
2911b1c72916STejun Heo 			postreset(slave, classes);
2912b1c72916STejun Heo 	}
2913c6fd2807SJeff Garzik 
29141e641060STejun Heo 	/*
29158c56caccSTejun Heo 	 * Some controllers can't be frozen very well and may set spurious
29168c56caccSTejun Heo 	 * error conditions during reset.  Clear accumulated error
29178c56caccSTejun Heo 	 * information and re-thaw the port if frozen.  As reset is the
29188c56caccSTejun Heo 	 * final recovery action and we cross check link onlineness against
29198c56caccSTejun Heo 	 * device classification later, no hotplug event is lost by this.
29201e641060STejun Heo 	 */
2921f046519fSTejun Heo 	spin_lock_irqsave(link->ap->lock, flags);
29221e641060STejun Heo 	memset(&link->eh_info, 0, sizeof(link->eh_info));
2923b1c72916STejun Heo 	if (slave)
29241e641060STejun Heo 		memset(&slave->eh_info, 0, sizeof(link->eh_info));
29251e641060STejun Heo 	ap->pflags &= ~ATA_PFLAG_EH_PENDING;
2926f046519fSTejun Heo 	spin_unlock_irqrestore(link->ap->lock, flags);
2927f046519fSTejun Heo 
29288c56caccSTejun Heo 	if (ap->pflags & ATA_PFLAG_FROZEN)
29298c56caccSTejun Heo 		ata_eh_thaw_port(ap);
29308c56caccSTejun Heo 
29313b761d3dSTejun Heo 	/*
29323b761d3dSTejun Heo 	 * Make sure onlineness and classification result correspond.
2933f046519fSTejun Heo 	 * Hotplug could have happened during reset and some
2934f046519fSTejun Heo 	 * controllers fail to wait while a drive is spinning up after
2935f046519fSTejun Heo 	 * being hotplugged causing misdetection.  By cross checking
29363b761d3dSTejun Heo 	 * link on/offlineness and classification result, those
29373b761d3dSTejun Heo 	 * conditions can be reliably detected and retried.
2938f046519fSTejun Heo 	 */
2939b1c72916STejun Heo 	nr_unknown = 0;
29401eca4365STejun Heo 	ata_for_each_dev(dev, link, ALL) {
29413b761d3dSTejun Heo 		if (ata_phys_link_online(ata_dev_phys_link(dev))) {
2942b1c72916STejun Heo 			if (classes[dev->devno] == ATA_DEV_UNKNOWN) {
2943a9a79dfeSJoe Perches 				ata_dev_dbg(dev, "link online but device misclassified\n");
2944f046519fSTejun Heo 				classes[dev->devno] = ATA_DEV_NONE;
2945b1c72916STejun Heo 				nr_unknown++;
2946b1c72916STejun Heo 			}
29473b761d3dSTejun Heo 		} else if (ata_phys_link_offline(ata_dev_phys_link(dev))) {
29483b761d3dSTejun Heo 			if (ata_class_enabled(classes[dev->devno]))
2949a9a79dfeSJoe Perches 				ata_dev_dbg(dev,
2950a9a79dfeSJoe Perches 					    "link offline, clearing class %d to NONE\n",
29513b761d3dSTejun Heo 					    classes[dev->devno]);
29523b761d3dSTejun Heo 			classes[dev->devno] = ATA_DEV_NONE;
29533b761d3dSTejun Heo 		} else if (classes[dev->devno] == ATA_DEV_UNKNOWN) {
2954a9a79dfeSJoe Perches 			ata_dev_dbg(dev,
2955a9a79dfeSJoe Perches 				    "link status unknown, clearing UNKNOWN to NONE\n");
29563b761d3dSTejun Heo 			classes[dev->devno] = ATA_DEV_NONE;
29573b761d3dSTejun Heo 		}
2958f046519fSTejun Heo 	}
2959f046519fSTejun Heo 
2960b1c72916STejun Heo 	if (classify && nr_unknown) {
2961f046519fSTejun Heo 		if (try < max_tries) {
2962a9a79dfeSJoe Perches 			ata_link_warn(link,
2963a9a79dfeSJoe Perches 				      "link online but %d devices misclassified, retrying\n",
29643b761d3dSTejun Heo 				      nr_unknown);
2965b1c72916STejun Heo 			failed_link = link;
2966f046519fSTejun Heo 			rc = -EAGAIN;
2967f046519fSTejun Heo 			goto fail;
2968f046519fSTejun Heo 		}
2969a9a79dfeSJoe Perches 		ata_link_warn(link,
29703b761d3dSTejun Heo 			      "link online but %d devices misclassified, "
29713b761d3dSTejun Heo 			      "device detection might fail\n", nr_unknown);
2972f046519fSTejun Heo 	}
2973f046519fSTejun Heo 
2974c6fd2807SJeff Garzik 	/* reset successful, schedule revalidation */
2975cf480626STejun Heo 	ata_eh_done(link, NULL, ATA_EH_RESET);
2976b1c72916STejun Heo 	if (slave)
2977b1c72916STejun Heo 		ata_eh_done(slave, NULL, ATA_EH_RESET);
297819b72321STejun Heo 	ehc->last_reset = jiffies;		/* update to completion time */
2979c6fd2807SJeff Garzik 	ehc->i.action |= ATA_EH_REVALIDATE;
29806b7ae954STejun Heo 	link->lpm_policy = ATA_LPM_UNKNOWN;	/* reset LPM state */
2981416dc9edSTejun Heo 
2982416dc9edSTejun Heo 	rc = 0;
2983fccb6ea5STejun Heo  out:
2984fccb6ea5STejun Heo 	/* clear hotplug flag */
2985fccb6ea5STejun Heo 	ehc->i.flags &= ~ATA_EHI_HOTPLUGGED;
2986b1c72916STejun Heo 	if (slave)
2987b1c72916STejun Heo 		sehc->i.flags &= ~ATA_EHI_HOTPLUGGED;
2988afaa5c37STejun Heo 
2989afaa5c37STejun Heo 	spin_lock_irqsave(ap->lock, flags);
2990afaa5c37STejun Heo 	ap->pflags &= ~ATA_PFLAG_RESETTING;
2991afaa5c37STejun Heo 	spin_unlock_irqrestore(ap->lock, flags);
2992afaa5c37STejun Heo 
2993c6fd2807SJeff Garzik 	return rc;
2994416dc9edSTejun Heo 
2995416dc9edSTejun Heo  fail:
29965958e302STejun Heo 	/* if SCR isn't accessible on a fan-out port, PMP needs to be reset */
29975958e302STejun Heo 	if (!ata_is_host_link(link) &&
29985958e302STejun Heo 	    sata_scr_read(link, SCR_STATUS, &sstatus))
29995958e302STejun Heo 		rc = -ERESTART;
30005958e302STejun Heo 
30017a46c078SGwendal Grignou 	if (try >= max_tries) {
30028ea7645cSTejun Heo 		/*
30038ea7645cSTejun Heo 		 * Thaw host port even if reset failed, so that the port
30048ea7645cSTejun Heo 		 * can be retried on the next phy event.  This risks
30058ea7645cSTejun Heo 		 * repeated EH runs but seems to be a better tradeoff than
30068ea7645cSTejun Heo 		 * shutting down a port after a botched hotplug attempt.
30078ea7645cSTejun Heo 		 */
30088ea7645cSTejun Heo 		if (ata_is_host_link(link))
30098ea7645cSTejun Heo 			ata_eh_thaw_port(ap);
3010416dc9edSTejun Heo 		goto out;
30118ea7645cSTejun Heo 	}
3012416dc9edSTejun Heo 
3013416dc9edSTejun Heo 	now = jiffies;
3014416dc9edSTejun Heo 	if (time_before(now, deadline)) {
3015416dc9edSTejun Heo 		unsigned long delta = deadline - now;
3016416dc9edSTejun Heo 
3017a9a79dfeSJoe Perches 		ata_link_warn(failed_link,
30180a2c0f56STejun Heo 			"reset failed (errno=%d), retrying in %u secs\n",
30190a2c0f56STejun Heo 			rc, DIV_ROUND_UP(jiffies_to_msecs(delta), 1000));
3020416dc9edSTejun Heo 
3021c0c362b6STejun Heo 		ata_eh_release(ap);
3022416dc9edSTejun Heo 		while (delta)
3023416dc9edSTejun Heo 			delta = schedule_timeout_uninterruptible(delta);
3024c0c362b6STejun Heo 		ata_eh_acquire(ap);
3025416dc9edSTejun Heo 	}
3026416dc9edSTejun Heo 
30277a46c078SGwendal Grignou 	/*
30287a46c078SGwendal Grignou 	 * While disks spinup behind PMP, some controllers fail sending SRST.
30297a46c078SGwendal Grignou 	 * They need to be reset - as well as the PMP - before retrying.
30307a46c078SGwendal Grignou 	 */
30317a46c078SGwendal Grignou 	if (rc == -ERESTART) {
30327a46c078SGwendal Grignou 		if (ata_is_host_link(link))
30337a46c078SGwendal Grignou 			ata_eh_thaw_port(ap);
30347a46c078SGwendal Grignou 		goto out;
30357a46c078SGwendal Grignou 	}
30367a46c078SGwendal Grignou 
3037b1c72916STejun Heo 	if (try == max_tries - 1) {
3038a07d499bSTejun Heo 		sata_down_spd_limit(link, 0);
3039b1c72916STejun Heo 		if (slave)
3040a07d499bSTejun Heo 			sata_down_spd_limit(slave, 0);
3041b1c72916STejun Heo 	} else if (rc == -EPIPE)
3042a07d499bSTejun Heo 		sata_down_spd_limit(failed_link, 0);
3043b1c72916STejun Heo 
3044416dc9edSTejun Heo 	if (hardreset)
3045416dc9edSTejun Heo 		reset = hardreset;
3046416dc9edSTejun Heo 	goto retry;
3047c6fd2807SJeff Garzik }
3048c6fd2807SJeff Garzik 
304945fabbb7SElias Oltmanns static inline void ata_eh_pull_park_action(struct ata_port *ap)
305045fabbb7SElias Oltmanns {
305145fabbb7SElias Oltmanns 	struct ata_link *link;
305245fabbb7SElias Oltmanns 	struct ata_device *dev;
305345fabbb7SElias Oltmanns 	unsigned long flags;
305445fabbb7SElias Oltmanns 
305545fabbb7SElias Oltmanns 	/*
305645fabbb7SElias Oltmanns 	 * This function can be thought of as an extended version of
305745fabbb7SElias Oltmanns 	 * ata_eh_about_to_do() specially crafted to accommodate the
305845fabbb7SElias Oltmanns 	 * requirements of ATA_EH_PARK handling. Since the EH thread
305945fabbb7SElias Oltmanns 	 * does not leave the do {} while () loop in ata_eh_recover as
306045fabbb7SElias Oltmanns 	 * long as the timeout for a park request to *one* device on
306145fabbb7SElias Oltmanns 	 * the port has not expired, and since we still want to pick
306245fabbb7SElias Oltmanns 	 * up park requests to other devices on the same port or
306345fabbb7SElias Oltmanns 	 * timeout updates for the same device, we have to pull
306445fabbb7SElias Oltmanns 	 * ATA_EH_PARK actions from eh_info into eh_context.i
306545fabbb7SElias Oltmanns 	 * ourselves at the beginning of each pass over the loop.
306645fabbb7SElias Oltmanns 	 *
306745fabbb7SElias Oltmanns 	 * Additionally, all write accesses to &ap->park_req_pending
306816735d02SWolfram Sang 	 * through reinit_completion() (see below) or complete_all()
306945fabbb7SElias Oltmanns 	 * (see ata_scsi_park_store()) are protected by the host lock.
307045fabbb7SElias Oltmanns 	 * As a result we have that park_req_pending.done is zero on
307145fabbb7SElias Oltmanns 	 * exit from this function, i.e. when ATA_EH_PARK actions for
307245fabbb7SElias Oltmanns 	 * *all* devices on port ap have been pulled into the
307345fabbb7SElias Oltmanns 	 * respective eh_context structs. If, and only if,
307445fabbb7SElias Oltmanns 	 * park_req_pending.done is non-zero by the time we reach
307545fabbb7SElias Oltmanns 	 * wait_for_completion_timeout(), another ATA_EH_PARK action
307645fabbb7SElias Oltmanns 	 * has been scheduled for at least one of the devices on port
307745fabbb7SElias Oltmanns 	 * ap and we have to cycle over the do {} while () loop in
307845fabbb7SElias Oltmanns 	 * ata_eh_recover() again.
307945fabbb7SElias Oltmanns 	 */
308045fabbb7SElias Oltmanns 
308145fabbb7SElias Oltmanns 	spin_lock_irqsave(ap->lock, flags);
308216735d02SWolfram Sang 	reinit_completion(&ap->park_req_pending);
30831eca4365STejun Heo 	ata_for_each_link(link, ap, EDGE) {
30841eca4365STejun Heo 		ata_for_each_dev(dev, link, ALL) {
308545fabbb7SElias Oltmanns 			struct ata_eh_info *ehi = &link->eh_info;
308645fabbb7SElias Oltmanns 
308745fabbb7SElias Oltmanns 			link->eh_context.i.dev_action[dev->devno] |=
308845fabbb7SElias Oltmanns 				ehi->dev_action[dev->devno] & ATA_EH_PARK;
308945fabbb7SElias Oltmanns 			ata_eh_clear_action(link, dev, ehi, ATA_EH_PARK);
309045fabbb7SElias Oltmanns 		}
309145fabbb7SElias Oltmanns 	}
309245fabbb7SElias Oltmanns 	spin_unlock_irqrestore(ap->lock, flags);
309345fabbb7SElias Oltmanns }
309445fabbb7SElias Oltmanns 
309545fabbb7SElias Oltmanns static void ata_eh_park_issue_cmd(struct ata_device *dev, int park)
309645fabbb7SElias Oltmanns {
309745fabbb7SElias Oltmanns 	struct ata_eh_context *ehc = &dev->link->eh_context;
309845fabbb7SElias Oltmanns 	struct ata_taskfile tf;
309945fabbb7SElias Oltmanns 	unsigned int err_mask;
310045fabbb7SElias Oltmanns 
310145fabbb7SElias Oltmanns 	ata_tf_init(dev, &tf);
310245fabbb7SElias Oltmanns 	if (park) {
310345fabbb7SElias Oltmanns 		ehc->unloaded_mask |= 1 << dev->devno;
310445fabbb7SElias Oltmanns 		tf.command = ATA_CMD_IDLEIMMEDIATE;
310545fabbb7SElias Oltmanns 		tf.feature = 0x44;
310645fabbb7SElias Oltmanns 		tf.lbal = 0x4c;
310745fabbb7SElias Oltmanns 		tf.lbam = 0x4e;
310845fabbb7SElias Oltmanns 		tf.lbah = 0x55;
310945fabbb7SElias Oltmanns 	} else {
311045fabbb7SElias Oltmanns 		ehc->unloaded_mask &= ~(1 << dev->devno);
311145fabbb7SElias Oltmanns 		tf.command = ATA_CMD_CHK_POWER;
311245fabbb7SElias Oltmanns 	}
311345fabbb7SElias Oltmanns 
311445fabbb7SElias Oltmanns 	tf.flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR;
3115bd18bc04SHannes Reinecke 	tf.protocol = ATA_PROT_NODATA;
311645fabbb7SElias Oltmanns 	err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
311745fabbb7SElias Oltmanns 	if (park && (err_mask || tf.lbal != 0xc4)) {
3118a9a79dfeSJoe Perches 		ata_dev_err(dev, "head unload failed!\n");
311945fabbb7SElias Oltmanns 		ehc->unloaded_mask &= ~(1 << dev->devno);
312045fabbb7SElias Oltmanns 	}
312145fabbb7SElias Oltmanns }
312245fabbb7SElias Oltmanns 
31230260731fSTejun Heo static int ata_eh_revalidate_and_attach(struct ata_link *link,
3124c6fd2807SJeff Garzik 					struct ata_device **r_failed_dev)
3125c6fd2807SJeff Garzik {
31260260731fSTejun Heo 	struct ata_port *ap = link->ap;
31270260731fSTejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
3128c6fd2807SJeff Garzik 	struct ata_device *dev;
31298c3c52a8STejun Heo 	unsigned int new_mask = 0;
3130c6fd2807SJeff Garzik 	unsigned long flags;
3131f58229f8STejun Heo 	int rc = 0;
3132c6fd2807SJeff Garzik 
3133c6fd2807SJeff Garzik 	DPRINTK("ENTER\n");
3134c6fd2807SJeff Garzik 
31358c3c52a8STejun Heo 	/* For PATA drive side cable detection to work, IDENTIFY must
31368c3c52a8STejun Heo 	 * be done backwards such that PDIAG- is released by the slave
31378c3c52a8STejun Heo 	 * device before the master device is identified.
31388c3c52a8STejun Heo 	 */
31391eca4365STejun Heo 	ata_for_each_dev(dev, link, ALL_REVERSE) {
3140f58229f8STejun Heo 		unsigned int action = ata_eh_dev_action(dev);
3141f58229f8STejun Heo 		unsigned int readid_flags = 0;
3142c6fd2807SJeff Garzik 
3143bff04647STejun Heo 		if (ehc->i.flags & ATA_EHI_DID_RESET)
3144bff04647STejun Heo 			readid_flags |= ATA_READID_POSTRESET;
3145bff04647STejun Heo 
31469666f400STejun Heo 		if ((action & ATA_EH_REVALIDATE) && ata_dev_enabled(dev)) {
3147633273a3STejun Heo 			WARN_ON(dev->class == ATA_DEV_PMP);
3148633273a3STejun Heo 
3149b1c72916STejun Heo 			if (ata_phys_link_offline(ata_dev_phys_link(dev))) {
3150c6fd2807SJeff Garzik 				rc = -EIO;
31518c3c52a8STejun Heo 				goto err;
3152c6fd2807SJeff Garzik 			}
3153c6fd2807SJeff Garzik 
31540260731fSTejun Heo 			ata_eh_about_to_do(link, dev, ATA_EH_REVALIDATE);
3155422c9daaSTejun Heo 			rc = ata_dev_revalidate(dev, ehc->classes[dev->devno],
3156422c9daaSTejun Heo 						readid_flags);
3157c6fd2807SJeff Garzik 			if (rc)
31588c3c52a8STejun Heo 				goto err;
3159c6fd2807SJeff Garzik 
31600260731fSTejun Heo 			ata_eh_done(link, dev, ATA_EH_REVALIDATE);
3161c6fd2807SJeff Garzik 
3162baa1e78aSTejun Heo 			/* Configuration may have changed, reconfigure
3163baa1e78aSTejun Heo 			 * transfer mode.
3164baa1e78aSTejun Heo 			 */
3165baa1e78aSTejun Heo 			ehc->i.flags |= ATA_EHI_SETMODE;
3166baa1e78aSTejun Heo 
3167c6fd2807SJeff Garzik 			/* schedule the scsi_rescan_device() here */
3168ad72cf98STejun Heo 			schedule_work(&(ap->scsi_rescan_task));
3169c6fd2807SJeff Garzik 		} else if (dev->class == ATA_DEV_UNKNOWN &&
3170c6fd2807SJeff Garzik 			   ehc->tries[dev->devno] &&
3171c6fd2807SJeff Garzik 			   ata_class_enabled(ehc->classes[dev->devno])) {
3172842faa6cSTejun Heo 			/* Temporarily set dev->class, it will be
3173842faa6cSTejun Heo 			 * permanently set once all configurations are
3174842faa6cSTejun Heo 			 * complete.  This is necessary because new
3175842faa6cSTejun Heo 			 * device configuration is done in two
3176842faa6cSTejun Heo 			 * separate loops.
3177842faa6cSTejun Heo 			 */
3178c6fd2807SJeff Garzik 			dev->class = ehc->classes[dev->devno];
3179c6fd2807SJeff Garzik 
3180633273a3STejun Heo 			if (dev->class == ATA_DEV_PMP)
3181633273a3STejun Heo 				rc = sata_pmp_attach(dev);
3182633273a3STejun Heo 			else
3183633273a3STejun Heo 				rc = ata_dev_read_id(dev, &dev->class,
3184633273a3STejun Heo 						     readid_flags, dev->id);
3185842faa6cSTejun Heo 
3186842faa6cSTejun Heo 			/* read_id might have changed class, store and reset */
3187842faa6cSTejun Heo 			ehc->classes[dev->devno] = dev->class;
3188842faa6cSTejun Heo 			dev->class = ATA_DEV_UNKNOWN;
3189842faa6cSTejun Heo 
31908c3c52a8STejun Heo 			switch (rc) {
31918c3c52a8STejun Heo 			case 0:
319299cf610aSTejun Heo 				/* clear error info accumulated during probe */
319399cf610aSTejun Heo 				ata_ering_clear(&dev->ering);
3194f58229f8STejun Heo 				new_mask |= 1 << dev->devno;
31958c3c52a8STejun Heo 				break;
31968c3c52a8STejun Heo 			case -ENOENT:
319755a8e2c8STejun Heo 				/* IDENTIFY was issued to non-existent
319855a8e2c8STejun Heo 				 * device.  No need to reset.  Just
3199842faa6cSTejun Heo 				 * thaw and ignore the device.
320055a8e2c8STejun Heo 				 */
320155a8e2c8STejun Heo 				ata_eh_thaw_port(ap);
3202c6fd2807SJeff Garzik 				break;
32038c3c52a8STejun Heo 			default:
32048c3c52a8STejun Heo 				goto err;
32058c3c52a8STejun Heo 			}
32068c3c52a8STejun Heo 		}
3207c6fd2807SJeff Garzik 	}
3208c6fd2807SJeff Garzik 
3209c1c4e8d5STejun Heo 	/* PDIAG- should have been released, ask cable type if post-reset */
321033267325STejun Heo 	if ((ehc->i.flags & ATA_EHI_DID_RESET) && ata_is_host_link(link)) {
321133267325STejun Heo 		if (ap->ops->cable_detect)
3212c1c4e8d5STejun Heo 			ap->cbl = ap->ops->cable_detect(ap);
321333267325STejun Heo 		ata_force_cbl(ap);
321433267325STejun Heo 	}
3215c1c4e8d5STejun Heo 
32168c3c52a8STejun Heo 	/* Configure new devices forward such that user doesn't see
32178c3c52a8STejun Heo 	 * device detection messages backwards.
32188c3c52a8STejun Heo 	 */
32191eca4365STejun Heo 	ata_for_each_dev(dev, link, ALL) {
32204f7c2874STejun Heo 		if (!(new_mask & (1 << dev->devno)))
32218c3c52a8STejun Heo 			continue;
32228c3c52a8STejun Heo 
3223842faa6cSTejun Heo 		dev->class = ehc->classes[dev->devno];
3224842faa6cSTejun Heo 
32254f7c2874STejun Heo 		if (dev->class == ATA_DEV_PMP)
32264f7c2874STejun Heo 			continue;
32274f7c2874STejun Heo 
32288c3c52a8STejun Heo 		ehc->i.flags |= ATA_EHI_PRINTINFO;
32298c3c52a8STejun Heo 		rc = ata_dev_configure(dev);
32308c3c52a8STejun Heo 		ehc->i.flags &= ~ATA_EHI_PRINTINFO;
3231842faa6cSTejun Heo 		if (rc) {
3232842faa6cSTejun Heo 			dev->class = ATA_DEV_UNKNOWN;
32338c3c52a8STejun Heo 			goto err;
3234842faa6cSTejun Heo 		}
32358c3c52a8STejun Heo 
3236c6fd2807SJeff Garzik 		spin_lock_irqsave(ap->lock, flags);
3237c6fd2807SJeff Garzik 		ap->pflags |= ATA_PFLAG_SCSI_HOTPLUG;
3238c6fd2807SJeff Garzik 		spin_unlock_irqrestore(ap->lock, flags);
3239baa1e78aSTejun Heo 
324055a8e2c8STejun Heo 		/* new device discovered, configure xfermode */
3241baa1e78aSTejun Heo 		ehc->i.flags |= ATA_EHI_SETMODE;
3242c6fd2807SJeff Garzik 	}
3243c6fd2807SJeff Garzik 
32448c3c52a8STejun Heo 	return 0;
32458c3c52a8STejun Heo 
32468c3c52a8STejun Heo  err:
3247c6fd2807SJeff Garzik 	*r_failed_dev = dev;
32488c3c52a8STejun Heo 	DPRINTK("EXIT rc=%d\n", rc);
3249c6fd2807SJeff Garzik 	return rc;
3250c6fd2807SJeff Garzik }
3251c6fd2807SJeff Garzik 
32526f1d1e3aSTejun Heo /**
32536f1d1e3aSTejun Heo  *	ata_set_mode - Program timings and issue SET FEATURES - XFER
32546f1d1e3aSTejun Heo  *	@link: link on which timings will be programmed
325598a1708dSMartin Olsson  *	@r_failed_dev: out parameter for failed device
32566f1d1e3aSTejun Heo  *
32576f1d1e3aSTejun Heo  *	Set ATA device disk transfer mode (PIO3, UDMA6, etc.).  If
32586f1d1e3aSTejun Heo  *	ata_set_mode() fails, pointer to the failing device is
32596f1d1e3aSTejun Heo  *	returned in @r_failed_dev.
32606f1d1e3aSTejun Heo  *
32616f1d1e3aSTejun Heo  *	LOCKING:
32626f1d1e3aSTejun Heo  *	PCI/etc. bus probe sem.
32636f1d1e3aSTejun Heo  *
32646f1d1e3aSTejun Heo  *	RETURNS:
32656f1d1e3aSTejun Heo  *	0 on success, negative errno otherwise
32666f1d1e3aSTejun Heo  */
32676f1d1e3aSTejun Heo int ata_set_mode(struct ata_link *link, struct ata_device **r_failed_dev)
32686f1d1e3aSTejun Heo {
32696f1d1e3aSTejun Heo 	struct ata_port *ap = link->ap;
327000115e0fSTejun Heo 	struct ata_device *dev;
327100115e0fSTejun Heo 	int rc;
32726f1d1e3aSTejun Heo 
327376326ac1STejun Heo 	/* if data transfer is verified, clear DUBIOUS_XFER on ering top */
32741eca4365STejun Heo 	ata_for_each_dev(dev, link, ENABLED) {
327576326ac1STejun Heo 		if (!(dev->flags & ATA_DFLAG_DUBIOUS_XFER)) {
327676326ac1STejun Heo 			struct ata_ering_entry *ent;
327776326ac1STejun Heo 
327876326ac1STejun Heo 			ent = ata_ering_top(&dev->ering);
327976326ac1STejun Heo 			if (ent)
328076326ac1STejun Heo 				ent->eflags &= ~ATA_EFLAG_DUBIOUS_XFER;
328176326ac1STejun Heo 		}
328276326ac1STejun Heo 	}
328376326ac1STejun Heo 
32846f1d1e3aSTejun Heo 	/* has private set_mode? */
32856f1d1e3aSTejun Heo 	if (ap->ops->set_mode)
328600115e0fSTejun Heo 		rc = ap->ops->set_mode(link, r_failed_dev);
328700115e0fSTejun Heo 	else
328800115e0fSTejun Heo 		rc = ata_do_set_mode(link, r_failed_dev);
328900115e0fSTejun Heo 
329000115e0fSTejun Heo 	/* if transfer mode has changed, set DUBIOUS_XFER on device */
32911eca4365STejun Heo 	ata_for_each_dev(dev, link, ENABLED) {
329200115e0fSTejun Heo 		struct ata_eh_context *ehc = &link->eh_context;
329300115e0fSTejun Heo 		u8 saved_xfer_mode = ehc->saved_xfer_mode[dev->devno];
329400115e0fSTejun Heo 		u8 saved_ncq = !!(ehc->saved_ncq_enabled & (1 << dev->devno));
329500115e0fSTejun Heo 
329600115e0fSTejun Heo 		if (dev->xfer_mode != saved_xfer_mode ||
329700115e0fSTejun Heo 		    ata_ncq_enabled(dev) != saved_ncq)
329800115e0fSTejun Heo 			dev->flags |= ATA_DFLAG_DUBIOUS_XFER;
329900115e0fSTejun Heo 	}
330000115e0fSTejun Heo 
330100115e0fSTejun Heo 	return rc;
33026f1d1e3aSTejun Heo }
33036f1d1e3aSTejun Heo 
330411fc33daSTejun Heo /**
330511fc33daSTejun Heo  *	atapi_eh_clear_ua - Clear ATAPI UNIT ATTENTION after reset
330611fc33daSTejun Heo  *	@dev: ATAPI device to clear UA for
330711fc33daSTejun Heo  *
330811fc33daSTejun Heo  *	Resets and other operations can make an ATAPI device raise
330911fc33daSTejun Heo  *	UNIT ATTENTION which causes the next operation to fail.  This
331011fc33daSTejun Heo  *	function clears UA.
331111fc33daSTejun Heo  *
331211fc33daSTejun Heo  *	LOCKING:
331311fc33daSTejun Heo  *	EH context (may sleep).
331411fc33daSTejun Heo  *
331511fc33daSTejun Heo  *	RETURNS:
331611fc33daSTejun Heo  *	0 on success, -errno on failure.
331711fc33daSTejun Heo  */
331811fc33daSTejun Heo static int atapi_eh_clear_ua(struct ata_device *dev)
331911fc33daSTejun Heo {
332011fc33daSTejun Heo 	int i;
332111fc33daSTejun Heo 
332211fc33daSTejun Heo 	for (i = 0; i < ATA_EH_UA_TRIES; i++) {
3323b5357081STejun Heo 		u8 *sense_buffer = dev->link->ap->sector_buf;
332411fc33daSTejun Heo 		u8 sense_key = 0;
332511fc33daSTejun Heo 		unsigned int err_mask;
332611fc33daSTejun Heo 
332711fc33daSTejun Heo 		err_mask = atapi_eh_tur(dev, &sense_key);
332811fc33daSTejun Heo 		if (err_mask != 0 && err_mask != AC_ERR_DEV) {
3329a9a79dfeSJoe Perches 			ata_dev_warn(dev,
3330a9a79dfeSJoe Perches 				     "TEST_UNIT_READY failed (err_mask=0x%x)\n",
3331a9a79dfeSJoe Perches 				     err_mask);
333211fc33daSTejun Heo 			return -EIO;
333311fc33daSTejun Heo 		}
333411fc33daSTejun Heo 
333511fc33daSTejun Heo 		if (!err_mask || sense_key != UNIT_ATTENTION)
333611fc33daSTejun Heo 			return 0;
333711fc33daSTejun Heo 
333811fc33daSTejun Heo 		err_mask = atapi_eh_request_sense(dev, sense_buffer, sense_key);
333911fc33daSTejun Heo 		if (err_mask) {
3340a9a79dfeSJoe Perches 			ata_dev_warn(dev, "failed to clear "
334111fc33daSTejun Heo 				"UNIT ATTENTION (err_mask=0x%x)\n", err_mask);
334211fc33daSTejun Heo 			return -EIO;
334311fc33daSTejun Heo 		}
334411fc33daSTejun Heo 	}
334511fc33daSTejun Heo 
3346a9a79dfeSJoe Perches 	ata_dev_warn(dev, "UNIT ATTENTION persists after %d tries\n",
3347a9a79dfeSJoe Perches 		     ATA_EH_UA_TRIES);
334811fc33daSTejun Heo 
334911fc33daSTejun Heo 	return 0;
335011fc33daSTejun Heo }
335111fc33daSTejun Heo 
33526013efd8STejun Heo /**
33536013efd8STejun Heo  *	ata_eh_maybe_retry_flush - Retry FLUSH if necessary
33546013efd8STejun Heo  *	@dev: ATA device which may need FLUSH retry
33556013efd8STejun Heo  *
33566013efd8STejun Heo  *	If @dev failed FLUSH, it needs to be reported upper layer
33576013efd8STejun Heo  *	immediately as it means that @dev failed to remap and already
33586013efd8STejun Heo  *	lost at least a sector and further FLUSH retrials won't make
33596013efd8STejun Heo  *	any difference to the lost sector.  However, if FLUSH failed
33606013efd8STejun Heo  *	for other reasons, for example transmission error, FLUSH needs
33616013efd8STejun Heo  *	to be retried.
33626013efd8STejun Heo  *
33636013efd8STejun Heo  *	This function determines whether FLUSH failure retry is
33646013efd8STejun Heo  *	necessary and performs it if so.
33656013efd8STejun Heo  *
33666013efd8STejun Heo  *	RETURNS:
33676013efd8STejun Heo  *	0 if EH can continue, -errno if EH needs to be repeated.
33686013efd8STejun Heo  */
33696013efd8STejun Heo static int ata_eh_maybe_retry_flush(struct ata_device *dev)
33706013efd8STejun Heo {
33716013efd8STejun Heo 	struct ata_link *link = dev->link;
33726013efd8STejun Heo 	struct ata_port *ap = link->ap;
33736013efd8STejun Heo 	struct ata_queued_cmd *qc;
33746013efd8STejun Heo 	struct ata_taskfile tf;
33756013efd8STejun Heo 	unsigned int err_mask;
33766013efd8STejun Heo 	int rc = 0;
33776013efd8STejun Heo 
33786013efd8STejun Heo 	/* did flush fail for this device? */
33796013efd8STejun Heo 	if (!ata_tag_valid(link->active_tag))
33806013efd8STejun Heo 		return 0;
33816013efd8STejun Heo 
33826013efd8STejun Heo 	qc = __ata_qc_from_tag(ap, link->active_tag);
33836013efd8STejun Heo 	if (qc->dev != dev || (qc->tf.command != ATA_CMD_FLUSH_EXT &&
33846013efd8STejun Heo 			       qc->tf.command != ATA_CMD_FLUSH))
33856013efd8STejun Heo 		return 0;
33866013efd8STejun Heo 
33876013efd8STejun Heo 	/* if the device failed it, it should be reported to upper layers */
33886013efd8STejun Heo 	if (qc->err_mask & AC_ERR_DEV)
33896013efd8STejun Heo 		return 0;
33906013efd8STejun Heo 
33916013efd8STejun Heo 	/* flush failed for some other reason, give it another shot */
33926013efd8STejun Heo 	ata_tf_init(dev, &tf);
33936013efd8STejun Heo 
33946013efd8STejun Heo 	tf.command = qc->tf.command;
33956013efd8STejun Heo 	tf.flags |= ATA_TFLAG_DEVICE;
33966013efd8STejun Heo 	tf.protocol = ATA_PROT_NODATA;
33976013efd8STejun Heo 
3398a9a79dfeSJoe Perches 	ata_dev_warn(dev, "retrying FLUSH 0x%x Emask 0x%x\n",
33996013efd8STejun Heo 		       tf.command, qc->err_mask);
34006013efd8STejun Heo 
34016013efd8STejun Heo 	err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
34026013efd8STejun Heo 	if (!err_mask) {
34036013efd8STejun Heo 		/*
34046013efd8STejun Heo 		 * FLUSH is complete but there's no way to
34056013efd8STejun Heo 		 * successfully complete a failed command from EH.
34066013efd8STejun Heo 		 * Making sure retry is allowed at least once and
34076013efd8STejun Heo 		 * retrying it should do the trick - whatever was in
34086013efd8STejun Heo 		 * the cache is already on the platter and this won't
34096013efd8STejun Heo 		 * cause infinite loop.
34106013efd8STejun Heo 		 */
34116013efd8STejun Heo 		qc->scsicmd->allowed = max(qc->scsicmd->allowed, 1);
34126013efd8STejun Heo 	} else {
3413a9a79dfeSJoe Perches 		ata_dev_warn(dev, "FLUSH failed Emask 0x%x\n",
34146013efd8STejun Heo 			       err_mask);
34156013efd8STejun Heo 		rc = -EIO;
34166013efd8STejun Heo 
34176013efd8STejun Heo 		/* if device failed it, report it to upper layers */
34186013efd8STejun Heo 		if (err_mask & AC_ERR_DEV) {
34196013efd8STejun Heo 			qc->err_mask |= AC_ERR_DEV;
34206013efd8STejun Heo 			qc->result_tf = tf;
34216013efd8STejun Heo 			if (!(ap->pflags & ATA_PFLAG_FROZEN))
34226013efd8STejun Heo 				rc = 0;
34236013efd8STejun Heo 		}
34246013efd8STejun Heo 	}
34256013efd8STejun Heo 	return rc;
34266013efd8STejun Heo }
34276013efd8STejun Heo 
34286b7ae954STejun Heo /**
34296b7ae954STejun Heo  *	ata_eh_set_lpm - configure SATA interface power management
34306b7ae954STejun Heo  *	@link: link to configure power management
34316b7ae954STejun Heo  *	@policy: the link power management policy
34326b7ae954STejun Heo  *	@r_failed_dev: out parameter for failed device
34336b7ae954STejun Heo  *
34346b7ae954STejun Heo  *	Enable SATA Interface power management.  This will enable
3435f4ac6476SHans de Goede  *	Device Interface Power Management (DIPM) for min_power and
3436f4ac6476SHans de Goede  *	medium_power_with_dipm policies, and then call driver specific
3437f4ac6476SHans de Goede  *	callbacks for enabling Host Initiated Power management.
34386b7ae954STejun Heo  *
34396b7ae954STejun Heo  *	LOCKING:
34406b7ae954STejun Heo  *	EH context.
34416b7ae954STejun Heo  *
34426b7ae954STejun Heo  *	RETURNS:
34436b7ae954STejun Heo  *	0 on success, -errno on failure.
34446b7ae954STejun Heo  */
34456b7ae954STejun Heo static int ata_eh_set_lpm(struct ata_link *link, enum ata_lpm_policy policy,
34466b7ae954STejun Heo 			  struct ata_device **r_failed_dev)
34476b7ae954STejun Heo {
34486c8ea89cSTejun Heo 	struct ata_port *ap = ata_is_host_link(link) ? link->ap : NULL;
34496b7ae954STejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
34506b7ae954STejun Heo 	struct ata_device *dev, *link_dev = NULL, *lpm_dev = NULL;
3451e5005b15STejun Heo 	enum ata_lpm_policy old_policy = link->lpm_policy;
34525f6f12ccSTejun Heo 	bool no_dipm = link->ap->flags & ATA_FLAG_NO_DIPM;
34536b7ae954STejun Heo 	unsigned int hints = ATA_LPM_EMPTY | ATA_LPM_HIPM;
34546b7ae954STejun Heo 	unsigned int err_mask;
34556b7ae954STejun Heo 	int rc;
34566b7ae954STejun Heo 
34576b7ae954STejun Heo 	/* if the link or host doesn't do LPM, noop */
34586b7ae954STejun Heo 	if ((link->flags & ATA_LFLAG_NO_LPM) || (ap && !ap->ops->set_lpm))
34596b7ae954STejun Heo 		return 0;
34606b7ae954STejun Heo 
34616b7ae954STejun Heo 	/*
34626b7ae954STejun Heo 	 * DIPM is enabled only for MIN_POWER as some devices
34636b7ae954STejun Heo 	 * misbehave when the host NACKs transition to SLUMBER.  Order
34646b7ae954STejun Heo 	 * device and link configurations such that the host always
34656b7ae954STejun Heo 	 * allows DIPM requests.
34666b7ae954STejun Heo 	 */
34676b7ae954STejun Heo 	ata_for_each_dev(dev, link, ENABLED) {
34686b7ae954STejun Heo 		bool hipm = ata_id_has_hipm(dev->id);
3469ae01b249STejun Heo 		bool dipm = ata_id_has_dipm(dev->id) && !no_dipm;
34706b7ae954STejun Heo 
34716b7ae954STejun Heo 		/* find the first enabled and LPM enabled devices */
34726b7ae954STejun Heo 		if (!link_dev)
34736b7ae954STejun Heo 			link_dev = dev;
34746b7ae954STejun Heo 
34756b7ae954STejun Heo 		if (!lpm_dev && (hipm || dipm))
34766b7ae954STejun Heo 			lpm_dev = dev;
34776b7ae954STejun Heo 
34786b7ae954STejun Heo 		hints &= ~ATA_LPM_EMPTY;
34796b7ae954STejun Heo 		if (!hipm)
34806b7ae954STejun Heo 			hints &= ~ATA_LPM_HIPM;
34816b7ae954STejun Heo 
34826b7ae954STejun Heo 		/* disable DIPM before changing link config */
3483f4ac6476SHans de Goede 		if (policy < ATA_LPM_MED_POWER_WITH_DIPM && dipm) {
34846b7ae954STejun Heo 			err_mask = ata_dev_set_feature(dev,
34856b7ae954STejun Heo 					SETFEATURES_SATA_DISABLE, SATA_DIPM);
34866b7ae954STejun Heo 			if (err_mask && err_mask != AC_ERR_DEV) {
3487a9a79dfeSJoe Perches 				ata_dev_warn(dev,
34886b7ae954STejun Heo 					     "failed to disable DIPM, Emask 0x%x\n",
34896b7ae954STejun Heo 					     err_mask);
34906b7ae954STejun Heo 				rc = -EIO;
34916b7ae954STejun Heo 				goto fail;
34926b7ae954STejun Heo 			}
34936b7ae954STejun Heo 		}
34946b7ae954STejun Heo 	}
34956b7ae954STejun Heo 
34966c8ea89cSTejun Heo 	if (ap) {
34976b7ae954STejun Heo 		rc = ap->ops->set_lpm(link, policy, hints);
34986b7ae954STejun Heo 		if (!rc && ap->slave_link)
34996b7ae954STejun Heo 			rc = ap->ops->set_lpm(ap->slave_link, policy, hints);
35006c8ea89cSTejun Heo 	} else
35016c8ea89cSTejun Heo 		rc = sata_pmp_set_lpm(link, policy, hints);
35026b7ae954STejun Heo 
35036b7ae954STejun Heo 	/*
35046b7ae954STejun Heo 	 * Attribute link config failure to the first (LPM) enabled
35056b7ae954STejun Heo 	 * device on the link.
35066b7ae954STejun Heo 	 */
35076b7ae954STejun Heo 	if (rc) {
35086b7ae954STejun Heo 		if (rc == -EOPNOTSUPP) {
35096b7ae954STejun Heo 			link->flags |= ATA_LFLAG_NO_LPM;
35106b7ae954STejun Heo 			return 0;
35116b7ae954STejun Heo 		}
35126b7ae954STejun Heo 		dev = lpm_dev ? lpm_dev : link_dev;
35136b7ae954STejun Heo 		goto fail;
35146b7ae954STejun Heo 	}
35156b7ae954STejun Heo 
3516e5005b15STejun Heo 	/*
3517e5005b15STejun Heo 	 * Low level driver acked the transition.  Issue DIPM command
3518e5005b15STejun Heo 	 * with the new policy set.
3519e5005b15STejun Heo 	 */
3520e5005b15STejun Heo 	link->lpm_policy = policy;
3521e5005b15STejun Heo 	if (ap && ap->slave_link)
3522e5005b15STejun Heo 		ap->slave_link->lpm_policy = policy;
3523e5005b15STejun Heo 
35246b7ae954STejun Heo 	/* host config updated, enable DIPM if transitioning to MIN_POWER */
35256b7ae954STejun Heo 	ata_for_each_dev(dev, link, ENABLED) {
3526f4ac6476SHans de Goede 		if (policy >= ATA_LPM_MED_POWER_WITH_DIPM && !no_dipm &&
3527ae01b249STejun Heo 		    ata_id_has_dipm(dev->id)) {
35286b7ae954STejun Heo 			err_mask = ata_dev_set_feature(dev,
35296b7ae954STejun Heo 					SETFEATURES_SATA_ENABLE, SATA_DIPM);
35306b7ae954STejun Heo 			if (err_mask && err_mask != AC_ERR_DEV) {
3531a9a79dfeSJoe Perches 				ata_dev_warn(dev,
35326b7ae954STejun Heo 					"failed to enable DIPM, Emask 0x%x\n",
35336b7ae954STejun Heo 					err_mask);
35346b7ae954STejun Heo 				rc = -EIO;
35356b7ae954STejun Heo 				goto fail;
35366b7ae954STejun Heo 			}
35376b7ae954STejun Heo 		}
35386b7ae954STejun Heo 	}
35396b7ae954STejun Heo 
354009c5b480SGabriele Mazzotta 	link->last_lpm_change = jiffies;
354109c5b480SGabriele Mazzotta 	link->flags |= ATA_LFLAG_CHANGED;
354209c5b480SGabriele Mazzotta 
35436b7ae954STejun Heo 	return 0;
35446b7ae954STejun Heo 
35456b7ae954STejun Heo fail:
3546e5005b15STejun Heo 	/* restore the old policy */
3547e5005b15STejun Heo 	link->lpm_policy = old_policy;
3548e5005b15STejun Heo 	if (ap && ap->slave_link)
3549e5005b15STejun Heo 		ap->slave_link->lpm_policy = old_policy;
3550e5005b15STejun Heo 
35516b7ae954STejun Heo 	/* if no device or only one more chance is left, disable LPM */
35526b7ae954STejun Heo 	if (!dev || ehc->tries[dev->devno] <= 2) {
3553a9a79dfeSJoe Perches 		ata_link_warn(link, "disabling LPM on the link\n");
35546b7ae954STejun Heo 		link->flags |= ATA_LFLAG_NO_LPM;
35556b7ae954STejun Heo 	}
35566b7ae954STejun Heo 	if (r_failed_dev)
35576b7ae954STejun Heo 		*r_failed_dev = dev;
35586b7ae954STejun Heo 	return rc;
35596b7ae954STejun Heo }
35606b7ae954STejun Heo 
35618a745f1fSKristen Carlson Accardi int ata_link_nr_enabled(struct ata_link *link)
3562c6fd2807SJeff Garzik {
3563f58229f8STejun Heo 	struct ata_device *dev;
3564f58229f8STejun Heo 	int cnt = 0;
3565c6fd2807SJeff Garzik 
35661eca4365STejun Heo 	ata_for_each_dev(dev, link, ENABLED)
3567c6fd2807SJeff Garzik 		cnt++;
3568c6fd2807SJeff Garzik 	return cnt;
3569c6fd2807SJeff Garzik }
3570c6fd2807SJeff Garzik 
35710260731fSTejun Heo static int ata_link_nr_vacant(struct ata_link *link)
3572c6fd2807SJeff Garzik {
3573f58229f8STejun Heo 	struct ata_device *dev;
3574f58229f8STejun Heo 	int cnt = 0;
3575c6fd2807SJeff Garzik 
35761eca4365STejun Heo 	ata_for_each_dev(dev, link, ALL)
3577f58229f8STejun Heo 		if (dev->class == ATA_DEV_UNKNOWN)
3578c6fd2807SJeff Garzik 			cnt++;
3579c6fd2807SJeff Garzik 	return cnt;
3580c6fd2807SJeff Garzik }
3581c6fd2807SJeff Garzik 
35820260731fSTejun Heo static int ata_eh_skip_recovery(struct ata_link *link)
3583c6fd2807SJeff Garzik {
3584672b2d65STejun Heo 	struct ata_port *ap = link->ap;
35850260731fSTejun Heo 	struct ata_eh_context *ehc = &link->eh_context;
3586f58229f8STejun Heo 	struct ata_device *dev;
3587c6fd2807SJeff Garzik 
3588f9df58cbSTejun Heo 	/* skip disabled links */
3589f9df58cbSTejun Heo 	if (link->flags & ATA_LFLAG_DISABLED)
3590f9df58cbSTejun Heo 		return 1;
3591f9df58cbSTejun Heo 
3592e2f3d75fSTejun Heo 	/* skip if explicitly requested */
3593e2f3d75fSTejun Heo 	if (ehc->i.flags & ATA_EHI_NO_RECOVERY)
3594e2f3d75fSTejun Heo 		return 1;
3595e2f3d75fSTejun Heo 
3596672b2d65STejun Heo 	/* thaw frozen port and recover failed devices */
3597672b2d65STejun Heo 	if ((ap->pflags & ATA_PFLAG_FROZEN) || ata_link_nr_enabled(link))
3598672b2d65STejun Heo 		return 0;
3599672b2d65STejun Heo 
3600672b2d65STejun Heo 	/* reset at least once if reset is requested */
3601672b2d65STejun Heo 	if ((ehc->i.action & ATA_EH_RESET) &&
3602672b2d65STejun Heo 	    !(ehc->i.flags & ATA_EHI_DID_RESET))
3603c6fd2807SJeff Garzik 		return 0;
3604c6fd2807SJeff Garzik 
3605c6fd2807SJeff Garzik 	/* skip if class codes for all vacant slots are ATA_DEV_NONE */
36061eca4365STejun Heo 	ata_for_each_dev(dev, link, ALL) {
3607c6fd2807SJeff Garzik 		if (dev->class == ATA_DEV_UNKNOWN &&
3608c6fd2807SJeff Garzik 		    ehc->classes[dev->devno] != ATA_DEV_NONE)
3609c6fd2807SJeff Garzik 			return 0;
3610c6fd2807SJeff Garzik 	}
3611c6fd2807SJeff Garzik 
3612c6fd2807SJeff Garzik 	return 1;
3613c6fd2807SJeff Garzik }
3614c6fd2807SJeff Garzik 
3615c2c7a89cSTejun Heo static int ata_count_probe_trials_cb(struct ata_ering_entry *ent, void *void_arg)
3616c2c7a89cSTejun Heo {
3617c2c7a89cSTejun Heo 	u64 interval = msecs_to_jiffies(ATA_EH_PROBE_TRIAL_INTERVAL);
3618c2c7a89cSTejun Heo 	u64 now = get_jiffies_64();
3619c2c7a89cSTejun Heo 	int *trials = void_arg;
3620c2c7a89cSTejun Heo 
36216868225eSLin Ming 	if ((ent->eflags & ATA_EFLAG_OLD_ER) ||
36226868225eSLin Ming 	    (ent->timestamp < now - min(now, interval)))
3623c2c7a89cSTejun Heo 		return -1;
3624c2c7a89cSTejun Heo 
3625c2c7a89cSTejun Heo 	(*trials)++;
3626c2c7a89cSTejun Heo 	return 0;
3627c2c7a89cSTejun Heo }
3628c2c7a89cSTejun Heo 
362902c05a27STejun Heo static int ata_eh_schedule_probe(struct ata_device *dev)
363002c05a27STejun Heo {
363102c05a27STejun Heo 	struct ata_eh_context *ehc = &dev->link->eh_context;
3632c2c7a89cSTejun Heo 	struct ata_link *link = ata_dev_phys_link(dev);
3633c2c7a89cSTejun Heo 	int trials = 0;
363402c05a27STejun Heo 
363502c05a27STejun Heo 	if (!(ehc->i.probe_mask & (1 << dev->devno)) ||
363602c05a27STejun Heo 	    (ehc->did_probe_mask & (1 << dev->devno)))
363702c05a27STejun Heo 		return 0;
363802c05a27STejun Heo 
363902c05a27STejun Heo 	ata_eh_detach_dev(dev);
364002c05a27STejun Heo 	ata_dev_init(dev);
364102c05a27STejun Heo 	ehc->did_probe_mask |= (1 << dev->devno);
3642cf480626STejun Heo 	ehc->i.action |= ATA_EH_RESET;
364300115e0fSTejun Heo 	ehc->saved_xfer_mode[dev->devno] = 0;
364400115e0fSTejun Heo 	ehc->saved_ncq_enabled &= ~(1 << dev->devno);
364502c05a27STejun Heo 
36466b7ae954STejun Heo 	/* the link maybe in a deep sleep, wake it up */
36476c8ea89cSTejun Heo 	if (link->lpm_policy > ATA_LPM_MAX_POWER) {
36486c8ea89cSTejun Heo 		if (ata_is_host_link(link))
36496c8ea89cSTejun Heo 			link->ap->ops->set_lpm(link, ATA_LPM_MAX_POWER,
36506c8ea89cSTejun Heo 					       ATA_LPM_EMPTY);
36516c8ea89cSTejun Heo 		else
36526c8ea89cSTejun Heo 			sata_pmp_set_lpm(link, ATA_LPM_MAX_POWER,
36536c8ea89cSTejun Heo 					 ATA_LPM_EMPTY);
36546c8ea89cSTejun Heo 	}
36556b7ae954STejun Heo 
3656c2c7a89cSTejun Heo 	/* Record and count probe trials on the ering.  The specific
3657c2c7a89cSTejun Heo 	 * error mask used is irrelevant.  Because a successful device
3658c2c7a89cSTejun Heo 	 * detection clears the ering, this count accumulates only if
3659c2c7a89cSTejun Heo 	 * there are consecutive failed probes.
3660c2c7a89cSTejun Heo 	 *
3661c2c7a89cSTejun Heo 	 * If the count is equal to or higher than ATA_EH_PROBE_TRIALS
3662c2c7a89cSTejun Heo 	 * in the last ATA_EH_PROBE_TRIAL_INTERVAL, link speed is
3663c2c7a89cSTejun Heo 	 * forced to 1.5Gbps.
3664c2c7a89cSTejun Heo 	 *
3665c2c7a89cSTejun Heo 	 * This is to work around cases where failed link speed
3666c2c7a89cSTejun Heo 	 * negotiation results in device misdetection leading to
3667c2c7a89cSTejun Heo 	 * infinite DEVXCHG or PHRDY CHG events.
3668c2c7a89cSTejun Heo 	 */
3669c2c7a89cSTejun Heo 	ata_ering_record(&dev->ering, 0, AC_ERR_OTHER);
3670c2c7a89cSTejun Heo 	ata_ering_map(&dev->ering, ata_count_probe_trials_cb, &trials);
3671c2c7a89cSTejun Heo 
3672c2c7a89cSTejun Heo 	if (trials > ATA_EH_PROBE_TRIALS)
3673c2c7a89cSTejun Heo 		sata_down_spd_limit(link, 1);
3674c2c7a89cSTejun Heo 
367502c05a27STejun Heo 	return 1;
367602c05a27STejun Heo }
367702c05a27STejun Heo 
36789b1e2658STejun Heo static int ata_eh_handle_dev_fail(struct ata_device *dev, int err)
3679fee7ca72STejun Heo {
36809af5c9c9STejun Heo 	struct ata_eh_context *ehc = &dev->link->eh_context;
3681fee7ca72STejun Heo 
3682cf9a590aSTejun Heo 	/* -EAGAIN from EH routine indicates retry without prejudice.
3683cf9a590aSTejun Heo 	 * The requester is responsible for ensuring forward progress.
3684cf9a590aSTejun Heo 	 */
3685cf9a590aSTejun Heo 	if (err != -EAGAIN)
3686fee7ca72STejun Heo 		ehc->tries[dev->devno]--;
3687fee7ca72STejun Heo 
3688fee7ca72STejun Heo 	switch (err) {
3689fee7ca72STejun Heo 	case -ENODEV:
3690fee7ca72STejun Heo 		/* device missing or wrong IDENTIFY data, schedule probing */
3691fee7ca72STejun Heo 		ehc->i.probe_mask |= (1 << dev->devno);
369205b83605SGustavo A. R. Silva 		/* fall through */
3693fee7ca72STejun Heo 	case -EINVAL:
3694fee7ca72STejun Heo 		/* give it just one more chance */
3695fee7ca72STejun Heo 		ehc->tries[dev->devno] = min(ehc->tries[dev->devno], 1);
369605b83605SGustavo A. R. Silva 		/* fall through */
3697fee7ca72STejun Heo 	case -EIO:
3698d89293abSTejun Heo 		if (ehc->tries[dev->devno] == 1) {
3699fee7ca72STejun Heo 			/* This is the last chance, better to slow
3700fee7ca72STejun Heo 			 * down than lose it.
3701fee7ca72STejun Heo 			 */
3702a07d499bSTejun Heo 			sata_down_spd_limit(ata_dev_phys_link(dev), 0);
3703d89293abSTejun Heo 			if (dev->pio_mode > XFER_PIO_0)
3704fee7ca72STejun Heo 				ata_down_xfermask_limit(dev, ATA_DNXFER_PIO);
3705fee7ca72STejun Heo 		}
3706fee7ca72STejun Heo 	}
3707fee7ca72STejun Heo 
3708fee7ca72STejun Heo 	if (ata_dev_enabled(dev) && !ehc->tries[dev->devno]) {
3709fee7ca72STejun Heo 		/* disable device if it has used up all its chances */
3710fee7ca72STejun Heo 		ata_dev_disable(dev);
3711fee7ca72STejun Heo 
3712fee7ca72STejun Heo 		/* detach if offline */
3713b1c72916STejun Heo 		if (ata_phys_link_offline(ata_dev_phys_link(dev)))
3714fee7ca72STejun Heo 			ata_eh_detach_dev(dev);
3715fee7ca72STejun Heo 
371602c05a27STejun Heo 		/* schedule probe if necessary */
371787fbc5a0STejun Heo 		if (ata_eh_schedule_probe(dev)) {
3718fee7ca72STejun Heo 			ehc->tries[dev->devno] = ATA_EH_DEV_TRIES;
371987fbc5a0STejun Heo 			memset(ehc->cmd_timeout_idx[dev->devno], 0,
372087fbc5a0STejun Heo 			       sizeof(ehc->cmd_timeout_idx[dev->devno]));
372187fbc5a0STejun Heo 		}
37229b1e2658STejun Heo 
37239b1e2658STejun Heo 		return 1;
3724fee7ca72STejun Heo 	} else {
3725cf480626STejun Heo 		ehc->i.action |= ATA_EH_RESET;
37269b1e2658STejun Heo 		return 0;
3727fee7ca72STejun Heo 	}
3728fee7ca72STejun Heo }
3729fee7ca72STejun Heo 
3730c6fd2807SJeff Garzik /**
3731c6fd2807SJeff Garzik  *	ata_eh_recover - recover host port after error
3732c6fd2807SJeff Garzik  *	@ap: host port to recover
3733c6fd2807SJeff Garzik  *	@prereset: prereset method (can be NULL)
3734c6fd2807SJeff Garzik  *	@softreset: softreset method (can be NULL)
3735c6fd2807SJeff Garzik  *	@hardreset: hardreset method (can be NULL)
3736c6fd2807SJeff Garzik  *	@postreset: postreset method (can be NULL)
37379b1e2658STejun Heo  *	@r_failed_link: out parameter for failed link
3738c6fd2807SJeff Garzik  *
3739c6fd2807SJeff Garzik  *	This is the alpha and omega, eum and yang, heart and soul of
3740c6fd2807SJeff Garzik  *	libata exception handling.  On entry, actions required to
37419b1e2658STejun Heo  *	recover each link and hotplug requests are recorded in the
37429b1e2658STejun Heo  *	link's eh_context.  This function executes all the operations
37439b1e2658STejun Heo  *	with appropriate retrials and fallbacks to resurrect failed
3744c6fd2807SJeff Garzik  *	devices, detach goners and greet newcomers.
3745c6fd2807SJeff Garzik  *
3746c6fd2807SJeff Garzik  *	LOCKING:
3747c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
3748c6fd2807SJeff Garzik  *
3749c6fd2807SJeff Garzik  *	RETURNS:
3750c6fd2807SJeff Garzik  *	0 on success, -errno on failure.
3751c6fd2807SJeff Garzik  */
3752fb7fd614STejun Heo int ata_eh_recover(struct ata_port *ap, ata_prereset_fn_t prereset,
3753c6fd2807SJeff Garzik 		   ata_reset_fn_t softreset, ata_reset_fn_t hardreset,
37549b1e2658STejun Heo 		   ata_postreset_fn_t postreset,
37559b1e2658STejun Heo 		   struct ata_link **r_failed_link)
3756c6fd2807SJeff Garzik {
37579b1e2658STejun Heo 	struct ata_link *link;
3758c6fd2807SJeff Garzik 	struct ata_device *dev;
37596b7ae954STejun Heo 	int rc, nr_fails;
376045fabbb7SElias Oltmanns 	unsigned long flags, deadline;
3761c6fd2807SJeff Garzik 
3762c6fd2807SJeff Garzik 	DPRINTK("ENTER\n");
3763c6fd2807SJeff Garzik 
3764c6fd2807SJeff Garzik 	/* prep for recovery */
37651eca4365STejun Heo 	ata_for_each_link(link, ap, EDGE) {
37669b1e2658STejun Heo 		struct ata_eh_context *ehc = &link->eh_context;
37679b1e2658STejun Heo 
3768f9df58cbSTejun Heo 		/* re-enable link? */
3769f9df58cbSTejun Heo 		if (ehc->i.action & ATA_EH_ENABLE_LINK) {
3770f9df58cbSTejun Heo 			ata_eh_about_to_do(link, NULL, ATA_EH_ENABLE_LINK);
3771f9df58cbSTejun Heo 			spin_lock_irqsave(ap->lock, flags);
3772f9df58cbSTejun Heo 			link->flags &= ~ATA_LFLAG_DISABLED;
3773f9df58cbSTejun Heo 			spin_unlock_irqrestore(ap->lock, flags);
3774f9df58cbSTejun Heo 			ata_eh_done(link, NULL, ATA_EH_ENABLE_LINK);
3775f9df58cbSTejun Heo 		}
3776f9df58cbSTejun Heo 
37771eca4365STejun Heo 		ata_for_each_dev(dev, link, ALL) {
3778fd995f70STejun Heo 			if (link->flags & ATA_LFLAG_NO_RETRY)
3779fd995f70STejun Heo 				ehc->tries[dev->devno] = 1;
3780fd995f70STejun Heo 			else
3781c6fd2807SJeff Garzik 				ehc->tries[dev->devno] = ATA_EH_DEV_TRIES;
3782c6fd2807SJeff Garzik 
378379a55b72STejun Heo 			/* collect port action mask recorded in dev actions */
37849b1e2658STejun Heo 			ehc->i.action |= ehc->i.dev_action[dev->devno] &
37859b1e2658STejun Heo 					 ~ATA_EH_PERDEV_MASK;
3786f58229f8STejun Heo 			ehc->i.dev_action[dev->devno] &= ATA_EH_PERDEV_MASK;
378779a55b72STejun Heo 
3788c6fd2807SJeff Garzik 			/* process hotplug request */
3789c6fd2807SJeff Garzik 			if (dev->flags & ATA_DFLAG_DETACH)
3790c6fd2807SJeff Garzik 				ata_eh_detach_dev(dev);
3791c6fd2807SJeff Garzik 
379202c05a27STejun Heo 			/* schedule probe if necessary */
379302c05a27STejun Heo 			if (!ata_dev_enabled(dev))
379402c05a27STejun Heo 				ata_eh_schedule_probe(dev);
3795c6fd2807SJeff Garzik 		}
37969b1e2658STejun Heo 	}
3797c6fd2807SJeff Garzik 
3798c6fd2807SJeff Garzik  retry:
3799c6fd2807SJeff Garzik 	rc = 0;
3800c6fd2807SJeff Garzik 
3801c6fd2807SJeff Garzik 	/* if UNLOADING, finish immediately */
3802c6fd2807SJeff Garzik 	if (ap->pflags & ATA_PFLAG_UNLOADING)
3803c6fd2807SJeff Garzik 		goto out;
3804c6fd2807SJeff Garzik 
38059b1e2658STejun Heo 	/* prep for EH */
38061eca4365STejun Heo 	ata_for_each_link(link, ap, EDGE) {
38079b1e2658STejun Heo 		struct ata_eh_context *ehc = &link->eh_context;
38089b1e2658STejun Heo 
3809c6fd2807SJeff Garzik 		/* skip EH if possible. */
38100260731fSTejun Heo 		if (ata_eh_skip_recovery(link))
3811c6fd2807SJeff Garzik 			ehc->i.action = 0;
3812c6fd2807SJeff Garzik 
38131eca4365STejun Heo 		ata_for_each_dev(dev, link, ALL)
3814f58229f8STejun Heo 			ehc->classes[dev->devno] = ATA_DEV_UNKNOWN;
38159b1e2658STejun Heo 	}
3816c6fd2807SJeff Garzik 
3817c6fd2807SJeff Garzik 	/* reset */
38181eca4365STejun Heo 	ata_for_each_link(link, ap, EDGE) {
38199b1e2658STejun Heo 		struct ata_eh_context *ehc = &link->eh_context;
38209b1e2658STejun Heo 
3821cf480626STejun Heo 		if (!(ehc->i.action & ATA_EH_RESET))
38229b1e2658STejun Heo 			continue;
38239b1e2658STejun Heo 
38249b1e2658STejun Heo 		rc = ata_eh_reset(link, ata_link_nr_vacant(link),
3825dc98c32cSTejun Heo 				  prereset, softreset, hardreset, postreset);
3826c6fd2807SJeff Garzik 		if (rc) {
3827a9a79dfeSJoe Perches 			ata_link_err(link, "reset failed, giving up\n");
3828c6fd2807SJeff Garzik 			goto out;
3829c6fd2807SJeff Garzik 		}
38309b1e2658STejun Heo 	}
3831c6fd2807SJeff Garzik 
383245fabbb7SElias Oltmanns 	do {
383345fabbb7SElias Oltmanns 		unsigned long now;
383445fabbb7SElias Oltmanns 
383545fabbb7SElias Oltmanns 		/*
383645fabbb7SElias Oltmanns 		 * clears ATA_EH_PARK in eh_info and resets
383745fabbb7SElias Oltmanns 		 * ap->park_req_pending
383845fabbb7SElias Oltmanns 		 */
383945fabbb7SElias Oltmanns 		ata_eh_pull_park_action(ap);
384045fabbb7SElias Oltmanns 
384145fabbb7SElias Oltmanns 		deadline = jiffies;
38421eca4365STejun Heo 		ata_for_each_link(link, ap, EDGE) {
38431eca4365STejun Heo 			ata_for_each_dev(dev, link, ALL) {
384445fabbb7SElias Oltmanns 				struct ata_eh_context *ehc = &link->eh_context;
384545fabbb7SElias Oltmanns 				unsigned long tmp;
384645fabbb7SElias Oltmanns 
38479162c657SHannes Reinecke 				if (dev->class != ATA_DEV_ATA &&
38489162c657SHannes Reinecke 				    dev->class != ATA_DEV_ZAC)
384945fabbb7SElias Oltmanns 					continue;
385045fabbb7SElias Oltmanns 				if (!(ehc->i.dev_action[dev->devno] &
385145fabbb7SElias Oltmanns 				      ATA_EH_PARK))
385245fabbb7SElias Oltmanns 					continue;
385345fabbb7SElias Oltmanns 				tmp = dev->unpark_deadline;
385445fabbb7SElias Oltmanns 				if (time_before(deadline, tmp))
385545fabbb7SElias Oltmanns 					deadline = tmp;
385645fabbb7SElias Oltmanns 				else if (time_before_eq(tmp, jiffies))
385745fabbb7SElias Oltmanns 					continue;
385845fabbb7SElias Oltmanns 				if (ehc->unloaded_mask & (1 << dev->devno))
385945fabbb7SElias Oltmanns 					continue;
386045fabbb7SElias Oltmanns 
386145fabbb7SElias Oltmanns 				ata_eh_park_issue_cmd(dev, 1);
386245fabbb7SElias Oltmanns 			}
386345fabbb7SElias Oltmanns 		}
386445fabbb7SElias Oltmanns 
386545fabbb7SElias Oltmanns 		now = jiffies;
386645fabbb7SElias Oltmanns 		if (time_before_eq(deadline, now))
386745fabbb7SElias Oltmanns 			break;
386845fabbb7SElias Oltmanns 
3869c0c362b6STejun Heo 		ata_eh_release(ap);
387045fabbb7SElias Oltmanns 		deadline = wait_for_completion_timeout(&ap->park_req_pending,
387145fabbb7SElias Oltmanns 						       deadline - now);
3872c0c362b6STejun Heo 		ata_eh_acquire(ap);
387345fabbb7SElias Oltmanns 	} while (deadline);
38741eca4365STejun Heo 	ata_for_each_link(link, ap, EDGE) {
38751eca4365STejun Heo 		ata_for_each_dev(dev, link, ALL) {
387645fabbb7SElias Oltmanns 			if (!(link->eh_context.unloaded_mask &
387745fabbb7SElias Oltmanns 			      (1 << dev->devno)))
387845fabbb7SElias Oltmanns 				continue;
387945fabbb7SElias Oltmanns 
388045fabbb7SElias Oltmanns 			ata_eh_park_issue_cmd(dev, 0);
388145fabbb7SElias Oltmanns 			ata_eh_done(link, dev, ATA_EH_PARK);
388245fabbb7SElias Oltmanns 		}
388345fabbb7SElias Oltmanns 	}
388445fabbb7SElias Oltmanns 
38859b1e2658STejun Heo 	/* the rest */
38866b7ae954STejun Heo 	nr_fails = 0;
38876b7ae954STejun Heo 	ata_for_each_link(link, ap, PMP_FIRST) {
38889b1e2658STejun Heo 		struct ata_eh_context *ehc = &link->eh_context;
38899b1e2658STejun Heo 
38906b7ae954STejun Heo 		if (sata_pmp_attached(ap) && ata_is_host_link(link))
38916b7ae954STejun Heo 			goto config_lpm;
38926b7ae954STejun Heo 
3893c6fd2807SJeff Garzik 		/* revalidate existing devices and attach new ones */
38940260731fSTejun Heo 		rc = ata_eh_revalidate_and_attach(link, &dev);
3895c6fd2807SJeff Garzik 		if (rc)
38966b7ae954STejun Heo 			goto rest_fail;
3897c6fd2807SJeff Garzik 
3898633273a3STejun Heo 		/* if PMP got attached, return, pmp EH will take care of it */
3899633273a3STejun Heo 		if (link->device->class == ATA_DEV_PMP) {
3900633273a3STejun Heo 			ehc->i.action = 0;
3901633273a3STejun Heo 			return 0;
3902633273a3STejun Heo 		}
3903633273a3STejun Heo 
3904baa1e78aSTejun Heo 		/* configure transfer mode if necessary */
3905baa1e78aSTejun Heo 		if (ehc->i.flags & ATA_EHI_SETMODE) {
39060260731fSTejun Heo 			rc = ata_set_mode(link, &dev);
39074ae72a1eSTejun Heo 			if (rc)
39086b7ae954STejun Heo 				goto rest_fail;
3909baa1e78aSTejun Heo 			ehc->i.flags &= ~ATA_EHI_SETMODE;
3910c6fd2807SJeff Garzik 		}
3911c6fd2807SJeff Garzik 
391211fc33daSTejun Heo 		/* If reset has been issued, clear UA to avoid
391311fc33daSTejun Heo 		 * disrupting the current users of the device.
391411fc33daSTejun Heo 		 */
391511fc33daSTejun Heo 		if (ehc->i.flags & ATA_EHI_DID_RESET) {
39161eca4365STejun Heo 			ata_for_each_dev(dev, link, ALL) {
391711fc33daSTejun Heo 				if (dev->class != ATA_DEV_ATAPI)
391811fc33daSTejun Heo 					continue;
391911fc33daSTejun Heo 				rc = atapi_eh_clear_ua(dev);
392011fc33daSTejun Heo 				if (rc)
39216b7ae954STejun Heo 					goto rest_fail;
392221334205SAaron Lu 				if (zpodd_dev_enabled(dev))
392321334205SAaron Lu 					zpodd_post_poweron(dev);
392411fc33daSTejun Heo 			}
392511fc33daSTejun Heo 		}
392611fc33daSTejun Heo 
39276013efd8STejun Heo 		/* retry flush if necessary */
39286013efd8STejun Heo 		ata_for_each_dev(dev, link, ALL) {
39299162c657SHannes Reinecke 			if (dev->class != ATA_DEV_ATA &&
39309162c657SHannes Reinecke 			    dev->class != ATA_DEV_ZAC)
39316013efd8STejun Heo 				continue;
39326013efd8STejun Heo 			rc = ata_eh_maybe_retry_flush(dev);
39336013efd8STejun Heo 			if (rc)
39346b7ae954STejun Heo 				goto rest_fail;
39356013efd8STejun Heo 		}
39366013efd8STejun Heo 
39376b7ae954STejun Heo 	config_lpm:
393811fc33daSTejun Heo 		/* configure link power saving */
39396b7ae954STejun Heo 		if (link->lpm_policy != ap->target_lpm_policy) {
39406b7ae954STejun Heo 			rc = ata_eh_set_lpm(link, ap->target_lpm_policy, &dev);
39416b7ae954STejun Heo 			if (rc)
39426b7ae954STejun Heo 				goto rest_fail;
39436b7ae954STejun Heo 		}
3944ca77329fSKristen Carlson Accardi 
39459b1e2658STejun Heo 		/* this link is okay now */
39469b1e2658STejun Heo 		ehc->i.flags = 0;
39479b1e2658STejun Heo 		continue;
3948c6fd2807SJeff Garzik 
39496b7ae954STejun Heo 	rest_fail:
39506b7ae954STejun Heo 		nr_fails++;
39516b7ae954STejun Heo 		if (dev)
39520a2c0f56STejun Heo 			ata_eh_handle_dev_fail(dev, rc);
3953c6fd2807SJeff Garzik 
3954b06ce3e5STejun Heo 		if (ap->pflags & ATA_PFLAG_FROZEN) {
3955b06ce3e5STejun Heo 			/* PMP reset requires working host port.
3956b06ce3e5STejun Heo 			 * Can't retry if it's frozen.
3957b06ce3e5STejun Heo 			 */
3958071f44b1STejun Heo 			if (sata_pmp_attached(ap))
3959b06ce3e5STejun Heo 				goto out;
39609b1e2658STejun Heo 			break;
39619b1e2658STejun Heo 		}
3962b06ce3e5STejun Heo 	}
39639b1e2658STejun Heo 
39646b7ae954STejun Heo 	if (nr_fails)
3965c6fd2807SJeff Garzik 		goto retry;
3966c6fd2807SJeff Garzik 
3967c6fd2807SJeff Garzik  out:
39689b1e2658STejun Heo 	if (rc && r_failed_link)
39699b1e2658STejun Heo 		*r_failed_link = link;
3970c6fd2807SJeff Garzik 
3971c6fd2807SJeff Garzik 	DPRINTK("EXIT, rc=%d\n", rc);
3972c6fd2807SJeff Garzik 	return rc;
3973c6fd2807SJeff Garzik }
3974c6fd2807SJeff Garzik 
3975c6fd2807SJeff Garzik /**
3976c6fd2807SJeff Garzik  *	ata_eh_finish - finish up EH
3977c6fd2807SJeff Garzik  *	@ap: host port to finish EH for
3978c6fd2807SJeff Garzik  *
3979c6fd2807SJeff Garzik  *	Recovery is complete.  Clean up EH states and retry or finish
3980c6fd2807SJeff Garzik  *	failed qcs.
3981c6fd2807SJeff Garzik  *
3982c6fd2807SJeff Garzik  *	LOCKING:
3983c6fd2807SJeff Garzik  *	None.
3984c6fd2807SJeff Garzik  */
3985fb7fd614STejun Heo void ata_eh_finish(struct ata_port *ap)
3986c6fd2807SJeff Garzik {
3987*258c4e5cSJens Axboe 	struct ata_queued_cmd *qc;
3988c6fd2807SJeff Garzik 	int tag;
3989c6fd2807SJeff Garzik 
3990c6fd2807SJeff Garzik 	/* retry or finish qcs */
3991*258c4e5cSJens Axboe 	ata_qc_for_each_raw(ap, qc, tag) {
3992c6fd2807SJeff Garzik 		if (!(qc->flags & ATA_QCFLAG_FAILED))
3993c6fd2807SJeff Garzik 			continue;
3994c6fd2807SJeff Garzik 
3995c6fd2807SJeff Garzik 		if (qc->err_mask) {
3996c6fd2807SJeff Garzik 			/* FIXME: Once EH migration is complete,
3997c6fd2807SJeff Garzik 			 * generate sense data in this function,
3998c6fd2807SJeff Garzik 			 * considering both err_mask and tf.
3999c6fd2807SJeff Garzik 			 */
400003faab78STejun Heo 			if (qc->flags & ATA_QCFLAG_RETRY)
4001c6fd2807SJeff Garzik 				ata_eh_qc_retry(qc);
400203faab78STejun Heo 			else
400303faab78STejun Heo 				ata_eh_qc_complete(qc);
4004c6fd2807SJeff Garzik 		} else {
4005c6fd2807SJeff Garzik 			if (qc->flags & ATA_QCFLAG_SENSE_VALID) {
4006c6fd2807SJeff Garzik 				ata_eh_qc_complete(qc);
4007c6fd2807SJeff Garzik 			} else {
4008c6fd2807SJeff Garzik 				/* feed zero TF to sense generation */
4009c6fd2807SJeff Garzik 				memset(&qc->result_tf, 0, sizeof(qc->result_tf));
4010c6fd2807SJeff Garzik 				ata_eh_qc_retry(qc);
4011c6fd2807SJeff Garzik 			}
4012c6fd2807SJeff Garzik 		}
4013c6fd2807SJeff Garzik 	}
4014da917d69STejun Heo 
4015da917d69STejun Heo 	/* make sure nr_active_links is zero after EH */
4016da917d69STejun Heo 	WARN_ON(ap->nr_active_links);
4017da917d69STejun Heo 	ap->nr_active_links = 0;
4018c6fd2807SJeff Garzik }
4019c6fd2807SJeff Garzik 
4020c6fd2807SJeff Garzik /**
4021c6fd2807SJeff Garzik  *	ata_do_eh - do standard error handling
4022c6fd2807SJeff Garzik  *	@ap: host port to handle error for
4023a1efdabaSTejun Heo  *
4024c6fd2807SJeff Garzik  *	@prereset: prereset method (can be NULL)
4025c6fd2807SJeff Garzik  *	@softreset: softreset method (can be NULL)
4026c6fd2807SJeff Garzik  *	@hardreset: hardreset method (can be NULL)
4027c6fd2807SJeff Garzik  *	@postreset: postreset method (can be NULL)
4028c6fd2807SJeff Garzik  *
4029c6fd2807SJeff Garzik  *	Perform standard error handling sequence.
4030c6fd2807SJeff Garzik  *
4031c6fd2807SJeff Garzik  *	LOCKING:
4032c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
4033c6fd2807SJeff Garzik  */
4034c6fd2807SJeff Garzik void ata_do_eh(struct ata_port *ap, ata_prereset_fn_t prereset,
4035c6fd2807SJeff Garzik 	       ata_reset_fn_t softreset, ata_reset_fn_t hardreset,
4036c6fd2807SJeff Garzik 	       ata_postreset_fn_t postreset)
4037c6fd2807SJeff Garzik {
40389b1e2658STejun Heo 	struct ata_device *dev;
40399b1e2658STejun Heo 	int rc;
40409b1e2658STejun Heo 
40419b1e2658STejun Heo 	ata_eh_autopsy(ap);
40429b1e2658STejun Heo 	ata_eh_report(ap);
40439b1e2658STejun Heo 
40449b1e2658STejun Heo 	rc = ata_eh_recover(ap, prereset, softreset, hardreset, postreset,
40459b1e2658STejun Heo 			    NULL);
40469b1e2658STejun Heo 	if (rc) {
40471eca4365STejun Heo 		ata_for_each_dev(dev, &ap->link, ALL)
40489b1e2658STejun Heo 			ata_dev_disable(dev);
40499b1e2658STejun Heo 	}
40509b1e2658STejun Heo 
4051c6fd2807SJeff Garzik 	ata_eh_finish(ap);
4052c6fd2807SJeff Garzik }
4053c6fd2807SJeff Garzik 
4054a1efdabaSTejun Heo /**
4055a1efdabaSTejun Heo  *	ata_std_error_handler - standard error handler
4056a1efdabaSTejun Heo  *	@ap: host port to handle error for
4057a1efdabaSTejun Heo  *
4058a1efdabaSTejun Heo  *	Standard error handler
4059a1efdabaSTejun Heo  *
4060a1efdabaSTejun Heo  *	LOCKING:
4061a1efdabaSTejun Heo  *	Kernel thread context (may sleep).
4062a1efdabaSTejun Heo  */
4063a1efdabaSTejun Heo void ata_std_error_handler(struct ata_port *ap)
4064a1efdabaSTejun Heo {
4065a1efdabaSTejun Heo 	struct ata_port_operations *ops = ap->ops;
4066a1efdabaSTejun Heo 	ata_reset_fn_t hardreset = ops->hardreset;
4067a1efdabaSTejun Heo 
406857c9efdfSTejun Heo 	/* ignore built-in hardreset if SCR access is not available */
4069fe06e5f9STejun Heo 	if (hardreset == sata_std_hardreset && !sata_scr_valid(&ap->link))
4070a1efdabaSTejun Heo 		hardreset = NULL;
4071a1efdabaSTejun Heo 
4072a1efdabaSTejun Heo 	ata_do_eh(ap, ops->prereset, ops->softreset, hardreset, ops->postreset);
4073a1efdabaSTejun Heo }
4074a1efdabaSTejun Heo 
40756ffa01d8STejun Heo #ifdef CONFIG_PM
4076c6fd2807SJeff Garzik /**
4077c6fd2807SJeff Garzik  *	ata_eh_handle_port_suspend - perform port suspend operation
4078c6fd2807SJeff Garzik  *	@ap: port to suspend
4079c6fd2807SJeff Garzik  *
4080c6fd2807SJeff Garzik  *	Suspend @ap.
4081c6fd2807SJeff Garzik  *
4082c6fd2807SJeff Garzik  *	LOCKING:
4083c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
4084c6fd2807SJeff Garzik  */
4085c6fd2807SJeff Garzik static void ata_eh_handle_port_suspend(struct ata_port *ap)
4086c6fd2807SJeff Garzik {
4087c6fd2807SJeff Garzik 	unsigned long flags;
4088c6fd2807SJeff Garzik 	int rc = 0;
40893dc67440SAaron Lu 	struct ata_device *dev;
4090c6fd2807SJeff Garzik 
4091c6fd2807SJeff Garzik 	/* are we suspending? */
4092c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
4093c6fd2807SJeff Garzik 	if (!(ap->pflags & ATA_PFLAG_PM_PENDING) ||
4094a7ff60dbSAaron Lu 	    ap->pm_mesg.event & PM_EVENT_RESUME) {
4095c6fd2807SJeff Garzik 		spin_unlock_irqrestore(ap->lock, flags);
4096c6fd2807SJeff Garzik 		return;
4097c6fd2807SJeff Garzik 	}
4098c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
4099c6fd2807SJeff Garzik 
4100c6fd2807SJeff Garzik 	WARN_ON(ap->pflags & ATA_PFLAG_SUSPENDED);
4101c6fd2807SJeff Garzik 
41023dc67440SAaron Lu 	/*
41033dc67440SAaron Lu 	 * If we have a ZPODD attached, check its zero
41043dc67440SAaron Lu 	 * power ready status before the port is frozen.
4105a7ff60dbSAaron Lu 	 * Only needed for runtime suspend.
41063dc67440SAaron Lu 	 */
4107a7ff60dbSAaron Lu 	if (PMSG_IS_AUTO(ap->pm_mesg)) {
41083dc67440SAaron Lu 		ata_for_each_dev(dev, &ap->link, ENABLED) {
41093dc67440SAaron Lu 			if (zpodd_dev_enabled(dev))
41103dc67440SAaron Lu 				zpodd_on_suspend(dev);
41113dc67440SAaron Lu 		}
4112a7ff60dbSAaron Lu 	}
41133dc67440SAaron Lu 
411464578a3dSTejun Heo 	/* tell ACPI we're suspending */
411564578a3dSTejun Heo 	rc = ata_acpi_on_suspend(ap);
411664578a3dSTejun Heo 	if (rc)
411764578a3dSTejun Heo 		goto out;
411864578a3dSTejun Heo 
4119c6fd2807SJeff Garzik 	/* suspend */
4120c6fd2807SJeff Garzik 	ata_eh_freeze_port(ap);
4121c6fd2807SJeff Garzik 
4122c6fd2807SJeff Garzik 	if (ap->ops->port_suspend)
4123c6fd2807SJeff Garzik 		rc = ap->ops->port_suspend(ap, ap->pm_mesg);
4124c6fd2807SJeff Garzik 
4125a7ff60dbSAaron Lu 	ata_acpi_set_state(ap, ap->pm_mesg);
412664578a3dSTejun Heo  out:
4127bc6e7c4bSDan Williams 	/* update the flags */
4128c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
4129c6fd2807SJeff Garzik 
4130c6fd2807SJeff Garzik 	ap->pflags &= ~ATA_PFLAG_PM_PENDING;
4131c6fd2807SJeff Garzik 	if (rc == 0)
4132c6fd2807SJeff Garzik 		ap->pflags |= ATA_PFLAG_SUSPENDED;
413364578a3dSTejun Heo 	else if (ap->pflags & ATA_PFLAG_FROZEN)
4134c6fd2807SJeff Garzik 		ata_port_schedule_eh(ap);
4135c6fd2807SJeff Garzik 
4136c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
4137c6fd2807SJeff Garzik 
4138c6fd2807SJeff Garzik 	return;
4139c6fd2807SJeff Garzik }
4140c6fd2807SJeff Garzik 
4141c6fd2807SJeff Garzik /**
4142c6fd2807SJeff Garzik  *	ata_eh_handle_port_resume - perform port resume operation
4143c6fd2807SJeff Garzik  *	@ap: port to resume
4144c6fd2807SJeff Garzik  *
4145c6fd2807SJeff Garzik  *	Resume @ap.
4146c6fd2807SJeff Garzik  *
4147c6fd2807SJeff Garzik  *	LOCKING:
4148c6fd2807SJeff Garzik  *	Kernel thread context (may sleep).
4149c6fd2807SJeff Garzik  */
4150c6fd2807SJeff Garzik static void ata_eh_handle_port_resume(struct ata_port *ap)
4151c6fd2807SJeff Garzik {
41526f9c1ea2STejun Heo 	struct ata_link *link;
41536f9c1ea2STejun Heo 	struct ata_device *dev;
4154c6fd2807SJeff Garzik 	unsigned long flags;
4155c6fd2807SJeff Garzik 
4156c6fd2807SJeff Garzik 	/* are we resuming? */
4157c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
4158c6fd2807SJeff Garzik 	if (!(ap->pflags & ATA_PFLAG_PM_PENDING) ||
4159a7ff60dbSAaron Lu 	    !(ap->pm_mesg.event & PM_EVENT_RESUME)) {
4160c6fd2807SJeff Garzik 		spin_unlock_irqrestore(ap->lock, flags);
4161c6fd2807SJeff Garzik 		return;
4162c6fd2807SJeff Garzik 	}
4163c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
4164c6fd2807SJeff Garzik 
41659666f400STejun Heo 	WARN_ON(!(ap->pflags & ATA_PFLAG_SUSPENDED));
4166c6fd2807SJeff Garzik 
41676f9c1ea2STejun Heo 	/*
41686f9c1ea2STejun Heo 	 * Error timestamps are in jiffies which doesn't run while
41696f9c1ea2STejun Heo 	 * suspended and PHY events during resume isn't too uncommon.
41706f9c1ea2STejun Heo 	 * When the two are combined, it can lead to unnecessary speed
41716f9c1ea2STejun Heo 	 * downs if the machine is suspended and resumed repeatedly.
41726f9c1ea2STejun Heo 	 * Clear error history.
41736f9c1ea2STejun Heo 	 */
41746f9c1ea2STejun Heo 	ata_for_each_link(link, ap, HOST_FIRST)
41756f9c1ea2STejun Heo 		ata_for_each_dev(dev, link, ALL)
41766f9c1ea2STejun Heo 			ata_ering_clear(&dev->ering);
41776f9c1ea2STejun Heo 
4178a7ff60dbSAaron Lu 	ata_acpi_set_state(ap, ap->pm_mesg);
4179bd3adca5SShaohua Li 
4180c6fd2807SJeff Garzik 	if (ap->ops->port_resume)
4181ae867937SKefeng Wang 		ap->ops->port_resume(ap);
4182c6fd2807SJeff Garzik 
41836746544cSTejun Heo 	/* tell ACPI that we're resuming */
41846746544cSTejun Heo 	ata_acpi_on_resume(ap);
41856746544cSTejun Heo 
4186bc6e7c4bSDan Williams 	/* update the flags */
4187c6fd2807SJeff Garzik 	spin_lock_irqsave(ap->lock, flags);
4188c6fd2807SJeff Garzik 	ap->pflags &= ~(ATA_PFLAG_PM_PENDING | ATA_PFLAG_SUSPENDED);
4189c6fd2807SJeff Garzik 	spin_unlock_irqrestore(ap->lock, flags);
4190c6fd2807SJeff Garzik }
41916ffa01d8STejun Heo #endif /* CONFIG_PM */
4192