diff options
author | Linus Torvalds <torvalds@g5.osdl.org> | 2006-06-23 18:58:44 -0400 |
---|---|---|
committer | Linus Torvalds <torvalds@g5.osdl.org> | 2006-06-23 18:58:44 -0400 |
commit | 6edad161cd4dfe1df772e7a74ab63cab53b5e8c1 (patch) | |
tree | 389d6daa728b2ba1bd8c2180cab705706449f62a /drivers/scsi/libata-eh.c | |
parent | 236ee8c33277ab48671995f26dc68a4639936418 (diff) | |
parent | 0dd4b21f517e138ea113db255645fbae1bf5eef3 (diff) |
Merge branch 'upstream-linus' of master.kernel.org:/pub/scm/linux/kernel/git/jgarzik/libata-dev
* 'upstream-linus' of master.kernel.org:/pub/scm/linux/kernel/git/jgarzik/libata-dev: (258 commits)
[libata] conversion to new debug scheme, part 1 of $N
[PATCH] libata: Add ata_scsi_dev_disabled
[libata] Add host lock to struct ata_port
[PATCH] libata: implement per-dev EH action mask eh_info->dev_action[]
[PATCH] libata-dev: move the CDB-intr DMA blacklisting
[PATCH] ahci: disable NCQ support on vt8251
[libata] ahci: add JMicron PCI IDs
[libata] sata_nv: add PCI IDs
[libata] ahci: Add NVIDIA PCI IDs.
[PATCH] libata: convert several bmdma-style controllers to new EH, take #3
[PATCH] sata_via: convert to new EH, take #3
[libata] sata_nv: s/spin_lock_irqsave/spin_lock/ in irq handler
[PATCH] sata_nv: add hotplug support
[PATCH] sata_nv: convert to new EH
[PATCH] sata_nv: better irq handlers
[PATCH] sata_nv: simplify constants
[PATCH] sata_nv: kill struct nv_host_desc and nv_host
[PATCH] sata_nv: kill not-working hotplug code
[libata] Update docs to reflect current driver API
[PATCH] libata: add host_set->next for legacy two host_sets case, take #3
...
Diffstat (limited to 'drivers/scsi/libata-eh.c')
-rw-r--r-- | drivers/scsi/libata-eh.c | 1907 |
1 files changed, 1907 insertions, 0 deletions
diff --git a/drivers/scsi/libata-eh.c b/drivers/scsi/libata-eh.c new file mode 100644 index 000000000000..823385981a7a --- /dev/null +++ b/drivers/scsi/libata-eh.c | |||
@@ -0,0 +1,1907 @@ | |||
1 | /* | ||
2 | * libata-eh.c - libata error handling | ||
3 | * | ||
4 | * Maintained by: Jeff Garzik <jgarzik@pobox.com> | ||
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 | |||
35 | #include <linux/config.h> | ||
36 | #include <linux/kernel.h> | ||
37 | #include <scsi/scsi.h> | ||
38 | #include <scsi/scsi_host.h> | ||
39 | #include <scsi/scsi_eh.h> | ||
40 | #include <scsi/scsi_device.h> | ||
41 | #include <scsi/scsi_cmnd.h> | ||
42 | #include "scsi_transport_api.h" | ||
43 | |||
44 | #include <linux/libata.h> | ||
45 | |||
46 | #include "libata.h" | ||
47 | |||
48 | static void __ata_port_freeze(struct ata_port *ap); | ||
49 | static void ata_eh_finish(struct ata_port *ap); | ||
50 | |||
51 | static void ata_ering_record(struct ata_ering *ering, int is_io, | ||
52 | unsigned int err_mask) | ||
53 | { | ||
54 | struct ata_ering_entry *ent; | ||
55 | |||
56 | WARN_ON(!err_mask); | ||
57 | |||
58 | ering->cursor++; | ||
59 | ering->cursor %= ATA_ERING_SIZE; | ||
60 | |||
61 | ent = &ering->ring[ering->cursor]; | ||
62 | ent->is_io = is_io; | ||
63 | ent->err_mask = err_mask; | ||
64 | ent->timestamp = get_jiffies_64(); | ||
65 | } | ||
66 | |||
67 | static struct ata_ering_entry * ata_ering_top(struct ata_ering *ering) | ||
68 | { | ||
69 | struct ata_ering_entry *ent = &ering->ring[ering->cursor]; | ||
70 | if (!ent->err_mask) | ||
71 | return NULL; | ||
72 | return ent; | ||
73 | } | ||
74 | |||
75 | static int ata_ering_map(struct ata_ering *ering, | ||
76 | int (*map_fn)(struct ata_ering_entry *, void *), | ||
77 | void *arg) | ||
78 | { | ||
79 | int idx, rc = 0; | ||
80 | struct ata_ering_entry *ent; | ||
81 | |||
82 | idx = ering->cursor; | ||
83 | do { | ||
84 | ent = &ering->ring[idx]; | ||
85 | if (!ent->err_mask) | ||
86 | break; | ||
87 | rc = map_fn(ent, arg); | ||
88 | if (rc) | ||
89 | break; | ||
90 | idx = (idx - 1 + ATA_ERING_SIZE) % ATA_ERING_SIZE; | ||
91 | } while (idx != ering->cursor); | ||
92 | |||
93 | return rc; | ||
94 | } | ||
95 | |||
96 | /** | ||
97 | * ata_scsi_timed_out - SCSI layer time out callback | ||
98 | * @cmd: timed out SCSI command | ||
99 | * | ||
100 | * Handles SCSI layer timeout. We race with normal completion of | ||
101 | * the qc for @cmd. If the qc is already gone, we lose and let | ||
102 | * the scsi command finish (EH_HANDLED). Otherwise, the qc has | ||
103 | * timed out and EH should be invoked. Prevent ata_qc_complete() | ||
104 | * from finishing it by setting EH_SCHEDULED and return | ||
105 | * EH_NOT_HANDLED. | ||
106 | * | ||
107 | * TODO: kill this function once old EH is gone. | ||
108 | * | ||
109 | * LOCKING: | ||
110 | * Called from timer context | ||
111 | * | ||
112 | * RETURNS: | ||
113 | * EH_HANDLED or EH_NOT_HANDLED | ||
114 | */ | ||
115 | enum scsi_eh_timer_return ata_scsi_timed_out(struct scsi_cmnd *cmd) | ||
116 | { | ||
117 | struct Scsi_Host *host = cmd->device->host; | ||
118 | struct ata_port *ap = ata_shost_to_port(host); | ||
119 | unsigned long flags; | ||
120 | struct ata_queued_cmd *qc; | ||
121 | enum scsi_eh_timer_return ret; | ||
122 | |||
123 | DPRINTK("ENTER\n"); | ||
124 | |||
125 | if (ap->ops->error_handler) { | ||
126 | ret = EH_NOT_HANDLED; | ||
127 | goto out; | ||
128 | } | ||
129 | |||
130 | ret = EH_HANDLED; | ||
131 | spin_lock_irqsave(ap->lock, flags); | ||
132 | qc = ata_qc_from_tag(ap, ap->active_tag); | ||
133 | if (qc) { | ||
134 | WARN_ON(qc->scsicmd != cmd); | ||
135 | qc->flags |= ATA_QCFLAG_EH_SCHEDULED; | ||
136 | qc->err_mask |= AC_ERR_TIMEOUT; | ||
137 | ret = EH_NOT_HANDLED; | ||
138 | } | ||
139 | spin_unlock_irqrestore(ap->lock, flags); | ||
140 | |||
141 | out: | ||
142 | DPRINTK("EXIT, ret=%d\n", ret); | ||
143 | return ret; | ||
144 | } | ||
145 | |||
146 | /** | ||
147 | * ata_scsi_error - SCSI layer error handler callback | ||
148 | * @host: SCSI host on which error occurred | ||
149 | * | ||
150 | * Handles SCSI-layer-thrown error events. | ||
151 | * | ||
152 | * LOCKING: | ||
153 | * Inherited from SCSI layer (none, can sleep) | ||
154 | * | ||
155 | * RETURNS: | ||
156 | * Zero. | ||
157 | */ | ||
158 | void ata_scsi_error(struct Scsi_Host *host) | ||
159 | { | ||
160 | struct ata_port *ap = ata_shost_to_port(host); | ||
161 | spinlock_t *ap_lock = ap->lock; | ||
162 | int i, repeat_cnt = ATA_EH_MAX_REPEAT; | ||
163 | unsigned long flags; | ||
164 | |||
165 | DPRINTK("ENTER\n"); | ||
166 | |||
167 | /* synchronize with port task */ | ||
168 | ata_port_flush_task(ap); | ||
169 | |||
170 | /* synchronize with host_set lock and sort out timeouts */ | ||
171 | |||
172 | /* For new EH, all qcs are finished in one of three ways - | ||
173 | * normal completion, error completion, and SCSI timeout. | ||
174 | * Both cmpletions can race against SCSI timeout. When normal | ||
175 | * completion wins, the qc never reaches EH. When error | ||
176 | * completion wins, the qc has ATA_QCFLAG_FAILED set. | ||
177 | * | ||
178 | * When SCSI timeout wins, things are a bit more complex. | ||
179 | * Normal or error completion can occur after the timeout but | ||
180 | * before this point. In such cases, both types of | ||
181 | * completions are honored. A scmd is determined to have | ||
182 | * timed out iff its associated qc is active and not failed. | ||
183 | */ | ||
184 | if (ap->ops->error_handler) { | ||
185 | struct scsi_cmnd *scmd, *tmp; | ||
186 | int nr_timedout = 0; | ||
187 | |||
188 | spin_lock_irqsave(ap_lock, flags); | ||
189 | |||
190 | list_for_each_entry_safe(scmd, tmp, &host->eh_cmd_q, eh_entry) { | ||
191 | struct ata_queued_cmd *qc; | ||
192 | |||
193 | for (i = 0; i < ATA_MAX_QUEUE; i++) { | ||
194 | qc = __ata_qc_from_tag(ap, i); | ||
195 | if (qc->flags & ATA_QCFLAG_ACTIVE && | ||
196 | qc->scsicmd == scmd) | ||
197 | break; | ||
198 | } | ||
199 | |||
200 | if (i < ATA_MAX_QUEUE) { | ||
201 | /* the scmd has an associated qc */ | ||
202 | if (!(qc->flags & ATA_QCFLAG_FAILED)) { | ||
203 | /* which hasn't failed yet, timeout */ | ||
204 | qc->err_mask |= AC_ERR_TIMEOUT; | ||
205 | qc->flags |= ATA_QCFLAG_FAILED; | ||
206 | nr_timedout++; | ||
207 | } | ||
208 | } else { | ||
209 | /* Normal completion occurred after | ||
210 | * SCSI timeout but before this point. | ||
211 | * Successfully complete it. | ||
212 | */ | ||
213 | scmd->retries = scmd->allowed; | ||
214 | scsi_eh_finish_cmd(scmd, &ap->eh_done_q); | ||
215 | } | ||
216 | } | ||
217 | |||
218 | /* If we have timed out qcs. They belong to EH from | ||
219 | * this point but the state of the controller is | ||
220 | * unknown. Freeze the port to make sure the IRQ | ||
221 | * handler doesn't diddle with those qcs. This must | ||
222 | * be done atomically w.r.t. setting QCFLAG_FAILED. | ||
223 | */ | ||
224 | if (nr_timedout) | ||
225 | __ata_port_freeze(ap); | ||
226 | |||
227 | spin_unlock_irqrestore(ap_lock, flags); | ||
228 | } else | ||
229 | spin_unlock_wait(ap_lock); | ||
230 | |||
231 | repeat: | ||
232 | /* invoke error handler */ | ||
233 | if (ap->ops->error_handler) { | ||
234 | /* fetch & clear EH info */ | ||
235 | spin_lock_irqsave(ap_lock, flags); | ||
236 | |||
237 | memset(&ap->eh_context, 0, sizeof(ap->eh_context)); | ||
238 | ap->eh_context.i = ap->eh_info; | ||
239 | memset(&ap->eh_info, 0, sizeof(ap->eh_info)); | ||
240 | |||
241 | ap->flags |= ATA_FLAG_EH_IN_PROGRESS; | ||
242 | ap->flags &= ~ATA_FLAG_EH_PENDING; | ||
243 | |||
244 | spin_unlock_irqrestore(ap_lock, flags); | ||
245 | |||
246 | /* invoke EH. if unloading, just finish failed qcs */ | ||
247 | if (!(ap->flags & ATA_FLAG_UNLOADING)) | ||
248 | ap->ops->error_handler(ap); | ||
249 | else | ||
250 | ata_eh_finish(ap); | ||
251 | |||
252 | /* Exception might have happend after ->error_handler | ||
253 | * recovered the port but before this point. Repeat | ||
254 | * EH in such case. | ||
255 | */ | ||
256 | spin_lock_irqsave(ap_lock, flags); | ||
257 | |||
258 | if (ap->flags & ATA_FLAG_EH_PENDING) { | ||
259 | if (--repeat_cnt) { | ||
260 | ata_port_printk(ap, KERN_INFO, | ||
261 | "EH pending after completion, " | ||
262 | "repeating EH (cnt=%d)\n", repeat_cnt); | ||
263 | spin_unlock_irqrestore(ap_lock, flags); | ||
264 | goto repeat; | ||
265 | } | ||
266 | ata_port_printk(ap, KERN_ERR, "EH pending after %d " | ||
267 | "tries, giving up\n", ATA_EH_MAX_REPEAT); | ||
268 | } | ||
269 | |||
270 | /* this run is complete, make sure EH info is clear */ | ||
271 | memset(&ap->eh_info, 0, sizeof(ap->eh_info)); | ||
272 | |||
273 | /* Clear host_eh_scheduled while holding ap_lock such | ||
274 | * that if exception occurs after this point but | ||
275 | * before EH completion, SCSI midlayer will | ||
276 | * re-initiate EH. | ||
277 | */ | ||
278 | host->host_eh_scheduled = 0; | ||
279 | |||
280 | spin_unlock_irqrestore(ap_lock, flags); | ||
281 | } else { | ||
282 | WARN_ON(ata_qc_from_tag(ap, ap->active_tag) == NULL); | ||
283 | ap->ops->eng_timeout(ap); | ||
284 | } | ||
285 | |||
286 | /* finish or retry handled scmd's and clean up */ | ||
287 | WARN_ON(host->host_failed || !list_empty(&host->eh_cmd_q)); | ||
288 | |||
289 | scsi_eh_flush_done_q(&ap->eh_done_q); | ||
290 | |||
291 | /* clean up */ | ||
292 | spin_lock_irqsave(ap_lock, flags); | ||
293 | |||
294 | if (ap->flags & ATA_FLAG_LOADING) { | ||
295 | ap->flags &= ~ATA_FLAG_LOADING; | ||
296 | } else { | ||
297 | if (ap->flags & ATA_FLAG_SCSI_HOTPLUG) | ||
298 | queue_work(ata_aux_wq, &ap->hotplug_task); | ||
299 | if (ap->flags & ATA_FLAG_RECOVERED) | ||
300 | ata_port_printk(ap, KERN_INFO, "EH complete\n"); | ||
301 | } | ||
302 | |||
303 | ap->flags &= ~(ATA_FLAG_SCSI_HOTPLUG | ATA_FLAG_RECOVERED); | ||
304 | |||
305 | /* tell wait_eh that we're done */ | ||
306 | ap->flags &= ~ATA_FLAG_EH_IN_PROGRESS; | ||
307 | wake_up_all(&ap->eh_wait_q); | ||
308 | |||
309 | spin_unlock_irqrestore(ap_lock, flags); | ||
310 | |||
311 | DPRINTK("EXIT\n"); | ||
312 | } | ||
313 | |||
314 | /** | ||
315 | * ata_port_wait_eh - Wait for the currently pending EH to complete | ||
316 | * @ap: Port to wait EH for | ||
317 | * | ||
318 | * Wait until the currently pending EH is complete. | ||
319 | * | ||
320 | * LOCKING: | ||
321 | * Kernel thread context (may sleep). | ||
322 | */ | ||
323 | void ata_port_wait_eh(struct ata_port *ap) | ||
324 | { | ||
325 | unsigned long flags; | ||
326 | DEFINE_WAIT(wait); | ||
327 | |||
328 | retry: | ||
329 | spin_lock_irqsave(ap->lock, flags); | ||
330 | |||
331 | while (ap->flags & (ATA_FLAG_EH_PENDING | ATA_FLAG_EH_IN_PROGRESS)) { | ||
332 | prepare_to_wait(&ap->eh_wait_q, &wait, TASK_UNINTERRUPTIBLE); | ||
333 | spin_unlock_irqrestore(ap->lock, flags); | ||
334 | schedule(); | ||
335 | spin_lock_irqsave(ap->lock, flags); | ||
336 | } | ||
337 | finish_wait(&ap->eh_wait_q, &wait); | ||
338 | |||
339 | spin_unlock_irqrestore(ap->lock, flags); | ||
340 | |||
341 | /* make sure SCSI EH is complete */ | ||
342 | if (scsi_host_in_recovery(ap->host)) { | ||
343 | msleep(10); | ||
344 | goto retry; | ||
345 | } | ||
346 | } | ||
347 | |||
348 | /** | ||
349 | * ata_qc_timeout - Handle timeout of queued command | ||
350 | * @qc: Command that timed out | ||
351 | * | ||
352 | * Some part of the kernel (currently, only the SCSI layer) | ||
353 | * has noticed that the active command on port @ap has not | ||
354 | * completed after a specified length of time. Handle this | ||
355 | * condition by disabling DMA (if necessary) and completing | ||
356 | * transactions, with error if necessary. | ||
357 | * | ||
358 | * This also handles the case of the "lost interrupt", where | ||
359 | * for some reason (possibly hardware bug, possibly driver bug) | ||
360 | * an interrupt was not delivered to the driver, even though the | ||
361 | * transaction completed successfully. | ||
362 | * | ||
363 | * TODO: kill this function once old EH is gone. | ||
364 | * | ||
365 | * LOCKING: | ||
366 | * Inherited from SCSI layer (none, can sleep) | ||
367 | */ | ||
368 | static void ata_qc_timeout(struct ata_queued_cmd *qc) | ||
369 | { | ||
370 | struct ata_port *ap = qc->ap; | ||
371 | u8 host_stat = 0, drv_stat; | ||
372 | unsigned long flags; | ||
373 | |||
374 | DPRINTK("ENTER\n"); | ||
375 | |||
376 | ap->hsm_task_state = HSM_ST_IDLE; | ||
377 | |||
378 | spin_lock_irqsave(ap->lock, flags); | ||
379 | |||
380 | switch (qc->tf.protocol) { | ||
381 | |||
382 | case ATA_PROT_DMA: | ||
383 | case ATA_PROT_ATAPI_DMA: | ||
384 | host_stat = ap->ops->bmdma_status(ap); | ||
385 | |||
386 | /* before we do anything else, clear DMA-Start bit */ | ||
387 | ap->ops->bmdma_stop(qc); | ||
388 | |||
389 | /* fall through */ | ||
390 | |||
391 | default: | ||
392 | ata_altstatus(ap); | ||
393 | drv_stat = ata_chk_status(ap); | ||
394 | |||
395 | /* ack bmdma irq events */ | ||
396 | ap->ops->irq_clear(ap); | ||
397 | |||
398 | ata_dev_printk(qc->dev, KERN_ERR, "command 0x%x timeout, " | ||
399 | "stat 0x%x host_stat 0x%x\n", | ||
400 | qc->tf.command, drv_stat, host_stat); | ||
401 | |||
402 | /* complete taskfile transaction */ | ||
403 | qc->err_mask |= AC_ERR_TIMEOUT; | ||
404 | break; | ||
405 | } | ||
406 | |||
407 | spin_unlock_irqrestore(ap->lock, flags); | ||
408 | |||
409 | ata_eh_qc_complete(qc); | ||
410 | |||
411 | DPRINTK("EXIT\n"); | ||
412 | } | ||
413 | |||
414 | /** | ||
415 | * ata_eng_timeout - Handle timeout of queued command | ||
416 | * @ap: Port on which timed-out command is active | ||
417 | * | ||
418 | * Some part of the kernel (currently, only the SCSI layer) | ||
419 | * has noticed that the active command on port @ap has not | ||
420 | * completed after a specified length of time. Handle this | ||
421 | * condition by disabling DMA (if necessary) and completing | ||
422 | * transactions, with error if necessary. | ||
423 | * | ||
424 | * This also handles the case of the "lost interrupt", where | ||
425 | * for some reason (possibly hardware bug, possibly driver bug) | ||
426 | * an interrupt was not delivered to the driver, even though the | ||
427 | * transaction completed successfully. | ||
428 | * | ||
429 | * TODO: kill this function once old EH is gone. | ||
430 | * | ||
431 | * LOCKING: | ||
432 | * Inherited from SCSI layer (none, can sleep) | ||
433 | */ | ||
434 | void ata_eng_timeout(struct ata_port *ap) | ||
435 | { | ||
436 | DPRINTK("ENTER\n"); | ||
437 | |||
438 | ata_qc_timeout(ata_qc_from_tag(ap, ap->active_tag)); | ||
439 | |||
440 | DPRINTK("EXIT\n"); | ||
441 | } | ||
442 | |||
443 | /** | ||
444 | * ata_qc_schedule_eh - schedule qc for error handling | ||
445 | * @qc: command to schedule error handling for | ||
446 | * | ||
447 | * Schedule error handling for @qc. EH will kick in as soon as | ||
448 | * other commands are drained. | ||
449 | * | ||
450 | * LOCKING: | ||
451 | * spin_lock_irqsave(host_set lock) | ||
452 | */ | ||
453 | void ata_qc_schedule_eh(struct ata_queued_cmd *qc) | ||
454 | { | ||
455 | struct ata_port *ap = qc->ap; | ||
456 | |||
457 | WARN_ON(!ap->ops->error_handler); | ||
458 | |||
459 | qc->flags |= ATA_QCFLAG_FAILED; | ||
460 | qc->ap->flags |= ATA_FLAG_EH_PENDING; | ||
461 | |||
462 | /* The following will fail if timeout has already expired. | ||
463 | * ata_scsi_error() takes care of such scmds on EH entry. | ||
464 | * Note that ATA_QCFLAG_FAILED is unconditionally set after | ||
465 | * this function completes. | ||
466 | */ | ||
467 | scsi_req_abort_cmd(qc->scsicmd); | ||
468 | } | ||
469 | |||
470 | /** | ||
471 | * ata_port_schedule_eh - schedule error handling without a qc | ||
472 | * @ap: ATA port to schedule EH for | ||
473 | * | ||
474 | * Schedule error handling for @ap. EH will kick in as soon as | ||
475 | * all commands are drained. | ||
476 | * | ||
477 | * LOCKING: | ||
478 | * spin_lock_irqsave(host_set lock) | ||
479 | */ | ||
480 | void ata_port_schedule_eh(struct ata_port *ap) | ||
481 | { | ||
482 | WARN_ON(!ap->ops->error_handler); | ||
483 | |||
484 | ap->flags |= ATA_FLAG_EH_PENDING; | ||
485 | scsi_schedule_eh(ap->host); | ||
486 | |||
487 | DPRINTK("port EH scheduled\n"); | ||
488 | } | ||
489 | |||
490 | /** | ||
491 | * ata_port_abort - abort all qc's on the port | ||
492 | * @ap: ATA port to abort qc's for | ||
493 | * | ||
494 | * Abort all active qc's of @ap and schedule EH. | ||
495 | * | ||
496 | * LOCKING: | ||
497 | * spin_lock_irqsave(host_set lock) | ||
498 | * | ||
499 | * RETURNS: | ||
500 | * Number of aborted qc's. | ||
501 | */ | ||
502 | int ata_port_abort(struct ata_port *ap) | ||
503 | { | ||
504 | int tag, nr_aborted = 0; | ||
505 | |||
506 | WARN_ON(!ap->ops->error_handler); | ||
507 | |||
508 | for (tag = 0; tag < ATA_MAX_QUEUE; tag++) { | ||
509 | struct ata_queued_cmd *qc = ata_qc_from_tag(ap, tag); | ||
510 | |||
511 | if (qc) { | ||
512 | qc->flags |= ATA_QCFLAG_FAILED; | ||
513 | ata_qc_complete(qc); | ||
514 | nr_aborted++; | ||
515 | } | ||
516 | } | ||
517 | |||
518 | if (!nr_aborted) | ||
519 | ata_port_schedule_eh(ap); | ||
520 | |||
521 | return nr_aborted; | ||
522 | } | ||
523 | |||
524 | /** | ||
525 | * __ata_port_freeze - freeze port | ||
526 | * @ap: ATA port to freeze | ||
527 | * | ||
528 | * This function is called when HSM violation or some other | ||
529 | * condition disrupts normal operation of the port. Frozen port | ||
530 | * is not allowed to perform any operation until the port is | ||
531 | * thawed, which usually follows a successful reset. | ||
532 | * | ||
533 | * ap->ops->freeze() callback can be used for freezing the port | ||
534 | * hardware-wise (e.g. mask interrupt and stop DMA engine). If a | ||
535 | * port cannot be frozen hardware-wise, the interrupt handler | ||
536 | * must ack and clear interrupts unconditionally while the port | ||
537 | * is frozen. | ||
538 | * | ||
539 | * LOCKING: | ||
540 | * spin_lock_irqsave(host_set lock) | ||
541 | */ | ||
542 | static void __ata_port_freeze(struct ata_port *ap) | ||
543 | { | ||
544 | WARN_ON(!ap->ops->error_handler); | ||
545 | |||
546 | if (ap->ops->freeze) | ||
547 | ap->ops->freeze(ap); | ||
548 | |||
549 | ap->flags |= ATA_FLAG_FROZEN; | ||
550 | |||
551 | DPRINTK("ata%u port frozen\n", ap->id); | ||
552 | } | ||
553 | |||
554 | /** | ||
555 | * ata_port_freeze - abort & freeze port | ||
556 | * @ap: ATA port to freeze | ||
557 | * | ||
558 | * Abort and freeze @ap. | ||
559 | * | ||
560 | * LOCKING: | ||
561 | * spin_lock_irqsave(host_set lock) | ||
562 | * | ||
563 | * RETURNS: | ||
564 | * Number of aborted commands. | ||
565 | */ | ||
566 | int ata_port_freeze(struct ata_port *ap) | ||
567 | { | ||
568 | int nr_aborted; | ||
569 | |||
570 | WARN_ON(!ap->ops->error_handler); | ||
571 | |||
572 | nr_aborted = ata_port_abort(ap); | ||
573 | __ata_port_freeze(ap); | ||
574 | |||
575 | return nr_aborted; | ||
576 | } | ||
577 | |||
578 | /** | ||
579 | * ata_eh_freeze_port - EH helper to freeze port | ||
580 | * @ap: ATA port to freeze | ||
581 | * | ||
582 | * Freeze @ap. | ||
583 | * | ||
584 | * LOCKING: | ||
585 | * None. | ||
586 | */ | ||
587 | void ata_eh_freeze_port(struct ata_port *ap) | ||
588 | { | ||
589 | unsigned long flags; | ||
590 | |||
591 | if (!ap->ops->error_handler) | ||
592 | return; | ||
593 | |||
594 | spin_lock_irqsave(ap->lock, flags); | ||
595 | __ata_port_freeze(ap); | ||
596 | spin_unlock_irqrestore(ap->lock, flags); | ||
597 | } | ||
598 | |||
599 | /** | ||
600 | * ata_port_thaw_port - EH helper to thaw port | ||
601 | * @ap: ATA port to thaw | ||
602 | * | ||
603 | * Thaw frozen port @ap. | ||
604 | * | ||
605 | * LOCKING: | ||
606 | * None. | ||
607 | */ | ||
608 | void ata_eh_thaw_port(struct ata_port *ap) | ||
609 | { | ||
610 | unsigned long flags; | ||
611 | |||
612 | if (!ap->ops->error_handler) | ||
613 | return; | ||
614 | |||
615 | spin_lock_irqsave(ap->lock, flags); | ||
616 | |||
617 | ap->flags &= ~ATA_FLAG_FROZEN; | ||
618 | |||
619 | if (ap->ops->thaw) | ||
620 | ap->ops->thaw(ap); | ||
621 | |||
622 | spin_unlock_irqrestore(ap->lock, flags); | ||
623 | |||
624 | DPRINTK("ata%u port thawed\n", ap->id); | ||
625 | } | ||
626 | |||
627 | static void ata_eh_scsidone(struct scsi_cmnd *scmd) | ||
628 | { | ||
629 | /* nada */ | ||
630 | } | ||
631 | |||
632 | static void __ata_eh_qc_complete(struct ata_queued_cmd *qc) | ||
633 | { | ||
634 | struct ata_port *ap = qc->ap; | ||
635 | struct scsi_cmnd *scmd = qc->scsicmd; | ||
636 | unsigned long flags; | ||
637 | |||
638 | spin_lock_irqsave(ap->lock, flags); | ||
639 | qc->scsidone = ata_eh_scsidone; | ||
640 | __ata_qc_complete(qc); | ||
641 | WARN_ON(ata_tag_valid(qc->tag)); | ||
642 | spin_unlock_irqrestore(ap->lock, flags); | ||
643 | |||
644 | scsi_eh_finish_cmd(scmd, &ap->eh_done_q); | ||
645 | } | ||
646 | |||
647 | /** | ||
648 | * ata_eh_qc_complete - Complete an active ATA command from EH | ||
649 | * @qc: Command to complete | ||
650 | * | ||
651 | * Indicate to the mid and upper layers that an ATA command has | ||
652 | * completed. To be used from EH. | ||
653 | */ | ||
654 | void ata_eh_qc_complete(struct ata_queued_cmd *qc) | ||
655 | { | ||
656 | struct scsi_cmnd *scmd = qc->scsicmd; | ||
657 | scmd->retries = scmd->allowed; | ||
658 | __ata_eh_qc_complete(qc); | ||
659 | } | ||
660 | |||
661 | /** | ||
662 | * ata_eh_qc_retry - Tell midlayer to retry an ATA command after EH | ||
663 | * @qc: Command to retry | ||
664 | * | ||
665 | * Indicate to the mid and upper layers that an ATA command | ||
666 | * should be retried. To be used from EH. | ||
667 | * | ||
668 | * SCSI midlayer limits the number of retries to scmd->allowed. | ||
669 | * scmd->retries is decremented for commands which get retried | ||
670 | * due to unrelated failures (qc->err_mask is zero). | ||
671 | */ | ||
672 | void ata_eh_qc_retry(struct ata_queued_cmd *qc) | ||
673 | { | ||
674 | struct scsi_cmnd *scmd = qc->scsicmd; | ||
675 | if (!qc->err_mask && scmd->retries) | ||
676 | scmd->retries--; | ||
677 | __ata_eh_qc_complete(qc); | ||
678 | } | ||
679 | |||
680 | /** | ||
681 | * ata_eh_detach_dev - detach ATA device | ||
682 | * @dev: ATA device to detach | ||
683 | * | ||
684 | * Detach @dev. | ||
685 | * | ||
686 | * LOCKING: | ||
687 | * None. | ||
688 | */ | ||
689 | static void ata_eh_detach_dev(struct ata_device *dev) | ||
690 | { | ||
691 | struct ata_port *ap = dev->ap; | ||
692 | unsigned long flags; | ||
693 | |||
694 | ata_dev_disable(dev); | ||
695 | |||
696 | spin_lock_irqsave(ap->lock, flags); | ||
697 | |||
698 | dev->flags &= ~ATA_DFLAG_DETACH; | ||
699 | |||
700 | if (ata_scsi_offline_dev(dev)) { | ||
701 | dev->flags |= ATA_DFLAG_DETACHED; | ||
702 | ap->flags |= ATA_FLAG_SCSI_HOTPLUG; | ||
703 | } | ||
704 | |||
705 | spin_unlock_irqrestore(ap->lock, flags); | ||
706 | } | ||
707 | |||
708 | static void ata_eh_clear_action(struct ata_device *dev, | ||
709 | struct ata_eh_info *ehi, unsigned int action) | ||
710 | { | ||
711 | int i; | ||
712 | |||
713 | if (!dev) { | ||
714 | ehi->action &= ~action; | ||
715 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
716 | ehi->dev_action[i] &= ~action; | ||
717 | } else { | ||
718 | /* doesn't make sense for port-wide EH actions */ | ||
719 | WARN_ON(!(action & ATA_EH_PERDEV_MASK)); | ||
720 | |||
721 | /* break ehi->action into ehi->dev_action */ | ||
722 | if (ehi->action & action) { | ||
723 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
724 | ehi->dev_action[i] |= ehi->action & action; | ||
725 | ehi->action &= ~action; | ||
726 | } | ||
727 | |||
728 | /* turn off the specified per-dev action */ | ||
729 | ehi->dev_action[dev->devno] &= ~action; | ||
730 | } | ||
731 | } | ||
732 | |||
733 | /** | ||
734 | * ata_eh_about_to_do - about to perform eh_action | ||
735 | * @ap: target ATA port | ||
736 | * @dev: target ATA dev for per-dev action (can be NULL) | ||
737 | * @action: action about to be performed | ||
738 | * | ||
739 | * Called just before performing EH actions to clear related bits | ||
740 | * in @ap->eh_info such that eh actions are not unnecessarily | ||
741 | * repeated. | ||
742 | * | ||
743 | * LOCKING: | ||
744 | * None. | ||
745 | */ | ||
746 | static void ata_eh_about_to_do(struct ata_port *ap, struct ata_device *dev, | ||
747 | unsigned int action) | ||
748 | { | ||
749 | unsigned long flags; | ||
750 | |||
751 | spin_lock_irqsave(ap->lock, flags); | ||
752 | ata_eh_clear_action(dev, &ap->eh_info, action); | ||
753 | ap->flags |= ATA_FLAG_RECOVERED; | ||
754 | spin_unlock_irqrestore(ap->lock, flags); | ||
755 | } | ||
756 | |||
757 | /** | ||
758 | * ata_eh_done - EH action complete | ||
759 | * @ap: target ATA port | ||
760 | * @dev: target ATA dev for per-dev action (can be NULL) | ||
761 | * @action: action just completed | ||
762 | * | ||
763 | * Called right after performing EH actions to clear related bits | ||
764 | * in @ap->eh_context. | ||
765 | * | ||
766 | * LOCKING: | ||
767 | * None. | ||
768 | */ | ||
769 | static void ata_eh_done(struct ata_port *ap, struct ata_device *dev, | ||
770 | unsigned int action) | ||
771 | { | ||
772 | ata_eh_clear_action(dev, &ap->eh_context.i, action); | ||
773 | } | ||
774 | |||
775 | /** | ||
776 | * ata_err_string - convert err_mask to descriptive string | ||
777 | * @err_mask: error mask to convert to string | ||
778 | * | ||
779 | * Convert @err_mask to descriptive string. Errors are | ||
780 | * prioritized according to severity and only the most severe | ||
781 | * error is reported. | ||
782 | * | ||
783 | * LOCKING: | ||
784 | * None. | ||
785 | * | ||
786 | * RETURNS: | ||
787 | * Descriptive string for @err_mask | ||
788 | */ | ||
789 | static const char * ata_err_string(unsigned int err_mask) | ||
790 | { | ||
791 | if (err_mask & AC_ERR_HOST_BUS) | ||
792 | return "host bus error"; | ||
793 | if (err_mask & AC_ERR_ATA_BUS) | ||
794 | return "ATA bus error"; | ||
795 | if (err_mask & AC_ERR_TIMEOUT) | ||
796 | return "timeout"; | ||
797 | if (err_mask & AC_ERR_HSM) | ||
798 | return "HSM violation"; | ||
799 | if (err_mask & AC_ERR_SYSTEM) | ||
800 | return "internal error"; | ||
801 | if (err_mask & AC_ERR_MEDIA) | ||
802 | return "media error"; | ||
803 | if (err_mask & AC_ERR_INVALID) | ||
804 | return "invalid argument"; | ||
805 | if (err_mask & AC_ERR_DEV) | ||
806 | return "device error"; | ||
807 | return "unknown error"; | ||
808 | } | ||
809 | |||
810 | /** | ||
811 | * ata_read_log_page - read a specific log page | ||
812 | * @dev: target device | ||
813 | * @page: page to read | ||
814 | * @buf: buffer to store read page | ||
815 | * @sectors: number of sectors to read | ||
816 | * | ||
817 | * Read log page using READ_LOG_EXT command. | ||
818 | * | ||
819 | * LOCKING: | ||
820 | * Kernel thread context (may sleep). | ||
821 | * | ||
822 | * RETURNS: | ||
823 | * 0 on success, AC_ERR_* mask otherwise. | ||
824 | */ | ||
825 | static unsigned int ata_read_log_page(struct ata_device *dev, | ||
826 | u8 page, void *buf, unsigned int sectors) | ||
827 | { | ||
828 | struct ata_taskfile tf; | ||
829 | unsigned int err_mask; | ||
830 | |||
831 | DPRINTK("read log page - page %d\n", page); | ||
832 | |||
833 | ata_tf_init(dev, &tf); | ||
834 | tf.command = ATA_CMD_READ_LOG_EXT; | ||
835 | tf.lbal = page; | ||
836 | tf.nsect = sectors; | ||
837 | tf.hob_nsect = sectors >> 8; | ||
838 | tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_LBA48 | ATA_TFLAG_DEVICE; | ||
839 | tf.protocol = ATA_PROT_PIO; | ||
840 | |||
841 | err_mask = ata_exec_internal(dev, &tf, NULL, DMA_FROM_DEVICE, | ||
842 | buf, sectors * ATA_SECT_SIZE); | ||
843 | |||
844 | DPRINTK("EXIT, err_mask=%x\n", err_mask); | ||
845 | return err_mask; | ||
846 | } | ||
847 | |||
848 | /** | ||
849 | * ata_eh_read_log_10h - Read log page 10h for NCQ error details | ||
850 | * @dev: Device to read log page 10h from | ||
851 | * @tag: Resulting tag of the failed command | ||
852 | * @tf: Resulting taskfile registers of the failed command | ||
853 | * | ||
854 | * Read log page 10h to obtain NCQ error details and clear error | ||
855 | * condition. | ||
856 | * | ||
857 | * LOCKING: | ||
858 | * Kernel thread context (may sleep). | ||
859 | * | ||
860 | * RETURNS: | ||
861 | * 0 on success, -errno otherwise. | ||
862 | */ | ||
863 | static int ata_eh_read_log_10h(struct ata_device *dev, | ||
864 | int *tag, struct ata_taskfile *tf) | ||
865 | { | ||
866 | u8 *buf = dev->ap->sector_buf; | ||
867 | unsigned int err_mask; | ||
868 | u8 csum; | ||
869 | int i; | ||
870 | |||
871 | err_mask = ata_read_log_page(dev, ATA_LOG_SATA_NCQ, buf, 1); | ||
872 | if (err_mask) | ||
873 | return -EIO; | ||
874 | |||
875 | csum = 0; | ||
876 | for (i = 0; i < ATA_SECT_SIZE; i++) | ||
877 | csum += buf[i]; | ||
878 | if (csum) | ||
879 | ata_dev_printk(dev, KERN_WARNING, | ||
880 | "invalid checksum 0x%x on log page 10h\n", csum); | ||
881 | |||
882 | if (buf[0] & 0x80) | ||
883 | return -ENOENT; | ||
884 | |||
885 | *tag = buf[0] & 0x1f; | ||
886 | |||
887 | tf->command = buf[2]; | ||
888 | tf->feature = buf[3]; | ||
889 | tf->lbal = buf[4]; | ||
890 | tf->lbam = buf[5]; | ||
891 | tf->lbah = buf[6]; | ||
892 | tf->device = buf[7]; | ||
893 | tf->hob_lbal = buf[8]; | ||
894 | tf->hob_lbam = buf[9]; | ||
895 | tf->hob_lbah = buf[10]; | ||
896 | tf->nsect = buf[12]; | ||
897 | tf->hob_nsect = buf[13]; | ||
898 | |||
899 | return 0; | ||
900 | } | ||
901 | |||
902 | /** | ||
903 | * atapi_eh_request_sense - perform ATAPI REQUEST_SENSE | ||
904 | * @dev: device to perform REQUEST_SENSE to | ||
905 | * @sense_buf: result sense data buffer (SCSI_SENSE_BUFFERSIZE bytes long) | ||
906 | * | ||
907 | * Perform ATAPI REQUEST_SENSE after the device reported CHECK | ||
908 | * SENSE. This function is EH helper. | ||
909 | * | ||
910 | * LOCKING: | ||
911 | * Kernel thread context (may sleep). | ||
912 | * | ||
913 | * RETURNS: | ||
914 | * 0 on success, AC_ERR_* mask on failure | ||
915 | */ | ||
916 | static unsigned int atapi_eh_request_sense(struct ata_device *dev, | ||
917 | unsigned char *sense_buf) | ||
918 | { | ||
919 | struct ata_port *ap = dev->ap; | ||
920 | struct ata_taskfile tf; | ||
921 | u8 cdb[ATAPI_CDB_LEN]; | ||
922 | |||
923 | DPRINTK("ATAPI request sense\n"); | ||
924 | |||
925 | ata_tf_init(dev, &tf); | ||
926 | |||
927 | /* FIXME: is this needed? */ | ||
928 | memset(sense_buf, 0, SCSI_SENSE_BUFFERSIZE); | ||
929 | |||
930 | /* XXX: why tf_read here? */ | ||
931 | ap->ops->tf_read(ap, &tf); | ||
932 | |||
933 | /* fill these in, for the case where they are -not- overwritten */ | ||
934 | sense_buf[0] = 0x70; | ||
935 | sense_buf[2] = tf.feature >> 4; | ||
936 | |||
937 | memset(cdb, 0, ATAPI_CDB_LEN); | ||
938 | cdb[0] = REQUEST_SENSE; | ||
939 | cdb[4] = SCSI_SENSE_BUFFERSIZE; | ||
940 | |||
941 | tf.flags |= ATA_TFLAG_ISADDR | ATA_TFLAG_DEVICE; | ||
942 | tf.command = ATA_CMD_PACKET; | ||
943 | |||
944 | /* is it pointless to prefer PIO for "safety reasons"? */ | ||
945 | if (ap->flags & ATA_FLAG_PIO_DMA) { | ||
946 | tf.protocol = ATA_PROT_ATAPI_DMA; | ||
947 | tf.feature |= ATAPI_PKT_DMA; | ||
948 | } else { | ||
949 | tf.protocol = ATA_PROT_ATAPI; | ||
950 | tf.lbam = (8 * 1024) & 0xff; | ||
951 | tf.lbah = (8 * 1024) >> 8; | ||
952 | } | ||
953 | |||
954 | return ata_exec_internal(dev, &tf, cdb, DMA_FROM_DEVICE, | ||
955 | sense_buf, SCSI_SENSE_BUFFERSIZE); | ||
956 | } | ||
957 | |||
958 | /** | ||
959 | * ata_eh_analyze_serror - analyze SError for a failed port | ||
960 | * @ap: ATA port to analyze SError for | ||
961 | * | ||
962 | * Analyze SError if available and further determine cause of | ||
963 | * failure. | ||
964 | * | ||
965 | * LOCKING: | ||
966 | * None. | ||
967 | */ | ||
968 | static void ata_eh_analyze_serror(struct ata_port *ap) | ||
969 | { | ||
970 | struct ata_eh_context *ehc = &ap->eh_context; | ||
971 | u32 serror = ehc->i.serror; | ||
972 | unsigned int err_mask = 0, action = 0; | ||
973 | |||
974 | if (serror & SERR_PERSISTENT) { | ||
975 | err_mask |= AC_ERR_ATA_BUS; | ||
976 | action |= ATA_EH_HARDRESET; | ||
977 | } | ||
978 | if (serror & | ||
979 | (SERR_DATA_RECOVERED | SERR_COMM_RECOVERED | SERR_DATA)) { | ||
980 | err_mask |= AC_ERR_ATA_BUS; | ||
981 | action |= ATA_EH_SOFTRESET; | ||
982 | } | ||
983 | if (serror & SERR_PROTOCOL) { | ||
984 | err_mask |= AC_ERR_HSM; | ||
985 | action |= ATA_EH_SOFTRESET; | ||
986 | } | ||
987 | if (serror & SERR_INTERNAL) { | ||
988 | err_mask |= AC_ERR_SYSTEM; | ||
989 | action |= ATA_EH_SOFTRESET; | ||
990 | } | ||
991 | if (serror & (SERR_PHYRDY_CHG | SERR_DEV_XCHG)) | ||
992 | ata_ehi_hotplugged(&ehc->i); | ||
993 | |||
994 | ehc->i.err_mask |= err_mask; | ||
995 | ehc->i.action |= action; | ||
996 | } | ||
997 | |||
998 | /** | ||
999 | * ata_eh_analyze_ncq_error - analyze NCQ error | ||
1000 | * @ap: ATA port to analyze NCQ error for | ||
1001 | * | ||
1002 | * Read log page 10h, determine the offending qc and acquire | ||
1003 | * error status TF. For NCQ device errors, all LLDDs have to do | ||
1004 | * is setting AC_ERR_DEV in ehi->err_mask. This function takes | ||
1005 | * care of the rest. | ||
1006 | * | ||
1007 | * LOCKING: | ||
1008 | * Kernel thread context (may sleep). | ||
1009 | */ | ||
1010 | static void ata_eh_analyze_ncq_error(struct ata_port *ap) | ||
1011 | { | ||
1012 | struct ata_eh_context *ehc = &ap->eh_context; | ||
1013 | struct ata_device *dev = ap->device; | ||
1014 | struct ata_queued_cmd *qc; | ||
1015 | struct ata_taskfile tf; | ||
1016 | int tag, rc; | ||
1017 | |||
1018 | /* if frozen, we can't do much */ | ||
1019 | if (ap->flags & ATA_FLAG_FROZEN) | ||
1020 | return; | ||
1021 | |||
1022 | /* is it NCQ device error? */ | ||
1023 | if (!ap->sactive || !(ehc->i.err_mask & AC_ERR_DEV)) | ||
1024 | return; | ||
1025 | |||
1026 | /* has LLDD analyzed already? */ | ||
1027 | for (tag = 0; tag < ATA_MAX_QUEUE; tag++) { | ||
1028 | qc = __ata_qc_from_tag(ap, tag); | ||
1029 | |||
1030 | if (!(qc->flags & ATA_QCFLAG_FAILED)) | ||
1031 | continue; | ||
1032 | |||
1033 | if (qc->err_mask) | ||
1034 | return; | ||
1035 | } | ||
1036 | |||
1037 | /* okay, this error is ours */ | ||
1038 | rc = ata_eh_read_log_10h(dev, &tag, &tf); | ||
1039 | if (rc) { | ||
1040 | ata_port_printk(ap, KERN_ERR, "failed to read log page 10h " | ||
1041 | "(errno=%d)\n", rc); | ||
1042 | return; | ||
1043 | } | ||
1044 | |||
1045 | if (!(ap->sactive & (1 << tag))) { | ||
1046 | ata_port_printk(ap, KERN_ERR, "log page 10h reported " | ||
1047 | "inactive tag %d\n", tag); | ||
1048 | return; | ||
1049 | } | ||
1050 | |||
1051 | /* we've got the perpetrator, condemn it */ | ||
1052 | qc = __ata_qc_from_tag(ap, tag); | ||
1053 | memcpy(&qc->result_tf, &tf, sizeof(tf)); | ||
1054 | qc->err_mask |= AC_ERR_DEV; | ||
1055 | ehc->i.err_mask &= ~AC_ERR_DEV; | ||
1056 | } | ||
1057 | |||
1058 | /** | ||
1059 | * ata_eh_analyze_tf - analyze taskfile of a failed qc | ||
1060 | * @qc: qc to analyze | ||
1061 | * @tf: Taskfile registers to analyze | ||
1062 | * | ||
1063 | * Analyze taskfile of @qc and further determine cause of | ||
1064 | * failure. This function also requests ATAPI sense data if | ||
1065 | * avaliable. | ||
1066 | * | ||
1067 | * LOCKING: | ||
1068 | * Kernel thread context (may sleep). | ||
1069 | * | ||
1070 | * RETURNS: | ||
1071 | * Determined recovery action | ||
1072 | */ | ||
1073 | static unsigned int ata_eh_analyze_tf(struct ata_queued_cmd *qc, | ||
1074 | const struct ata_taskfile *tf) | ||
1075 | { | ||
1076 | unsigned int tmp, action = 0; | ||
1077 | u8 stat = tf->command, err = tf->feature; | ||
1078 | |||
1079 | if ((stat & (ATA_BUSY | ATA_DRQ | ATA_DRDY)) != ATA_DRDY) { | ||
1080 | qc->err_mask |= AC_ERR_HSM; | ||
1081 | return ATA_EH_SOFTRESET; | ||
1082 | } | ||
1083 | |||
1084 | if (!(qc->err_mask & AC_ERR_DEV)) | ||
1085 | return 0; | ||
1086 | |||
1087 | switch (qc->dev->class) { | ||
1088 | case ATA_DEV_ATA: | ||
1089 | if (err & ATA_ICRC) | ||
1090 | qc->err_mask |= AC_ERR_ATA_BUS; | ||
1091 | if (err & ATA_UNC) | ||
1092 | qc->err_mask |= AC_ERR_MEDIA; | ||
1093 | if (err & ATA_IDNF) | ||
1094 | qc->err_mask |= AC_ERR_INVALID; | ||
1095 | break; | ||
1096 | |||
1097 | case ATA_DEV_ATAPI: | ||
1098 | tmp = atapi_eh_request_sense(qc->dev, | ||
1099 | qc->scsicmd->sense_buffer); | ||
1100 | if (!tmp) { | ||
1101 | /* ATA_QCFLAG_SENSE_VALID is used to tell | ||
1102 | * atapi_qc_complete() that sense data is | ||
1103 | * already valid. | ||
1104 | * | ||
1105 | * TODO: interpret sense data and set | ||
1106 | * appropriate err_mask. | ||
1107 | */ | ||
1108 | qc->flags |= ATA_QCFLAG_SENSE_VALID; | ||
1109 | } else | ||
1110 | qc->err_mask |= tmp; | ||
1111 | } | ||
1112 | |||
1113 | if (qc->err_mask & (AC_ERR_HSM | AC_ERR_TIMEOUT | AC_ERR_ATA_BUS)) | ||
1114 | action |= ATA_EH_SOFTRESET; | ||
1115 | |||
1116 | return action; | ||
1117 | } | ||
1118 | |||
1119 | static int ata_eh_categorize_ering_entry(struct ata_ering_entry *ent) | ||
1120 | { | ||
1121 | if (ent->err_mask & (AC_ERR_ATA_BUS | AC_ERR_TIMEOUT)) | ||
1122 | return 1; | ||
1123 | |||
1124 | if (ent->is_io) { | ||
1125 | if (ent->err_mask & AC_ERR_HSM) | ||
1126 | return 1; | ||
1127 | if ((ent->err_mask & | ||
1128 | (AC_ERR_DEV|AC_ERR_MEDIA|AC_ERR_INVALID)) == AC_ERR_DEV) | ||
1129 | return 2; | ||
1130 | } | ||
1131 | |||
1132 | return 0; | ||
1133 | } | ||
1134 | |||
1135 | struct speed_down_needed_arg { | ||
1136 | u64 since; | ||
1137 | int nr_errors[3]; | ||
1138 | }; | ||
1139 | |||
1140 | static int speed_down_needed_cb(struct ata_ering_entry *ent, void *void_arg) | ||
1141 | { | ||
1142 | struct speed_down_needed_arg *arg = void_arg; | ||
1143 | |||
1144 | if (ent->timestamp < arg->since) | ||
1145 | return -1; | ||
1146 | |||
1147 | arg->nr_errors[ata_eh_categorize_ering_entry(ent)]++; | ||
1148 | return 0; | ||
1149 | } | ||
1150 | |||
1151 | /** | ||
1152 | * ata_eh_speed_down_needed - Determine wheter speed down is necessary | ||
1153 | * @dev: Device of interest | ||
1154 | * | ||
1155 | * This function examines error ring of @dev and determines | ||
1156 | * whether speed down is necessary. Speed down is necessary if | ||
1157 | * there have been more than 3 of Cat-1 errors or 10 of Cat-2 | ||
1158 | * errors during last 15 minutes. | ||
1159 | * | ||
1160 | * Cat-1 errors are ATA_BUS, TIMEOUT for any command and HSM | ||
1161 | * violation for known supported commands. | ||
1162 | * | ||
1163 | * Cat-2 errors are unclassified DEV error for known supported | ||
1164 | * command. | ||
1165 | * | ||
1166 | * LOCKING: | ||
1167 | * Inherited from caller. | ||
1168 | * | ||
1169 | * RETURNS: | ||
1170 | * 1 if speed down is necessary, 0 otherwise | ||
1171 | */ | ||
1172 | static int ata_eh_speed_down_needed(struct ata_device *dev) | ||
1173 | { | ||
1174 | const u64 interval = 15LLU * 60 * HZ; | ||
1175 | static const int err_limits[3] = { -1, 3, 10 }; | ||
1176 | struct speed_down_needed_arg arg; | ||
1177 | struct ata_ering_entry *ent; | ||
1178 | int err_cat; | ||
1179 | u64 j64; | ||
1180 | |||
1181 | ent = ata_ering_top(&dev->ering); | ||
1182 | if (!ent) | ||
1183 | return 0; | ||
1184 | |||
1185 | err_cat = ata_eh_categorize_ering_entry(ent); | ||
1186 | if (err_cat == 0) | ||
1187 | return 0; | ||
1188 | |||
1189 | memset(&arg, 0, sizeof(arg)); | ||
1190 | |||
1191 | j64 = get_jiffies_64(); | ||
1192 | if (j64 >= interval) | ||
1193 | arg.since = j64 - interval; | ||
1194 | else | ||
1195 | arg.since = 0; | ||
1196 | |||
1197 | ata_ering_map(&dev->ering, speed_down_needed_cb, &arg); | ||
1198 | |||
1199 | return arg.nr_errors[err_cat] > err_limits[err_cat]; | ||
1200 | } | ||
1201 | |||
1202 | /** | ||
1203 | * ata_eh_speed_down - record error and speed down if necessary | ||
1204 | * @dev: Failed device | ||
1205 | * @is_io: Did the device fail during normal IO? | ||
1206 | * @err_mask: err_mask of the error | ||
1207 | * | ||
1208 | * Record error and examine error history to determine whether | ||
1209 | * adjusting transmission speed is necessary. It also sets | ||
1210 | * transmission limits appropriately if such adjustment is | ||
1211 | * necessary. | ||
1212 | * | ||
1213 | * LOCKING: | ||
1214 | * Kernel thread context (may sleep). | ||
1215 | * | ||
1216 | * RETURNS: | ||
1217 | * 0 on success, -errno otherwise | ||
1218 | */ | ||
1219 | static int ata_eh_speed_down(struct ata_device *dev, int is_io, | ||
1220 | unsigned int err_mask) | ||
1221 | { | ||
1222 | if (!err_mask) | ||
1223 | return 0; | ||
1224 | |||
1225 | /* record error and determine whether speed down is necessary */ | ||
1226 | ata_ering_record(&dev->ering, is_io, err_mask); | ||
1227 | |||
1228 | if (!ata_eh_speed_down_needed(dev)) | ||
1229 | return 0; | ||
1230 | |||
1231 | /* speed down SATA link speed if possible */ | ||
1232 | if (sata_down_spd_limit(dev->ap) == 0) | ||
1233 | return ATA_EH_HARDRESET; | ||
1234 | |||
1235 | /* lower transfer mode */ | ||
1236 | if (ata_down_xfermask_limit(dev, 0) == 0) | ||
1237 | return ATA_EH_SOFTRESET; | ||
1238 | |||
1239 | ata_dev_printk(dev, KERN_ERR, | ||
1240 | "speed down requested but no transfer mode left\n"); | ||
1241 | return 0; | ||
1242 | } | ||
1243 | |||
1244 | /** | ||
1245 | * ata_eh_autopsy - analyze error and determine recovery action | ||
1246 | * @ap: ATA port to perform autopsy on | ||
1247 | * | ||
1248 | * Analyze why @ap failed and determine which recovery action is | ||
1249 | * needed. This function also sets more detailed AC_ERR_* values | ||
1250 | * and fills sense data for ATAPI CHECK SENSE. | ||
1251 | * | ||
1252 | * LOCKING: | ||
1253 | * Kernel thread context (may sleep). | ||
1254 | */ | ||
1255 | static void ata_eh_autopsy(struct ata_port *ap) | ||
1256 | { | ||
1257 | struct ata_eh_context *ehc = &ap->eh_context; | ||
1258 | unsigned int action = ehc->i.action; | ||
1259 | struct ata_device *failed_dev = NULL; | ||
1260 | unsigned int all_err_mask = 0; | ||
1261 | int tag, is_io = 0; | ||
1262 | u32 serror; | ||
1263 | int rc; | ||
1264 | |||
1265 | DPRINTK("ENTER\n"); | ||
1266 | |||
1267 | /* obtain and analyze SError */ | ||
1268 | rc = sata_scr_read(ap, SCR_ERROR, &serror); | ||
1269 | if (rc == 0) { | ||
1270 | ehc->i.serror |= serror; | ||
1271 | ata_eh_analyze_serror(ap); | ||
1272 | } else if (rc != -EOPNOTSUPP) | ||
1273 | action |= ATA_EH_HARDRESET; | ||
1274 | |||
1275 | /* analyze NCQ failure */ | ||
1276 | ata_eh_analyze_ncq_error(ap); | ||
1277 | |||
1278 | /* any real error trumps AC_ERR_OTHER */ | ||
1279 | if (ehc->i.err_mask & ~AC_ERR_OTHER) | ||
1280 | ehc->i.err_mask &= ~AC_ERR_OTHER; | ||
1281 | |||
1282 | all_err_mask |= ehc->i.err_mask; | ||
1283 | |||
1284 | for (tag = 0; tag < ATA_MAX_QUEUE; tag++) { | ||
1285 | struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag); | ||
1286 | |||
1287 | if (!(qc->flags & ATA_QCFLAG_FAILED)) | ||
1288 | continue; | ||
1289 | |||
1290 | /* inherit upper level err_mask */ | ||
1291 | qc->err_mask |= ehc->i.err_mask; | ||
1292 | |||
1293 | /* analyze TF */ | ||
1294 | action |= ata_eh_analyze_tf(qc, &qc->result_tf); | ||
1295 | |||
1296 | /* DEV errors are probably spurious in case of ATA_BUS error */ | ||
1297 | if (qc->err_mask & AC_ERR_ATA_BUS) | ||
1298 | qc->err_mask &= ~(AC_ERR_DEV | AC_ERR_MEDIA | | ||
1299 | AC_ERR_INVALID); | ||
1300 | |||
1301 | /* any real error trumps unknown error */ | ||
1302 | if (qc->err_mask & ~AC_ERR_OTHER) | ||
1303 | qc->err_mask &= ~AC_ERR_OTHER; | ||
1304 | |||
1305 | /* SENSE_VALID trumps dev/unknown error and revalidation */ | ||
1306 | if (qc->flags & ATA_QCFLAG_SENSE_VALID) { | ||
1307 | qc->err_mask &= ~(AC_ERR_DEV | AC_ERR_OTHER); | ||
1308 | action &= ~ATA_EH_REVALIDATE; | ||
1309 | } | ||
1310 | |||
1311 | /* accumulate error info */ | ||
1312 | failed_dev = qc->dev; | ||
1313 | all_err_mask |= qc->err_mask; | ||
1314 | if (qc->flags & ATA_QCFLAG_IO) | ||
1315 | is_io = 1; | ||
1316 | } | ||
1317 | |||
1318 | /* enforce default EH actions */ | ||
1319 | if (ap->flags & ATA_FLAG_FROZEN || | ||
1320 | all_err_mask & (AC_ERR_HSM | AC_ERR_TIMEOUT)) | ||
1321 | action |= ATA_EH_SOFTRESET; | ||
1322 | else if (all_err_mask) | ||
1323 | action |= ATA_EH_REVALIDATE; | ||
1324 | |||
1325 | /* if we have offending qcs and the associated failed device */ | ||
1326 | if (failed_dev) { | ||
1327 | /* speed down */ | ||
1328 | action |= ata_eh_speed_down(failed_dev, is_io, all_err_mask); | ||
1329 | |||
1330 | /* perform per-dev EH action only on the offending device */ | ||
1331 | ehc->i.dev_action[failed_dev->devno] |= | ||
1332 | action & ATA_EH_PERDEV_MASK; | ||
1333 | action &= ~ATA_EH_PERDEV_MASK; | ||
1334 | } | ||
1335 | |||
1336 | /* record autopsy result */ | ||
1337 | ehc->i.dev = failed_dev; | ||
1338 | ehc->i.action = action; | ||
1339 | |||
1340 | DPRINTK("EXIT\n"); | ||
1341 | } | ||
1342 | |||
1343 | /** | ||
1344 | * ata_eh_report - report error handling to user | ||
1345 | * @ap: ATA port EH is going on | ||
1346 | * | ||
1347 | * Report EH to user. | ||
1348 | * | ||
1349 | * LOCKING: | ||
1350 | * None. | ||
1351 | */ | ||
1352 | static void ata_eh_report(struct ata_port *ap) | ||
1353 | { | ||
1354 | struct ata_eh_context *ehc = &ap->eh_context; | ||
1355 | const char *frozen, *desc; | ||
1356 | int tag, nr_failed = 0; | ||
1357 | |||
1358 | desc = NULL; | ||
1359 | if (ehc->i.desc[0] != '\0') | ||
1360 | desc = ehc->i.desc; | ||
1361 | |||
1362 | for (tag = 0; tag < ATA_MAX_QUEUE; tag++) { | ||
1363 | struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag); | ||
1364 | |||
1365 | if (!(qc->flags & ATA_QCFLAG_FAILED)) | ||
1366 | continue; | ||
1367 | if (qc->flags & ATA_QCFLAG_SENSE_VALID && !qc->err_mask) | ||
1368 | continue; | ||
1369 | |||
1370 | nr_failed++; | ||
1371 | } | ||
1372 | |||
1373 | if (!nr_failed && !ehc->i.err_mask) | ||
1374 | return; | ||
1375 | |||
1376 | frozen = ""; | ||
1377 | if (ap->flags & ATA_FLAG_FROZEN) | ||
1378 | frozen = " frozen"; | ||
1379 | |||
1380 | if (ehc->i.dev) { | ||
1381 | ata_dev_printk(ehc->i.dev, KERN_ERR, "exception Emask 0x%x " | ||
1382 | "SAct 0x%x SErr 0x%x action 0x%x%s\n", | ||
1383 | ehc->i.err_mask, ap->sactive, ehc->i.serror, | ||
1384 | ehc->i.action, frozen); | ||
1385 | if (desc) | ||
1386 | ata_dev_printk(ehc->i.dev, KERN_ERR, "(%s)\n", desc); | ||
1387 | } else { | ||
1388 | ata_port_printk(ap, KERN_ERR, "exception Emask 0x%x " | ||
1389 | "SAct 0x%x SErr 0x%x action 0x%x%s\n", | ||
1390 | ehc->i.err_mask, ap->sactive, ehc->i.serror, | ||
1391 | ehc->i.action, frozen); | ||
1392 | if (desc) | ||
1393 | ata_port_printk(ap, KERN_ERR, "(%s)\n", desc); | ||
1394 | } | ||
1395 | |||
1396 | for (tag = 0; tag < ATA_MAX_QUEUE; tag++) { | ||
1397 | struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag); | ||
1398 | |||
1399 | if (!(qc->flags & ATA_QCFLAG_FAILED) || !qc->err_mask) | ||
1400 | continue; | ||
1401 | |||
1402 | ata_dev_printk(qc->dev, KERN_ERR, "tag %d cmd 0x%x " | ||
1403 | "Emask 0x%x stat 0x%x err 0x%x (%s)\n", | ||
1404 | qc->tag, qc->tf.command, qc->err_mask, | ||
1405 | qc->result_tf.command, qc->result_tf.feature, | ||
1406 | ata_err_string(qc->err_mask)); | ||
1407 | } | ||
1408 | } | ||
1409 | |||
1410 | static int ata_do_reset(struct ata_port *ap, ata_reset_fn_t reset, | ||
1411 | unsigned int *classes) | ||
1412 | { | ||
1413 | int i, rc; | ||
1414 | |||
1415 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1416 | classes[i] = ATA_DEV_UNKNOWN; | ||
1417 | |||
1418 | rc = reset(ap, classes); | ||
1419 | if (rc) | ||
1420 | return rc; | ||
1421 | |||
1422 | /* If any class isn't ATA_DEV_UNKNOWN, consider classification | ||
1423 | * is complete and convert all ATA_DEV_UNKNOWN to | ||
1424 | * ATA_DEV_NONE. | ||
1425 | */ | ||
1426 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1427 | if (classes[i] != ATA_DEV_UNKNOWN) | ||
1428 | break; | ||
1429 | |||
1430 | if (i < ATA_MAX_DEVICES) | ||
1431 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1432 | if (classes[i] == ATA_DEV_UNKNOWN) | ||
1433 | classes[i] = ATA_DEV_NONE; | ||
1434 | |||
1435 | return 0; | ||
1436 | } | ||
1437 | |||
1438 | static int ata_eh_followup_srst_needed(int rc, int classify, | ||
1439 | const unsigned int *classes) | ||
1440 | { | ||
1441 | if (rc == -EAGAIN) | ||
1442 | return 1; | ||
1443 | if (rc != 0) | ||
1444 | return 0; | ||
1445 | if (classify && classes[0] == ATA_DEV_UNKNOWN) | ||
1446 | return 1; | ||
1447 | return 0; | ||
1448 | } | ||
1449 | |||
1450 | static int ata_eh_reset(struct ata_port *ap, int classify, | ||
1451 | ata_prereset_fn_t prereset, ata_reset_fn_t softreset, | ||
1452 | ata_reset_fn_t hardreset, ata_postreset_fn_t postreset) | ||
1453 | { | ||
1454 | struct ata_eh_context *ehc = &ap->eh_context; | ||
1455 | unsigned int *classes = ehc->classes; | ||
1456 | int tries = ATA_EH_RESET_TRIES; | ||
1457 | int verbose = !(ap->flags & ATA_FLAG_LOADING); | ||
1458 | unsigned int action; | ||
1459 | ata_reset_fn_t reset; | ||
1460 | int i, did_followup_srst, rc; | ||
1461 | |||
1462 | /* Determine which reset to use and record in ehc->i.action. | ||
1463 | * prereset() may examine and modify it. | ||
1464 | */ | ||
1465 | action = ehc->i.action; | ||
1466 | ehc->i.action &= ~ATA_EH_RESET_MASK; | ||
1467 | if (softreset && (!hardreset || (!sata_set_spd_needed(ap) && | ||
1468 | !(action & ATA_EH_HARDRESET)))) | ||
1469 | ehc->i.action |= ATA_EH_SOFTRESET; | ||
1470 | else | ||
1471 | ehc->i.action |= ATA_EH_HARDRESET; | ||
1472 | |||
1473 | if (prereset) { | ||
1474 | rc = prereset(ap); | ||
1475 | if (rc) { | ||
1476 | ata_port_printk(ap, KERN_ERR, | ||
1477 | "prereset failed (errno=%d)\n", rc); | ||
1478 | return rc; | ||
1479 | } | ||
1480 | } | ||
1481 | |||
1482 | /* prereset() might have modified ehc->i.action */ | ||
1483 | if (ehc->i.action & ATA_EH_HARDRESET) | ||
1484 | reset = hardreset; | ||
1485 | else if (ehc->i.action & ATA_EH_SOFTRESET) | ||
1486 | reset = softreset; | ||
1487 | else { | ||
1488 | /* prereset told us not to reset, bang classes and return */ | ||
1489 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1490 | classes[i] = ATA_DEV_NONE; | ||
1491 | return 0; | ||
1492 | } | ||
1493 | |||
1494 | /* did prereset() screw up? if so, fix up to avoid oopsing */ | ||
1495 | if (!reset) { | ||
1496 | ata_port_printk(ap, KERN_ERR, "BUG: prereset() requested " | ||
1497 | "invalid reset type\n"); | ||
1498 | if (softreset) | ||
1499 | reset = softreset; | ||
1500 | else | ||
1501 | reset = hardreset; | ||
1502 | } | ||
1503 | |||
1504 | retry: | ||
1505 | /* shut up during boot probing */ | ||
1506 | if (verbose) | ||
1507 | ata_port_printk(ap, KERN_INFO, "%s resetting port\n", | ||
1508 | reset == softreset ? "soft" : "hard"); | ||
1509 | |||
1510 | /* reset */ | ||
1511 | ata_eh_about_to_do(ap, NULL, ATA_EH_RESET_MASK); | ||
1512 | ehc->i.flags |= ATA_EHI_DID_RESET; | ||
1513 | |||
1514 | rc = ata_do_reset(ap, reset, classes); | ||
1515 | |||
1516 | did_followup_srst = 0; | ||
1517 | if (reset == hardreset && | ||
1518 | ata_eh_followup_srst_needed(rc, classify, classes)) { | ||
1519 | /* okay, let's do follow-up softreset */ | ||
1520 | did_followup_srst = 1; | ||
1521 | reset = softreset; | ||
1522 | |||
1523 | if (!reset) { | ||
1524 | ata_port_printk(ap, KERN_ERR, | ||
1525 | "follow-up softreset required " | ||
1526 | "but no softreset avaliable\n"); | ||
1527 | return -EINVAL; | ||
1528 | } | ||
1529 | |||
1530 | ata_eh_about_to_do(ap, NULL, ATA_EH_RESET_MASK); | ||
1531 | rc = ata_do_reset(ap, reset, classes); | ||
1532 | |||
1533 | if (rc == 0 && classify && | ||
1534 | classes[0] == ATA_DEV_UNKNOWN) { | ||
1535 | ata_port_printk(ap, KERN_ERR, | ||
1536 | "classification failed\n"); | ||
1537 | return -EINVAL; | ||
1538 | } | ||
1539 | } | ||
1540 | |||
1541 | if (rc && --tries) { | ||
1542 | const char *type; | ||
1543 | |||
1544 | if (reset == softreset) { | ||
1545 | if (did_followup_srst) | ||
1546 | type = "follow-up soft"; | ||
1547 | else | ||
1548 | type = "soft"; | ||
1549 | } else | ||
1550 | type = "hard"; | ||
1551 | |||
1552 | ata_port_printk(ap, KERN_WARNING, | ||
1553 | "%sreset failed, retrying in 5 secs\n", type); | ||
1554 | ssleep(5); | ||
1555 | |||
1556 | if (reset == hardreset) | ||
1557 | sata_down_spd_limit(ap); | ||
1558 | if (hardreset) | ||
1559 | reset = hardreset; | ||
1560 | goto retry; | ||
1561 | } | ||
1562 | |||
1563 | if (rc == 0) { | ||
1564 | /* After the reset, the device state is PIO 0 and the | ||
1565 | * controller state is undefined. Record the mode. | ||
1566 | */ | ||
1567 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1568 | ap->device[i].pio_mode = XFER_PIO_0; | ||
1569 | |||
1570 | if (postreset) | ||
1571 | postreset(ap, classes); | ||
1572 | |||
1573 | /* reset successful, schedule revalidation */ | ||
1574 | ata_eh_done(ap, NULL, ATA_EH_RESET_MASK); | ||
1575 | ehc->i.action |= ATA_EH_REVALIDATE; | ||
1576 | } | ||
1577 | |||
1578 | return rc; | ||
1579 | } | ||
1580 | |||
1581 | static int ata_eh_revalidate_and_attach(struct ata_port *ap, | ||
1582 | struct ata_device **r_failed_dev) | ||
1583 | { | ||
1584 | struct ata_eh_context *ehc = &ap->eh_context; | ||
1585 | struct ata_device *dev; | ||
1586 | unsigned long flags; | ||
1587 | int i, rc = 0; | ||
1588 | |||
1589 | DPRINTK("ENTER\n"); | ||
1590 | |||
1591 | for (i = 0; i < ATA_MAX_DEVICES; i++) { | ||
1592 | unsigned int action; | ||
1593 | |||
1594 | dev = &ap->device[i]; | ||
1595 | action = ehc->i.action | ehc->i.dev_action[dev->devno]; | ||
1596 | |||
1597 | if (action & ATA_EH_REVALIDATE && ata_dev_enabled(dev)) { | ||
1598 | if (ata_port_offline(ap)) { | ||
1599 | rc = -EIO; | ||
1600 | break; | ||
1601 | } | ||
1602 | |||
1603 | ata_eh_about_to_do(ap, dev, ATA_EH_REVALIDATE); | ||
1604 | rc = ata_dev_revalidate(dev, | ||
1605 | ehc->i.flags & ATA_EHI_DID_RESET); | ||
1606 | if (rc) | ||
1607 | break; | ||
1608 | |||
1609 | ata_eh_done(ap, dev, ATA_EH_REVALIDATE); | ||
1610 | |||
1611 | /* schedule the scsi_rescan_device() here */ | ||
1612 | queue_work(ata_aux_wq, &(ap->scsi_rescan_task)); | ||
1613 | } else if (dev->class == ATA_DEV_UNKNOWN && | ||
1614 | ehc->tries[dev->devno] && | ||
1615 | ata_class_enabled(ehc->classes[dev->devno])) { | ||
1616 | dev->class = ehc->classes[dev->devno]; | ||
1617 | |||
1618 | rc = ata_dev_read_id(dev, &dev->class, 1, dev->id); | ||
1619 | if (rc == 0) | ||
1620 | rc = ata_dev_configure(dev, 1); | ||
1621 | |||
1622 | if (rc) { | ||
1623 | dev->class = ATA_DEV_UNKNOWN; | ||
1624 | break; | ||
1625 | } | ||
1626 | |||
1627 | spin_lock_irqsave(ap->lock, flags); | ||
1628 | ap->flags |= ATA_FLAG_SCSI_HOTPLUG; | ||
1629 | spin_unlock_irqrestore(ap->lock, flags); | ||
1630 | } | ||
1631 | } | ||
1632 | |||
1633 | if (rc) | ||
1634 | *r_failed_dev = dev; | ||
1635 | |||
1636 | DPRINTK("EXIT\n"); | ||
1637 | return rc; | ||
1638 | } | ||
1639 | |||
1640 | static int ata_port_nr_enabled(struct ata_port *ap) | ||
1641 | { | ||
1642 | int i, cnt = 0; | ||
1643 | |||
1644 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1645 | if (ata_dev_enabled(&ap->device[i])) | ||
1646 | cnt++; | ||
1647 | return cnt; | ||
1648 | } | ||
1649 | |||
1650 | static int ata_port_nr_vacant(struct ata_port *ap) | ||
1651 | { | ||
1652 | int i, cnt = 0; | ||
1653 | |||
1654 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1655 | if (ap->device[i].class == ATA_DEV_UNKNOWN) | ||
1656 | cnt++; | ||
1657 | return cnt; | ||
1658 | } | ||
1659 | |||
1660 | static int ata_eh_skip_recovery(struct ata_port *ap) | ||
1661 | { | ||
1662 | struct ata_eh_context *ehc = &ap->eh_context; | ||
1663 | int i; | ||
1664 | |||
1665 | if (ap->flags & ATA_FLAG_FROZEN || ata_port_nr_enabled(ap)) | ||
1666 | return 0; | ||
1667 | |||
1668 | /* skip if class codes for all vacant slots are ATA_DEV_NONE */ | ||
1669 | for (i = 0; i < ATA_MAX_DEVICES; i++) { | ||
1670 | struct ata_device *dev = &ap->device[i]; | ||
1671 | |||
1672 | if (dev->class == ATA_DEV_UNKNOWN && | ||
1673 | ehc->classes[dev->devno] != ATA_DEV_NONE) | ||
1674 | return 0; | ||
1675 | } | ||
1676 | |||
1677 | return 1; | ||
1678 | } | ||
1679 | |||
1680 | /** | ||
1681 | * ata_eh_recover - recover host port after error | ||
1682 | * @ap: host port to recover | ||
1683 | * @prereset: prereset method (can be NULL) | ||
1684 | * @softreset: softreset method (can be NULL) | ||
1685 | * @hardreset: hardreset method (can be NULL) | ||
1686 | * @postreset: postreset method (can be NULL) | ||
1687 | * | ||
1688 | * This is the alpha and omega, eum and yang, heart and soul of | ||
1689 | * libata exception handling. On entry, actions required to | ||
1690 | * recover the port and hotplug requests are recorded in | ||
1691 | * eh_context. This function executes all the operations with | ||
1692 | * appropriate retrials and fallbacks to resurrect failed | ||
1693 | * devices, detach goners and greet newcomers. | ||
1694 | * | ||
1695 | * LOCKING: | ||
1696 | * Kernel thread context (may sleep). | ||
1697 | * | ||
1698 | * RETURNS: | ||
1699 | * 0 on success, -errno on failure. | ||
1700 | */ | ||
1701 | static int ata_eh_recover(struct ata_port *ap, ata_prereset_fn_t prereset, | ||
1702 | ata_reset_fn_t softreset, ata_reset_fn_t hardreset, | ||
1703 | ata_postreset_fn_t postreset) | ||
1704 | { | ||
1705 | struct ata_eh_context *ehc = &ap->eh_context; | ||
1706 | struct ata_device *dev; | ||
1707 | int down_xfermask, i, rc; | ||
1708 | |||
1709 | DPRINTK("ENTER\n"); | ||
1710 | |||
1711 | /* prep for recovery */ | ||
1712 | for (i = 0; i < ATA_MAX_DEVICES; i++) { | ||
1713 | dev = &ap->device[i]; | ||
1714 | |||
1715 | ehc->tries[dev->devno] = ATA_EH_DEV_TRIES; | ||
1716 | |||
1717 | /* process hotplug request */ | ||
1718 | if (dev->flags & ATA_DFLAG_DETACH) | ||
1719 | ata_eh_detach_dev(dev); | ||
1720 | |||
1721 | if (!ata_dev_enabled(dev) && | ||
1722 | ((ehc->i.probe_mask & (1 << dev->devno)) && | ||
1723 | !(ehc->did_probe_mask & (1 << dev->devno)))) { | ||
1724 | ata_eh_detach_dev(dev); | ||
1725 | ata_dev_init(dev); | ||
1726 | ehc->did_probe_mask |= (1 << dev->devno); | ||
1727 | ehc->i.action |= ATA_EH_SOFTRESET; | ||
1728 | } | ||
1729 | } | ||
1730 | |||
1731 | retry: | ||
1732 | down_xfermask = 0; | ||
1733 | rc = 0; | ||
1734 | |||
1735 | /* if UNLOADING, finish immediately */ | ||
1736 | if (ap->flags & ATA_FLAG_UNLOADING) | ||
1737 | goto out; | ||
1738 | |||
1739 | /* skip EH if possible. */ | ||
1740 | if (ata_eh_skip_recovery(ap)) | ||
1741 | ehc->i.action = 0; | ||
1742 | |||
1743 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1744 | ehc->classes[i] = ATA_DEV_UNKNOWN; | ||
1745 | |||
1746 | /* reset */ | ||
1747 | if (ehc->i.action & ATA_EH_RESET_MASK) { | ||
1748 | ata_eh_freeze_port(ap); | ||
1749 | |||
1750 | rc = ata_eh_reset(ap, ata_port_nr_vacant(ap), prereset, | ||
1751 | softreset, hardreset, postreset); | ||
1752 | if (rc) { | ||
1753 | ata_port_printk(ap, KERN_ERR, | ||
1754 | "reset failed, giving up\n"); | ||
1755 | goto out; | ||
1756 | } | ||
1757 | |||
1758 | ata_eh_thaw_port(ap); | ||
1759 | } | ||
1760 | |||
1761 | /* revalidate existing devices and attach new ones */ | ||
1762 | rc = ata_eh_revalidate_and_attach(ap, &dev); | ||
1763 | if (rc) | ||
1764 | goto dev_fail; | ||
1765 | |||
1766 | /* configure transfer mode if the port has been reset */ | ||
1767 | if (ehc->i.flags & ATA_EHI_DID_RESET) { | ||
1768 | rc = ata_set_mode(ap, &dev); | ||
1769 | if (rc) { | ||
1770 | down_xfermask = 1; | ||
1771 | goto dev_fail; | ||
1772 | } | ||
1773 | } | ||
1774 | |||
1775 | goto out; | ||
1776 | |||
1777 | dev_fail: | ||
1778 | switch (rc) { | ||
1779 | case -ENODEV: | ||
1780 | /* device missing, schedule probing */ | ||
1781 | ehc->i.probe_mask |= (1 << dev->devno); | ||
1782 | case -EINVAL: | ||
1783 | ehc->tries[dev->devno] = 0; | ||
1784 | break; | ||
1785 | case -EIO: | ||
1786 | sata_down_spd_limit(ap); | ||
1787 | default: | ||
1788 | ehc->tries[dev->devno]--; | ||
1789 | if (down_xfermask && | ||
1790 | ata_down_xfermask_limit(dev, ehc->tries[dev->devno] == 1)) | ||
1791 | ehc->tries[dev->devno] = 0; | ||
1792 | } | ||
1793 | |||
1794 | if (ata_dev_enabled(dev) && !ehc->tries[dev->devno]) { | ||
1795 | /* disable device if it has used up all its chances */ | ||
1796 | ata_dev_disable(dev); | ||
1797 | |||
1798 | /* detach if offline */ | ||
1799 | if (ata_port_offline(ap)) | ||
1800 | ata_eh_detach_dev(dev); | ||
1801 | |||
1802 | /* probe if requested */ | ||
1803 | if ((ehc->i.probe_mask & (1 << dev->devno)) && | ||
1804 | !(ehc->did_probe_mask & (1 << dev->devno))) { | ||
1805 | ata_eh_detach_dev(dev); | ||
1806 | ata_dev_init(dev); | ||
1807 | |||
1808 | ehc->tries[dev->devno] = ATA_EH_DEV_TRIES; | ||
1809 | ehc->did_probe_mask |= (1 << dev->devno); | ||
1810 | ehc->i.action |= ATA_EH_SOFTRESET; | ||
1811 | } | ||
1812 | } else { | ||
1813 | /* soft didn't work? be haaaaard */ | ||
1814 | if (ehc->i.flags & ATA_EHI_DID_RESET) | ||
1815 | ehc->i.action |= ATA_EH_HARDRESET; | ||
1816 | else | ||
1817 | ehc->i.action |= ATA_EH_SOFTRESET; | ||
1818 | } | ||
1819 | |||
1820 | if (ata_port_nr_enabled(ap)) { | ||
1821 | ata_port_printk(ap, KERN_WARNING, "failed to recover some " | ||
1822 | "devices, retrying in 5 secs\n"); | ||
1823 | ssleep(5); | ||
1824 | } else { | ||
1825 | /* no device left, repeat fast */ | ||
1826 | msleep(500); | ||
1827 | } | ||
1828 | |||
1829 | goto retry; | ||
1830 | |||
1831 | out: | ||
1832 | if (rc) { | ||
1833 | for (i = 0; i < ATA_MAX_DEVICES; i++) | ||
1834 | ata_dev_disable(&ap->device[i]); | ||
1835 | } | ||
1836 | |||
1837 | DPRINTK("EXIT, rc=%d\n", rc); | ||
1838 | return rc; | ||
1839 | } | ||
1840 | |||
1841 | /** | ||
1842 | * ata_eh_finish - finish up EH | ||
1843 | * @ap: host port to finish EH for | ||
1844 | * | ||
1845 | * Recovery is complete. Clean up EH states and retry or finish | ||
1846 | * failed qcs. | ||
1847 | * | ||
1848 | * LOCKING: | ||
1849 | * None. | ||
1850 | */ | ||
1851 | static void ata_eh_finish(struct ata_port *ap) | ||
1852 | { | ||
1853 | int tag; | ||
1854 | |||
1855 | /* retry or finish qcs */ | ||
1856 | for (tag = 0; tag < ATA_MAX_QUEUE; tag++) { | ||
1857 | struct ata_queued_cmd *qc = __ata_qc_from_tag(ap, tag); | ||
1858 | |||
1859 | if (!(qc->flags & ATA_QCFLAG_FAILED)) | ||
1860 | continue; | ||
1861 | |||
1862 | if (qc->err_mask) { | ||
1863 | /* FIXME: Once EH migration is complete, | ||
1864 | * generate sense data in this function, | ||
1865 | * considering both err_mask and tf. | ||
1866 | */ | ||
1867 | if (qc->err_mask & AC_ERR_INVALID) | ||
1868 | ata_eh_qc_complete(qc); | ||
1869 | else | ||
1870 | ata_eh_qc_retry(qc); | ||
1871 | } else { | ||
1872 | if (qc->flags & ATA_QCFLAG_SENSE_VALID) { | ||
1873 | ata_eh_qc_complete(qc); | ||
1874 | } else { | ||
1875 | /* feed zero TF to sense generation */ | ||
1876 | memset(&qc->result_tf, 0, sizeof(qc->result_tf)); | ||
1877 | ata_eh_qc_retry(qc); | ||
1878 | } | ||
1879 | } | ||
1880 | } | ||
1881 | } | ||
1882 | |||
1883 | /** | ||
1884 | * ata_do_eh - do standard error handling | ||
1885 | * @ap: host port to handle error for | ||
1886 | * @prereset: prereset method (can be NULL) | ||
1887 | * @softreset: softreset method (can be NULL) | ||
1888 | * @hardreset: hardreset method (can be NULL) | ||
1889 | * @postreset: postreset method (can be NULL) | ||
1890 | * | ||
1891 | * Perform standard error handling sequence. | ||
1892 | * | ||
1893 | * LOCKING: | ||
1894 | * Kernel thread context (may sleep). | ||
1895 | */ | ||
1896 | void ata_do_eh(struct ata_port *ap, ata_prereset_fn_t prereset, | ||
1897 | ata_reset_fn_t softreset, ata_reset_fn_t hardreset, | ||
1898 | ata_postreset_fn_t postreset) | ||
1899 | { | ||
1900 | if (!(ap->flags & ATA_FLAG_LOADING)) { | ||
1901 | ata_eh_autopsy(ap); | ||
1902 | ata_eh_report(ap); | ||
1903 | } | ||
1904 | |||
1905 | ata_eh_recover(ap, prereset, softreset, hardreset, postreset); | ||
1906 | ata_eh_finish(ap); | ||
1907 | } | ||