xref: /openbmc/linux/drivers/ata/libata-eh.c (revision dea54fba)
1 /*
2  *  libata-eh.c - libata error handling
3  *
4  *  Maintained by:  Tejun Heo <tj@kernel.org>
5  *    		    Please ALWAYS copy linux-ide@vger.kernel.org
6  *		    on emails.
7  *
8  *  Copyright 2006 Tejun Heo <htejun@gmail.com>
9  *
10  *
11  *  This program is free software; you can redistribute it and/or
12  *  modify it under the terms of the GNU General Public License as
13  *  published by the Free Software Foundation; either version 2, or
14  *  (at your option) any later version.
15  *
16  *  This program is distributed in the hope that it will be useful,
17  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
18  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
19  *  General Public License for more details.
20  *
21  *  You should have received a copy of the GNU General Public License
22  *  along with this program; see the file COPYING.  If not, write to
23  *  the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139,
24  *  USA.
25  *
26  *
27  *  libata documentation is available via 'make {ps|pdf}docs',
28  *  as Documentation/driver-api/libata.rst
29  *
30  *  Hardware documentation available from http://www.t13.org/ and
31  *  http://www.sata-io.org/
32  *
33  */
34 
35 #include <linux/kernel.h>
36 #include <linux/blkdev.h>
37 #include <linux/export.h>
38 #include <linux/pci.h>
39 #include <scsi/scsi.h>
40 #include <scsi/scsi_host.h>
41 #include <scsi/scsi_eh.h>
42 #include <scsi/scsi_device.h>
43 #include <scsi/scsi_cmnd.h>
44 #include <scsi/scsi_dbg.h>
45 #include "../scsi/scsi_transport_api.h"
46 
47 #include <linux/libata.h>
48 
49 #include <trace/events/libata.h>
50 #include "libata.h"
51 
52 enum {
53 	/* speed down verdicts */
54 	ATA_EH_SPDN_NCQ_OFF		= (1 << 0),
55 	ATA_EH_SPDN_SPEED_DOWN		= (1 << 1),
56 	ATA_EH_SPDN_FALLBACK_TO_PIO	= (1 << 2),
57 	ATA_EH_SPDN_KEEP_ERRORS		= (1 << 3),
58 
59 	/* error flags */
60 	ATA_EFLAG_IS_IO			= (1 << 0),
61 	ATA_EFLAG_DUBIOUS_XFER		= (1 << 1),
62 	ATA_EFLAG_OLD_ER                = (1 << 31),
63 
64 	/* error categories */
65 	ATA_ECAT_NONE			= 0,
66 	ATA_ECAT_ATA_BUS		= 1,
67 	ATA_ECAT_TOUT_HSM		= 2,
68 	ATA_ECAT_UNK_DEV		= 3,
69 	ATA_ECAT_DUBIOUS_NONE		= 4,
70 	ATA_ECAT_DUBIOUS_ATA_BUS	= 5,
71 	ATA_ECAT_DUBIOUS_TOUT_HSM	= 6,
72 	ATA_ECAT_DUBIOUS_UNK_DEV	= 7,
73 	ATA_ECAT_NR			= 8,
74 
75 	ATA_EH_CMD_DFL_TIMEOUT		=  5000,
76 
77 	/* always put at least this amount of time between resets */
78 	ATA_EH_RESET_COOL_DOWN		=  5000,
79 
80 	/* Waiting in ->prereset can never be reliable.  It's
81 	 * sometimes nice to wait there but it can't be depended upon;
82 	 * otherwise, we wouldn't be resetting.  Just give it enough
83 	 * time for most drives to spin up.
84 	 */
85 	ATA_EH_PRERESET_TIMEOUT		= 10000,
86 	ATA_EH_FASTDRAIN_INTERVAL	=  3000,
87 
88 	ATA_EH_UA_TRIES			= 5,
89 
90 	/* probe speed down parameters, see ata_eh_schedule_probe() */
91 	ATA_EH_PROBE_TRIAL_INTERVAL	= 60000,	/* 1 min */
92 	ATA_EH_PROBE_TRIALS		= 2,
93 };
94 
95 /* The following table determines how we sequence resets.  Each entry
96  * represents timeout for that try.  The first try can be soft or
97  * hardreset.  All others are hardreset if available.  In most cases
98  * the first reset w/ 10sec timeout should succeed.  Following entries
99  * are mostly for error handling, hotplug and those outlier devices that
100  * take an exceptionally long time to recover from reset.
101  */
102 static const unsigned long ata_eh_reset_timeouts[] = {
103 	10000,	/* most drives spin up by 10sec */
104 	10000,	/* > 99% working drives spin up before 20sec */
105 	35000,	/* give > 30 secs of idleness for outlier devices */
106 	 5000,	/* and sweet one last chance */
107 	ULONG_MAX, /* > 1 min has elapsed, give up */
108 };
109 
110 static const unsigned long ata_eh_identify_timeouts[] = {
111 	 5000,	/* covers > 99% of successes and not too boring on failures */
112 	10000,  /* combined time till here is enough even for media access */
113 	30000,	/* for true idiots */
114 	ULONG_MAX,
115 };
116 
117 static const unsigned long ata_eh_flush_timeouts[] = {
118 	15000,	/* be generous with flush */
119 	15000,  /* ditto */
120 	30000,	/* and even more generous */
121 	ULONG_MAX,
122 };
123 
124 static const unsigned long ata_eh_other_timeouts[] = {
125 	 5000,	/* same rationale as identify timeout */
126 	10000,	/* ditto */
127 	/* but no merciful 30sec for other commands, it just isn't worth it */
128 	ULONG_MAX,
129 };
130 
131 struct ata_eh_cmd_timeout_ent {
132 	const u8		*commands;
133 	const unsigned long	*timeouts;
134 };
135 
136 /* The following table determines timeouts to use for EH internal
137  * commands.  Each table entry is a command class and matches the
138  * commands the entry applies to and the timeout table to use.
139  *
140  * On the retry after a command timed out, the next timeout value from
141  * the table is used.  If the table doesn't contain further entries,
142  * the last value is used.
143  *
144  * ehc->cmd_timeout_idx keeps track of which timeout to use per
145  * command class, so if SET_FEATURES times out on the first try, the
146  * next try will use the second timeout value only for that class.
147  */
148 #define CMDS(cmds...)	(const u8 []){ cmds, 0 }
149 static const struct ata_eh_cmd_timeout_ent
150 ata_eh_cmd_timeout_table[ATA_EH_CMD_TIMEOUT_TABLE_SIZE] = {
151 	{ .commands = CMDS(ATA_CMD_ID_ATA, ATA_CMD_ID_ATAPI),
152 	  .timeouts = ata_eh_identify_timeouts, },
153 	{ .commands = CMDS(ATA_CMD_READ_NATIVE_MAX, ATA_CMD_READ_NATIVE_MAX_EXT),
154 	  .timeouts = ata_eh_other_timeouts, },
155 	{ .commands = CMDS(ATA_CMD_SET_MAX, ATA_CMD_SET_MAX_EXT),
156 	  .timeouts = ata_eh_other_timeouts, },
157 	{ .commands = CMDS(ATA_CMD_SET_FEATURES),
158 	  .timeouts = ata_eh_other_timeouts, },
159 	{ .commands = CMDS(ATA_CMD_INIT_DEV_PARAMS),
160 	  .timeouts = ata_eh_other_timeouts, },
161 	{ .commands = CMDS(ATA_CMD_FLUSH, ATA_CMD_FLUSH_EXT),
162 	  .timeouts = ata_eh_flush_timeouts },
163 };
164 #undef CMDS
165 
166 static void __ata_port_freeze(struct ata_port *ap);
167 #ifdef CONFIG_PM
168 static void ata_eh_handle_port_suspend(struct ata_port *ap);
169 static void ata_eh_handle_port_resume(struct ata_port *ap);
170 #else /* CONFIG_PM */
171 static void ata_eh_handle_port_suspend(struct ata_port *ap)
172 { }
173 
174 static void ata_eh_handle_port_resume(struct ata_port *ap)
175 { }
176 #endif /* CONFIG_PM */
177 
178 static void __ata_ehi_pushv_desc(struct ata_eh_info *ehi, const char *fmt,
179 				 va_list args)
180 {
181 	ehi->desc_len += vscnprintf(ehi->desc + ehi->desc_len,
182 				     ATA_EH_DESC_LEN - ehi->desc_len,
183 				     fmt, args);
184 }
185 
186 /**
187  *	__ata_ehi_push_desc - push error description without adding separator
188  *	@ehi: target EHI
189  *	@fmt: printf format string
190  *
191  *	Format string according to @fmt and append it to @ehi->desc.
192  *
193  *	LOCKING:
194  *	spin_lock_irqsave(host lock)
195  */
196 void __ata_ehi_push_desc(struct ata_eh_info *ehi, const char *fmt, ...)
197 {
198 	va_list args;
199 
200 	va_start(args, fmt);
201 	__ata_ehi_pushv_desc(ehi, fmt, args);
202 	va_end(args);
203 }
204 
205 /**
206  *	ata_ehi_push_desc - push error description with separator
207  *	@ehi: target EHI
208  *	@fmt: printf format string
209  *
210  *	Format string according to @fmt and append it to @ehi->desc.
211  *	If @ehi->desc is not empty, ", " is added in-between.
212  *
213  *	LOCKING:
214  *	spin_lock_irqsave(host lock)
215  */
216 void ata_ehi_push_desc(struct ata_eh_info *ehi, const char *fmt, ...)
217 {
218 	va_list args;
219 
220 	if (ehi->desc_len)
221 		__ata_ehi_push_desc(ehi, ", ");
222 
223 	va_start(args, fmt);
224 	__ata_ehi_pushv_desc(ehi, fmt, args);
225 	va_end(args);
226 }
227 
228 /**
229  *	ata_ehi_clear_desc - clean error description
230  *	@ehi: target EHI
231  *
232  *	Clear @ehi->desc.
233  *
234  *	LOCKING:
235  *	spin_lock_irqsave(host lock)
236  */
237 void ata_ehi_clear_desc(struct ata_eh_info *ehi)
238 {
239 	ehi->desc[0] = '\0';
240 	ehi->desc_len = 0;
241 }
242 
243 /**
244  *	ata_port_desc - append port description
245  *	@ap: target ATA port
246  *	@fmt: printf format string
247  *
248  *	Format string according to @fmt and append it to port
249  *	description.  If port description is not empty, " " is added
250  *	in-between.  This function is to be used while initializing
251  *	ata_host.  The description is printed on host registration.
252  *
253  *	LOCKING:
254  *	None.
255  */
256 void ata_port_desc(struct ata_port *ap, const char *fmt, ...)
257 {
258 	va_list args;
259 
260 	WARN_ON(!(ap->pflags & ATA_PFLAG_INITIALIZING));
261 
262 	if (ap->link.eh_info.desc_len)
263 		__ata_ehi_push_desc(&ap->link.eh_info, " ");
264 
265 	va_start(args, fmt);
266 	__ata_ehi_pushv_desc(&ap->link.eh_info, fmt, args);
267 	va_end(args);
268 }
269 
270 #ifdef CONFIG_PCI
271 
272 /**
273  *	ata_port_pbar_desc - append PCI BAR description
274  *	@ap: target ATA port
275  *	@bar: target PCI BAR
276  *	@offset: offset into PCI BAR
277  *	@name: name of the area
278  *
279  *	If @offset is negative, this function formats a string which
280  *	contains the name, address, size and type of the BAR and
281  *	appends it to the port description.  If @offset is zero or
282  *	positive, only name and offsetted address is appended.
283  *
284  *	LOCKING:
285  *	None.
286  */
287 void ata_port_pbar_desc(struct ata_port *ap, int bar, ssize_t offset,
288 			const char *name)
289 {
290 	struct pci_dev *pdev = to_pci_dev(ap->host->dev);
291 	char *type = "";
292 	unsigned long long start, len;
293 
294 	if (pci_resource_flags(pdev, bar) & IORESOURCE_MEM)
295 		type = "m";
296 	else if (pci_resource_flags(pdev, bar) & IORESOURCE_IO)
297 		type = "i";
298 
299 	start = (unsigned long long)pci_resource_start(pdev, bar);
300 	len = (unsigned long long)pci_resource_len(pdev, bar);
301 
302 	if (offset < 0)
303 		ata_port_desc(ap, "%s %s%llu@0x%llx", name, type, len, start);
304 	else
305 		ata_port_desc(ap, "%s 0x%llx", name,
306 				start + (unsigned long long)offset);
307 }
308 
309 #endif /* CONFIG_PCI */
310 
311 static int ata_lookup_timeout_table(u8 cmd)
312 {
313 	int i;
314 
315 	for (i = 0; i < ATA_EH_CMD_TIMEOUT_TABLE_SIZE; i++) {
316 		const u8 *cur;
317 
318 		for (cur = ata_eh_cmd_timeout_table[i].commands; *cur; cur++)
319 			if (*cur == cmd)
320 				return i;
321 	}
322 
323 	return -1;
324 }
325 
326 /**
327  *	ata_internal_cmd_timeout - determine timeout for an internal command
328  *	@dev: target device
329  *	@cmd: internal command to be issued
330  *
331  *	Determine timeout for internal command @cmd for @dev.
332  *
333  *	LOCKING:
334  *	EH context.
335  *
336  *	RETURNS:
337  *	Determined timeout.
338  */
339 unsigned long ata_internal_cmd_timeout(struct ata_device *dev, u8 cmd)
340 {
341 	struct ata_eh_context *ehc = &dev->link->eh_context;
342 	int ent = ata_lookup_timeout_table(cmd);
343 	int idx;
344 
345 	if (ent < 0)
346 		return ATA_EH_CMD_DFL_TIMEOUT;
347 
348 	idx = ehc->cmd_timeout_idx[dev->devno][ent];
349 	return ata_eh_cmd_timeout_table[ent].timeouts[idx];
350 }
351 
352 /**
353  *	ata_internal_cmd_timed_out - notification for internal command timeout
354  *	@dev: target device
355  *	@cmd: internal command which timed out
356  *
357  *	Notify EH that internal command @cmd for @dev timed out.  This
358  *	function should be called only for commands whose timeouts are
359  *	determined using ata_internal_cmd_timeout().
360  *
361  *	LOCKING:
362  *	EH context.
363  */
364 void ata_internal_cmd_timed_out(struct ata_device *dev, u8 cmd)
365 {
366 	struct ata_eh_context *ehc = &dev->link->eh_context;
367 	int ent = ata_lookup_timeout_table(cmd);
368 	int idx;
369 
370 	if (ent < 0)
371 		return;
372 
373 	idx = ehc->cmd_timeout_idx[dev->devno][ent];
374 	if (ata_eh_cmd_timeout_table[ent].timeouts[idx + 1] != ULONG_MAX)
375 		ehc->cmd_timeout_idx[dev->devno][ent]++;
376 }
377 
378 static void ata_ering_record(struct ata_ering *ering, unsigned int eflags,
379 			     unsigned int err_mask)
380 {
381 	struct ata_ering_entry *ent;
382 
383 	WARN_ON(!err_mask);
384 
385 	ering->cursor++;
386 	ering->cursor %= ATA_ERING_SIZE;
387 
388 	ent = &ering->ring[ering->cursor];
389 	ent->eflags = eflags;
390 	ent->err_mask = err_mask;
391 	ent->timestamp = get_jiffies_64();
392 }
393 
394 static struct ata_ering_entry *ata_ering_top(struct ata_ering *ering)
395 {
396 	struct ata_ering_entry *ent = &ering->ring[ering->cursor];
397 
398 	if (ent->err_mask)
399 		return ent;
400 	return NULL;
401 }
402 
403 int ata_ering_map(struct ata_ering *ering,
404 		  int (*map_fn)(struct ata_ering_entry *, void *),
405 		  void *arg)
406 {
407 	int idx, rc = 0;
408 	struct ata_ering_entry *ent;
409 
410 	idx = ering->cursor;
411 	do {
412 		ent = &ering->ring[idx];
413 		if (!ent->err_mask)
414 			break;
415 		rc = map_fn(ent, arg);
416 		if (rc)
417 			break;
418 		idx = (idx - 1 + ATA_ERING_SIZE) % ATA_ERING_SIZE;
419 	} while (idx != ering->cursor);
420 
421 	return rc;
422 }
423 
424 static int ata_ering_clear_cb(struct ata_ering_entry *ent, void *void_arg)
425 {
426 	ent->eflags |= ATA_EFLAG_OLD_ER;
427 	return 0;
428 }
429 
430 static void ata_ering_clear(struct ata_ering *ering)
431 {
432 	ata_ering_map(ering, ata_ering_clear_cb, NULL);
433 }
434 
435 static unsigned int ata_eh_dev_action(struct ata_device *dev)
436 {
437 	struct ata_eh_context *ehc = &dev->link->eh_context;
438 
439 	return ehc->i.action | ehc->i.dev_action[dev->devno];
440 }
441 
442 static void ata_eh_clear_action(struct ata_link *link, struct ata_device *dev,
443 				struct ata_eh_info *ehi, unsigned int action)
444 {
445 	struct ata_device *tdev;
446 
447 	if (!dev) {
448 		ehi->action &= ~action;
449 		ata_for_each_dev(tdev, link, ALL)
450 			ehi->dev_action[tdev->devno] &= ~action;
451 	} else {
452 		/* doesn't make sense for port-wide EH actions */
453 		WARN_ON(!(action & ATA_EH_PERDEV_MASK));
454 
455 		/* break ehi->action into ehi->dev_action */
456 		if (ehi->action & action) {
457 			ata_for_each_dev(tdev, link, ALL)
458 				ehi->dev_action[tdev->devno] |=
459 					ehi->action & action;
460 			ehi->action &= ~action;
461 		}
462 
463 		/* turn off the specified per-dev action */
464 		ehi->dev_action[dev->devno] &= ~action;
465 	}
466 }
467 
468 /**
469  *	ata_eh_acquire - acquire EH ownership
470  *	@ap: ATA port to acquire EH ownership for
471  *
472  *	Acquire EH ownership for @ap.  This is the basic exclusion
473  *	mechanism for ports sharing a host.  Only one port hanging off
474  *	the same host can claim the ownership of EH.
475  *
476  *	LOCKING:
477  *	EH context.
478  */
479 void ata_eh_acquire(struct ata_port *ap)
480 {
481 	mutex_lock(&ap->host->eh_mutex);
482 	WARN_ON_ONCE(ap->host->eh_owner);
483 	ap->host->eh_owner = current;
484 }
485 
486 /**
487  *	ata_eh_release - release EH ownership
488  *	@ap: ATA port to release EH ownership for
489  *
490  *	Release EH ownership for @ap if the caller.  The caller must
491  *	have acquired EH ownership using ata_eh_acquire() previously.
492  *
493  *	LOCKING:
494  *	EH context.
495  */
496 void ata_eh_release(struct ata_port *ap)
497 {
498 	WARN_ON_ONCE(ap->host->eh_owner != current);
499 	ap->host->eh_owner = NULL;
500 	mutex_unlock(&ap->host->eh_mutex);
501 }
502 
503 /**
504  *	ata_scsi_timed_out - SCSI layer time out callback
505  *	@cmd: timed out SCSI command
506  *
507  *	Handles SCSI layer timeout.  We race with normal completion of
508  *	the qc for @cmd.  If the qc is already gone, we lose and let
509  *	the scsi command finish (EH_HANDLED).  Otherwise, the qc has
510  *	timed out and EH should be invoked.  Prevent ata_qc_complete()
511  *	from finishing it by setting EH_SCHEDULED and return
512  *	EH_NOT_HANDLED.
513  *
514  *	TODO: kill this function once old EH is gone.
515  *
516  *	LOCKING:
517  *	Called from timer context
518  *
519  *	RETURNS:
520  *	EH_HANDLED or EH_NOT_HANDLED
521  */
522 enum blk_eh_timer_return ata_scsi_timed_out(struct scsi_cmnd *cmd)
523 {
524 	struct Scsi_Host *host = cmd->device->host;
525 	struct ata_port *ap = ata_shost_to_port(host);
526 	unsigned long flags;
527 	struct ata_queued_cmd *qc;
528 	enum blk_eh_timer_return ret;
529 
530 	DPRINTK("ENTER\n");
531 
532 	if (ap->ops->error_handler) {
533 		ret = BLK_EH_NOT_HANDLED;
534 		goto out;
535 	}
536 
537 	ret = BLK_EH_HANDLED;
538 	spin_lock_irqsave(ap->lock, flags);
539 	qc = ata_qc_from_tag(ap, ap->link.active_tag);
540 	if (qc) {
541 		WARN_ON(qc->scsicmd != cmd);
542 		qc->flags |= ATA_QCFLAG_EH_SCHEDULED;
543 		qc->err_mask |= AC_ERR_TIMEOUT;
544 		ret = BLK_EH_NOT_HANDLED;
545 	}
546 	spin_unlock_irqrestore(ap->lock, flags);
547 
548  out:
549 	DPRINTK("EXIT, ret=%d\n", ret);
550 	return ret;
551 }
552 EXPORT_SYMBOL(ata_scsi_timed_out);
553 
554 static void ata_eh_unload(struct ata_port *ap)
555 {
556 	struct ata_link *link;
557 	struct ata_device *dev;
558 	unsigned long flags;
559 
560 	/* Restore SControl IPM and SPD for the next driver and
561 	 * disable attached devices.
562 	 */
563 	ata_for_each_link(link, ap, PMP_FIRST) {
564 		sata_scr_write(link, SCR_CONTROL, link->saved_scontrol & 0xff0);
565 		ata_for_each_dev(dev, link, ALL)
566 			ata_dev_disable(dev);
567 	}
568 
569 	/* freeze and set UNLOADED */
570 	spin_lock_irqsave(ap->lock, flags);
571 
572 	ata_port_freeze(ap);			/* won't be thawed */
573 	ap->pflags &= ~ATA_PFLAG_EH_PENDING;	/* clear pending from freeze */
574 	ap->pflags |= ATA_PFLAG_UNLOADED;
575 
576 	spin_unlock_irqrestore(ap->lock, flags);
577 }
578 
579 /**
580  *	ata_scsi_error - SCSI layer error handler callback
581  *	@host: SCSI host on which error occurred
582  *
583  *	Handles SCSI-layer-thrown error events.
584  *
585  *	LOCKING:
586  *	Inherited from SCSI layer (none, can sleep)
587  *
588  *	RETURNS:
589  *	Zero.
590  */
591 void ata_scsi_error(struct Scsi_Host *host)
592 {
593 	struct ata_port *ap = ata_shost_to_port(host);
594 	unsigned long flags;
595 	LIST_HEAD(eh_work_q);
596 
597 	DPRINTK("ENTER\n");
598 
599 	spin_lock_irqsave(host->host_lock, flags);
600 	list_splice_init(&host->eh_cmd_q, &eh_work_q);
601 	spin_unlock_irqrestore(host->host_lock, flags);
602 
603 	ata_scsi_cmd_error_handler(host, ap, &eh_work_q);
604 
605 	/* If we timed raced normal completion and there is nothing to
606 	   recover nr_timedout == 0 why exactly are we doing error recovery ? */
607 	ata_scsi_port_error_handler(host, ap);
608 
609 	/* finish or retry handled scmd's and clean up */
610 	WARN_ON(!list_empty(&eh_work_q));
611 
612 	DPRINTK("EXIT\n");
613 }
614 
615 /**
616  * ata_scsi_cmd_error_handler - error callback for a list of commands
617  * @host:	scsi host containing the port
618  * @ap:		ATA port within the host
619  * @eh_work_q:	list of commands to process
620  *
621  * process the given list of commands and return those finished to the
622  * ap->eh_done_q.  This function is the first part of the libata error
623  * handler which processes a given list of failed commands.
624  */
625 void ata_scsi_cmd_error_handler(struct Scsi_Host *host, struct ata_port *ap,
626 				struct list_head *eh_work_q)
627 {
628 	int i;
629 	unsigned long flags;
630 
631 	/* make sure sff pio task is not running */
632 	ata_sff_flush_pio_task(ap);
633 
634 	/* synchronize with host lock and sort out timeouts */
635 
636 	/* For new EH, all qcs are finished in one of three ways -
637 	 * normal completion, error completion, and SCSI timeout.
638 	 * Both completions can race against SCSI timeout.  When normal
639 	 * completion wins, the qc never reaches EH.  When error
640 	 * completion wins, the qc has ATA_QCFLAG_FAILED set.
641 	 *
642 	 * When SCSI timeout wins, things are a bit more complex.
643 	 * Normal or error completion can occur after the timeout but
644 	 * before this point.  In such cases, both types of
645 	 * completions are honored.  A scmd is determined to have
646 	 * timed out iff its associated qc is active and not failed.
647 	 */
648 	if (ap->ops->error_handler) {
649 		struct scsi_cmnd *scmd, *tmp;
650 		int nr_timedout = 0;
651 
652 		spin_lock_irqsave(ap->lock, flags);
653 
654 		/* This must occur under the ap->lock as we don't want
655 		   a polled recovery to race the real interrupt handler
656 
657 		   The lost_interrupt handler checks for any completed but
658 		   non-notified command and completes much like an IRQ handler.
659 
660 		   We then fall into the error recovery code which will treat
661 		   this as if normal completion won the race */
662 
663 		if (ap->ops->lost_interrupt)
664 			ap->ops->lost_interrupt(ap);
665 
666 		list_for_each_entry_safe(scmd, tmp, eh_work_q, eh_entry) {
667 			struct ata_queued_cmd *qc;
668 
669 			for (i = 0; i < ATA_MAX_QUEUE; i++) {
670 				qc = __ata_qc_from_tag(ap, i);
671 				if (qc->flags & ATA_QCFLAG_ACTIVE &&
672 				    qc->scsicmd == scmd)
673 					break;
674 			}
675 
676 			if (i < ATA_MAX_QUEUE) {
677 				/* the scmd has an associated qc */
678 				if (!(qc->flags & ATA_QCFLAG_FAILED)) {
679 					/* which hasn't failed yet, timeout */
680 					qc->err_mask |= AC_ERR_TIMEOUT;
681 					qc->flags |= ATA_QCFLAG_FAILED;
682 					nr_timedout++;
683 				}
684 			} else {
685 				/* Normal completion occurred after
686 				 * SCSI timeout but before this point.
687 				 * Successfully complete it.
688 				 */
689 				scmd->retries = scmd->allowed;
690 				scsi_eh_finish_cmd(scmd, &ap->eh_done_q);
691 			}
692 		}
693 
694 		/* If we have timed out qcs.  They belong to EH from
695 		 * this point but the state of the controller is
696 		 * unknown.  Freeze the port to make sure the IRQ
697 		 * handler doesn't diddle with those qcs.  This must
698 		 * be done atomically w.r.t. setting QCFLAG_FAILED.
699 		 */
700 		if (nr_timedout)
701 			__ata_port_freeze(ap);
702 
703 		spin_unlock_irqrestore(ap->lock, flags);
704 
705 		/* initialize eh_tries */
706 		ap->eh_tries = ATA_EH_MAX_TRIES;
707 	} else
708 		spin_unlock_wait(ap->lock);
709 
710 }
711 EXPORT_SYMBOL(ata_scsi_cmd_error_handler);
712 
713 /**
714  * ata_scsi_port_error_handler - recover the port after the commands
715  * @host:	SCSI host containing the port
716  * @ap:		the ATA port
717  *
718  * Handle the recovery of the port @ap after all the commands
719  * have been recovered.
720  */
721 void ata_scsi_port_error_handler(struct Scsi_Host *host, struct ata_port *ap)
722 {
723 	unsigned long flags;
724 
725 	/* invoke error handler */
726 	if (ap->ops->error_handler) {
727 		struct ata_link *link;
728 
729 		/* acquire EH ownership */
730 		ata_eh_acquire(ap);
731  repeat:
732 		/* kill fast drain timer */
733 		del_timer_sync(&ap->fastdrain_timer);
734 
735 		/* process port resume request */
736 		ata_eh_handle_port_resume(ap);
737 
738 		/* fetch & clear EH info */
739 		spin_lock_irqsave(ap->lock, flags);
740 
741 		ata_for_each_link(link, ap, HOST_FIRST) {
742 			struct ata_eh_context *ehc = &link->eh_context;
743 			struct ata_device *dev;
744 
745 			memset(&link->eh_context, 0, sizeof(link->eh_context));
746 			link->eh_context.i = link->eh_info;
747 			memset(&link->eh_info, 0, sizeof(link->eh_info));
748 
749 			ata_for_each_dev(dev, link, ENABLED) {
750 				int devno = dev->devno;
751 
752 				ehc->saved_xfer_mode[devno] = dev->xfer_mode;
753 				if (ata_ncq_enabled(dev))
754 					ehc->saved_ncq_enabled |= 1 << devno;
755 			}
756 		}
757 
758 		ap->pflags |= ATA_PFLAG_EH_IN_PROGRESS;
759 		ap->pflags &= ~ATA_PFLAG_EH_PENDING;
760 		ap->excl_link = NULL;	/* don't maintain exclusion over EH */
761 
762 		spin_unlock_irqrestore(ap->lock, flags);
763 
764 		/* invoke EH, skip if unloading or suspended */
765 		if (!(ap->pflags & (ATA_PFLAG_UNLOADING | ATA_PFLAG_SUSPENDED)))
766 			ap->ops->error_handler(ap);
767 		else {
768 			/* if unloading, commence suicide */
769 			if ((ap->pflags & ATA_PFLAG_UNLOADING) &&
770 			    !(ap->pflags & ATA_PFLAG_UNLOADED))
771 				ata_eh_unload(ap);
772 			ata_eh_finish(ap);
773 		}
774 
775 		/* process port suspend request */
776 		ata_eh_handle_port_suspend(ap);
777 
778 		/* Exception might have happened after ->error_handler
779 		 * recovered the port but before this point.  Repeat
780 		 * EH in such case.
781 		 */
782 		spin_lock_irqsave(ap->lock, flags);
783 
784 		if (ap->pflags & ATA_PFLAG_EH_PENDING) {
785 			if (--ap->eh_tries) {
786 				spin_unlock_irqrestore(ap->lock, flags);
787 				goto repeat;
788 			}
789 			ata_port_err(ap,
790 				     "EH pending after %d tries, giving up\n",
791 				     ATA_EH_MAX_TRIES);
792 			ap->pflags &= ~ATA_PFLAG_EH_PENDING;
793 		}
794 
795 		/* this run is complete, make sure EH info is clear */
796 		ata_for_each_link(link, ap, HOST_FIRST)
797 			memset(&link->eh_info, 0, sizeof(link->eh_info));
798 
799 		/* end eh (clear host_eh_scheduled) while holding
800 		 * ap->lock such that if exception occurs after this
801 		 * point but before EH completion, SCSI midlayer will
802 		 * re-initiate EH.
803 		 */
804 		ap->ops->end_eh(ap);
805 
806 		spin_unlock_irqrestore(ap->lock, flags);
807 		ata_eh_release(ap);
808 	} else {
809 		WARN_ON(ata_qc_from_tag(ap, ap->link.active_tag) == NULL);
810 		ap->ops->eng_timeout(ap);
811 	}
812 
813 	scsi_eh_flush_done_q(&ap->eh_done_q);
814 
815 	/* clean up */
816 	spin_lock_irqsave(ap->lock, flags);
817 
818 	if (ap->pflags & ATA_PFLAG_LOADING)
819 		ap->pflags &= ~ATA_PFLAG_LOADING;
820 	else if (ap->pflags & ATA_PFLAG_SCSI_HOTPLUG)
821 		schedule_delayed_work(&ap->hotplug_task, 0);
822 
823 	if (ap->pflags & ATA_PFLAG_RECOVERED)
824 		ata_port_info(ap, "EH complete\n");
825 
826 	ap->pflags &= ~(ATA_PFLAG_SCSI_HOTPLUG | ATA_PFLAG_RECOVERED);
827 
828 	/* tell wait_eh that we're done */
829 	ap->pflags &= ~ATA_PFLAG_EH_IN_PROGRESS;
830 	wake_up_all(&ap->eh_wait_q);
831 
832 	spin_unlock_irqrestore(ap->lock, flags);
833 }
834 EXPORT_SYMBOL_GPL(ata_scsi_port_error_handler);
835 
836 /**
837  *	ata_port_wait_eh - Wait for the currently pending EH to complete
838  *	@ap: Port to wait EH for
839  *
840  *	Wait until the currently pending EH is complete.
841  *
842  *	LOCKING:
843  *	Kernel thread context (may sleep).
844  */
845 void ata_port_wait_eh(struct ata_port *ap)
846 {
847 	unsigned long flags;
848 	DEFINE_WAIT(wait);
849 
850  retry:
851 	spin_lock_irqsave(ap->lock, flags);
852 
853 	while (ap->pflags & (ATA_PFLAG_EH_PENDING | ATA_PFLAG_EH_IN_PROGRESS)) {
854 		prepare_to_wait(&ap->eh_wait_q, &wait, TASK_UNINTERRUPTIBLE);
855 		spin_unlock_irqrestore(ap->lock, flags);
856 		schedule();
857 		spin_lock_irqsave(ap->lock, flags);
858 	}
859 	finish_wait(&ap->eh_wait_q, &wait);
860 
861 	spin_unlock_irqrestore(ap->lock, flags);
862 
863 	/* make sure SCSI EH is complete */
864 	if (scsi_host_in_recovery(ap->scsi_host)) {
865 		ata_msleep(ap, 10);
866 		goto retry;
867 	}
868 }
869 EXPORT_SYMBOL_GPL(ata_port_wait_eh);
870 
871 static int ata_eh_nr_in_flight(struct ata_port *ap)
872 {
873 	unsigned int tag;
874 	int nr = 0;
875 
876 	/* count only non-internal commands */
877 	for (tag = 0; tag < ATA_MAX_QUEUE - 1; tag++)
878 		if (ata_qc_from_tag(ap, tag))
879 			nr++;
880 
881 	return nr;
882 }
883 
884 void ata_eh_fastdrain_timerfn(unsigned long arg)
885 {
886 	struct ata_port *ap = (void *)arg;
887 	unsigned long flags;
888 	int cnt;
889 
890 	spin_lock_irqsave(ap->lock, flags);
891 
892 	cnt = ata_eh_nr_in_flight(ap);
893 
894 	/* are we done? */
895 	if (!cnt)
896 		goto out_unlock;
897 
898 	if (cnt == ap->fastdrain_cnt) {
899 		unsigned int tag;
900 
901 		/* No progress during the last interval, tag all
902 		 * in-flight qcs as timed out and freeze the port.
903 		 */
904 		for (tag = 0; tag < ATA_MAX_QUEUE - 1; tag++) {
905 			struct ata_queued_cmd *qc = ata_qc_from_tag(ap, tag);
906 			if (qc)
907 				qc->err_mask |= AC_ERR_TIMEOUT;
908 		}
909 
910 		ata_port_freeze(ap);
911 	} else {
912 		/* some qcs have finished, give it another chance */
913 		ap->fastdrain_cnt = cnt;
914 		ap->fastdrain_timer.expires =
915 			ata_deadline(jiffies, ATA_EH_FASTDRAIN_INTERVAL);
916 		add_timer(&ap->fastdrain_timer);
917 	}
918 
919  out_unlock:
920 	spin_unlock_irqrestore(ap->lock, flags);
921 }
922 
923 /**
924  *	ata_eh_set_pending - set ATA_PFLAG_EH_PENDING and activate fast drain
925  *	@ap: target ATA port
926  *	@fastdrain: activate fast drain
927  *
928  *	Set ATA_PFLAG_EH_PENDING and activate fast drain if @fastdrain
929  *	is non-zero and EH wasn't pending before.  Fast drain ensures
930  *	that EH kicks in in timely manner.
931  *
932  *	LOCKING:
933  *	spin_lock_irqsave(host lock)
934  */
935 static void ata_eh_set_pending(struct ata_port *ap, int fastdrain)
936 {
937 	int cnt;
938 
939 	/* already scheduled? */
940 	if (ap->pflags & ATA_PFLAG_EH_PENDING)
941 		return;
942 
943 	ap->pflags |= ATA_PFLAG_EH_PENDING;
944 
945 	if (!fastdrain)
946 		return;
947 
948 	/* do we have in-flight qcs? */
949 	cnt = ata_eh_nr_in_flight(ap);
950 	if (!cnt)
951 		return;
952 
953 	/* activate fast drain */
954 	ap->fastdrain_cnt = cnt;
955 	ap->fastdrain_timer.expires =
956 		ata_deadline(jiffies, ATA_EH_FASTDRAIN_INTERVAL);
957 	add_timer(&ap->fastdrain_timer);
958 }
959 
960 /**
961  *	ata_qc_schedule_eh - schedule qc for error handling
962  *	@qc: command to schedule error handling for
963  *
964  *	Schedule error handling for @qc.  EH will kick in as soon as
965  *	other commands are drained.
966  *
967  *	LOCKING:
968  *	spin_lock_irqsave(host lock)
969  */
970 void ata_qc_schedule_eh(struct ata_queued_cmd *qc)
971 {
972 	struct ata_port *ap = qc->ap;
973 	struct request_queue *q = qc->scsicmd->device->request_queue;
974 	unsigned long flags;
975 
976 	WARN_ON(!ap->ops->error_handler);
977 
978 	qc->flags |= ATA_QCFLAG_FAILED;
979 	ata_eh_set_pending(ap, 1);
980 
981 	/* The following will fail if timeout has already expired.
982 	 * ata_scsi_error() takes care of such scmds on EH entry.
983 	 * Note that ATA_QCFLAG_FAILED is unconditionally set after
984 	 * this function completes.
985 	 */
986 	spin_lock_irqsave(q->queue_lock, flags);
987 	blk_abort_request(qc->scsicmd->request);
988 	spin_unlock_irqrestore(q->queue_lock, flags);
989 }
990 
991 /**
992  * ata_std_sched_eh - non-libsas ata_ports issue eh with this common routine
993  * @ap: ATA port to schedule EH for
994  *
995  *	LOCKING: inherited from ata_port_schedule_eh
996  *	spin_lock_irqsave(host lock)
997  */
998 void ata_std_sched_eh(struct ata_port *ap)
999 {
1000 	WARN_ON(!ap->ops->error_handler);
1001 
1002 	if (ap->pflags & ATA_PFLAG_INITIALIZING)
1003 		return;
1004 
1005 	ata_eh_set_pending(ap, 1);
1006 	scsi_schedule_eh(ap->scsi_host);
1007 
1008 	DPRINTK("port EH scheduled\n");
1009 }
1010 EXPORT_SYMBOL_GPL(ata_std_sched_eh);
1011 
1012 /**
1013  * ata_std_end_eh - non-libsas ata_ports complete eh with this common routine
1014  * @ap: ATA port to end EH for
1015  *
1016  * In the libata object model there is a 1:1 mapping of ata_port to
1017  * shost, so host fields can be directly manipulated under ap->lock, in
1018  * the libsas case we need to hold a lock at the ha->level to coordinate
1019  * these events.
1020  *
1021  *	LOCKING:
1022  *	spin_lock_irqsave(host lock)
1023  */
1024 void ata_std_end_eh(struct ata_port *ap)
1025 {
1026 	struct Scsi_Host *host = ap->scsi_host;
1027 
1028 	host->host_eh_scheduled = 0;
1029 }
1030 EXPORT_SYMBOL(ata_std_end_eh);
1031 
1032 
1033 /**
1034  *	ata_port_schedule_eh - schedule error handling without a qc
1035  *	@ap: ATA port to schedule EH for
1036  *
1037  *	Schedule error handling for @ap.  EH will kick in as soon as
1038  *	all commands are drained.
1039  *
1040  *	LOCKING:
1041  *	spin_lock_irqsave(host lock)
1042  */
1043 void ata_port_schedule_eh(struct ata_port *ap)
1044 {
1045 	/* see: ata_std_sched_eh, unless you know better */
1046 	ap->ops->sched_eh(ap);
1047 }
1048 
1049 static int ata_do_link_abort(struct ata_port *ap, struct ata_link *link)
1050 {
1051 	int tag, nr_aborted = 0;
1052 
1053 	WARN_ON(!ap->ops->error_handler);
1054 
1055 	/* we're gonna abort all commands, no need for fast drain */
1056 	ata_eh_set_pending(ap, 0);
1057 
1058 	for (tag = 0; tag < ATA_MAX_QUEUE; tag++) {
1059 		struct ata_queued_cmd *qc = ata_qc_from_tag(ap, tag);
1060 
1061 		if (qc && (!link || qc->dev->link == link)) {
1062 			qc->flags |= ATA_QCFLAG_FAILED;
1063 			ata_qc_complete(qc);
1064 			nr_aborted++;
1065 		}
1066 	}
1067 
1068 	if (!nr_aborted)
1069 		ata_port_schedule_eh(ap);
1070 
1071 	return nr_aborted;
1072 }
1073 
1074 /**
1075  *	ata_link_abort - abort all qc's on the link
1076  *	@link: ATA link to abort qc's for
1077  *
1078  *	Abort all active qc's active on @link and schedule EH.
1079  *
1080  *	LOCKING:
1081  *	spin_lock_irqsave(host lock)
1082  *
1083  *	RETURNS:
1084  *	Number of aborted qc's.
1085  */
1086 int ata_link_abort(struct ata_link *link)
1087 {
1088 	return ata_do_link_abort(link->ap, link);
1089 }
1090 
1091 /**
1092  *	ata_port_abort - abort all qc's on the port
1093  *	@ap: ATA port to abort qc's for
1094  *
1095  *	Abort all active qc's of @ap and schedule EH.
1096  *
1097  *	LOCKING:
1098  *	spin_lock_irqsave(host_set lock)
1099  *
1100  *	RETURNS:
1101  *	Number of aborted qc's.
1102  */
1103 int ata_port_abort(struct ata_port *ap)
1104 {
1105 	return ata_do_link_abort(ap, NULL);
1106 }
1107 
1108 /**
1109  *	__ata_port_freeze - freeze port
1110  *	@ap: ATA port to freeze
1111  *
1112  *	This function is called when HSM violation or some other
1113  *	condition disrupts normal operation of the port.  Frozen port
1114  *	is not allowed to perform any operation until the port is
1115  *	thawed, which usually follows a successful reset.
1116  *
1117  *	ap->ops->freeze() callback can be used for freezing the port
1118  *	hardware-wise (e.g. mask interrupt and stop DMA engine).  If a
1119  *	port cannot be frozen hardware-wise, the interrupt handler
1120  *	must ack and clear interrupts unconditionally while the port
1121  *	is frozen.
1122  *
1123  *	LOCKING:
1124  *	spin_lock_irqsave(host lock)
1125  */
1126 static void __ata_port_freeze(struct ata_port *ap)
1127 {
1128 	WARN_ON(!ap->ops->error_handler);
1129 
1130 	if (ap->ops->freeze)
1131 		ap->ops->freeze(ap);
1132 
1133 	ap->pflags |= ATA_PFLAG_FROZEN;
1134 
1135 	DPRINTK("ata%u port frozen\n", ap->print_id);
1136 }
1137 
1138 /**
1139  *	ata_port_freeze - abort & freeze port
1140  *	@ap: ATA port to freeze
1141  *
1142  *	Abort and freeze @ap.  The freeze operation must be called
1143  *	first, because some hardware requires special operations
1144  *	before the taskfile registers are accessible.
1145  *
1146  *	LOCKING:
1147  *	spin_lock_irqsave(host lock)
1148  *
1149  *	RETURNS:
1150  *	Number of aborted commands.
1151  */
1152 int ata_port_freeze(struct ata_port *ap)
1153 {
1154 	int nr_aborted;
1155 
1156 	WARN_ON(!ap->ops->error_handler);
1157 
1158 	__ata_port_freeze(ap);
1159 	nr_aborted = ata_port_abort(ap);
1160 
1161 	return nr_aborted;
1162 }
1163 
1164 /**
1165  *	sata_async_notification - SATA async notification handler
1166  *	@ap: ATA port where async notification is received
1167  *
1168  *	Handler to be called when async notification via SDB FIS is
1169  *	received.  This function schedules EH if necessary.
1170  *
1171  *	LOCKING:
1172  *	spin_lock_irqsave(host lock)
1173  *
1174  *	RETURNS:
1175  *	1 if EH is scheduled, 0 otherwise.
1176  */
1177 int sata_async_notification(struct ata_port *ap)
1178 {
1179 	u32 sntf;
1180 	int rc;
1181 
1182 	if (!(ap->flags & ATA_FLAG_AN))
1183 		return 0;
1184 
1185 	rc = sata_scr_read(&ap->link, SCR_NOTIFICATION, &sntf);
1186 	if (rc == 0)
1187 		sata_scr_write(&ap->link, SCR_NOTIFICATION, sntf);
1188 
1189 	if (!sata_pmp_attached(ap) || rc) {
1190 		/* PMP is not attached or SNTF is not available */
1191 		if (!sata_pmp_attached(ap)) {
1192 			/* PMP is not attached.  Check whether ATAPI
1193 			 * AN is configured.  If so, notify media
1194 			 * change.
1195 			 */
1196 			struct ata_device *dev = ap->link.device;
1197 
1198 			if ((dev->class == ATA_DEV_ATAPI) &&
1199 			    (dev->flags & ATA_DFLAG_AN))
1200 				ata_scsi_media_change_notify(dev);
1201 			return 0;
1202 		} else {
1203 			/* PMP is attached but SNTF is not available.
1204 			 * ATAPI async media change notification is
1205 			 * not used.  The PMP must be reporting PHY
1206 			 * status change, schedule EH.
1207 			 */
1208 			ata_port_schedule_eh(ap);
1209 			return 1;
1210 		}
1211 	} else {
1212 		/* PMP is attached and SNTF is available */
1213 		struct ata_link *link;
1214 
1215 		/* check and notify ATAPI AN */
1216 		ata_for_each_link(link, ap, EDGE) {
1217 			if (!(sntf & (1 << link->pmp)))
1218 				continue;
1219 
1220 			if ((link->device->class == ATA_DEV_ATAPI) &&
1221 			    (link->device->flags & ATA_DFLAG_AN))
1222 				ata_scsi_media_change_notify(link->device);
1223 		}
1224 
1225 		/* If PMP is reporting that PHY status of some
1226 		 * downstream ports has changed, schedule EH.
1227 		 */
1228 		if (sntf & (1 << SATA_PMP_CTRL_PORT)) {
1229 			ata_port_schedule_eh(ap);
1230 			return 1;
1231 		}
1232 
1233 		return 0;
1234 	}
1235 }
1236 
1237 /**
1238  *	ata_eh_freeze_port - EH helper to freeze port
1239  *	@ap: ATA port to freeze
1240  *
1241  *	Freeze @ap.
1242  *
1243  *	LOCKING:
1244  *	None.
1245  */
1246 void ata_eh_freeze_port(struct ata_port *ap)
1247 {
1248 	unsigned long flags;
1249 
1250 	if (!ap->ops->error_handler)
1251 		return;
1252 
1253 	spin_lock_irqsave(ap->lock, flags);
1254 	__ata_port_freeze(ap);
1255 	spin_unlock_irqrestore(ap->lock, flags);
1256 }
1257 
1258 /**
1259  *	ata_port_thaw_port - EH helper to thaw port
1260  *	@ap: ATA port to thaw
1261  *
1262  *	Thaw frozen port @ap.
1263  *
1264  *	LOCKING:
1265  *	None.
1266  */
1267 void ata_eh_thaw_port(struct ata_port *ap)
1268 {
1269 	unsigned long flags;
1270 
1271 	if (!ap->ops->error_handler)
1272 		return;
1273 
1274 	spin_lock_irqsave(ap->lock, flags);
1275 
1276 	ap->pflags &= ~ATA_PFLAG_FROZEN;
1277 
1278 	if (ap->ops->thaw)
1279 		ap->ops->thaw(ap);
1280 
1281 	spin_unlock_irqrestore(ap->lock, flags);
1282 
1283 	DPRINTK("ata%u port thawed\n", ap->print_id);
1284 }
1285 
1286 static void ata_eh_scsidone(struct scsi_cmnd *scmd)
1287 {
1288 	/* nada */
1289 }
1290 
1291 static void __ata_eh_qc_complete(struct ata_queued_cmd *qc)
1292 {
1293 	struct ata_port *ap = qc->ap;
1294 	struct scsi_cmnd *scmd = qc->scsicmd;
1295 	unsigned long flags;
1296 
1297 	spin_lock_irqsave(ap->lock, flags);
1298 	qc->scsidone = ata_eh_scsidone;
1299 	__ata_qc_complete(qc);
1300 	WARN_ON(ata_tag_valid(qc->tag));
1301 	spin_unlock_irqrestore(ap->lock, flags);
1302 
1303 	scsi_eh_finish_cmd(scmd, &ap->eh_done_q);
1304 }
1305 
1306 /**
1307  *	ata_eh_qc_complete - Complete an active ATA command from EH
1308  *	@qc: Command to complete
1309  *
1310  *	Indicate to the mid and upper layers that an ATA command has
1311  *	completed.  To be used from EH.
1312  */
1313 void ata_eh_qc_complete(struct ata_queued_cmd *qc)
1314 {
1315 	struct scsi_cmnd *scmd = qc->scsicmd;
1316 	scmd->retries = scmd->allowed;
1317 	__ata_eh_qc_complete(qc);
1318 }
1319 
1320 /**
1321  *	ata_eh_qc_retry - Tell midlayer to retry an ATA command after EH
1322  *	@qc: Command to retry
1323  *
1324  *	Indicate to the mid and upper layers that an ATA command
1325  *	should be retried.  To be used from EH.
1326  *
1327  *	SCSI midlayer limits the number of retries to scmd->allowed.
1328  *	scmd->allowed is incremented for commands which get retried
1329  *	due to unrelated failures (qc->err_mask is zero).
1330  */
1331 void ata_eh_qc_retry(struct ata_queued_cmd *qc)
1332 {
1333 	struct scsi_cmnd *scmd = qc->scsicmd;
1334 	if (!qc->err_mask)
1335 		scmd->allowed++;
1336 	__ata_eh_qc_complete(qc);
1337 }
1338 
1339 /**
1340  *	ata_dev_disable - disable ATA device
1341  *	@dev: ATA device to disable
1342  *
1343  *	Disable @dev.
1344  *
1345  *	Locking:
1346  *	EH context.
1347  */
1348 void ata_dev_disable(struct ata_device *dev)
1349 {
1350 	if (!ata_dev_enabled(dev))
1351 		return;
1352 
1353 	if (ata_msg_drv(dev->link->ap))
1354 		ata_dev_warn(dev, "disabled\n");
1355 	ata_acpi_on_disable(dev);
1356 	ata_down_xfermask_limit(dev, ATA_DNXFER_FORCE_PIO0 | ATA_DNXFER_QUIET);
1357 	dev->class++;
1358 
1359 	/* From now till the next successful probe, ering is used to
1360 	 * track probe failures.  Clear accumulated device error info.
1361 	 */
1362 	ata_ering_clear(&dev->ering);
1363 }
1364 
1365 /**
1366  *	ata_eh_detach_dev - detach ATA device
1367  *	@dev: ATA device to detach
1368  *
1369  *	Detach @dev.
1370  *
1371  *	LOCKING:
1372  *	None.
1373  */
1374 void ata_eh_detach_dev(struct ata_device *dev)
1375 {
1376 	struct ata_link *link = dev->link;
1377 	struct ata_port *ap = link->ap;
1378 	struct ata_eh_context *ehc = &link->eh_context;
1379 	unsigned long flags;
1380 
1381 	ata_dev_disable(dev);
1382 
1383 	spin_lock_irqsave(ap->lock, flags);
1384 
1385 	dev->flags &= ~ATA_DFLAG_DETACH;
1386 
1387 	if (ata_scsi_offline_dev(dev)) {
1388 		dev->flags |= ATA_DFLAG_DETACHED;
1389 		ap->pflags |= ATA_PFLAG_SCSI_HOTPLUG;
1390 	}
1391 
1392 	/* clear per-dev EH info */
1393 	ata_eh_clear_action(link, dev, &link->eh_info, ATA_EH_PERDEV_MASK);
1394 	ata_eh_clear_action(link, dev, &link->eh_context.i, ATA_EH_PERDEV_MASK);
1395 	ehc->saved_xfer_mode[dev->devno] = 0;
1396 	ehc->saved_ncq_enabled &= ~(1 << dev->devno);
1397 
1398 	spin_unlock_irqrestore(ap->lock, flags);
1399 }
1400 
1401 /**
1402  *	ata_eh_about_to_do - about to perform eh_action
1403  *	@link: target ATA link
1404  *	@dev: target ATA dev for per-dev action (can be NULL)
1405  *	@action: action about to be performed
1406  *
1407  *	Called just before performing EH actions to clear related bits
1408  *	in @link->eh_info such that eh actions are not unnecessarily
1409  *	repeated.
1410  *
1411  *	LOCKING:
1412  *	None.
1413  */
1414 void ata_eh_about_to_do(struct ata_link *link, struct ata_device *dev,
1415 			unsigned int action)
1416 {
1417 	struct ata_port *ap = link->ap;
1418 	struct ata_eh_info *ehi = &link->eh_info;
1419 	struct ata_eh_context *ehc = &link->eh_context;
1420 	unsigned long flags;
1421 
1422 	spin_lock_irqsave(ap->lock, flags);
1423 
1424 	ata_eh_clear_action(link, dev, ehi, action);
1425 
1426 	/* About to take EH action, set RECOVERED.  Ignore actions on
1427 	 * slave links as master will do them again.
1428 	 */
1429 	if (!(ehc->i.flags & ATA_EHI_QUIET) && link != ap->slave_link)
1430 		ap->pflags |= ATA_PFLAG_RECOVERED;
1431 
1432 	spin_unlock_irqrestore(ap->lock, flags);
1433 }
1434 
1435 /**
1436  *	ata_eh_done - EH action complete
1437  *	@link: ATA link for which EH actions are complete
1438  *	@dev: target ATA dev for per-dev action (can be NULL)
1439  *	@action: action just completed
1440  *
1441  *	Called right after performing EH actions to clear related bits
1442  *	in @link->eh_context.
1443  *
1444  *	LOCKING:
1445  *	None.
1446  */
1447 void ata_eh_done(struct ata_link *link, struct ata_device *dev,
1448 		 unsigned int action)
1449 {
1450 	struct ata_eh_context *ehc = &link->eh_context;
1451 
1452 	ata_eh_clear_action(link, dev, &ehc->i, action);
1453 }
1454 
1455 /**
1456  *	ata_err_string - convert err_mask to descriptive string
1457  *	@err_mask: error mask to convert to string
1458  *
1459  *	Convert @err_mask to descriptive string.  Errors are
1460  *	prioritized according to severity and only the most severe
1461  *	error is reported.
1462  *
1463  *	LOCKING:
1464  *	None.
1465  *
1466  *	RETURNS:
1467  *	Descriptive string for @err_mask
1468  */
1469 static const char *ata_err_string(unsigned int err_mask)
1470 {
1471 	if (err_mask & AC_ERR_HOST_BUS)
1472 		return "host bus error";
1473 	if (err_mask & AC_ERR_ATA_BUS)
1474 		return "ATA bus error";
1475 	if (err_mask & AC_ERR_TIMEOUT)
1476 		return "timeout";
1477 	if (err_mask & AC_ERR_HSM)
1478 		return "HSM violation";
1479 	if (err_mask & AC_ERR_SYSTEM)
1480 		return "internal error";
1481 	if (err_mask & AC_ERR_MEDIA)
1482 		return "media error";
1483 	if (err_mask & AC_ERR_INVALID)
1484 		return "invalid argument";
1485 	if (err_mask & AC_ERR_DEV)
1486 		return "device error";
1487 	return "unknown error";
1488 }
1489 
1490 /**
1491  *	ata_eh_read_log_10h - Read log page 10h for NCQ error details
1492  *	@dev: Device to read log page 10h from
1493  *	@tag: Resulting tag of the failed command
1494  *	@tf: Resulting taskfile registers of the failed command
1495  *
1496  *	Read log page 10h to obtain NCQ error details and clear error
1497  *	condition.
1498  *
1499  *	LOCKING:
1500  *	Kernel thread context (may sleep).
1501  *
1502  *	RETURNS:
1503  *	0 on success, -errno otherwise.
1504  */
1505 static int ata_eh_read_log_10h(struct ata_device *dev,
1506 			       int *tag, struct ata_taskfile *tf)
1507 {
1508 	u8 *buf = dev->link->ap->sector_buf;
1509 	unsigned int err_mask;
1510 	u8 csum;
1511 	int i;
1512 
1513 	err_mask = ata_read_log_page(dev, ATA_LOG_SATA_NCQ, 0, buf, 1);
1514 	if (err_mask)
1515 		return -EIO;
1516 
1517 	csum = 0;
1518 	for (i = 0; i < ATA_SECT_SIZE; i++)
1519 		csum += buf[i];
1520 	if (csum)
1521 		ata_dev_warn(dev, "invalid checksum 0x%x on log page 10h\n",
1522 			     csum);
1523 
1524 	if (buf[0] & 0x80)
1525 		return -ENOENT;
1526 
1527 	*tag = buf[0] & 0x1f;
1528 
1529 	tf->command = buf[2];
1530 	tf->feature = buf[3];
1531 	tf->lbal = buf[4];
1532 	tf->lbam = buf[5];
1533 	tf->lbah = buf[6];
1534 	tf->device = buf[7];
1535 	tf->hob_lbal = buf[8];
1536 	tf->hob_lbam = buf[9];
1537 	tf->hob_lbah = buf[10];
1538 	tf->nsect = buf[12];
1539 	tf->hob_nsect = buf[13];
1540 	if (ata_id_has_ncq_autosense(dev->id))
1541 		tf->auxiliary = buf[14] << 16 | buf[15] << 8 | buf[16];
1542 
1543 	return 0;
1544 }
1545 
1546 /**
1547  *	atapi_eh_tur - perform ATAPI TEST_UNIT_READY
1548  *	@dev: target ATAPI device
1549  *	@r_sense_key: out parameter for sense_key
1550  *
1551  *	Perform ATAPI TEST_UNIT_READY.
1552  *
1553  *	LOCKING:
1554  *	EH context (may sleep).
1555  *
1556  *	RETURNS:
1557  *	0 on success, AC_ERR_* mask on failure.
1558  */
1559 unsigned int atapi_eh_tur(struct ata_device *dev, u8 *r_sense_key)
1560 {
1561 	u8 cdb[ATAPI_CDB_LEN] = { TEST_UNIT_READY, 0, 0, 0, 0, 0 };
1562 	struct ata_taskfile tf;
1563 	unsigned int err_mask;
1564 
1565 	ata_tf_init(dev, &tf);
1566 
1567 	tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1568 	tf.command = ATA_CMD_PACKET;
1569 	tf.protocol = ATAPI_PROT_NODATA;
1570 
1571 	err_mask = ata_exec_internal(dev, &tf, cdb, DMA_NONE, NULL, 0, 0);
1572 	if (err_mask == AC_ERR_DEV)
1573 		*r_sense_key = tf.feature >> 4;
1574 	return err_mask;
1575 }
1576 
1577 /**
1578  *	ata_eh_request_sense - perform REQUEST_SENSE_DATA_EXT
1579  *	@qc: qc to perform REQUEST_SENSE_SENSE_DATA_EXT to
1580  *	@cmd: scsi command for which the sense code should be set
1581  *
1582  *	Perform REQUEST_SENSE_DATA_EXT after the device reported CHECK
1583  *	SENSE.  This function is an EH helper.
1584  *
1585  *	LOCKING:
1586  *	Kernel thread context (may sleep).
1587  */
1588 static void ata_eh_request_sense(struct ata_queued_cmd *qc,
1589 				 struct scsi_cmnd *cmd)
1590 {
1591 	struct ata_device *dev = qc->dev;
1592 	struct ata_taskfile tf;
1593 	unsigned int err_mask;
1594 
1595 	if (qc->ap->pflags & ATA_PFLAG_FROZEN) {
1596 		ata_dev_warn(dev, "sense data available but port frozen\n");
1597 		return;
1598 	}
1599 
1600 	if (!cmd || qc->flags & ATA_QCFLAG_SENSE_VALID)
1601 		return;
1602 
1603 	if (!ata_id_sense_reporting_enabled(dev->id)) {
1604 		ata_dev_warn(qc->dev, "sense data reporting disabled\n");
1605 		return;
1606 	}
1607 
1608 	DPRINTK("ATA request sense\n");
1609 
1610 	ata_tf_init(dev, &tf);
1611 	tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1612 	tf.flags |= ATA_TFLAG_LBA | ATA_TFLAG_LBA48;
1613 	tf.command = ATA_CMD_REQ_SENSE_DATA;
1614 	tf.protocol = ATA_PROT_NODATA;
1615 
1616 	err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
1617 	/* Ignore err_mask; ATA_ERR might be set */
1618 	if (tf.command & ATA_SENSE) {
1619 		ata_scsi_set_sense(dev, cmd, tf.lbah, tf.lbam, tf.lbal);
1620 		qc->flags |= ATA_QCFLAG_SENSE_VALID;
1621 	} else {
1622 		ata_dev_warn(dev, "request sense failed stat %02x emask %x\n",
1623 			     tf.command, err_mask);
1624 	}
1625 }
1626 
1627 /**
1628  *	atapi_eh_request_sense - perform ATAPI REQUEST_SENSE
1629  *	@dev: device to perform REQUEST_SENSE to
1630  *	@sense_buf: result sense data buffer (SCSI_SENSE_BUFFERSIZE bytes long)
1631  *	@dfl_sense_key: default sense key to use
1632  *
1633  *	Perform ATAPI REQUEST_SENSE after the device reported CHECK
1634  *	SENSE.  This function is EH helper.
1635  *
1636  *	LOCKING:
1637  *	Kernel thread context (may sleep).
1638  *
1639  *	RETURNS:
1640  *	0 on success, AC_ERR_* mask on failure
1641  */
1642 unsigned int atapi_eh_request_sense(struct ata_device *dev,
1643 					   u8 *sense_buf, u8 dfl_sense_key)
1644 {
1645 	u8 cdb[ATAPI_CDB_LEN] =
1646 		{ REQUEST_SENSE, 0, 0, 0, SCSI_SENSE_BUFFERSIZE, 0 };
1647 	struct ata_port *ap = dev->link->ap;
1648 	struct ata_taskfile tf;
1649 
1650 	DPRINTK("ATAPI request sense\n");
1651 
1652 	memset(sense_buf, 0, SCSI_SENSE_BUFFERSIZE);
1653 
1654 	/* initialize sense_buf with the error register,
1655 	 * for the case where they are -not- overwritten
1656 	 */
1657 	sense_buf[0] = 0x70;
1658 	sense_buf[2] = dfl_sense_key;
1659 
1660 	/* some devices time out if garbage left in tf */
1661 	ata_tf_init(dev, &tf);
1662 
1663 	tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE;
1664 	tf.command = ATA_CMD_PACKET;
1665 
1666 	/* is it pointless to prefer PIO for "safety reasons"? */
1667 	if (ap->flags & ATA_FLAG_PIO_DMA) {
1668 		tf.protocol = ATAPI_PROT_DMA;
1669 		tf.feature |= ATAPI_PKT_DMA;
1670 	} else {
1671 		tf.protocol = ATAPI_PROT_PIO;
1672 		tf.lbam = SCSI_SENSE_BUFFERSIZE;
1673 		tf.lbah = 0;
1674 	}
1675 
1676 	return ata_exec_internal(dev, &tf, cdb, DMA_FROM_DEVICE,
1677 				 sense_buf, SCSI_SENSE_BUFFERSIZE, 0);
1678 }
1679 
1680 /**
1681  *	ata_eh_analyze_serror - analyze SError for a failed port
1682  *	@link: ATA link to analyze SError for
1683  *
1684  *	Analyze SError if available and further determine cause of
1685  *	failure.
1686  *
1687  *	LOCKING:
1688  *	None.
1689  */
1690 static void ata_eh_analyze_serror(struct ata_link *link)
1691 {
1692 	struct ata_eh_context *ehc = &link->eh_context;
1693 	u32 serror = ehc->i.serror;
1694 	unsigned int err_mask = 0, action = 0;
1695 	u32 hotplug_mask;
1696 
1697 	if (serror & (SERR_PERSISTENT | SERR_DATA)) {
1698 		err_mask |= AC_ERR_ATA_BUS;
1699 		action |= ATA_EH_RESET;
1700 	}
1701 	if (serror & SERR_PROTOCOL) {
1702 		err_mask |= AC_ERR_HSM;
1703 		action |= ATA_EH_RESET;
1704 	}
1705 	if (serror & SERR_INTERNAL) {
1706 		err_mask |= AC_ERR_SYSTEM;
1707 		action |= ATA_EH_RESET;
1708 	}
1709 
1710 	/* Determine whether a hotplug event has occurred.  Both
1711 	 * SError.N/X are considered hotplug events for enabled or
1712 	 * host links.  For disabled PMP links, only N bit is
1713 	 * considered as X bit is left at 1 for link plugging.
1714 	 */
1715 	if (link->lpm_policy > ATA_LPM_MAX_POWER)
1716 		hotplug_mask = 0;	/* hotplug doesn't work w/ LPM */
1717 	else if (!(link->flags & ATA_LFLAG_DISABLED) || ata_is_host_link(link))
1718 		hotplug_mask = SERR_PHYRDY_CHG | SERR_DEV_XCHG;
1719 	else
1720 		hotplug_mask = SERR_PHYRDY_CHG;
1721 
1722 	if (serror & hotplug_mask)
1723 		ata_ehi_hotplugged(&ehc->i);
1724 
1725 	ehc->i.err_mask |= err_mask;
1726 	ehc->i.action |= action;
1727 }
1728 
1729 /**
1730  *	ata_eh_analyze_ncq_error - analyze NCQ error
1731  *	@link: ATA link to analyze NCQ error for
1732  *
1733  *	Read log page 10h, determine the offending qc and acquire
1734  *	error status TF.  For NCQ device errors, all LLDDs have to do
1735  *	is setting AC_ERR_DEV in ehi->err_mask.  This function takes
1736  *	care of the rest.
1737  *
1738  *	LOCKING:
1739  *	Kernel thread context (may sleep).
1740  */
1741 void ata_eh_analyze_ncq_error(struct ata_link *link)
1742 {
1743 	struct ata_port *ap = link->ap;
1744 	struct ata_eh_context *ehc = &link->eh_context;
1745 	struct ata_device *dev = link->device;
1746 	struct ata_queued_cmd *qc;
1747 	struct ata_taskfile tf;
1748 	int tag, rc;
1749 
1750 	/* if frozen, we can't do much */
1751 	if (ap->pflags & ATA_PFLAG_FROZEN)
1752 		return;
1753 
1754 	/* is it NCQ device error? */
1755 	if (!link->sactive || !(ehc->i.err_mask & AC_ERR_DEV))
1756 		return;
1757 
1758 	/* has LLDD analyzed already? */
1759 	for (tag = 0; tag < ATA_MAX_QUEUE; tag++) {
1760 		qc = __ata_qc_from_tag(ap, tag);
1761 
1762 		if (!(qc->flags & ATA_QCFLAG_FAILED))
1763 			continue;
1764 
1765 		if (qc->err_mask)
1766 			return;
1767 	}
1768 
1769 	/* okay, this error is ours */
1770 	memset(&tf, 0, sizeof(tf));
1771 	rc = ata_eh_read_log_10h(dev, &tag, &tf);
1772 	if (rc) {
1773 		ata_link_err(link, "failed to read log page 10h (errno=%d)\n",
1774 			     rc);
1775 		return;
1776 	}
1777 
1778 	if (!(link->sactive & (1 << tag))) {
1779 		ata_link_err(link, "log page 10h reported inactive tag %d\n",
1780 			     tag);
1781 		return;
1782 	}
1783 
1784 	/* we've got the perpetrator, condemn it */
1785 	qc = __ata_qc_from_tag(ap, tag);
1786 	memcpy(&qc->result_tf, &tf, sizeof(tf));
1787 	qc->result_tf.flags = ATA_TFLAG_ISADDR | ATA_TFLAG_LBA | ATA_TFLAG_LBA48;
1788 	qc->err_mask |= AC_ERR_DEV | AC_ERR_NCQ;
1789 	if ((qc->result_tf.command & ATA_SENSE) || qc->result_tf.auxiliary) {
1790 		char sense_key, asc, ascq;
1791 
1792 		sense_key = (qc->result_tf.auxiliary >> 16) & 0xff;
1793 		asc = (qc->result_tf.auxiliary >> 8) & 0xff;
1794 		ascq = qc->result_tf.auxiliary & 0xff;
1795 		ata_scsi_set_sense(dev, qc->scsicmd, sense_key, asc, ascq);
1796 		ata_scsi_set_sense_information(dev, qc->scsicmd,
1797 					       &qc->result_tf);
1798 		qc->flags |= ATA_QCFLAG_SENSE_VALID;
1799 	}
1800 
1801 	ehc->i.err_mask &= ~AC_ERR_DEV;
1802 }
1803 
1804 /**
1805  *	ata_eh_analyze_tf - analyze taskfile of a failed qc
1806  *	@qc: qc to analyze
1807  *	@tf: Taskfile registers to analyze
1808  *
1809  *	Analyze taskfile of @qc and further determine cause of
1810  *	failure.  This function also requests ATAPI sense data if
1811  *	available.
1812  *
1813  *	LOCKING:
1814  *	Kernel thread context (may sleep).
1815  *
1816  *	RETURNS:
1817  *	Determined recovery action
1818  */
1819 static unsigned int ata_eh_analyze_tf(struct ata_queued_cmd *qc,
1820 				      const struct ata_taskfile *tf)
1821 {
1822 	unsigned int tmp, action = 0;
1823 	u8 stat = tf->command, err = tf->feature;
1824 
1825 	if ((stat & (ATA_BUSY | ATA_DRQ | ATA_DRDY)) != ATA_DRDY) {
1826 		qc->err_mask |= AC_ERR_HSM;
1827 		return ATA_EH_RESET;
1828 	}
1829 
1830 	if (stat & (ATA_ERR | ATA_DF)) {
1831 		qc->err_mask |= AC_ERR_DEV;
1832 		/*
1833 		 * Sense data reporting does not work if the
1834 		 * device fault bit is set.
1835 		 */
1836 		if (stat & ATA_DF)
1837 			stat &= ~ATA_SENSE;
1838 	} else {
1839 		return 0;
1840 	}
1841 
1842 	switch (qc->dev->class) {
1843 	case ATA_DEV_ATA:
1844 	case ATA_DEV_ZAC:
1845 		if (stat & ATA_SENSE)
1846 			ata_eh_request_sense(qc, qc->scsicmd);
1847 		if (err & ATA_ICRC)
1848 			qc->err_mask |= AC_ERR_ATA_BUS;
1849 		if (err & (ATA_UNC | ATA_AMNF))
1850 			qc->err_mask |= AC_ERR_MEDIA;
1851 		if (err & ATA_IDNF)
1852 			qc->err_mask |= AC_ERR_INVALID;
1853 		break;
1854 
1855 	case ATA_DEV_ATAPI:
1856 		if (!(qc->ap->pflags & ATA_PFLAG_FROZEN)) {
1857 			tmp = atapi_eh_request_sense(qc->dev,
1858 						qc->scsicmd->sense_buffer,
1859 						qc->result_tf.feature >> 4);
1860 			if (!tmp)
1861 				qc->flags |= ATA_QCFLAG_SENSE_VALID;
1862 			else
1863 				qc->err_mask |= tmp;
1864 		}
1865 	}
1866 
1867 	if (qc->flags & ATA_QCFLAG_SENSE_VALID) {
1868 		int ret = scsi_check_sense(qc->scsicmd);
1869 		/*
1870 		 * SUCCESS here means that the sense code could
1871 		 * evaluated and should be passed to the upper layers
1872 		 * for correct evaluation.
1873 		 * FAILED means the sense code could not interpreted
1874 		 * and the device would need to be reset.
1875 		 * NEEDS_RETRY and ADD_TO_MLQUEUE means that the
1876 		 * command would need to be retried.
1877 		 */
1878 		if (ret == NEEDS_RETRY || ret == ADD_TO_MLQUEUE) {
1879 			qc->flags |= ATA_QCFLAG_RETRY;
1880 			qc->err_mask |= AC_ERR_OTHER;
1881 		} else if (ret != SUCCESS) {
1882 			qc->err_mask |= AC_ERR_HSM;
1883 		}
1884 	}
1885 	if (qc->err_mask & (AC_ERR_HSM | AC_ERR_TIMEOUT | AC_ERR_ATA_BUS))
1886 		action |= ATA_EH_RESET;
1887 
1888 	return action;
1889 }
1890 
1891 static int ata_eh_categorize_error(unsigned int eflags, unsigned int err_mask,
1892 				   int *xfer_ok)
1893 {
1894 	int base = 0;
1895 
1896 	if (!(eflags & ATA_EFLAG_DUBIOUS_XFER))
1897 		*xfer_ok = 1;
1898 
1899 	if (!*xfer_ok)
1900 		base = ATA_ECAT_DUBIOUS_NONE;
1901 
1902 	if (err_mask & AC_ERR_ATA_BUS)
1903 		return base + ATA_ECAT_ATA_BUS;
1904 
1905 	if (err_mask & AC_ERR_TIMEOUT)
1906 		return base + ATA_ECAT_TOUT_HSM;
1907 
1908 	if (eflags & ATA_EFLAG_IS_IO) {
1909 		if (err_mask & AC_ERR_HSM)
1910 			return base + ATA_ECAT_TOUT_HSM;
1911 		if ((err_mask &
1912 		     (AC_ERR_DEV|AC_ERR_MEDIA|AC_ERR_INVALID)) == AC_ERR_DEV)
1913 			return base + ATA_ECAT_UNK_DEV;
1914 	}
1915 
1916 	return 0;
1917 }
1918 
1919 struct speed_down_verdict_arg {
1920 	u64 since;
1921 	int xfer_ok;
1922 	int nr_errors[ATA_ECAT_NR];
1923 };
1924 
1925 static int speed_down_verdict_cb(struct ata_ering_entry *ent, void *void_arg)
1926 {
1927 	struct speed_down_verdict_arg *arg = void_arg;
1928 	int cat;
1929 
1930 	if ((ent->eflags & ATA_EFLAG_OLD_ER) || (ent->timestamp < arg->since))
1931 		return -1;
1932 
1933 	cat = ata_eh_categorize_error(ent->eflags, ent->err_mask,
1934 				      &arg->xfer_ok);
1935 	arg->nr_errors[cat]++;
1936 
1937 	return 0;
1938 }
1939 
1940 /**
1941  *	ata_eh_speed_down_verdict - Determine speed down verdict
1942  *	@dev: Device of interest
1943  *
1944  *	This function examines error ring of @dev and determines
1945  *	whether NCQ needs to be turned off, transfer speed should be
1946  *	stepped down, or falling back to PIO is necessary.
1947  *
1948  *	ECAT_ATA_BUS	: ATA_BUS error for any command
1949  *
1950  *	ECAT_TOUT_HSM	: TIMEOUT for any command or HSM violation for
1951  *			  IO commands
1952  *
1953  *	ECAT_UNK_DEV	: Unknown DEV error for IO commands
1954  *
1955  *	ECAT_DUBIOUS_*	: Identical to above three but occurred while
1956  *			  data transfer hasn't been verified.
1957  *
1958  *	Verdicts are
1959  *
1960  *	NCQ_OFF		: Turn off NCQ.
1961  *
1962  *	SPEED_DOWN	: Speed down transfer speed but don't fall back
1963  *			  to PIO.
1964  *
1965  *	FALLBACK_TO_PIO	: Fall back to PIO.
1966  *
1967  *	Even if multiple verdicts are returned, only one action is
1968  *	taken per error.  An action triggered by non-DUBIOUS errors
1969  *	clears ering, while one triggered by DUBIOUS_* errors doesn't.
1970  *	This is to expedite speed down decisions right after device is
1971  *	initially configured.
1972  *
1973  *	The following are speed down rules.  #1 and #2 deal with
1974  *	DUBIOUS errors.
1975  *
1976  *	1. If more than one DUBIOUS_ATA_BUS or DUBIOUS_TOUT_HSM errors
1977  *	   occurred during last 5 mins, SPEED_DOWN and FALLBACK_TO_PIO.
1978  *
1979  *	2. If more than one DUBIOUS_TOUT_HSM or DUBIOUS_UNK_DEV errors
1980  *	   occurred during last 5 mins, NCQ_OFF.
1981  *
1982  *	3. If more than 8 ATA_BUS, TOUT_HSM or UNK_DEV errors
1983  *	   occurred during last 5 mins, FALLBACK_TO_PIO
1984  *
1985  *	4. If more than 3 TOUT_HSM or UNK_DEV errors occurred
1986  *	   during last 10 mins, NCQ_OFF.
1987  *
1988  *	5. If more than 3 ATA_BUS or TOUT_HSM errors, or more than 6
1989  *	   UNK_DEV errors occurred during last 10 mins, SPEED_DOWN.
1990  *
1991  *	LOCKING:
1992  *	Inherited from caller.
1993  *
1994  *	RETURNS:
1995  *	OR of ATA_EH_SPDN_* flags.
1996  */
1997 static unsigned int ata_eh_speed_down_verdict(struct ata_device *dev)
1998 {
1999 	const u64 j5mins = 5LLU * 60 * HZ, j10mins = 10LLU * 60 * HZ;
2000 	u64 j64 = get_jiffies_64();
2001 	struct speed_down_verdict_arg arg;
2002 	unsigned int verdict = 0;
2003 
2004 	/* scan past 5 mins of error history */
2005 	memset(&arg, 0, sizeof(arg));
2006 	arg.since = j64 - min(j64, j5mins);
2007 	ata_ering_map(&dev->ering, speed_down_verdict_cb, &arg);
2008 
2009 	if (arg.nr_errors[ATA_ECAT_DUBIOUS_ATA_BUS] +
2010 	    arg.nr_errors[ATA_ECAT_DUBIOUS_TOUT_HSM] > 1)
2011 		verdict |= ATA_EH_SPDN_SPEED_DOWN |
2012 			ATA_EH_SPDN_FALLBACK_TO_PIO | ATA_EH_SPDN_KEEP_ERRORS;
2013 
2014 	if (arg.nr_errors[ATA_ECAT_DUBIOUS_TOUT_HSM] +
2015 	    arg.nr_errors[ATA_ECAT_DUBIOUS_UNK_DEV] > 1)
2016 		verdict |= ATA_EH_SPDN_NCQ_OFF | ATA_EH_SPDN_KEEP_ERRORS;
2017 
2018 	if (arg.nr_errors[ATA_ECAT_ATA_BUS] +
2019 	    arg.nr_errors[ATA_ECAT_TOUT_HSM] +
2020 	    arg.nr_errors[ATA_ECAT_UNK_DEV] > 6)
2021 		verdict |= ATA_EH_SPDN_FALLBACK_TO_PIO;
2022 
2023 	/* scan past 10 mins of error history */
2024 	memset(&arg, 0, sizeof(arg));
2025 	arg.since = j64 - min(j64, j10mins);
2026 	ata_ering_map(&dev->ering, speed_down_verdict_cb, &arg);
2027 
2028 	if (arg.nr_errors[ATA_ECAT_TOUT_HSM] +
2029 	    arg.nr_errors[ATA_ECAT_UNK_DEV] > 3)
2030 		verdict |= ATA_EH_SPDN_NCQ_OFF;
2031 
2032 	if (arg.nr_errors[ATA_ECAT_ATA_BUS] +
2033 	    arg.nr_errors[ATA_ECAT_TOUT_HSM] > 3 ||
2034 	    arg.nr_errors[ATA_ECAT_UNK_DEV] > 6)
2035 		verdict |= ATA_EH_SPDN_SPEED_DOWN;
2036 
2037 	return verdict;
2038 }
2039 
2040 /**
2041  *	ata_eh_speed_down - record error and speed down if necessary
2042  *	@dev: Failed device
2043  *	@eflags: mask of ATA_EFLAG_* flags
2044  *	@err_mask: err_mask of the error
2045  *
2046  *	Record error and examine error history to determine whether
2047  *	adjusting transmission speed is necessary.  It also sets
2048  *	transmission limits appropriately if such adjustment is
2049  *	necessary.
2050  *
2051  *	LOCKING:
2052  *	Kernel thread context (may sleep).
2053  *
2054  *	RETURNS:
2055  *	Determined recovery action.
2056  */
2057 static unsigned int ata_eh_speed_down(struct ata_device *dev,
2058 				unsigned int eflags, unsigned int err_mask)
2059 {
2060 	struct ata_link *link = ata_dev_phys_link(dev);
2061 	int xfer_ok = 0;
2062 	unsigned int verdict;
2063 	unsigned int action = 0;
2064 
2065 	/* don't bother if Cat-0 error */
2066 	if (ata_eh_categorize_error(eflags, err_mask, &xfer_ok) == 0)
2067 		return 0;
2068 
2069 	/* record error and determine whether speed down is necessary */
2070 	ata_ering_record(&dev->ering, eflags, err_mask);
2071 	verdict = ata_eh_speed_down_verdict(dev);
2072 
2073 	/* turn off NCQ? */
2074 	if ((verdict & ATA_EH_SPDN_NCQ_OFF) &&
2075 	    (dev->flags & (ATA_DFLAG_PIO | ATA_DFLAG_NCQ |
2076 			   ATA_DFLAG_NCQ_OFF)) == ATA_DFLAG_NCQ) {
2077 		dev->flags |= ATA_DFLAG_NCQ_OFF;
2078 		ata_dev_warn(dev, "NCQ disabled due to excessive errors\n");
2079 		goto done;
2080 	}
2081 
2082 	/* speed down? */
2083 	if (verdict & ATA_EH_SPDN_SPEED_DOWN) {
2084 		/* speed down SATA link speed if possible */
2085 		if (sata_down_spd_limit(link, 0) == 0) {
2086 			action |= ATA_EH_RESET;
2087 			goto done;
2088 		}
2089 
2090 		/* lower transfer mode */
2091 		if (dev->spdn_cnt < 2) {
2092 			static const int dma_dnxfer_sel[] =
2093 				{ ATA_DNXFER_DMA, ATA_DNXFER_40C };
2094 			static const int pio_dnxfer_sel[] =
2095 				{ ATA_DNXFER_PIO, ATA_DNXFER_FORCE_PIO0 };
2096 			int sel;
2097 
2098 			if (dev->xfer_shift != ATA_SHIFT_PIO)
2099 				sel = dma_dnxfer_sel[dev->spdn_cnt];
2100 			else
2101 				sel = pio_dnxfer_sel[dev->spdn_cnt];
2102 
2103 			dev->spdn_cnt++;
2104 
2105 			if (ata_down_xfermask_limit(dev, sel) == 0) {
2106 				action |= ATA_EH_RESET;
2107 				goto done;
2108 			}
2109 		}
2110 	}
2111 
2112 	/* Fall back to PIO?  Slowing down to PIO is meaningless for
2113 	 * SATA ATA devices.  Consider it only for PATA and SATAPI.
2114 	 */
2115 	if ((verdict & ATA_EH_SPDN_FALLBACK_TO_PIO) && (dev->spdn_cnt >= 2) &&
2116 	    (link->ap->cbl != ATA_CBL_SATA || dev->class == ATA_DEV_ATAPI) &&
2117 	    (dev->xfer_shift != ATA_SHIFT_PIO)) {
2118 		if (ata_down_xfermask_limit(dev, ATA_DNXFER_FORCE_PIO) == 0) {
2119 			dev->spdn_cnt = 0;
2120 			action |= ATA_EH_RESET;
2121 			goto done;
2122 		}
2123 	}
2124 
2125 	return 0;
2126  done:
2127 	/* device has been slowed down, blow error history */
2128 	if (!(verdict & ATA_EH_SPDN_KEEP_ERRORS))
2129 		ata_ering_clear(&dev->ering);
2130 	return action;
2131 }
2132 
2133 /**
2134  *	ata_eh_worth_retry - analyze error and decide whether to retry
2135  *	@qc: qc to possibly retry
2136  *
2137  *	Look at the cause of the error and decide if a retry
2138  * 	might be useful or not.  We don't want to retry media errors
2139  *	because the drive itself has probably already taken 10-30 seconds
2140  *	doing its own internal retries before reporting the failure.
2141  */
2142 static inline int ata_eh_worth_retry(struct ata_queued_cmd *qc)
2143 {
2144 	if (qc->err_mask & AC_ERR_MEDIA)
2145 		return 0;	/* don't retry media errors */
2146 	if (qc->flags & ATA_QCFLAG_IO)
2147 		return 1;	/* otherwise retry anything from fs stack */
2148 	if (qc->err_mask & AC_ERR_INVALID)
2149 		return 0;	/* don't retry these */
2150 	return qc->err_mask != AC_ERR_DEV;  /* retry if not dev error */
2151 }
2152 
2153 /**
2154  *	ata_eh_link_autopsy - analyze error and determine recovery action
2155  *	@link: host link to perform autopsy on
2156  *
2157  *	Analyze why @link failed and determine which recovery actions
2158  *	are needed.  This function also sets more detailed AC_ERR_*
2159  *	values and fills sense data for ATAPI CHECK SENSE.
2160  *
2161  *	LOCKING:
2162  *	Kernel thread context (may sleep).
2163  */
2164 static void ata_eh_link_autopsy(struct ata_link *link)
2165 {
2166 	struct ata_port *ap = link->ap;
2167 	struct ata_eh_context *ehc = &link->eh_context;
2168 	struct ata_device *dev;
2169 	unsigned int all_err_mask = 0, eflags = 0;
2170 	int tag;
2171 	u32 serror;
2172 	int rc;
2173 
2174 	DPRINTK("ENTER\n");
2175 
2176 	if (ehc->i.flags & ATA_EHI_NO_AUTOPSY)
2177 		return;
2178 
2179 	/* obtain and analyze SError */
2180 	rc = sata_scr_read(link, SCR_ERROR, &serror);
2181 	if (rc == 0) {
2182 		ehc->i.serror |= serror;
2183 		ata_eh_analyze_serror(link);
2184 	} else if (rc != -EOPNOTSUPP) {
2185 		/* SError read failed, force reset and probing */
2186 		ehc->i.probe_mask |= ATA_ALL_DEVICES;
2187 		ehc->i.action |= ATA_EH_RESET;
2188 		ehc->i.err_mask |= AC_ERR_OTHER;
2189 	}
2190 
2191 	/* analyze NCQ failure */
2192 	ata_eh_analyze_ncq_error(link);
2193 
2194 	/* any real error trumps AC_ERR_OTHER */
2195 	if (ehc->i.err_mask & ~AC_ERR_OTHER)
2196 		ehc->i.err_mask &= ~AC_ERR_OTHER;
2197 
2198 	all_err_mask |= ehc->i.err_mask;
2199 
2200 	for (tag = 0; tag < ATA_MAX_QUEUE; tag++) {
2201 		struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag);
2202 
2203 		if (!(qc->flags & ATA_QCFLAG_FAILED) ||
2204 		    ata_dev_phys_link(qc->dev) != link)
2205 			continue;
2206 
2207 		/* inherit upper level err_mask */
2208 		qc->err_mask |= ehc->i.err_mask;
2209 
2210 		/* analyze TF */
2211 		ehc->i.action |= ata_eh_analyze_tf(qc, &qc->result_tf);
2212 
2213 		/* DEV errors are probably spurious in case of ATA_BUS error */
2214 		if (qc->err_mask & AC_ERR_ATA_BUS)
2215 			qc->err_mask &= ~(AC_ERR_DEV | AC_ERR_MEDIA |
2216 					  AC_ERR_INVALID);
2217 
2218 		/* any real error trumps unknown error */
2219 		if (qc->err_mask & ~AC_ERR_OTHER)
2220 			qc->err_mask &= ~AC_ERR_OTHER;
2221 
2222 		/* SENSE_VALID trumps dev/unknown error and revalidation */
2223 		if (qc->flags & ATA_QCFLAG_SENSE_VALID)
2224 			qc->err_mask &= ~(AC_ERR_DEV | AC_ERR_OTHER);
2225 
2226 		/* determine whether the command is worth retrying */
2227 		if (ata_eh_worth_retry(qc))
2228 			qc->flags |= ATA_QCFLAG_RETRY;
2229 
2230 		/* accumulate error info */
2231 		ehc->i.dev = qc->dev;
2232 		all_err_mask |= qc->err_mask;
2233 		if (qc->flags & ATA_QCFLAG_IO)
2234 			eflags |= ATA_EFLAG_IS_IO;
2235 		trace_ata_eh_link_autopsy_qc(qc);
2236 	}
2237 
2238 	/* enforce default EH actions */
2239 	if (ap->pflags & ATA_PFLAG_FROZEN ||
2240 	    all_err_mask & (AC_ERR_HSM | AC_ERR_TIMEOUT))
2241 		ehc->i.action |= ATA_EH_RESET;
2242 	else if (((eflags & ATA_EFLAG_IS_IO) && all_err_mask) ||
2243 		 (!(eflags & ATA_EFLAG_IS_IO) && (all_err_mask & ~AC_ERR_DEV)))
2244 		ehc->i.action |= ATA_EH_REVALIDATE;
2245 
2246 	/* If we have offending qcs and the associated failed device,
2247 	 * perform per-dev EH action only on the offending device.
2248 	 */
2249 	if (ehc->i.dev) {
2250 		ehc->i.dev_action[ehc->i.dev->devno] |=
2251 			ehc->i.action & ATA_EH_PERDEV_MASK;
2252 		ehc->i.action &= ~ATA_EH_PERDEV_MASK;
2253 	}
2254 
2255 	/* propagate timeout to host link */
2256 	if ((all_err_mask & AC_ERR_TIMEOUT) && !ata_is_host_link(link))
2257 		ap->link.eh_context.i.err_mask |= AC_ERR_TIMEOUT;
2258 
2259 	/* record error and consider speeding down */
2260 	dev = ehc->i.dev;
2261 	if (!dev && ((ata_link_max_devices(link) == 1 &&
2262 		      ata_dev_enabled(link->device))))
2263 	    dev = link->device;
2264 
2265 	if (dev) {
2266 		if (dev->flags & ATA_DFLAG_DUBIOUS_XFER)
2267 			eflags |= ATA_EFLAG_DUBIOUS_XFER;
2268 		ehc->i.action |= ata_eh_speed_down(dev, eflags, all_err_mask);
2269 	}
2270 	trace_ata_eh_link_autopsy(dev, ehc->i.action, all_err_mask);
2271 	DPRINTK("EXIT\n");
2272 }
2273 
2274 /**
2275  *	ata_eh_autopsy - analyze error and determine recovery action
2276  *	@ap: host port to perform autopsy on
2277  *
2278  *	Analyze all links of @ap and determine why they failed and
2279  *	which recovery actions are needed.
2280  *
2281  *	LOCKING:
2282  *	Kernel thread context (may sleep).
2283  */
2284 void ata_eh_autopsy(struct ata_port *ap)
2285 {
2286 	struct ata_link *link;
2287 
2288 	ata_for_each_link(link, ap, EDGE)
2289 		ata_eh_link_autopsy(link);
2290 
2291 	/* Handle the frigging slave link.  Autopsy is done similarly
2292 	 * but actions and flags are transferred over to the master
2293 	 * link and handled from there.
2294 	 */
2295 	if (ap->slave_link) {
2296 		struct ata_eh_context *mehc = &ap->link.eh_context;
2297 		struct ata_eh_context *sehc = &ap->slave_link->eh_context;
2298 
2299 		/* transfer control flags from master to slave */
2300 		sehc->i.flags |= mehc->i.flags & ATA_EHI_TO_SLAVE_MASK;
2301 
2302 		/* perform autopsy on the slave link */
2303 		ata_eh_link_autopsy(ap->slave_link);
2304 
2305 		/* transfer actions from slave to master and clear slave */
2306 		ata_eh_about_to_do(ap->slave_link, NULL, ATA_EH_ALL_ACTIONS);
2307 		mehc->i.action		|= sehc->i.action;
2308 		mehc->i.dev_action[1]	|= sehc->i.dev_action[1];
2309 		mehc->i.flags		|= sehc->i.flags;
2310 		ata_eh_done(ap->slave_link, NULL, ATA_EH_ALL_ACTIONS);
2311 	}
2312 
2313 	/* Autopsy of fanout ports can affect host link autopsy.
2314 	 * Perform host link autopsy last.
2315 	 */
2316 	if (sata_pmp_attached(ap))
2317 		ata_eh_link_autopsy(&ap->link);
2318 }
2319 
2320 /**
2321  *	ata_get_cmd_descript - get description for ATA command
2322  *	@command: ATA command code to get description for
2323  *
2324  *	Return a textual description of the given command, or NULL if the
2325  *	command is not known.
2326  *
2327  *	LOCKING:
2328  *	None
2329  */
2330 const char *ata_get_cmd_descript(u8 command)
2331 {
2332 #ifdef CONFIG_ATA_VERBOSE_ERROR
2333 	static const struct
2334 	{
2335 		u8 command;
2336 		const char *text;
2337 	} cmd_descr[] = {
2338 		{ ATA_CMD_DEV_RESET,		"DEVICE RESET" },
2339 		{ ATA_CMD_CHK_POWER,		"CHECK POWER MODE" },
2340 		{ ATA_CMD_STANDBY,		"STANDBY" },
2341 		{ ATA_CMD_IDLE,			"IDLE" },
2342 		{ ATA_CMD_EDD,			"EXECUTE DEVICE DIAGNOSTIC" },
2343 		{ ATA_CMD_DOWNLOAD_MICRO,	"DOWNLOAD MICROCODE" },
2344 		{ ATA_CMD_DOWNLOAD_MICRO_DMA,	"DOWNLOAD MICROCODE DMA" },
2345 		{ ATA_CMD_NOP,			"NOP" },
2346 		{ ATA_CMD_FLUSH,		"FLUSH CACHE" },
2347 		{ ATA_CMD_FLUSH_EXT,		"FLUSH CACHE EXT" },
2348 		{ ATA_CMD_ID_ATA,		"IDENTIFY DEVICE" },
2349 		{ ATA_CMD_ID_ATAPI,		"IDENTIFY PACKET DEVICE" },
2350 		{ ATA_CMD_SERVICE,		"SERVICE" },
2351 		{ ATA_CMD_READ,			"READ DMA" },
2352 		{ ATA_CMD_READ_EXT,		"READ DMA EXT" },
2353 		{ ATA_CMD_READ_QUEUED,		"READ DMA QUEUED" },
2354 		{ ATA_CMD_READ_STREAM_EXT,	"READ STREAM EXT" },
2355 		{ ATA_CMD_READ_STREAM_DMA_EXT,  "READ STREAM DMA EXT" },
2356 		{ ATA_CMD_WRITE,		"WRITE DMA" },
2357 		{ ATA_CMD_WRITE_EXT,		"WRITE DMA EXT" },
2358 		{ ATA_CMD_WRITE_QUEUED,		"WRITE DMA QUEUED EXT" },
2359 		{ ATA_CMD_WRITE_STREAM_EXT,	"WRITE STREAM EXT" },
2360 		{ ATA_CMD_WRITE_STREAM_DMA_EXT, "WRITE STREAM DMA EXT" },
2361 		{ ATA_CMD_WRITE_FUA_EXT,	"WRITE DMA FUA EXT" },
2362 		{ ATA_CMD_WRITE_QUEUED_FUA_EXT, "WRITE DMA QUEUED FUA EXT" },
2363 		{ ATA_CMD_FPDMA_READ,		"READ FPDMA QUEUED" },
2364 		{ ATA_CMD_FPDMA_WRITE,		"WRITE FPDMA QUEUED" },
2365 		{ ATA_CMD_FPDMA_SEND,		"SEND FPDMA QUEUED" },
2366 		{ ATA_CMD_FPDMA_RECV,		"RECEIVE FPDMA QUEUED" },
2367 		{ ATA_CMD_PIO_READ,		"READ SECTOR(S)" },
2368 		{ ATA_CMD_PIO_READ_EXT,		"READ SECTOR(S) EXT" },
2369 		{ ATA_CMD_PIO_WRITE,		"WRITE SECTOR(S)" },
2370 		{ ATA_CMD_PIO_WRITE_EXT,	"WRITE SECTOR(S) EXT" },
2371 		{ ATA_CMD_READ_MULTI,		"READ MULTIPLE" },
2372 		{ ATA_CMD_READ_MULTI_EXT,	"READ MULTIPLE EXT" },
2373 		{ ATA_CMD_WRITE_MULTI,		"WRITE MULTIPLE" },
2374 		{ ATA_CMD_WRITE_MULTI_EXT,	"WRITE MULTIPLE EXT" },
2375 		{ ATA_CMD_WRITE_MULTI_FUA_EXT,	"WRITE MULTIPLE FUA EXT" },
2376 		{ ATA_CMD_SET_FEATURES,		"SET FEATURES" },
2377 		{ ATA_CMD_SET_MULTI,		"SET MULTIPLE MODE" },
2378 		{ ATA_CMD_VERIFY,		"READ VERIFY SECTOR(S)" },
2379 		{ ATA_CMD_VERIFY_EXT,		"READ VERIFY SECTOR(S) EXT" },
2380 		{ ATA_CMD_WRITE_UNCORR_EXT,	"WRITE UNCORRECTABLE EXT" },
2381 		{ ATA_CMD_STANDBYNOW1,		"STANDBY IMMEDIATE" },
2382 		{ ATA_CMD_IDLEIMMEDIATE,	"IDLE IMMEDIATE" },
2383 		{ ATA_CMD_SLEEP,		"SLEEP" },
2384 		{ ATA_CMD_INIT_DEV_PARAMS,	"INITIALIZE DEVICE PARAMETERS" },
2385 		{ ATA_CMD_READ_NATIVE_MAX,	"READ NATIVE MAX ADDRESS" },
2386 		{ ATA_CMD_READ_NATIVE_MAX_EXT,	"READ NATIVE MAX ADDRESS EXT" },
2387 		{ ATA_CMD_SET_MAX,		"SET MAX ADDRESS" },
2388 		{ ATA_CMD_SET_MAX_EXT,		"SET MAX ADDRESS EXT" },
2389 		{ ATA_CMD_READ_LOG_EXT,		"READ LOG EXT" },
2390 		{ ATA_CMD_WRITE_LOG_EXT,	"WRITE LOG EXT" },
2391 		{ ATA_CMD_READ_LOG_DMA_EXT,	"READ LOG DMA EXT" },
2392 		{ ATA_CMD_WRITE_LOG_DMA_EXT,	"WRITE LOG DMA EXT" },
2393 		{ ATA_CMD_TRUSTED_NONDATA,	"TRUSTED NON-DATA" },
2394 		{ ATA_CMD_TRUSTED_RCV,		"TRUSTED RECEIVE" },
2395 		{ ATA_CMD_TRUSTED_RCV_DMA,	"TRUSTED RECEIVE DMA" },
2396 		{ ATA_CMD_TRUSTED_SND,		"TRUSTED SEND" },
2397 		{ ATA_CMD_TRUSTED_SND_DMA,	"TRUSTED SEND DMA" },
2398 		{ ATA_CMD_PMP_READ,		"READ BUFFER" },
2399 		{ ATA_CMD_PMP_READ_DMA,		"READ BUFFER DMA" },
2400 		{ ATA_CMD_PMP_WRITE,		"WRITE BUFFER" },
2401 		{ ATA_CMD_PMP_WRITE_DMA,	"WRITE BUFFER DMA" },
2402 		{ ATA_CMD_CONF_OVERLAY,		"DEVICE CONFIGURATION OVERLAY" },
2403 		{ ATA_CMD_SEC_SET_PASS,		"SECURITY SET PASSWORD" },
2404 		{ ATA_CMD_SEC_UNLOCK,		"SECURITY UNLOCK" },
2405 		{ ATA_CMD_SEC_ERASE_PREP,	"SECURITY ERASE PREPARE" },
2406 		{ ATA_CMD_SEC_ERASE_UNIT,	"SECURITY ERASE UNIT" },
2407 		{ ATA_CMD_SEC_FREEZE_LOCK,	"SECURITY FREEZE LOCK" },
2408 		{ ATA_CMD_SEC_DISABLE_PASS,	"SECURITY DISABLE PASSWORD" },
2409 		{ ATA_CMD_CONFIG_STREAM,	"CONFIGURE STREAM" },
2410 		{ ATA_CMD_SMART,		"SMART" },
2411 		{ ATA_CMD_MEDIA_LOCK,		"DOOR LOCK" },
2412 		{ ATA_CMD_MEDIA_UNLOCK,		"DOOR UNLOCK" },
2413 		{ ATA_CMD_DSM,			"DATA SET MANAGEMENT" },
2414 		{ ATA_CMD_CHK_MED_CRD_TYP,	"CHECK MEDIA CARD TYPE" },
2415 		{ ATA_CMD_CFA_REQ_EXT_ERR,	"CFA REQUEST EXTENDED ERROR" },
2416 		{ ATA_CMD_CFA_WRITE_NE,		"CFA WRITE SECTORS WITHOUT ERASE" },
2417 		{ ATA_CMD_CFA_TRANS_SECT,	"CFA TRANSLATE SECTOR" },
2418 		{ ATA_CMD_CFA_ERASE,		"CFA ERASE SECTORS" },
2419 		{ ATA_CMD_CFA_WRITE_MULT_NE,	"CFA WRITE MULTIPLE WITHOUT ERASE" },
2420 		{ ATA_CMD_REQ_SENSE_DATA,	"REQUEST SENSE DATA EXT" },
2421 		{ ATA_CMD_SANITIZE_DEVICE,	"SANITIZE DEVICE" },
2422 		{ ATA_CMD_ZAC_MGMT_IN,		"ZAC MANAGEMENT IN" },
2423 		{ ATA_CMD_ZAC_MGMT_OUT,		"ZAC MANAGEMENT OUT" },
2424 		{ ATA_CMD_READ_LONG,		"READ LONG (with retries)" },
2425 		{ ATA_CMD_READ_LONG_ONCE,	"READ LONG (without retries)" },
2426 		{ ATA_CMD_WRITE_LONG,		"WRITE LONG (with retries)" },
2427 		{ ATA_CMD_WRITE_LONG_ONCE,	"WRITE LONG (without retries)" },
2428 		{ ATA_CMD_RESTORE,		"RECALIBRATE" },
2429 		{ 0,				NULL } /* terminate list */
2430 	};
2431 
2432 	unsigned int i;
2433 	for (i = 0; cmd_descr[i].text; i++)
2434 		if (cmd_descr[i].command == command)
2435 			return cmd_descr[i].text;
2436 #endif
2437 
2438 	return NULL;
2439 }
2440 EXPORT_SYMBOL_GPL(ata_get_cmd_descript);
2441 
2442 /**
2443  *	ata_eh_link_report - report error handling to user
2444  *	@link: ATA link EH is going on
2445  *
2446  *	Report EH to user.
2447  *
2448  *	LOCKING:
2449  *	None.
2450  */
2451 static void ata_eh_link_report(struct ata_link *link)
2452 {
2453 	struct ata_port *ap = link->ap;
2454 	struct ata_eh_context *ehc = &link->eh_context;
2455 	const char *frozen, *desc;
2456 	char tries_buf[6] = "";
2457 	int tag, nr_failed = 0;
2458 
2459 	if (ehc->i.flags & ATA_EHI_QUIET)
2460 		return;
2461 
2462 	desc = NULL;
2463 	if (ehc->i.desc[0] != '\0')
2464 		desc = ehc->i.desc;
2465 
2466 	for (tag = 0; tag < ATA_MAX_QUEUE; tag++) {
2467 		struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag);
2468 
2469 		if (!(qc->flags & ATA_QCFLAG_FAILED) ||
2470 		    ata_dev_phys_link(qc->dev) != link ||
2471 		    ((qc->flags & ATA_QCFLAG_QUIET) &&
2472 		     qc->err_mask == AC_ERR_DEV))
2473 			continue;
2474 		if (qc->flags & ATA_QCFLAG_SENSE_VALID && !qc->err_mask)
2475 			continue;
2476 
2477 		nr_failed++;
2478 	}
2479 
2480 	if (!nr_failed && !ehc->i.err_mask)
2481 		return;
2482 
2483 	frozen = "";
2484 	if (ap->pflags & ATA_PFLAG_FROZEN)
2485 		frozen = " frozen";
2486 
2487 	if (ap->eh_tries < ATA_EH_MAX_TRIES)
2488 		snprintf(tries_buf, sizeof(tries_buf), " t%d",
2489 			 ap->eh_tries);
2490 
2491 	if (ehc->i.dev) {
2492 		ata_dev_err(ehc->i.dev, "exception Emask 0x%x "
2493 			    "SAct 0x%x SErr 0x%x action 0x%x%s%s\n",
2494 			    ehc->i.err_mask, link->sactive, ehc->i.serror,
2495 			    ehc->i.action, frozen, tries_buf);
2496 		if (desc)
2497 			ata_dev_err(ehc->i.dev, "%s\n", desc);
2498 	} else {
2499 		ata_link_err(link, "exception Emask 0x%x "
2500 			     "SAct 0x%x SErr 0x%x action 0x%x%s%s\n",
2501 			     ehc->i.err_mask, link->sactive, ehc->i.serror,
2502 			     ehc->i.action, frozen, tries_buf);
2503 		if (desc)
2504 			ata_link_err(link, "%s\n", desc);
2505 	}
2506 
2507 #ifdef CONFIG_ATA_VERBOSE_ERROR
2508 	if (ehc->i.serror)
2509 		ata_link_err(link,
2510 		  "SError: { %s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s%s}\n",
2511 		  ehc->i.serror & SERR_DATA_RECOVERED ? "RecovData " : "",
2512 		  ehc->i.serror & SERR_COMM_RECOVERED ? "RecovComm " : "",
2513 		  ehc->i.serror & SERR_DATA ? "UnrecovData " : "",
2514 		  ehc->i.serror & SERR_PERSISTENT ? "Persist " : "",
2515 		  ehc->i.serror & SERR_PROTOCOL ? "Proto " : "",
2516 		  ehc->i.serror & SERR_INTERNAL ? "HostInt " : "",
2517 		  ehc->i.serror & SERR_PHYRDY_CHG ? "PHYRdyChg " : "",
2518 		  ehc->i.serror & SERR_PHY_INT_ERR ? "PHYInt " : "",
2519 		  ehc->i.serror & SERR_COMM_WAKE ? "CommWake " : "",
2520 		  ehc->i.serror & SERR_10B_8B_ERR ? "10B8B " : "",
2521 		  ehc->i.serror & SERR_DISPARITY ? "Dispar " : "",
2522 		  ehc->i.serror & SERR_CRC ? "BadCRC " : "",
2523 		  ehc->i.serror & SERR_HANDSHAKE ? "Handshk " : "",
2524 		  ehc->i.serror & SERR_LINK_SEQ_ERR ? "LinkSeq " : "",
2525 		  ehc->i.serror & SERR_TRANS_ST_ERROR ? "TrStaTrns " : "",
2526 		  ehc->i.serror & SERR_UNRECOG_FIS ? "UnrecFIS " : "",
2527 		  ehc->i.serror & SERR_DEV_XCHG ? "DevExch " : "");
2528 #endif
2529 
2530 	for (tag = 0; tag < ATA_MAX_QUEUE; tag++) {
2531 		struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag);
2532 		struct ata_taskfile *cmd = &qc->tf, *res = &qc->result_tf;
2533 		char data_buf[20] = "";
2534 		char cdb_buf[70] = "";
2535 
2536 		if (!(qc->flags & ATA_QCFLAG_FAILED) ||
2537 		    ata_dev_phys_link(qc->dev) != link || !qc->err_mask)
2538 			continue;
2539 
2540 		if (qc->dma_dir != DMA_NONE) {
2541 			static const char *dma_str[] = {
2542 				[DMA_BIDIRECTIONAL]	= "bidi",
2543 				[DMA_TO_DEVICE]		= "out",
2544 				[DMA_FROM_DEVICE]	= "in",
2545 			};
2546 			const char *prot_str = NULL;
2547 
2548 			switch (qc->tf.protocol) {
2549 			case ATA_PROT_UNKNOWN:
2550 				prot_str = "unknown";
2551 				break;
2552 			case ATA_PROT_NODATA:
2553 				prot_str = "nodata";
2554 				break;
2555 			case ATA_PROT_PIO:
2556 				prot_str = "pio";
2557 				break;
2558 			case ATA_PROT_DMA:
2559 				prot_str = "dma";
2560 				break;
2561 			case ATA_PROT_NCQ:
2562 				prot_str = "ncq dma";
2563 				break;
2564 			case ATA_PROT_NCQ_NODATA:
2565 				prot_str = "ncq nodata";
2566 				break;
2567 			case ATAPI_PROT_NODATA:
2568 				prot_str = "nodata";
2569 				break;
2570 			case ATAPI_PROT_PIO:
2571 				prot_str = "pio";
2572 				break;
2573 			case ATAPI_PROT_DMA:
2574 				prot_str = "dma";
2575 				break;
2576 			}
2577 			snprintf(data_buf, sizeof(data_buf), " %s %u %s",
2578 				 prot_str, qc->nbytes, dma_str[qc->dma_dir]);
2579 		}
2580 
2581 		if (ata_is_atapi(qc->tf.protocol)) {
2582 			const u8 *cdb = qc->cdb;
2583 			size_t cdb_len = qc->dev->cdb_len;
2584 
2585 			if (qc->scsicmd) {
2586 				cdb = qc->scsicmd->cmnd;
2587 				cdb_len = qc->scsicmd->cmd_len;
2588 			}
2589 			__scsi_format_command(cdb_buf, sizeof(cdb_buf),
2590 					      cdb, cdb_len);
2591 		} else {
2592 			const char *descr = ata_get_cmd_descript(cmd->command);
2593 			if (descr)
2594 				ata_dev_err(qc->dev, "failed command: %s\n",
2595 					    descr);
2596 		}
2597 
2598 		ata_dev_err(qc->dev,
2599 			"cmd %02x/%02x:%02x:%02x:%02x:%02x/%02x:%02x:%02x:%02x:%02x/%02x "
2600 			"tag %d%s\n         %s"
2601 			"res %02x/%02x:%02x:%02x:%02x:%02x/%02x:%02x:%02x:%02x:%02x/%02x "
2602 			"Emask 0x%x (%s)%s\n",
2603 			cmd->command, cmd->feature, cmd->nsect,
2604 			cmd->lbal, cmd->lbam, cmd->lbah,
2605 			cmd->hob_feature, cmd->hob_nsect,
2606 			cmd->hob_lbal, cmd->hob_lbam, cmd->hob_lbah,
2607 			cmd->device, qc->tag, data_buf, cdb_buf,
2608 			res->command, res->feature, res->nsect,
2609 			res->lbal, res->lbam, res->lbah,
2610 			res->hob_feature, res->hob_nsect,
2611 			res->hob_lbal, res->hob_lbam, res->hob_lbah,
2612 			res->device, qc->err_mask, ata_err_string(qc->err_mask),
2613 			qc->err_mask & AC_ERR_NCQ ? " <F>" : "");
2614 
2615 #ifdef CONFIG_ATA_VERBOSE_ERROR
2616 		if (res->command & (ATA_BUSY | ATA_DRDY | ATA_DF | ATA_DRQ |
2617 				    ATA_SENSE | ATA_ERR)) {
2618 			if (res->command & ATA_BUSY)
2619 				ata_dev_err(qc->dev, "status: { Busy }\n");
2620 			else
2621 				ata_dev_err(qc->dev, "status: { %s%s%s%s%s}\n",
2622 				  res->command & ATA_DRDY ? "DRDY " : "",
2623 				  res->command & ATA_DF ? "DF " : "",
2624 				  res->command & ATA_DRQ ? "DRQ " : "",
2625 				  res->command & ATA_SENSE ? "SENSE " : "",
2626 				  res->command & ATA_ERR ? "ERR " : "");
2627 		}
2628 
2629 		if (cmd->command != ATA_CMD_PACKET &&
2630 		    (res->feature & (ATA_ICRC | ATA_UNC | ATA_AMNF |
2631 				     ATA_IDNF | ATA_ABORTED)))
2632 			ata_dev_err(qc->dev, "error: { %s%s%s%s%s}\n",
2633 			  res->feature & ATA_ICRC ? "ICRC " : "",
2634 			  res->feature & ATA_UNC ? "UNC " : "",
2635 			  res->feature & ATA_AMNF ? "AMNF " : "",
2636 			  res->feature & ATA_IDNF ? "IDNF " : "",
2637 			  res->feature & ATA_ABORTED ? "ABRT " : "");
2638 #endif
2639 	}
2640 }
2641 
2642 /**
2643  *	ata_eh_report - report error handling to user
2644  *	@ap: ATA port to report EH about
2645  *
2646  *	Report EH to user.
2647  *
2648  *	LOCKING:
2649  *	None.
2650  */
2651 void ata_eh_report(struct ata_port *ap)
2652 {
2653 	struct ata_link *link;
2654 
2655 	ata_for_each_link(link, ap, HOST_FIRST)
2656 		ata_eh_link_report(link);
2657 }
2658 
2659 static int ata_do_reset(struct ata_link *link, ata_reset_fn_t reset,
2660 			unsigned int *classes, unsigned long deadline,
2661 			bool clear_classes)
2662 {
2663 	struct ata_device *dev;
2664 
2665 	if (clear_classes)
2666 		ata_for_each_dev(dev, link, ALL)
2667 			classes[dev->devno] = ATA_DEV_UNKNOWN;
2668 
2669 	return reset(link, classes, deadline);
2670 }
2671 
2672 static int ata_eh_followup_srst_needed(struct ata_link *link, int rc)
2673 {
2674 	if ((link->flags & ATA_LFLAG_NO_SRST) || ata_link_offline(link))
2675 		return 0;
2676 	if (rc == -EAGAIN)
2677 		return 1;
2678 	if (sata_pmp_supported(link->ap) && ata_is_host_link(link))
2679 		return 1;
2680 	return 0;
2681 }
2682 
2683 int ata_eh_reset(struct ata_link *link, int classify,
2684 		 ata_prereset_fn_t prereset, ata_reset_fn_t softreset,
2685 		 ata_reset_fn_t hardreset, ata_postreset_fn_t postreset)
2686 {
2687 	struct ata_port *ap = link->ap;
2688 	struct ata_link *slave = ap->slave_link;
2689 	struct ata_eh_context *ehc = &link->eh_context;
2690 	struct ata_eh_context *sehc = slave ? &slave->eh_context : NULL;
2691 	unsigned int *classes = ehc->classes;
2692 	unsigned int lflags = link->flags;
2693 	int verbose = !(ehc->i.flags & ATA_EHI_QUIET);
2694 	int max_tries = 0, try = 0;
2695 	struct ata_link *failed_link;
2696 	struct ata_device *dev;
2697 	unsigned long deadline, now;
2698 	ata_reset_fn_t reset;
2699 	unsigned long flags;
2700 	u32 sstatus;
2701 	int nr_unknown, rc;
2702 
2703 	/*
2704 	 * Prepare to reset
2705 	 */
2706 	while (ata_eh_reset_timeouts[max_tries] != ULONG_MAX)
2707 		max_tries++;
2708 	if (link->flags & ATA_LFLAG_RST_ONCE)
2709 		max_tries = 1;
2710 	if (link->flags & ATA_LFLAG_NO_HRST)
2711 		hardreset = NULL;
2712 	if (link->flags & ATA_LFLAG_NO_SRST)
2713 		softreset = NULL;
2714 
2715 	/* make sure each reset attempt is at least COOL_DOWN apart */
2716 	if (ehc->i.flags & ATA_EHI_DID_RESET) {
2717 		now = jiffies;
2718 		WARN_ON(time_after(ehc->last_reset, now));
2719 		deadline = ata_deadline(ehc->last_reset,
2720 					ATA_EH_RESET_COOL_DOWN);
2721 		if (time_before(now, deadline))
2722 			schedule_timeout_uninterruptible(deadline - now);
2723 	}
2724 
2725 	spin_lock_irqsave(ap->lock, flags);
2726 	ap->pflags |= ATA_PFLAG_RESETTING;
2727 	spin_unlock_irqrestore(ap->lock, flags);
2728 
2729 	ata_eh_about_to_do(link, NULL, ATA_EH_RESET);
2730 
2731 	ata_for_each_dev(dev, link, ALL) {
2732 		/* If we issue an SRST then an ATA drive (not ATAPI)
2733 		 * may change configuration and be in PIO0 timing. If
2734 		 * we do a hard reset (or are coming from power on)
2735 		 * this is true for ATA or ATAPI. Until we've set a
2736 		 * suitable controller mode we should not touch the
2737 		 * bus as we may be talking too fast.
2738 		 */
2739 		dev->pio_mode = XFER_PIO_0;
2740 		dev->dma_mode = 0xff;
2741 
2742 		/* If the controller has a pio mode setup function
2743 		 * then use it to set the chipset to rights. Don't
2744 		 * touch the DMA setup as that will be dealt with when
2745 		 * configuring devices.
2746 		 */
2747 		if (ap->ops->set_piomode)
2748 			ap->ops->set_piomode(ap, dev);
2749 	}
2750 
2751 	/* prefer hardreset */
2752 	reset = NULL;
2753 	ehc->i.action &= ~ATA_EH_RESET;
2754 	if (hardreset) {
2755 		reset = hardreset;
2756 		ehc->i.action |= ATA_EH_HARDRESET;
2757 	} else if (softreset) {
2758 		reset = softreset;
2759 		ehc->i.action |= ATA_EH_SOFTRESET;
2760 	}
2761 
2762 	if (prereset) {
2763 		unsigned long deadline = ata_deadline(jiffies,
2764 						      ATA_EH_PRERESET_TIMEOUT);
2765 
2766 		if (slave) {
2767 			sehc->i.action &= ~ATA_EH_RESET;
2768 			sehc->i.action |= ehc->i.action;
2769 		}
2770 
2771 		rc = prereset(link, deadline);
2772 
2773 		/* If present, do prereset on slave link too.  Reset
2774 		 * is skipped iff both master and slave links report
2775 		 * -ENOENT or clear ATA_EH_RESET.
2776 		 */
2777 		if (slave && (rc == 0 || rc == -ENOENT)) {
2778 			int tmp;
2779 
2780 			tmp = prereset(slave, deadline);
2781 			if (tmp != -ENOENT)
2782 				rc = tmp;
2783 
2784 			ehc->i.action |= sehc->i.action;
2785 		}
2786 
2787 		if (rc) {
2788 			if (rc == -ENOENT) {
2789 				ata_link_dbg(link, "port disabled--ignoring\n");
2790 				ehc->i.action &= ~ATA_EH_RESET;
2791 
2792 				ata_for_each_dev(dev, link, ALL)
2793 					classes[dev->devno] = ATA_DEV_NONE;
2794 
2795 				rc = 0;
2796 			} else
2797 				ata_link_err(link,
2798 					     "prereset failed (errno=%d)\n",
2799 					     rc);
2800 			goto out;
2801 		}
2802 
2803 		/* prereset() might have cleared ATA_EH_RESET.  If so,
2804 		 * bang classes, thaw and return.
2805 		 */
2806 		if (reset && !(ehc->i.action & ATA_EH_RESET)) {
2807 			ata_for_each_dev(dev, link, ALL)
2808 				classes[dev->devno] = ATA_DEV_NONE;
2809 			if ((ap->pflags & ATA_PFLAG_FROZEN) &&
2810 			    ata_is_host_link(link))
2811 				ata_eh_thaw_port(ap);
2812 			rc = 0;
2813 			goto out;
2814 		}
2815 	}
2816 
2817  retry:
2818 	/*
2819 	 * Perform reset
2820 	 */
2821 	if (ata_is_host_link(link))
2822 		ata_eh_freeze_port(ap);
2823 
2824 	deadline = ata_deadline(jiffies, ata_eh_reset_timeouts[try++]);
2825 
2826 	if (reset) {
2827 		if (verbose)
2828 			ata_link_info(link, "%s resetting link\n",
2829 				      reset == softreset ? "soft" : "hard");
2830 
2831 		/* mark that this EH session started with reset */
2832 		ehc->last_reset = jiffies;
2833 		if (reset == hardreset)
2834 			ehc->i.flags |= ATA_EHI_DID_HARDRESET;
2835 		else
2836 			ehc->i.flags |= ATA_EHI_DID_SOFTRESET;
2837 
2838 		rc = ata_do_reset(link, reset, classes, deadline, true);
2839 		if (rc && rc != -EAGAIN) {
2840 			failed_link = link;
2841 			goto fail;
2842 		}
2843 
2844 		/* hardreset slave link if existent */
2845 		if (slave && reset == hardreset) {
2846 			int tmp;
2847 
2848 			if (verbose)
2849 				ata_link_info(slave, "hard resetting link\n");
2850 
2851 			ata_eh_about_to_do(slave, NULL, ATA_EH_RESET);
2852 			tmp = ata_do_reset(slave, reset, classes, deadline,
2853 					   false);
2854 			switch (tmp) {
2855 			case -EAGAIN:
2856 				rc = -EAGAIN;
2857 			case 0:
2858 				break;
2859 			default:
2860 				failed_link = slave;
2861 				rc = tmp;
2862 				goto fail;
2863 			}
2864 		}
2865 
2866 		/* perform follow-up SRST if necessary */
2867 		if (reset == hardreset &&
2868 		    ata_eh_followup_srst_needed(link, rc)) {
2869 			reset = softreset;
2870 
2871 			if (!reset) {
2872 				ata_link_err(link,
2873 	     "follow-up softreset required but no softreset available\n");
2874 				failed_link = link;
2875 				rc = -EINVAL;
2876 				goto fail;
2877 			}
2878 
2879 			ata_eh_about_to_do(link, NULL, ATA_EH_RESET);
2880 			rc = ata_do_reset(link, reset, classes, deadline, true);
2881 			if (rc) {
2882 				failed_link = link;
2883 				goto fail;
2884 			}
2885 		}
2886 	} else {
2887 		if (verbose)
2888 			ata_link_info(link,
2889 	"no reset method available, skipping reset\n");
2890 		if (!(lflags & ATA_LFLAG_ASSUME_CLASS))
2891 			lflags |= ATA_LFLAG_ASSUME_ATA;
2892 	}
2893 
2894 	/*
2895 	 * Post-reset processing
2896 	 */
2897 	ata_for_each_dev(dev, link, ALL) {
2898 		/* After the reset, the device state is PIO 0 and the
2899 		 * controller state is undefined.  Reset also wakes up
2900 		 * drives from sleeping mode.
2901 		 */
2902 		dev->pio_mode = XFER_PIO_0;
2903 		dev->flags &= ~ATA_DFLAG_SLEEPING;
2904 
2905 		if (ata_phys_link_offline(ata_dev_phys_link(dev)))
2906 			continue;
2907 
2908 		/* apply class override */
2909 		if (lflags & ATA_LFLAG_ASSUME_ATA)
2910 			classes[dev->devno] = ATA_DEV_ATA;
2911 		else if (lflags & ATA_LFLAG_ASSUME_SEMB)
2912 			classes[dev->devno] = ATA_DEV_SEMB_UNSUP;
2913 	}
2914 
2915 	/* record current link speed */
2916 	if (sata_scr_read(link, SCR_STATUS, &sstatus) == 0)
2917 		link->sata_spd = (sstatus >> 4) & 0xf;
2918 	if (slave && sata_scr_read(slave, SCR_STATUS, &sstatus) == 0)
2919 		slave->sata_spd = (sstatus >> 4) & 0xf;
2920 
2921 	/* thaw the port */
2922 	if (ata_is_host_link(link))
2923 		ata_eh_thaw_port(ap);
2924 
2925 	/* postreset() should clear hardware SError.  Although SError
2926 	 * is cleared during link resume, clearing SError here is
2927 	 * necessary as some PHYs raise hotplug events after SRST.
2928 	 * This introduces race condition where hotplug occurs between
2929 	 * reset and here.  This race is mediated by cross checking
2930 	 * link onlineness and classification result later.
2931 	 */
2932 	if (postreset) {
2933 		postreset(link, classes);
2934 		if (slave)
2935 			postreset(slave, classes);
2936 	}
2937 
2938 	/*
2939 	 * Some controllers can't be frozen very well and may set spurious
2940 	 * error conditions during reset.  Clear accumulated error
2941 	 * information and re-thaw the port if frozen.  As reset is the
2942 	 * final recovery action and we cross check link onlineness against
2943 	 * device classification later, no hotplug event is lost by this.
2944 	 */
2945 	spin_lock_irqsave(link->ap->lock, flags);
2946 	memset(&link->eh_info, 0, sizeof(link->eh_info));
2947 	if (slave)
2948 		memset(&slave->eh_info, 0, sizeof(link->eh_info));
2949 	ap->pflags &= ~ATA_PFLAG_EH_PENDING;
2950 	spin_unlock_irqrestore(link->ap->lock, flags);
2951 
2952 	if (ap->pflags & ATA_PFLAG_FROZEN)
2953 		ata_eh_thaw_port(ap);
2954 
2955 	/*
2956 	 * Make sure onlineness and classification result correspond.
2957 	 * Hotplug could have happened during reset and some
2958 	 * controllers fail to wait while a drive is spinning up after
2959 	 * being hotplugged causing misdetection.  By cross checking
2960 	 * link on/offlineness and classification result, those
2961 	 * conditions can be reliably detected and retried.
2962 	 */
2963 	nr_unknown = 0;
2964 	ata_for_each_dev(dev, link, ALL) {
2965 		if (ata_phys_link_online(ata_dev_phys_link(dev))) {
2966 			if (classes[dev->devno] == ATA_DEV_UNKNOWN) {
2967 				ata_dev_dbg(dev, "link online but device misclassified\n");
2968 				classes[dev->devno] = ATA_DEV_NONE;
2969 				nr_unknown++;
2970 			}
2971 		} else if (ata_phys_link_offline(ata_dev_phys_link(dev))) {
2972 			if (ata_class_enabled(classes[dev->devno]))
2973 				ata_dev_dbg(dev,
2974 					    "link offline, clearing class %d to NONE\n",
2975 					    classes[dev->devno]);
2976 			classes[dev->devno] = ATA_DEV_NONE;
2977 		} else if (classes[dev->devno] == ATA_DEV_UNKNOWN) {
2978 			ata_dev_dbg(dev,
2979 				    "link status unknown, clearing UNKNOWN to NONE\n");
2980 			classes[dev->devno] = ATA_DEV_NONE;
2981 		}
2982 	}
2983 
2984 	if (classify && nr_unknown) {
2985 		if (try < max_tries) {
2986 			ata_link_warn(link,
2987 				      "link online but %d devices misclassified, retrying\n",
2988 				      nr_unknown);
2989 			failed_link = link;
2990 			rc = -EAGAIN;
2991 			goto fail;
2992 		}
2993 		ata_link_warn(link,
2994 			      "link online but %d devices misclassified, "
2995 			      "device detection might fail\n", nr_unknown);
2996 	}
2997 
2998 	/* reset successful, schedule revalidation */
2999 	ata_eh_done(link, NULL, ATA_EH_RESET);
3000 	if (slave)
3001 		ata_eh_done(slave, NULL, ATA_EH_RESET);
3002 	ehc->last_reset = jiffies;		/* update to completion time */
3003 	ehc->i.action |= ATA_EH_REVALIDATE;
3004 	link->lpm_policy = ATA_LPM_UNKNOWN;	/* reset LPM state */
3005 
3006 	rc = 0;
3007  out:
3008 	/* clear hotplug flag */
3009 	ehc->i.flags &= ~ATA_EHI_HOTPLUGGED;
3010 	if (slave)
3011 		sehc->i.flags &= ~ATA_EHI_HOTPLUGGED;
3012 
3013 	spin_lock_irqsave(ap->lock, flags);
3014 	ap->pflags &= ~ATA_PFLAG_RESETTING;
3015 	spin_unlock_irqrestore(ap->lock, flags);
3016 
3017 	return rc;
3018 
3019  fail:
3020 	/* if SCR isn't accessible on a fan-out port, PMP needs to be reset */
3021 	if (!ata_is_host_link(link) &&
3022 	    sata_scr_read(link, SCR_STATUS, &sstatus))
3023 		rc = -ERESTART;
3024 
3025 	if (try >= max_tries) {
3026 		/*
3027 		 * Thaw host port even if reset failed, so that the port
3028 		 * can be retried on the next phy event.  This risks
3029 		 * repeated EH runs but seems to be a better tradeoff than
3030 		 * shutting down a port after a botched hotplug attempt.
3031 		 */
3032 		if (ata_is_host_link(link))
3033 			ata_eh_thaw_port(ap);
3034 		goto out;
3035 	}
3036 
3037 	now = jiffies;
3038 	if (time_before(now, deadline)) {
3039 		unsigned long delta = deadline - now;
3040 
3041 		ata_link_warn(failed_link,
3042 			"reset failed (errno=%d), retrying in %u secs\n",
3043 			rc, DIV_ROUND_UP(jiffies_to_msecs(delta), 1000));
3044 
3045 		ata_eh_release(ap);
3046 		while (delta)
3047 			delta = schedule_timeout_uninterruptible(delta);
3048 		ata_eh_acquire(ap);
3049 	}
3050 
3051 	/*
3052 	 * While disks spinup behind PMP, some controllers fail sending SRST.
3053 	 * They need to be reset - as well as the PMP - before retrying.
3054 	 */
3055 	if (rc == -ERESTART) {
3056 		if (ata_is_host_link(link))
3057 			ata_eh_thaw_port(ap);
3058 		goto out;
3059 	}
3060 
3061 	if (try == max_tries - 1) {
3062 		sata_down_spd_limit(link, 0);
3063 		if (slave)
3064 			sata_down_spd_limit(slave, 0);
3065 	} else if (rc == -EPIPE)
3066 		sata_down_spd_limit(failed_link, 0);
3067 
3068 	if (hardreset)
3069 		reset = hardreset;
3070 	goto retry;
3071 }
3072 
3073 static inline void ata_eh_pull_park_action(struct ata_port *ap)
3074 {
3075 	struct ata_link *link;
3076 	struct ata_device *dev;
3077 	unsigned long flags;
3078 
3079 	/*
3080 	 * This function can be thought of as an extended version of
3081 	 * ata_eh_about_to_do() specially crafted to accommodate the
3082 	 * requirements of ATA_EH_PARK handling. Since the EH thread
3083 	 * does not leave the do {} while () loop in ata_eh_recover as
3084 	 * long as the timeout for a park request to *one* device on
3085 	 * the port has not expired, and since we still want to pick
3086 	 * up park requests to other devices on the same port or
3087 	 * timeout updates for the same device, we have to pull
3088 	 * ATA_EH_PARK actions from eh_info into eh_context.i
3089 	 * ourselves at the beginning of each pass over the loop.
3090 	 *
3091 	 * Additionally, all write accesses to &ap->park_req_pending
3092 	 * through reinit_completion() (see below) or complete_all()
3093 	 * (see ata_scsi_park_store()) are protected by the host lock.
3094 	 * As a result we have that park_req_pending.done is zero on
3095 	 * exit from this function, i.e. when ATA_EH_PARK actions for
3096 	 * *all* devices on port ap have been pulled into the
3097 	 * respective eh_context structs. If, and only if,
3098 	 * park_req_pending.done is non-zero by the time we reach
3099 	 * wait_for_completion_timeout(), another ATA_EH_PARK action
3100 	 * has been scheduled for at least one of the devices on port
3101 	 * ap and we have to cycle over the do {} while () loop in
3102 	 * ata_eh_recover() again.
3103 	 */
3104 
3105 	spin_lock_irqsave(ap->lock, flags);
3106 	reinit_completion(&ap->park_req_pending);
3107 	ata_for_each_link(link, ap, EDGE) {
3108 		ata_for_each_dev(dev, link, ALL) {
3109 			struct ata_eh_info *ehi = &link->eh_info;
3110 
3111 			link->eh_context.i.dev_action[dev->devno] |=
3112 				ehi->dev_action[dev->devno] & ATA_EH_PARK;
3113 			ata_eh_clear_action(link, dev, ehi, ATA_EH_PARK);
3114 		}
3115 	}
3116 	spin_unlock_irqrestore(ap->lock, flags);
3117 }
3118 
3119 static void ata_eh_park_issue_cmd(struct ata_device *dev, int park)
3120 {
3121 	struct ata_eh_context *ehc = &dev->link->eh_context;
3122 	struct ata_taskfile tf;
3123 	unsigned int err_mask;
3124 
3125 	ata_tf_init(dev, &tf);
3126 	if (park) {
3127 		ehc->unloaded_mask |= 1 << dev->devno;
3128 		tf.command = ATA_CMD_IDLEIMMEDIATE;
3129 		tf.feature = 0x44;
3130 		tf.lbal = 0x4c;
3131 		tf.lbam = 0x4e;
3132 		tf.lbah = 0x55;
3133 	} else {
3134 		ehc->unloaded_mask &= ~(1 << dev->devno);
3135 		tf.command = ATA_CMD_CHK_POWER;
3136 	}
3137 
3138 	tf.flags |= ATA_TFLAG_DEVICE | ATA_TFLAG_ISADDR;
3139 	tf.protocol = ATA_PROT_NODATA;
3140 	err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
3141 	if (park && (err_mask || tf.lbal != 0xc4)) {
3142 		ata_dev_err(dev, "head unload failed!\n");
3143 		ehc->unloaded_mask &= ~(1 << dev->devno);
3144 	}
3145 }
3146 
3147 static int ata_eh_revalidate_and_attach(struct ata_link *link,
3148 					struct ata_device **r_failed_dev)
3149 {
3150 	struct ata_port *ap = link->ap;
3151 	struct ata_eh_context *ehc = &link->eh_context;
3152 	struct ata_device *dev;
3153 	unsigned int new_mask = 0;
3154 	unsigned long flags;
3155 	int rc = 0;
3156 
3157 	DPRINTK("ENTER\n");
3158 
3159 	/* For PATA drive side cable detection to work, IDENTIFY must
3160 	 * be done backwards such that PDIAG- is released by the slave
3161 	 * device before the master device is identified.
3162 	 */
3163 	ata_for_each_dev(dev, link, ALL_REVERSE) {
3164 		unsigned int action = ata_eh_dev_action(dev);
3165 		unsigned int readid_flags = 0;
3166 
3167 		if (ehc->i.flags & ATA_EHI_DID_RESET)
3168 			readid_flags |= ATA_READID_POSTRESET;
3169 
3170 		if ((action & ATA_EH_REVALIDATE) && ata_dev_enabled(dev)) {
3171 			WARN_ON(dev->class == ATA_DEV_PMP);
3172 
3173 			if (ata_phys_link_offline(ata_dev_phys_link(dev))) {
3174 				rc = -EIO;
3175 				goto err;
3176 			}
3177 
3178 			ata_eh_about_to_do(link, dev, ATA_EH_REVALIDATE);
3179 			rc = ata_dev_revalidate(dev, ehc->classes[dev->devno],
3180 						readid_flags);
3181 			if (rc)
3182 				goto err;
3183 
3184 			ata_eh_done(link, dev, ATA_EH_REVALIDATE);
3185 
3186 			/* Configuration may have changed, reconfigure
3187 			 * transfer mode.
3188 			 */
3189 			ehc->i.flags |= ATA_EHI_SETMODE;
3190 
3191 			/* schedule the scsi_rescan_device() here */
3192 			schedule_work(&(ap->scsi_rescan_task));
3193 		} else if (dev->class == ATA_DEV_UNKNOWN &&
3194 			   ehc->tries[dev->devno] &&
3195 			   ata_class_enabled(ehc->classes[dev->devno])) {
3196 			/* Temporarily set dev->class, it will be
3197 			 * permanently set once all configurations are
3198 			 * complete.  This is necessary because new
3199 			 * device configuration is done in two
3200 			 * separate loops.
3201 			 */
3202 			dev->class = ehc->classes[dev->devno];
3203 
3204 			if (dev->class == ATA_DEV_PMP)
3205 				rc = sata_pmp_attach(dev);
3206 			else
3207 				rc = ata_dev_read_id(dev, &dev->class,
3208 						     readid_flags, dev->id);
3209 
3210 			/* read_id might have changed class, store and reset */
3211 			ehc->classes[dev->devno] = dev->class;
3212 			dev->class = ATA_DEV_UNKNOWN;
3213 
3214 			switch (rc) {
3215 			case 0:
3216 				/* clear error info accumulated during probe */
3217 				ata_ering_clear(&dev->ering);
3218 				new_mask |= 1 << dev->devno;
3219 				break;
3220 			case -ENOENT:
3221 				/* IDENTIFY was issued to non-existent
3222 				 * device.  No need to reset.  Just
3223 				 * thaw and ignore the device.
3224 				 */
3225 				ata_eh_thaw_port(ap);
3226 				break;
3227 			default:
3228 				goto err;
3229 			}
3230 		}
3231 	}
3232 
3233 	/* PDIAG- should have been released, ask cable type if post-reset */
3234 	if ((ehc->i.flags & ATA_EHI_DID_RESET) && ata_is_host_link(link)) {
3235 		if (ap->ops->cable_detect)
3236 			ap->cbl = ap->ops->cable_detect(ap);
3237 		ata_force_cbl(ap);
3238 	}
3239 
3240 	/* Configure new devices forward such that user doesn't see
3241 	 * device detection messages backwards.
3242 	 */
3243 	ata_for_each_dev(dev, link, ALL) {
3244 		if (!(new_mask & (1 << dev->devno)))
3245 			continue;
3246 
3247 		dev->class = ehc->classes[dev->devno];
3248 
3249 		if (dev->class == ATA_DEV_PMP)
3250 			continue;
3251 
3252 		ehc->i.flags |= ATA_EHI_PRINTINFO;
3253 		rc = ata_dev_configure(dev);
3254 		ehc->i.flags &= ~ATA_EHI_PRINTINFO;
3255 		if (rc) {
3256 			dev->class = ATA_DEV_UNKNOWN;
3257 			goto err;
3258 		}
3259 
3260 		spin_lock_irqsave(ap->lock, flags);
3261 		ap->pflags |= ATA_PFLAG_SCSI_HOTPLUG;
3262 		spin_unlock_irqrestore(ap->lock, flags);
3263 
3264 		/* new device discovered, configure xfermode */
3265 		ehc->i.flags |= ATA_EHI_SETMODE;
3266 	}
3267 
3268 	return 0;
3269 
3270  err:
3271 	*r_failed_dev = dev;
3272 	DPRINTK("EXIT rc=%d\n", rc);
3273 	return rc;
3274 }
3275 
3276 /**
3277  *	ata_set_mode - Program timings and issue SET FEATURES - XFER
3278  *	@link: link on which timings will be programmed
3279  *	@r_failed_dev: out parameter for failed device
3280  *
3281  *	Set ATA device disk transfer mode (PIO3, UDMA6, etc.).  If
3282  *	ata_set_mode() fails, pointer to the failing device is
3283  *	returned in @r_failed_dev.
3284  *
3285  *	LOCKING:
3286  *	PCI/etc. bus probe sem.
3287  *
3288  *	RETURNS:
3289  *	0 on success, negative errno otherwise
3290  */
3291 int ata_set_mode(struct ata_link *link, struct ata_device **r_failed_dev)
3292 {
3293 	struct ata_port *ap = link->ap;
3294 	struct ata_device *dev;
3295 	int rc;
3296 
3297 	/* if data transfer is verified, clear DUBIOUS_XFER on ering top */
3298 	ata_for_each_dev(dev, link, ENABLED) {
3299 		if (!(dev->flags & ATA_DFLAG_DUBIOUS_XFER)) {
3300 			struct ata_ering_entry *ent;
3301 
3302 			ent = ata_ering_top(&dev->ering);
3303 			if (ent)
3304 				ent->eflags &= ~ATA_EFLAG_DUBIOUS_XFER;
3305 		}
3306 	}
3307 
3308 	/* has private set_mode? */
3309 	if (ap->ops->set_mode)
3310 		rc = ap->ops->set_mode(link, r_failed_dev);
3311 	else
3312 		rc = ata_do_set_mode(link, r_failed_dev);
3313 
3314 	/* if transfer mode has changed, set DUBIOUS_XFER on device */
3315 	ata_for_each_dev(dev, link, ENABLED) {
3316 		struct ata_eh_context *ehc = &link->eh_context;
3317 		u8 saved_xfer_mode = ehc->saved_xfer_mode[dev->devno];
3318 		u8 saved_ncq = !!(ehc->saved_ncq_enabled & (1 << dev->devno));
3319 
3320 		if (dev->xfer_mode != saved_xfer_mode ||
3321 		    ata_ncq_enabled(dev) != saved_ncq)
3322 			dev->flags |= ATA_DFLAG_DUBIOUS_XFER;
3323 	}
3324 
3325 	return rc;
3326 }
3327 
3328 /**
3329  *	atapi_eh_clear_ua - Clear ATAPI UNIT ATTENTION after reset
3330  *	@dev: ATAPI device to clear UA for
3331  *
3332  *	Resets and other operations can make an ATAPI device raise
3333  *	UNIT ATTENTION which causes the next operation to fail.  This
3334  *	function clears UA.
3335  *
3336  *	LOCKING:
3337  *	EH context (may sleep).
3338  *
3339  *	RETURNS:
3340  *	0 on success, -errno on failure.
3341  */
3342 static int atapi_eh_clear_ua(struct ata_device *dev)
3343 {
3344 	int i;
3345 
3346 	for (i = 0; i < ATA_EH_UA_TRIES; i++) {
3347 		u8 *sense_buffer = dev->link->ap->sector_buf;
3348 		u8 sense_key = 0;
3349 		unsigned int err_mask;
3350 
3351 		err_mask = atapi_eh_tur(dev, &sense_key);
3352 		if (err_mask != 0 && err_mask != AC_ERR_DEV) {
3353 			ata_dev_warn(dev,
3354 				     "TEST_UNIT_READY failed (err_mask=0x%x)\n",
3355 				     err_mask);
3356 			return -EIO;
3357 		}
3358 
3359 		if (!err_mask || sense_key != UNIT_ATTENTION)
3360 			return 0;
3361 
3362 		err_mask = atapi_eh_request_sense(dev, sense_buffer, sense_key);
3363 		if (err_mask) {
3364 			ata_dev_warn(dev, "failed to clear "
3365 				"UNIT ATTENTION (err_mask=0x%x)\n", err_mask);
3366 			return -EIO;
3367 		}
3368 	}
3369 
3370 	ata_dev_warn(dev, "UNIT ATTENTION persists after %d tries\n",
3371 		     ATA_EH_UA_TRIES);
3372 
3373 	return 0;
3374 }
3375 
3376 /**
3377  *	ata_eh_maybe_retry_flush - Retry FLUSH if necessary
3378  *	@dev: ATA device which may need FLUSH retry
3379  *
3380  *	If @dev failed FLUSH, it needs to be reported upper layer
3381  *	immediately as it means that @dev failed to remap and already
3382  *	lost at least a sector and further FLUSH retrials won't make
3383  *	any difference to the lost sector.  However, if FLUSH failed
3384  *	for other reasons, for example transmission error, FLUSH needs
3385  *	to be retried.
3386  *
3387  *	This function determines whether FLUSH failure retry is
3388  *	necessary and performs it if so.
3389  *
3390  *	RETURNS:
3391  *	0 if EH can continue, -errno if EH needs to be repeated.
3392  */
3393 static int ata_eh_maybe_retry_flush(struct ata_device *dev)
3394 {
3395 	struct ata_link *link = dev->link;
3396 	struct ata_port *ap = link->ap;
3397 	struct ata_queued_cmd *qc;
3398 	struct ata_taskfile tf;
3399 	unsigned int err_mask;
3400 	int rc = 0;
3401 
3402 	/* did flush fail for this device? */
3403 	if (!ata_tag_valid(link->active_tag))
3404 		return 0;
3405 
3406 	qc = __ata_qc_from_tag(ap, link->active_tag);
3407 	if (qc->dev != dev || (qc->tf.command != ATA_CMD_FLUSH_EXT &&
3408 			       qc->tf.command != ATA_CMD_FLUSH))
3409 		return 0;
3410 
3411 	/* if the device failed it, it should be reported to upper layers */
3412 	if (qc->err_mask & AC_ERR_DEV)
3413 		return 0;
3414 
3415 	/* flush failed for some other reason, give it another shot */
3416 	ata_tf_init(dev, &tf);
3417 
3418 	tf.command = qc->tf.command;
3419 	tf.flags |= ATA_TFLAG_DEVICE;
3420 	tf.protocol = ATA_PROT_NODATA;
3421 
3422 	ata_dev_warn(dev, "retrying FLUSH 0x%x Emask 0x%x\n",
3423 		       tf.command, qc->err_mask);
3424 
3425 	err_mask = ata_exec_internal(dev, &tf, NULL, DMA_NONE, NULL, 0, 0);
3426 	if (!err_mask) {
3427 		/*
3428 		 * FLUSH is complete but there's no way to
3429 		 * successfully complete a failed command from EH.
3430 		 * Making sure retry is allowed at least once and
3431 		 * retrying it should do the trick - whatever was in
3432 		 * the cache is already on the platter and this won't
3433 		 * cause infinite loop.
3434 		 */
3435 		qc->scsicmd->allowed = max(qc->scsicmd->allowed, 1);
3436 	} else {
3437 		ata_dev_warn(dev, "FLUSH failed Emask 0x%x\n",
3438 			       err_mask);
3439 		rc = -EIO;
3440 
3441 		/* if device failed it, report it to upper layers */
3442 		if (err_mask & AC_ERR_DEV) {
3443 			qc->err_mask |= AC_ERR_DEV;
3444 			qc->result_tf = tf;
3445 			if (!(ap->pflags & ATA_PFLAG_FROZEN))
3446 				rc = 0;
3447 		}
3448 	}
3449 	return rc;
3450 }
3451 
3452 /**
3453  *	ata_eh_set_lpm - configure SATA interface power management
3454  *	@link: link to configure power management
3455  *	@policy: the link power management policy
3456  *	@r_failed_dev: out parameter for failed device
3457  *
3458  *	Enable SATA Interface power management.  This will enable
3459  *	Device Interface Power Management (DIPM) for min_power
3460  * 	policy, and then call driver specific callbacks for
3461  *	enabling Host Initiated Power management.
3462  *
3463  *	LOCKING:
3464  *	EH context.
3465  *
3466  *	RETURNS:
3467  *	0 on success, -errno on failure.
3468  */
3469 static int ata_eh_set_lpm(struct ata_link *link, enum ata_lpm_policy policy,
3470 			  struct ata_device **r_failed_dev)
3471 {
3472 	struct ata_port *ap = ata_is_host_link(link) ? link->ap : NULL;
3473 	struct ata_eh_context *ehc = &link->eh_context;
3474 	struct ata_device *dev, *link_dev = NULL, *lpm_dev = NULL;
3475 	enum ata_lpm_policy old_policy = link->lpm_policy;
3476 	bool no_dipm = link->ap->flags & ATA_FLAG_NO_DIPM;
3477 	unsigned int hints = ATA_LPM_EMPTY | ATA_LPM_HIPM;
3478 	unsigned int err_mask;
3479 	int rc;
3480 
3481 	/* if the link or host doesn't do LPM, noop */
3482 	if ((link->flags & ATA_LFLAG_NO_LPM) || (ap && !ap->ops->set_lpm))
3483 		return 0;
3484 
3485 	/*
3486 	 * DIPM is enabled only for MIN_POWER as some devices
3487 	 * misbehave when the host NACKs transition to SLUMBER.  Order
3488 	 * device and link configurations such that the host always
3489 	 * allows DIPM requests.
3490 	 */
3491 	ata_for_each_dev(dev, link, ENABLED) {
3492 		bool hipm = ata_id_has_hipm(dev->id);
3493 		bool dipm = ata_id_has_dipm(dev->id) && !no_dipm;
3494 
3495 		/* find the first enabled and LPM enabled devices */
3496 		if (!link_dev)
3497 			link_dev = dev;
3498 
3499 		if (!lpm_dev && (hipm || dipm))
3500 			lpm_dev = dev;
3501 
3502 		hints &= ~ATA_LPM_EMPTY;
3503 		if (!hipm)
3504 			hints &= ~ATA_LPM_HIPM;
3505 
3506 		/* disable DIPM before changing link config */
3507 		if (policy != ATA_LPM_MIN_POWER && dipm) {
3508 			err_mask = ata_dev_set_feature(dev,
3509 					SETFEATURES_SATA_DISABLE, SATA_DIPM);
3510 			if (err_mask && err_mask != AC_ERR_DEV) {
3511 				ata_dev_warn(dev,
3512 					     "failed to disable DIPM, Emask 0x%x\n",
3513 					     err_mask);
3514 				rc = -EIO;
3515 				goto fail;
3516 			}
3517 		}
3518 	}
3519 
3520 	if (ap) {
3521 		rc = ap->ops->set_lpm(link, policy, hints);
3522 		if (!rc && ap->slave_link)
3523 			rc = ap->ops->set_lpm(ap->slave_link, policy, hints);
3524 	} else
3525 		rc = sata_pmp_set_lpm(link, policy, hints);
3526 
3527 	/*
3528 	 * Attribute link config failure to the first (LPM) enabled
3529 	 * device on the link.
3530 	 */
3531 	if (rc) {
3532 		if (rc == -EOPNOTSUPP) {
3533 			link->flags |= ATA_LFLAG_NO_LPM;
3534 			return 0;
3535 		}
3536 		dev = lpm_dev ? lpm_dev : link_dev;
3537 		goto fail;
3538 	}
3539 
3540 	/*
3541 	 * Low level driver acked the transition.  Issue DIPM command
3542 	 * with the new policy set.
3543 	 */
3544 	link->lpm_policy = policy;
3545 	if (ap && ap->slave_link)
3546 		ap->slave_link->lpm_policy = policy;
3547 
3548 	/* host config updated, enable DIPM if transitioning to MIN_POWER */
3549 	ata_for_each_dev(dev, link, ENABLED) {
3550 		if (policy == ATA_LPM_MIN_POWER && !no_dipm &&
3551 		    ata_id_has_dipm(dev->id)) {
3552 			err_mask = ata_dev_set_feature(dev,
3553 					SETFEATURES_SATA_ENABLE, SATA_DIPM);
3554 			if (err_mask && err_mask != AC_ERR_DEV) {
3555 				ata_dev_warn(dev,
3556 					"failed to enable DIPM, Emask 0x%x\n",
3557 					err_mask);
3558 				rc = -EIO;
3559 				goto fail;
3560 			}
3561 		}
3562 	}
3563 
3564 	link->last_lpm_change = jiffies;
3565 	link->flags |= ATA_LFLAG_CHANGED;
3566 
3567 	return 0;
3568 
3569 fail:
3570 	/* restore the old policy */
3571 	link->lpm_policy = old_policy;
3572 	if (ap && ap->slave_link)
3573 		ap->slave_link->lpm_policy = old_policy;
3574 
3575 	/* if no device or only one more chance is left, disable LPM */
3576 	if (!dev || ehc->tries[dev->devno] <= 2) {
3577 		ata_link_warn(link, "disabling LPM on the link\n");
3578 		link->flags |= ATA_LFLAG_NO_LPM;
3579 	}
3580 	if (r_failed_dev)
3581 		*r_failed_dev = dev;
3582 	return rc;
3583 }
3584 
3585 int ata_link_nr_enabled(struct ata_link *link)
3586 {
3587 	struct ata_device *dev;
3588 	int cnt = 0;
3589 
3590 	ata_for_each_dev(dev, link, ENABLED)
3591 		cnt++;
3592 	return cnt;
3593 }
3594 
3595 static int ata_link_nr_vacant(struct ata_link *link)
3596 {
3597 	struct ata_device *dev;
3598 	int cnt = 0;
3599 
3600 	ata_for_each_dev(dev, link, ALL)
3601 		if (dev->class == ATA_DEV_UNKNOWN)
3602 			cnt++;
3603 	return cnt;
3604 }
3605 
3606 static int ata_eh_skip_recovery(struct ata_link *link)
3607 {
3608 	struct ata_port *ap = link->ap;
3609 	struct ata_eh_context *ehc = &link->eh_context;
3610 	struct ata_device *dev;
3611 
3612 	/* skip disabled links */
3613 	if (link->flags & ATA_LFLAG_DISABLED)
3614 		return 1;
3615 
3616 	/* skip if explicitly requested */
3617 	if (ehc->i.flags & ATA_EHI_NO_RECOVERY)
3618 		return 1;
3619 
3620 	/* thaw frozen port and recover failed devices */
3621 	if ((ap->pflags & ATA_PFLAG_FROZEN) || ata_link_nr_enabled(link))
3622 		return 0;
3623 
3624 	/* reset at least once if reset is requested */
3625 	if ((ehc->i.action & ATA_EH_RESET) &&
3626 	    !(ehc->i.flags & ATA_EHI_DID_RESET))
3627 		return 0;
3628 
3629 	/* skip if class codes for all vacant slots are ATA_DEV_NONE */
3630 	ata_for_each_dev(dev, link, ALL) {
3631 		if (dev->class == ATA_DEV_UNKNOWN &&
3632 		    ehc->classes[dev->devno] != ATA_DEV_NONE)
3633 			return 0;
3634 	}
3635 
3636 	return 1;
3637 }
3638 
3639 static int ata_count_probe_trials_cb(struct ata_ering_entry *ent, void *void_arg)
3640 {
3641 	u64 interval = msecs_to_jiffies(ATA_EH_PROBE_TRIAL_INTERVAL);
3642 	u64 now = get_jiffies_64();
3643 	int *trials = void_arg;
3644 
3645 	if ((ent->eflags & ATA_EFLAG_OLD_ER) ||
3646 	    (ent->timestamp < now - min(now, interval)))
3647 		return -1;
3648 
3649 	(*trials)++;
3650 	return 0;
3651 }
3652 
3653 static int ata_eh_schedule_probe(struct ata_device *dev)
3654 {
3655 	struct ata_eh_context *ehc = &dev->link->eh_context;
3656 	struct ata_link *link = ata_dev_phys_link(dev);
3657 	int trials = 0;
3658 
3659 	if (!(ehc->i.probe_mask & (1 << dev->devno)) ||
3660 	    (ehc->did_probe_mask & (1 << dev->devno)))
3661 		return 0;
3662 
3663 	ata_eh_detach_dev(dev);
3664 	ata_dev_init(dev);
3665 	ehc->did_probe_mask |= (1 << dev->devno);
3666 	ehc->i.action |= ATA_EH_RESET;
3667 	ehc->saved_xfer_mode[dev->devno] = 0;
3668 	ehc->saved_ncq_enabled &= ~(1 << dev->devno);
3669 
3670 	/* the link maybe in a deep sleep, wake it up */
3671 	if (link->lpm_policy > ATA_LPM_MAX_POWER) {
3672 		if (ata_is_host_link(link))
3673 			link->ap->ops->set_lpm(link, ATA_LPM_MAX_POWER,
3674 					       ATA_LPM_EMPTY);
3675 		else
3676 			sata_pmp_set_lpm(link, ATA_LPM_MAX_POWER,
3677 					 ATA_LPM_EMPTY);
3678 	}
3679 
3680 	/* Record and count probe trials on the ering.  The specific
3681 	 * error mask used is irrelevant.  Because a successful device
3682 	 * detection clears the ering, this count accumulates only if
3683 	 * there are consecutive failed probes.
3684 	 *
3685 	 * If the count is equal to or higher than ATA_EH_PROBE_TRIALS
3686 	 * in the last ATA_EH_PROBE_TRIAL_INTERVAL, link speed is
3687 	 * forced to 1.5Gbps.
3688 	 *
3689 	 * This is to work around cases where failed link speed
3690 	 * negotiation results in device misdetection leading to
3691 	 * infinite DEVXCHG or PHRDY CHG events.
3692 	 */
3693 	ata_ering_record(&dev->ering, 0, AC_ERR_OTHER);
3694 	ata_ering_map(&dev->ering, ata_count_probe_trials_cb, &trials);
3695 
3696 	if (trials > ATA_EH_PROBE_TRIALS)
3697 		sata_down_spd_limit(link, 1);
3698 
3699 	return 1;
3700 }
3701 
3702 static int ata_eh_handle_dev_fail(struct ata_device *dev, int err)
3703 {
3704 	struct ata_eh_context *ehc = &dev->link->eh_context;
3705 
3706 	/* -EAGAIN from EH routine indicates retry without prejudice.
3707 	 * The requester is responsible for ensuring forward progress.
3708 	 */
3709 	if (err != -EAGAIN)
3710 		ehc->tries[dev->devno]--;
3711 
3712 	switch (err) {
3713 	case -ENODEV:
3714 		/* device missing or wrong IDENTIFY data, schedule probing */
3715 		ehc->i.probe_mask |= (1 << dev->devno);
3716 	case -EINVAL:
3717 		/* give it just one more chance */
3718 		ehc->tries[dev->devno] = min(ehc->tries[dev->devno], 1);
3719 	case -EIO:
3720 		if (ehc->tries[dev->devno] == 1) {
3721 			/* This is the last chance, better to slow
3722 			 * down than lose it.
3723 			 */
3724 			sata_down_spd_limit(ata_dev_phys_link(dev), 0);
3725 			if (dev->pio_mode > XFER_PIO_0)
3726 				ata_down_xfermask_limit(dev, ATA_DNXFER_PIO);
3727 		}
3728 	}
3729 
3730 	if (ata_dev_enabled(dev) && !ehc->tries[dev->devno]) {
3731 		/* disable device if it has used up all its chances */
3732 		ata_dev_disable(dev);
3733 
3734 		/* detach if offline */
3735 		if (ata_phys_link_offline(ata_dev_phys_link(dev)))
3736 			ata_eh_detach_dev(dev);
3737 
3738 		/* schedule probe if necessary */
3739 		if (ata_eh_schedule_probe(dev)) {
3740 			ehc->tries[dev->devno] = ATA_EH_DEV_TRIES;
3741 			memset(ehc->cmd_timeout_idx[dev->devno], 0,
3742 			       sizeof(ehc->cmd_timeout_idx[dev->devno]));
3743 		}
3744 
3745 		return 1;
3746 	} else {
3747 		ehc->i.action |= ATA_EH_RESET;
3748 		return 0;
3749 	}
3750 }
3751 
3752 /**
3753  *	ata_eh_recover - recover host port after error
3754  *	@ap: host port to recover
3755  *	@prereset: prereset method (can be NULL)
3756  *	@softreset: softreset method (can be NULL)
3757  *	@hardreset: hardreset method (can be NULL)
3758  *	@postreset: postreset method (can be NULL)
3759  *	@r_failed_link: out parameter for failed link
3760  *
3761  *	This is the alpha and omega, eum and yang, heart and soul of
3762  *	libata exception handling.  On entry, actions required to
3763  *	recover each link and hotplug requests are recorded in the
3764  *	link's eh_context.  This function executes all the operations
3765  *	with appropriate retrials and fallbacks to resurrect failed
3766  *	devices, detach goners and greet newcomers.
3767  *
3768  *	LOCKING:
3769  *	Kernel thread context (may sleep).
3770  *
3771  *	RETURNS:
3772  *	0 on success, -errno on failure.
3773  */
3774 int ata_eh_recover(struct ata_port *ap, ata_prereset_fn_t prereset,
3775 		   ata_reset_fn_t softreset, ata_reset_fn_t hardreset,
3776 		   ata_postreset_fn_t postreset,
3777 		   struct ata_link **r_failed_link)
3778 {
3779 	struct ata_link *link;
3780 	struct ata_device *dev;
3781 	int rc, nr_fails;
3782 	unsigned long flags, deadline;
3783 
3784 	DPRINTK("ENTER\n");
3785 
3786 	/* prep for recovery */
3787 	ata_for_each_link(link, ap, EDGE) {
3788 		struct ata_eh_context *ehc = &link->eh_context;
3789 
3790 		/* re-enable link? */
3791 		if (ehc->i.action & ATA_EH_ENABLE_LINK) {
3792 			ata_eh_about_to_do(link, NULL, ATA_EH_ENABLE_LINK);
3793 			spin_lock_irqsave(ap->lock, flags);
3794 			link->flags &= ~ATA_LFLAG_DISABLED;
3795 			spin_unlock_irqrestore(ap->lock, flags);
3796 			ata_eh_done(link, NULL, ATA_EH_ENABLE_LINK);
3797 		}
3798 
3799 		ata_for_each_dev(dev, link, ALL) {
3800 			if (link->flags & ATA_LFLAG_NO_RETRY)
3801 				ehc->tries[dev->devno] = 1;
3802 			else
3803 				ehc->tries[dev->devno] = ATA_EH_DEV_TRIES;
3804 
3805 			/* collect port action mask recorded in dev actions */
3806 			ehc->i.action |= ehc->i.dev_action[dev->devno] &
3807 					 ~ATA_EH_PERDEV_MASK;
3808 			ehc->i.dev_action[dev->devno] &= ATA_EH_PERDEV_MASK;
3809 
3810 			/* process hotplug request */
3811 			if (dev->flags & ATA_DFLAG_DETACH)
3812 				ata_eh_detach_dev(dev);
3813 
3814 			/* schedule probe if necessary */
3815 			if (!ata_dev_enabled(dev))
3816 				ata_eh_schedule_probe(dev);
3817 		}
3818 	}
3819 
3820  retry:
3821 	rc = 0;
3822 
3823 	/* if UNLOADING, finish immediately */
3824 	if (ap->pflags & ATA_PFLAG_UNLOADING)
3825 		goto out;
3826 
3827 	/* prep for EH */
3828 	ata_for_each_link(link, ap, EDGE) {
3829 		struct ata_eh_context *ehc = &link->eh_context;
3830 
3831 		/* skip EH if possible. */
3832 		if (ata_eh_skip_recovery(link))
3833 			ehc->i.action = 0;
3834 
3835 		ata_for_each_dev(dev, link, ALL)
3836 			ehc->classes[dev->devno] = ATA_DEV_UNKNOWN;
3837 	}
3838 
3839 	/* reset */
3840 	ata_for_each_link(link, ap, EDGE) {
3841 		struct ata_eh_context *ehc = &link->eh_context;
3842 
3843 		if (!(ehc->i.action & ATA_EH_RESET))
3844 			continue;
3845 
3846 		rc = ata_eh_reset(link, ata_link_nr_vacant(link),
3847 				  prereset, softreset, hardreset, postreset);
3848 		if (rc) {
3849 			ata_link_err(link, "reset failed, giving up\n");
3850 			goto out;
3851 		}
3852 	}
3853 
3854 	do {
3855 		unsigned long now;
3856 
3857 		/*
3858 		 * clears ATA_EH_PARK in eh_info and resets
3859 		 * ap->park_req_pending
3860 		 */
3861 		ata_eh_pull_park_action(ap);
3862 
3863 		deadline = jiffies;
3864 		ata_for_each_link(link, ap, EDGE) {
3865 			ata_for_each_dev(dev, link, ALL) {
3866 				struct ata_eh_context *ehc = &link->eh_context;
3867 				unsigned long tmp;
3868 
3869 				if (dev->class != ATA_DEV_ATA &&
3870 				    dev->class != ATA_DEV_ZAC)
3871 					continue;
3872 				if (!(ehc->i.dev_action[dev->devno] &
3873 				      ATA_EH_PARK))
3874 					continue;
3875 				tmp = dev->unpark_deadline;
3876 				if (time_before(deadline, tmp))
3877 					deadline = tmp;
3878 				else if (time_before_eq(tmp, jiffies))
3879 					continue;
3880 				if (ehc->unloaded_mask & (1 << dev->devno))
3881 					continue;
3882 
3883 				ata_eh_park_issue_cmd(dev, 1);
3884 			}
3885 		}
3886 
3887 		now = jiffies;
3888 		if (time_before_eq(deadline, now))
3889 			break;
3890 
3891 		ata_eh_release(ap);
3892 		deadline = wait_for_completion_timeout(&ap->park_req_pending,
3893 						       deadline - now);
3894 		ata_eh_acquire(ap);
3895 	} while (deadline);
3896 	ata_for_each_link(link, ap, EDGE) {
3897 		ata_for_each_dev(dev, link, ALL) {
3898 			if (!(link->eh_context.unloaded_mask &
3899 			      (1 << dev->devno)))
3900 				continue;
3901 
3902 			ata_eh_park_issue_cmd(dev, 0);
3903 			ata_eh_done(link, dev, ATA_EH_PARK);
3904 		}
3905 	}
3906 
3907 	/* the rest */
3908 	nr_fails = 0;
3909 	ata_for_each_link(link, ap, PMP_FIRST) {
3910 		struct ata_eh_context *ehc = &link->eh_context;
3911 
3912 		if (sata_pmp_attached(ap) && ata_is_host_link(link))
3913 			goto config_lpm;
3914 
3915 		/* revalidate existing devices and attach new ones */
3916 		rc = ata_eh_revalidate_and_attach(link, &dev);
3917 		if (rc)
3918 			goto rest_fail;
3919 
3920 		/* if PMP got attached, return, pmp EH will take care of it */
3921 		if (link->device->class == ATA_DEV_PMP) {
3922 			ehc->i.action = 0;
3923 			return 0;
3924 		}
3925 
3926 		/* configure transfer mode if necessary */
3927 		if (ehc->i.flags & ATA_EHI_SETMODE) {
3928 			rc = ata_set_mode(link, &dev);
3929 			if (rc)
3930 				goto rest_fail;
3931 			ehc->i.flags &= ~ATA_EHI_SETMODE;
3932 		}
3933 
3934 		/* If reset has been issued, clear UA to avoid
3935 		 * disrupting the current users of the device.
3936 		 */
3937 		if (ehc->i.flags & ATA_EHI_DID_RESET) {
3938 			ata_for_each_dev(dev, link, ALL) {
3939 				if (dev->class != ATA_DEV_ATAPI)
3940 					continue;
3941 				rc = atapi_eh_clear_ua(dev);
3942 				if (rc)
3943 					goto rest_fail;
3944 				if (zpodd_dev_enabled(dev))
3945 					zpodd_post_poweron(dev);
3946 			}
3947 		}
3948 
3949 		/* retry flush if necessary */
3950 		ata_for_each_dev(dev, link, ALL) {
3951 			if (dev->class != ATA_DEV_ATA &&
3952 			    dev->class != ATA_DEV_ZAC)
3953 				continue;
3954 			rc = ata_eh_maybe_retry_flush(dev);
3955 			if (rc)
3956 				goto rest_fail;
3957 		}
3958 
3959 	config_lpm:
3960 		/* configure link power saving */
3961 		if (link->lpm_policy != ap->target_lpm_policy) {
3962 			rc = ata_eh_set_lpm(link, ap->target_lpm_policy, &dev);
3963 			if (rc)
3964 				goto rest_fail;
3965 		}
3966 
3967 		/* this link is okay now */
3968 		ehc->i.flags = 0;
3969 		continue;
3970 
3971 	rest_fail:
3972 		nr_fails++;
3973 		if (dev)
3974 			ata_eh_handle_dev_fail(dev, rc);
3975 
3976 		if (ap->pflags & ATA_PFLAG_FROZEN) {
3977 			/* PMP reset requires working host port.
3978 			 * Can't retry if it's frozen.
3979 			 */
3980 			if (sata_pmp_attached(ap))
3981 				goto out;
3982 			break;
3983 		}
3984 	}
3985 
3986 	if (nr_fails)
3987 		goto retry;
3988 
3989  out:
3990 	if (rc && r_failed_link)
3991 		*r_failed_link = link;
3992 
3993 	DPRINTK("EXIT, rc=%d\n", rc);
3994 	return rc;
3995 }
3996 
3997 /**
3998  *	ata_eh_finish - finish up EH
3999  *	@ap: host port to finish EH for
4000  *
4001  *	Recovery is complete.  Clean up EH states and retry or finish
4002  *	failed qcs.
4003  *
4004  *	LOCKING:
4005  *	None.
4006  */
4007 void ata_eh_finish(struct ata_port *ap)
4008 {
4009 	int tag;
4010 
4011 	/* retry or finish qcs */
4012 	for (tag = 0; tag < ATA_MAX_QUEUE; tag++) {
4013 		struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag);
4014 
4015 		if (!(qc->flags & ATA_QCFLAG_FAILED))
4016 			continue;
4017 
4018 		if (qc->err_mask) {
4019 			/* FIXME: Once EH migration is complete,
4020 			 * generate sense data in this function,
4021 			 * considering both err_mask and tf.
4022 			 */
4023 			if (qc->flags & ATA_QCFLAG_RETRY)
4024 				ata_eh_qc_retry(qc);
4025 			else
4026 				ata_eh_qc_complete(qc);
4027 		} else {
4028 			if (qc->flags & ATA_QCFLAG_SENSE_VALID) {
4029 				ata_eh_qc_complete(qc);
4030 			} else {
4031 				/* feed zero TF to sense generation */
4032 				memset(&qc->result_tf, 0, sizeof(qc->result_tf));
4033 				ata_eh_qc_retry(qc);
4034 			}
4035 		}
4036 	}
4037 
4038 	/* make sure nr_active_links is zero after EH */
4039 	WARN_ON(ap->nr_active_links);
4040 	ap->nr_active_links = 0;
4041 }
4042 
4043 /**
4044  *	ata_do_eh - do standard error handling
4045  *	@ap: host port to handle error for
4046  *
4047  *	@prereset: prereset method (can be NULL)
4048  *	@softreset: softreset method (can be NULL)
4049  *	@hardreset: hardreset method (can be NULL)
4050  *	@postreset: postreset method (can be NULL)
4051  *
4052  *	Perform standard error handling sequence.
4053  *
4054  *	LOCKING:
4055  *	Kernel thread context (may sleep).
4056  */
4057 void ata_do_eh(struct ata_port *ap, ata_prereset_fn_t prereset,
4058 	       ata_reset_fn_t softreset, ata_reset_fn_t hardreset,
4059 	       ata_postreset_fn_t postreset)
4060 {
4061 	struct ata_device *dev;
4062 	int rc;
4063 
4064 	ata_eh_autopsy(ap);
4065 	ata_eh_report(ap);
4066 
4067 	rc = ata_eh_recover(ap, prereset, softreset, hardreset, postreset,
4068 			    NULL);
4069 	if (rc) {
4070 		ata_for_each_dev(dev, &ap->link, ALL)
4071 			ata_dev_disable(dev);
4072 	}
4073 
4074 	ata_eh_finish(ap);
4075 }
4076 
4077 /**
4078  *	ata_std_error_handler - standard error handler
4079  *	@ap: host port to handle error for
4080  *
4081  *	Standard error handler
4082  *
4083  *	LOCKING:
4084  *	Kernel thread context (may sleep).
4085  */
4086 void ata_std_error_handler(struct ata_port *ap)
4087 {
4088 	struct ata_port_operations *ops = ap->ops;
4089 	ata_reset_fn_t hardreset = ops->hardreset;
4090 
4091 	/* ignore built-in hardreset if SCR access is not available */
4092 	if (hardreset == sata_std_hardreset && !sata_scr_valid(&ap->link))
4093 		hardreset = NULL;
4094 
4095 	ata_do_eh(ap, ops->prereset, ops->softreset, hardreset, ops->postreset);
4096 }
4097 
4098 #ifdef CONFIG_PM
4099 /**
4100  *	ata_eh_handle_port_suspend - perform port suspend operation
4101  *	@ap: port to suspend
4102  *
4103  *	Suspend @ap.
4104  *
4105  *	LOCKING:
4106  *	Kernel thread context (may sleep).
4107  */
4108 static void ata_eh_handle_port_suspend(struct ata_port *ap)
4109 {
4110 	unsigned long flags;
4111 	int rc = 0;
4112 	struct ata_device *dev;
4113 
4114 	/* are we suspending? */
4115 	spin_lock_irqsave(ap->lock, flags);
4116 	if (!(ap->pflags & ATA_PFLAG_PM_PENDING) ||
4117 	    ap->pm_mesg.event & PM_EVENT_RESUME) {
4118 		spin_unlock_irqrestore(ap->lock, flags);
4119 		return;
4120 	}
4121 	spin_unlock_irqrestore(ap->lock, flags);
4122 
4123 	WARN_ON(ap->pflags & ATA_PFLAG_SUSPENDED);
4124 
4125 	/*
4126 	 * If we have a ZPODD attached, check its zero
4127 	 * power ready status before the port is frozen.
4128 	 * Only needed for runtime suspend.
4129 	 */
4130 	if (PMSG_IS_AUTO(ap->pm_mesg)) {
4131 		ata_for_each_dev(dev, &ap->link, ENABLED) {
4132 			if (zpodd_dev_enabled(dev))
4133 				zpodd_on_suspend(dev);
4134 		}
4135 	}
4136 
4137 	/* tell ACPI we're suspending */
4138 	rc = ata_acpi_on_suspend(ap);
4139 	if (rc)
4140 		goto out;
4141 
4142 	/* suspend */
4143 	ata_eh_freeze_port(ap);
4144 
4145 	if (ap->ops->port_suspend)
4146 		rc = ap->ops->port_suspend(ap, ap->pm_mesg);
4147 
4148 	ata_acpi_set_state(ap, ap->pm_mesg);
4149  out:
4150 	/* update the flags */
4151 	spin_lock_irqsave(ap->lock, flags);
4152 
4153 	ap->pflags &= ~ATA_PFLAG_PM_PENDING;
4154 	if (rc == 0)
4155 		ap->pflags |= ATA_PFLAG_SUSPENDED;
4156 	else if (ap->pflags & ATA_PFLAG_FROZEN)
4157 		ata_port_schedule_eh(ap);
4158 
4159 	spin_unlock_irqrestore(ap->lock, flags);
4160 
4161 	return;
4162 }
4163 
4164 /**
4165  *	ata_eh_handle_port_resume - perform port resume operation
4166  *	@ap: port to resume
4167  *
4168  *	Resume @ap.
4169  *
4170  *	LOCKING:
4171  *	Kernel thread context (may sleep).
4172  */
4173 static void ata_eh_handle_port_resume(struct ata_port *ap)
4174 {
4175 	struct ata_link *link;
4176 	struct ata_device *dev;
4177 	unsigned long flags;
4178 
4179 	/* are we resuming? */
4180 	spin_lock_irqsave(ap->lock, flags);
4181 	if (!(ap->pflags & ATA_PFLAG_PM_PENDING) ||
4182 	    !(ap->pm_mesg.event & PM_EVENT_RESUME)) {
4183 		spin_unlock_irqrestore(ap->lock, flags);
4184 		return;
4185 	}
4186 	spin_unlock_irqrestore(ap->lock, flags);
4187 
4188 	WARN_ON(!(ap->pflags & ATA_PFLAG_SUSPENDED));
4189 
4190 	/*
4191 	 * Error timestamps are in jiffies which doesn't run while
4192 	 * suspended and PHY events during resume isn't too uncommon.
4193 	 * When the two are combined, it can lead to unnecessary speed
4194 	 * downs if the machine is suspended and resumed repeatedly.
4195 	 * Clear error history.
4196 	 */
4197 	ata_for_each_link(link, ap, HOST_FIRST)
4198 		ata_for_each_dev(dev, link, ALL)
4199 			ata_ering_clear(&dev->ering);
4200 
4201 	ata_acpi_set_state(ap, ap->pm_mesg);
4202 
4203 	if (ap->ops->port_resume)
4204 		ap->ops->port_resume(ap);
4205 
4206 	/* tell ACPI that we're resuming */
4207 	ata_acpi_on_resume(ap);
4208 
4209 	/* update the flags */
4210 	spin_lock_irqsave(ap->lock, flags);
4211 	ap->pflags &= ~(ATA_PFLAG_PM_PENDING | ATA_PFLAG_SUSPENDED);
4212 	spin_unlock_irqrestore(ap->lock, flags);
4213 }
4214 #endif /* CONFIG_PM */
4215