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