Merge branch 'topic/misc' into for-linus
[deliverable/linux.git] / drivers / scsi / scsi_error.c
1 /*
2 * scsi_error.c Copyright (C) 1997 Eric Youngdale
3 *
4 * SCSI error/timeout handling
5 * Initial versions: Eric Youngdale. Based upon conversations with
6 * Leonard Zubkoff and David Miller at Linux Expo,
7 * ideas originating from all over the place.
8 *
9 * Restructured scsi_unjam_host and associated functions.
10 * September 04, 2002 Mike Anderson (andmike@us.ibm.com)
11 *
12 * Forward port of Russell King's (rmk@arm.linux.org.uk) changes and
13 * minor cleanups.
14 * September 30, 2002 Mike Anderson (andmike@us.ibm.com)
15 */
16
17 #include <linux/module.h>
18 #include <linux/sched.h>
19 #include <linux/gfp.h>
20 #include <linux/timer.h>
21 #include <linux/string.h>
22 #include <linux/kernel.h>
23 #include <linux/freezer.h>
24 #include <linux/kthread.h>
25 #include <linux/interrupt.h>
26 #include <linux/blkdev.h>
27 #include <linux/delay.h>
28
29 #include <scsi/scsi.h>
30 #include <scsi/scsi_cmnd.h>
31 #include <scsi/scsi_dbg.h>
32 #include <scsi/scsi_device.h>
33 #include <scsi/scsi_eh.h>
34 #include <scsi/scsi_transport.h>
35 #include <scsi/scsi_host.h>
36 #include <scsi/scsi_ioctl.h>
37
38 #include "scsi_priv.h"
39 #include "scsi_logging.h"
40 #include "scsi_transport_api.h"
41
42 #include <trace/events/scsi.h>
43
44 #define SENSE_TIMEOUT (10*HZ)
45
46 /*
47 * These should *probably* be handled by the host itself.
48 * Since it is allowed to sleep, it probably should.
49 */
50 #define BUS_RESET_SETTLE_TIME (10)
51 #define HOST_RESET_SETTLE_TIME (10)
52
53 /* called with shost->host_lock held */
54 void scsi_eh_wakeup(struct Scsi_Host *shost)
55 {
56 if (shost->host_busy == shost->host_failed) {
57 trace_scsi_eh_wakeup(shost);
58 wake_up_process(shost->ehandler);
59 SCSI_LOG_ERROR_RECOVERY(5,
60 printk("Waking error handler thread\n"));
61 }
62 }
63
64 /**
65 * scsi_schedule_eh - schedule EH for SCSI host
66 * @shost: SCSI host to invoke error handling on.
67 *
68 * Schedule SCSI EH without scmd.
69 */
70 void scsi_schedule_eh(struct Scsi_Host *shost)
71 {
72 unsigned long flags;
73
74 spin_lock_irqsave(shost->host_lock, flags);
75
76 if (scsi_host_set_state(shost, SHOST_RECOVERY) == 0 ||
77 scsi_host_set_state(shost, SHOST_CANCEL_RECOVERY) == 0) {
78 shost->host_eh_scheduled++;
79 scsi_eh_wakeup(shost);
80 }
81
82 spin_unlock_irqrestore(shost->host_lock, flags);
83 }
84 EXPORT_SYMBOL_GPL(scsi_schedule_eh);
85
86 /**
87 * scsi_eh_scmd_add - add scsi cmd to error handling.
88 * @scmd: scmd to run eh on.
89 * @eh_flag: optional SCSI_EH flag.
90 *
91 * Return value:
92 * 0 on failure.
93 */
94 int scsi_eh_scmd_add(struct scsi_cmnd *scmd, int eh_flag)
95 {
96 struct Scsi_Host *shost = scmd->device->host;
97 unsigned long flags;
98 int ret = 0;
99
100 if (!shost->ehandler)
101 return 0;
102
103 spin_lock_irqsave(shost->host_lock, flags);
104 if (scsi_host_set_state(shost, SHOST_RECOVERY))
105 if (scsi_host_set_state(shost, SHOST_CANCEL_RECOVERY))
106 goto out_unlock;
107
108 ret = 1;
109 scmd->eh_eflags |= eh_flag;
110 list_add_tail(&scmd->eh_entry, &shost->eh_cmd_q);
111 shost->host_failed++;
112 scsi_eh_wakeup(shost);
113 out_unlock:
114 spin_unlock_irqrestore(shost->host_lock, flags);
115 return ret;
116 }
117
118 /**
119 * scsi_times_out - Timeout function for normal scsi commands.
120 * @req: request that is timing out.
121 *
122 * Notes:
123 * We do not need to lock this. There is the potential for a race
124 * only in that the normal completion handling might run, but if the
125 * normal completion function determines that the timer has already
126 * fired, then it mustn't do anything.
127 */
128 enum blk_eh_timer_return scsi_times_out(struct request *req)
129 {
130 struct scsi_cmnd *scmd = req->special;
131 enum blk_eh_timer_return rtn = BLK_EH_NOT_HANDLED;
132
133 trace_scsi_dispatch_cmd_timeout(scmd);
134 scsi_log_completion(scmd, TIMEOUT_ERROR);
135
136 if (scmd->device->host->transportt->eh_timed_out)
137 rtn = scmd->device->host->transportt->eh_timed_out(scmd);
138 else if (scmd->device->host->hostt->eh_timed_out)
139 rtn = scmd->device->host->hostt->eh_timed_out(scmd);
140
141 if (unlikely(rtn == BLK_EH_NOT_HANDLED &&
142 !scsi_eh_scmd_add(scmd, SCSI_EH_CANCEL_CMD))) {
143 scmd->result |= DID_TIME_OUT << 16;
144 rtn = BLK_EH_HANDLED;
145 }
146
147 return rtn;
148 }
149
150 /**
151 * scsi_block_when_processing_errors - Prevent cmds from being queued.
152 * @sdev: Device on which we are performing recovery.
153 *
154 * Description:
155 * We block until the host is out of error recovery, and then check to
156 * see whether the host or the device is offline.
157 *
158 * Return value:
159 * 0 when dev was taken offline by error recovery. 1 OK to proceed.
160 */
161 int scsi_block_when_processing_errors(struct scsi_device *sdev)
162 {
163 int online;
164
165 wait_event(sdev->host->host_wait, !scsi_host_in_recovery(sdev->host));
166
167 online = scsi_device_online(sdev);
168
169 SCSI_LOG_ERROR_RECOVERY(5, printk("%s: rtn: %d\n", __func__,
170 online));
171
172 return online;
173 }
174 EXPORT_SYMBOL(scsi_block_when_processing_errors);
175
176 #ifdef CONFIG_SCSI_LOGGING
177 /**
178 * scsi_eh_prt_fail_stats - Log info on failures.
179 * @shost: scsi host being recovered.
180 * @work_q: Queue of scsi cmds to process.
181 */
182 static inline void scsi_eh_prt_fail_stats(struct Scsi_Host *shost,
183 struct list_head *work_q)
184 {
185 struct scsi_cmnd *scmd;
186 struct scsi_device *sdev;
187 int total_failures = 0;
188 int cmd_failed = 0;
189 int cmd_cancel = 0;
190 int devices_failed = 0;
191
192 shost_for_each_device(sdev, shost) {
193 list_for_each_entry(scmd, work_q, eh_entry) {
194 if (scmd->device == sdev) {
195 ++total_failures;
196 if (scmd->eh_eflags & SCSI_EH_CANCEL_CMD)
197 ++cmd_cancel;
198 else
199 ++cmd_failed;
200 }
201 }
202
203 if (cmd_cancel || cmd_failed) {
204 SCSI_LOG_ERROR_RECOVERY(3,
205 sdev_printk(KERN_INFO, sdev,
206 "%s: cmds failed: %d, cancel: %d\n",
207 __func__, cmd_failed,
208 cmd_cancel));
209 cmd_cancel = 0;
210 cmd_failed = 0;
211 ++devices_failed;
212 }
213 }
214
215 SCSI_LOG_ERROR_RECOVERY(2, printk("Total of %d commands on %d"
216 " devices require eh work\n",
217 total_failures, devices_failed));
218 }
219 #endif
220
221 /**
222 * scsi_check_sense - Examine scsi cmd sense
223 * @scmd: Cmd to have sense checked.
224 *
225 * Return value:
226 * SUCCESS or FAILED or NEEDS_RETRY
227 *
228 * Notes:
229 * When a deferred error is detected the current command has
230 * not been executed and needs retrying.
231 */
232 static int scsi_check_sense(struct scsi_cmnd *scmd)
233 {
234 struct scsi_device *sdev = scmd->device;
235 struct scsi_sense_hdr sshdr;
236
237 if (! scsi_command_normalize_sense(scmd, &sshdr))
238 return FAILED; /* no valid sense data */
239
240 if (scsi_sense_is_deferred(&sshdr))
241 return NEEDS_RETRY;
242
243 if (sdev->scsi_dh_data && sdev->scsi_dh_data->scsi_dh &&
244 sdev->scsi_dh_data->scsi_dh->check_sense) {
245 int rc;
246
247 rc = sdev->scsi_dh_data->scsi_dh->check_sense(sdev, &sshdr);
248 if (rc != SCSI_RETURN_NOT_HANDLED)
249 return rc;
250 /* handler does not care. Drop down to default handling */
251 }
252
253 /*
254 * Previous logic looked for FILEMARK, EOM or ILI which are
255 * mainly associated with tapes and returned SUCCESS.
256 */
257 if (sshdr.response_code == 0x70) {
258 /* fixed format */
259 if (scmd->sense_buffer[2] & 0xe0)
260 return SUCCESS;
261 } else {
262 /*
263 * descriptor format: look for "stream commands sense data
264 * descriptor" (see SSC-3). Assume single sense data
265 * descriptor. Ignore ILI from SBC-2 READ LONG and WRITE LONG.
266 */
267 if ((sshdr.additional_length > 3) &&
268 (scmd->sense_buffer[8] == 0x4) &&
269 (scmd->sense_buffer[11] & 0xe0))
270 return SUCCESS;
271 }
272
273 switch (sshdr.sense_key) {
274 case NO_SENSE:
275 return SUCCESS;
276 case RECOVERED_ERROR:
277 return /* soft_error */ SUCCESS;
278
279 case ABORTED_COMMAND:
280 if (sshdr.asc == 0x10) /* DIF */
281 return SUCCESS;
282
283 return NEEDS_RETRY;
284 case NOT_READY:
285 case UNIT_ATTENTION:
286 /*
287 * if we are expecting a cc/ua because of a bus reset that we
288 * performed, treat this just as a retry. otherwise this is
289 * information that we should pass up to the upper-level driver
290 * so that we can deal with it there.
291 */
292 if (scmd->device->expecting_cc_ua) {
293 scmd->device->expecting_cc_ua = 0;
294 return NEEDS_RETRY;
295 }
296 /*
297 * if the device is in the process of becoming ready, we
298 * should retry.
299 */
300 if ((sshdr.asc == 0x04) && (sshdr.ascq == 0x01))
301 return NEEDS_RETRY;
302 /*
303 * if the device is not started, we need to wake
304 * the error handler to start the motor
305 */
306 if (scmd->device->allow_restart &&
307 (sshdr.asc == 0x04) && (sshdr.ascq == 0x02))
308 return FAILED;
309
310 if (sshdr.asc == 0x3f && sshdr.ascq == 0x0e)
311 scmd_printk(KERN_WARNING, scmd,
312 "Warning! Received an indication that the "
313 "LUN assignments on this target have "
314 "changed. The Linux SCSI layer does not "
315 "automatically remap LUN assignments.\n");
316 else if (sshdr.asc == 0x3f)
317 scmd_printk(KERN_WARNING, scmd,
318 "Warning! Received an indication that the "
319 "operating parameters on this target have "
320 "changed. The Linux SCSI layer does not "
321 "automatically adjust these parameters.\n");
322
323 /*
324 * Pass the UA upwards for a determination in the completion
325 * functions.
326 */
327 return SUCCESS;
328
329 /* these three are not supported */
330 case COPY_ABORTED:
331 case VOLUME_OVERFLOW:
332 case MISCOMPARE:
333 return SUCCESS;
334
335 case MEDIUM_ERROR:
336 if (sshdr.asc == 0x11 || /* UNRECOVERED READ ERR */
337 sshdr.asc == 0x13 || /* AMNF DATA FIELD */
338 sshdr.asc == 0x14) { /* RECORD NOT FOUND */
339 return SUCCESS;
340 }
341 return NEEDS_RETRY;
342
343 case HARDWARE_ERROR:
344 if (scmd->device->retry_hwerror)
345 return ADD_TO_MLQUEUE;
346 else
347 return SUCCESS;
348
349 case ILLEGAL_REQUEST:
350 case BLANK_CHECK:
351 case DATA_PROTECT:
352 default:
353 return SUCCESS;
354 }
355 }
356
357 static void scsi_handle_queue_ramp_up(struct scsi_device *sdev)
358 {
359 struct scsi_host_template *sht = sdev->host->hostt;
360 struct scsi_device *tmp_sdev;
361
362 if (!sht->change_queue_depth ||
363 sdev->queue_depth >= sdev->max_queue_depth)
364 return;
365
366 if (time_before(jiffies,
367 sdev->last_queue_ramp_up + sdev->queue_ramp_up_period))
368 return;
369
370 if (time_before(jiffies,
371 sdev->last_queue_full_time + sdev->queue_ramp_up_period))
372 return;
373
374 /*
375 * Walk all devices of a target and do
376 * ramp up on them.
377 */
378 shost_for_each_device(tmp_sdev, sdev->host) {
379 if (tmp_sdev->channel != sdev->channel ||
380 tmp_sdev->id != sdev->id ||
381 tmp_sdev->queue_depth == sdev->max_queue_depth)
382 continue;
383 /*
384 * call back into LLD to increase queue_depth by one
385 * with ramp up reason code.
386 */
387 sht->change_queue_depth(tmp_sdev, tmp_sdev->queue_depth + 1,
388 SCSI_QDEPTH_RAMP_UP);
389 sdev->last_queue_ramp_up = jiffies;
390 }
391 }
392
393 static void scsi_handle_queue_full(struct scsi_device *sdev)
394 {
395 struct scsi_host_template *sht = sdev->host->hostt;
396 struct scsi_device *tmp_sdev;
397
398 if (!sht->change_queue_depth)
399 return;
400
401 shost_for_each_device(tmp_sdev, sdev->host) {
402 if (tmp_sdev->channel != sdev->channel ||
403 tmp_sdev->id != sdev->id)
404 continue;
405 /*
406 * We do not know the number of commands that were at
407 * the device when we got the queue full so we start
408 * from the highest possible value and work our way down.
409 */
410 sht->change_queue_depth(tmp_sdev, tmp_sdev->queue_depth - 1,
411 SCSI_QDEPTH_QFULL);
412 }
413 }
414
415 /**
416 * scsi_eh_completed_normally - Disposition a eh cmd on return from LLD.
417 * @scmd: SCSI cmd to examine.
418 *
419 * Notes:
420 * This is *only* called when we are examining the status of commands
421 * queued during error recovery. the main difference here is that we
422 * don't allow for the possibility of retries here, and we are a lot
423 * more restrictive about what we consider acceptable.
424 */
425 static int scsi_eh_completed_normally(struct scsi_cmnd *scmd)
426 {
427 /*
428 * first check the host byte, to see if there is anything in there
429 * that would indicate what we need to do.
430 */
431 if (host_byte(scmd->result) == DID_RESET) {
432 /*
433 * rats. we are already in the error handler, so we now
434 * get to try and figure out what to do next. if the sense
435 * is valid, we have a pretty good idea of what to do.
436 * if not, we mark it as FAILED.
437 */
438 return scsi_check_sense(scmd);
439 }
440 if (host_byte(scmd->result) != DID_OK)
441 return FAILED;
442
443 /*
444 * next, check the message byte.
445 */
446 if (msg_byte(scmd->result) != COMMAND_COMPLETE)
447 return FAILED;
448
449 /*
450 * now, check the status byte to see if this indicates
451 * anything special.
452 */
453 switch (status_byte(scmd->result)) {
454 case GOOD:
455 scsi_handle_queue_ramp_up(scmd->device);
456 case COMMAND_TERMINATED:
457 return SUCCESS;
458 case CHECK_CONDITION:
459 return scsi_check_sense(scmd);
460 case CONDITION_GOOD:
461 case INTERMEDIATE_GOOD:
462 case INTERMEDIATE_C_GOOD:
463 /*
464 * who knows? FIXME(eric)
465 */
466 return SUCCESS;
467 case RESERVATION_CONFLICT:
468 if (scmd->cmnd[0] == TEST_UNIT_READY)
469 /* it is a success, we probed the device and
470 * found it */
471 return SUCCESS;
472 /* otherwise, we failed to send the command */
473 return FAILED;
474 case QUEUE_FULL:
475 scsi_handle_queue_full(scmd->device);
476 /* fall through */
477 case BUSY:
478 return NEEDS_RETRY;
479 default:
480 return FAILED;
481 }
482 return FAILED;
483 }
484
485 /**
486 * scsi_eh_done - Completion function for error handling.
487 * @scmd: Cmd that is done.
488 */
489 static void scsi_eh_done(struct scsi_cmnd *scmd)
490 {
491 struct completion *eh_action;
492
493 SCSI_LOG_ERROR_RECOVERY(3,
494 printk("%s scmd: %p result: %x\n",
495 __func__, scmd, scmd->result));
496
497 eh_action = scmd->device->host->eh_action;
498 if (eh_action)
499 complete(eh_action);
500 }
501
502 /**
503 * scsi_try_host_reset - ask host adapter to reset itself
504 * @scmd: SCSI cmd to send hsot reset.
505 */
506 static int scsi_try_host_reset(struct scsi_cmnd *scmd)
507 {
508 unsigned long flags;
509 int rtn;
510
511 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Snd Host RST\n",
512 __func__));
513
514 if (!scmd->device->host->hostt->eh_host_reset_handler)
515 return FAILED;
516
517 rtn = scmd->device->host->hostt->eh_host_reset_handler(scmd);
518
519 if (rtn == SUCCESS) {
520 if (!scmd->device->host->hostt->skip_settle_delay)
521 ssleep(HOST_RESET_SETTLE_TIME);
522 spin_lock_irqsave(scmd->device->host->host_lock, flags);
523 scsi_report_bus_reset(scmd->device->host,
524 scmd_channel(scmd));
525 spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
526 }
527
528 return rtn;
529 }
530
531 /**
532 * scsi_try_bus_reset - ask host to perform a bus reset
533 * @scmd: SCSI cmd to send bus reset.
534 */
535 static int scsi_try_bus_reset(struct scsi_cmnd *scmd)
536 {
537 unsigned long flags;
538 int rtn;
539
540 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Snd Bus RST\n",
541 __func__));
542
543 if (!scmd->device->host->hostt->eh_bus_reset_handler)
544 return FAILED;
545
546 rtn = scmd->device->host->hostt->eh_bus_reset_handler(scmd);
547
548 if (rtn == SUCCESS) {
549 if (!scmd->device->host->hostt->skip_settle_delay)
550 ssleep(BUS_RESET_SETTLE_TIME);
551 spin_lock_irqsave(scmd->device->host->host_lock, flags);
552 scsi_report_bus_reset(scmd->device->host,
553 scmd_channel(scmd));
554 spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
555 }
556
557 return rtn;
558 }
559
560 static void __scsi_report_device_reset(struct scsi_device *sdev, void *data)
561 {
562 sdev->was_reset = 1;
563 sdev->expecting_cc_ua = 1;
564 }
565
566 /**
567 * scsi_try_target_reset - Ask host to perform a target reset
568 * @scmd: SCSI cmd used to send a target reset
569 *
570 * Notes:
571 * There is no timeout for this operation. if this operation is
572 * unreliable for a given host, then the host itself needs to put a
573 * timer on it, and set the host back to a consistent state prior to
574 * returning.
575 */
576 static int scsi_try_target_reset(struct scsi_cmnd *scmd)
577 {
578 unsigned long flags;
579 int rtn;
580
581 if (!scmd->device->host->hostt->eh_target_reset_handler)
582 return FAILED;
583
584 rtn = scmd->device->host->hostt->eh_target_reset_handler(scmd);
585 if (rtn == SUCCESS) {
586 spin_lock_irqsave(scmd->device->host->host_lock, flags);
587 __starget_for_each_device(scsi_target(scmd->device), NULL,
588 __scsi_report_device_reset);
589 spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
590 }
591
592 return rtn;
593 }
594
595 /**
596 * scsi_try_bus_device_reset - Ask host to perform a BDR on a dev
597 * @scmd: SCSI cmd used to send BDR
598 *
599 * Notes:
600 * There is no timeout for this operation. if this operation is
601 * unreliable for a given host, then the host itself needs to put a
602 * timer on it, and set the host back to a consistent state prior to
603 * returning.
604 */
605 static int scsi_try_bus_device_reset(struct scsi_cmnd *scmd)
606 {
607 int rtn;
608
609 if (!scmd->device->host->hostt->eh_device_reset_handler)
610 return FAILED;
611
612 rtn = scmd->device->host->hostt->eh_device_reset_handler(scmd);
613 if (rtn == SUCCESS)
614 __scsi_report_device_reset(scmd->device, NULL);
615 return rtn;
616 }
617
618 static int scsi_try_to_abort_cmd(struct scsi_cmnd *scmd)
619 {
620 if (!scmd->device->host->hostt->eh_abort_handler)
621 return FAILED;
622
623 return scmd->device->host->hostt->eh_abort_handler(scmd);
624 }
625
626 static void scsi_abort_eh_cmnd(struct scsi_cmnd *scmd)
627 {
628 if (scsi_try_to_abort_cmd(scmd) != SUCCESS)
629 if (scsi_try_bus_device_reset(scmd) != SUCCESS)
630 if (scsi_try_target_reset(scmd) != SUCCESS)
631 if (scsi_try_bus_reset(scmd) != SUCCESS)
632 scsi_try_host_reset(scmd);
633 }
634
635 /**
636 * scsi_eh_prep_cmnd - Save a scsi command info as part of error recory
637 * @scmd: SCSI command structure to hijack
638 * @ses: structure to save restore information
639 * @cmnd: CDB to send. Can be NULL if no new cmnd is needed
640 * @cmnd_size: size in bytes of @cmnd (must be <= BLK_MAX_CDB)
641 * @sense_bytes: size of sense data to copy. or 0 (if != 0 @cmnd is ignored)
642 *
643 * This function is used to save a scsi command information before re-execution
644 * as part of the error recovery process. If @sense_bytes is 0 the command
645 * sent must be one that does not transfer any data. If @sense_bytes != 0
646 * @cmnd is ignored and this functions sets up a REQUEST_SENSE command
647 * and cmnd buffers to read @sense_bytes into @scmd->sense_buffer.
648 */
649 void scsi_eh_prep_cmnd(struct scsi_cmnd *scmd, struct scsi_eh_save *ses,
650 unsigned char *cmnd, int cmnd_size, unsigned sense_bytes)
651 {
652 struct scsi_device *sdev = scmd->device;
653
654 /*
655 * We need saved copies of a number of fields - this is because
656 * error handling may need to overwrite these with different values
657 * to run different commands, and once error handling is complete,
658 * we will need to restore these values prior to running the actual
659 * command.
660 */
661 ses->cmd_len = scmd->cmd_len;
662 ses->cmnd = scmd->cmnd;
663 ses->data_direction = scmd->sc_data_direction;
664 ses->sdb = scmd->sdb;
665 ses->next_rq = scmd->request->next_rq;
666 ses->result = scmd->result;
667 ses->underflow = scmd->underflow;
668 ses->prot_op = scmd->prot_op;
669
670 scmd->prot_op = SCSI_PROT_NORMAL;
671 scmd->cmnd = ses->eh_cmnd;
672 memset(scmd->cmnd, 0, BLK_MAX_CDB);
673 memset(&scmd->sdb, 0, sizeof(scmd->sdb));
674 scmd->request->next_rq = NULL;
675
676 if (sense_bytes) {
677 scmd->sdb.length = min_t(unsigned, SCSI_SENSE_BUFFERSIZE,
678 sense_bytes);
679 sg_init_one(&ses->sense_sgl, scmd->sense_buffer,
680 scmd->sdb.length);
681 scmd->sdb.table.sgl = &ses->sense_sgl;
682 scmd->sc_data_direction = DMA_FROM_DEVICE;
683 scmd->sdb.table.nents = 1;
684 scmd->cmnd[0] = REQUEST_SENSE;
685 scmd->cmnd[4] = scmd->sdb.length;
686 scmd->cmd_len = COMMAND_SIZE(scmd->cmnd[0]);
687 } else {
688 scmd->sc_data_direction = DMA_NONE;
689 if (cmnd) {
690 BUG_ON(cmnd_size > BLK_MAX_CDB);
691 memcpy(scmd->cmnd, cmnd, cmnd_size);
692 scmd->cmd_len = COMMAND_SIZE(scmd->cmnd[0]);
693 }
694 }
695
696 scmd->underflow = 0;
697
698 if (sdev->scsi_level <= SCSI_2 && sdev->scsi_level != SCSI_UNKNOWN)
699 scmd->cmnd[1] = (scmd->cmnd[1] & 0x1f) |
700 (sdev->lun << 5 & 0xe0);
701
702 /*
703 * Zero the sense buffer. The scsi spec mandates that any
704 * untransferred sense data should be interpreted as being zero.
705 */
706 memset(scmd->sense_buffer, 0, SCSI_SENSE_BUFFERSIZE);
707 }
708 EXPORT_SYMBOL(scsi_eh_prep_cmnd);
709
710 /**
711 * scsi_eh_restore_cmnd - Restore a scsi command info as part of error recory
712 * @scmd: SCSI command structure to restore
713 * @ses: saved information from a coresponding call to scsi_eh_prep_cmnd
714 *
715 * Undo any damage done by above scsi_eh_prep_cmnd().
716 */
717 void scsi_eh_restore_cmnd(struct scsi_cmnd* scmd, struct scsi_eh_save *ses)
718 {
719 /*
720 * Restore original data
721 */
722 scmd->cmd_len = ses->cmd_len;
723 scmd->cmnd = ses->cmnd;
724 scmd->sc_data_direction = ses->data_direction;
725 scmd->sdb = ses->sdb;
726 scmd->request->next_rq = ses->next_rq;
727 scmd->result = ses->result;
728 scmd->underflow = ses->underflow;
729 scmd->prot_op = ses->prot_op;
730 }
731 EXPORT_SYMBOL(scsi_eh_restore_cmnd);
732
733 /**
734 * scsi_send_eh_cmnd - submit a scsi command as part of error recory
735 * @scmd: SCSI command structure to hijack
736 * @cmnd: CDB to send
737 * @cmnd_size: size in bytes of @cmnd
738 * @timeout: timeout for this request
739 * @sense_bytes: size of sense data to copy or 0
740 *
741 * This function is used to send a scsi command down to a target device
742 * as part of the error recovery process. See also scsi_eh_prep_cmnd() above.
743 *
744 * Return value:
745 * SUCCESS or FAILED or NEEDS_RETRY
746 */
747 static int scsi_send_eh_cmnd(struct scsi_cmnd *scmd, unsigned char *cmnd,
748 int cmnd_size, int timeout, unsigned sense_bytes)
749 {
750 struct scsi_device *sdev = scmd->device;
751 struct Scsi_Host *shost = sdev->host;
752 DECLARE_COMPLETION_ONSTACK(done);
753 unsigned long timeleft;
754 struct scsi_eh_save ses;
755 int rtn;
756
757 scsi_eh_prep_cmnd(scmd, &ses, cmnd, cmnd_size, sense_bytes);
758 shost->eh_action = &done;
759
760 scsi_log_send(scmd);
761 scmd->scsi_done = scsi_eh_done;
762 shost->hostt->queuecommand(shost, scmd);
763
764 timeleft = wait_for_completion_timeout(&done, timeout);
765
766 shost->eh_action = NULL;
767
768 scsi_log_completion(scmd, SUCCESS);
769
770 SCSI_LOG_ERROR_RECOVERY(3,
771 printk("%s: scmd: %p, timeleft: %ld\n",
772 __func__, scmd, timeleft));
773
774 /*
775 * If there is time left scsi_eh_done got called, and we will
776 * examine the actual status codes to see whether the command
777 * actually did complete normally, else tell the host to forget
778 * about this command.
779 */
780 if (timeleft) {
781 rtn = scsi_eh_completed_normally(scmd);
782 SCSI_LOG_ERROR_RECOVERY(3,
783 printk("%s: scsi_eh_completed_normally %x\n",
784 __func__, rtn));
785
786 switch (rtn) {
787 case SUCCESS:
788 case NEEDS_RETRY:
789 case FAILED:
790 break;
791 case ADD_TO_MLQUEUE:
792 rtn = NEEDS_RETRY;
793 break;
794 default:
795 rtn = FAILED;
796 break;
797 }
798 } else {
799 scsi_abort_eh_cmnd(scmd);
800 rtn = FAILED;
801 }
802
803 scsi_eh_restore_cmnd(scmd, &ses);
804 return rtn;
805 }
806
807 /**
808 * scsi_request_sense - Request sense data from a particular target.
809 * @scmd: SCSI cmd for request sense.
810 *
811 * Notes:
812 * Some hosts automatically obtain this information, others require
813 * that we obtain it on our own. This function will *not* return until
814 * the command either times out, or it completes.
815 */
816 static int scsi_request_sense(struct scsi_cmnd *scmd)
817 {
818 return scsi_send_eh_cmnd(scmd, NULL, 0, SENSE_TIMEOUT, ~0);
819 }
820
821 /**
822 * scsi_eh_finish_cmd - Handle a cmd that eh is finished with.
823 * @scmd: Original SCSI cmd that eh has finished.
824 * @done_q: Queue for processed commands.
825 *
826 * Notes:
827 * We don't want to use the normal command completion while we are are
828 * still handling errors - it may cause other commands to be queued,
829 * and that would disturb what we are doing. Thus we really want to
830 * keep a list of pending commands for final completion, and once we
831 * are ready to leave error handling we handle completion for real.
832 */
833 void scsi_eh_finish_cmd(struct scsi_cmnd *scmd, struct list_head *done_q)
834 {
835 scmd->device->host->host_failed--;
836 scmd->eh_eflags = 0;
837 list_move_tail(&scmd->eh_entry, done_q);
838 }
839 EXPORT_SYMBOL(scsi_eh_finish_cmd);
840
841 /**
842 * scsi_eh_get_sense - Get device sense data.
843 * @work_q: Queue of commands to process.
844 * @done_q: Queue of processed commands.
845 *
846 * Description:
847 * See if we need to request sense information. if so, then get it
848 * now, so we have a better idea of what to do.
849 *
850 * Notes:
851 * This has the unfortunate side effect that if a shost adapter does
852 * not automatically request sense information, we end up shutting
853 * it down before we request it.
854 *
855 * All drivers should request sense information internally these days,
856 * so for now all I have to say is tough noogies if you end up in here.
857 *
858 * XXX: Long term this code should go away, but that needs an audit of
859 * all LLDDs first.
860 */
861 int scsi_eh_get_sense(struct list_head *work_q,
862 struct list_head *done_q)
863 {
864 struct scsi_cmnd *scmd, *next;
865 int rtn;
866
867 list_for_each_entry_safe(scmd, next, work_q, eh_entry) {
868 if ((scmd->eh_eflags & SCSI_EH_CANCEL_CMD) ||
869 SCSI_SENSE_VALID(scmd))
870 continue;
871
872 SCSI_LOG_ERROR_RECOVERY(2, scmd_printk(KERN_INFO, scmd,
873 "%s: requesting sense\n",
874 current->comm));
875 rtn = scsi_request_sense(scmd);
876 if (rtn != SUCCESS)
877 continue;
878
879 SCSI_LOG_ERROR_RECOVERY(3, printk("sense requested for %p"
880 " result %x\n", scmd,
881 scmd->result));
882 SCSI_LOG_ERROR_RECOVERY(3, scsi_print_sense("bh", scmd));
883
884 rtn = scsi_decide_disposition(scmd);
885
886 /*
887 * if the result was normal, then just pass it along to the
888 * upper level.
889 */
890 if (rtn == SUCCESS)
891 /* we don't want this command reissued, just
892 * finished with the sense data, so set
893 * retries to the max allowed to ensure it
894 * won't get reissued */
895 scmd->retries = scmd->allowed;
896 else if (rtn != NEEDS_RETRY)
897 continue;
898
899 scsi_eh_finish_cmd(scmd, done_q);
900 }
901
902 return list_empty(work_q);
903 }
904 EXPORT_SYMBOL_GPL(scsi_eh_get_sense);
905
906 /**
907 * scsi_eh_tur - Send TUR to device.
908 * @scmd: &scsi_cmnd to send TUR
909 *
910 * Return value:
911 * 0 - Device is ready. 1 - Device NOT ready.
912 */
913 static int scsi_eh_tur(struct scsi_cmnd *scmd)
914 {
915 static unsigned char tur_command[6] = {TEST_UNIT_READY, 0, 0, 0, 0, 0};
916 int retry_cnt = 1, rtn;
917
918 retry_tur:
919 rtn = scsi_send_eh_cmnd(scmd, tur_command, 6, SENSE_TIMEOUT, 0);
920
921 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: scmd %p rtn %x\n",
922 __func__, scmd, rtn));
923
924 switch (rtn) {
925 case NEEDS_RETRY:
926 if (retry_cnt--)
927 goto retry_tur;
928 /*FALLTHRU*/
929 case SUCCESS:
930 return 0;
931 default:
932 return 1;
933 }
934 }
935
936 /**
937 * scsi_eh_abort_cmds - abort pending commands.
938 * @work_q: &list_head for pending commands.
939 * @done_q: &list_head for processed commands.
940 *
941 * Decription:
942 * Try and see whether or not it makes sense to try and abort the
943 * running command. This only works out to be the case if we have one
944 * command that has timed out. If the command simply failed, it makes
945 * no sense to try and abort the command, since as far as the shost
946 * adapter is concerned, it isn't running.
947 */
948 static int scsi_eh_abort_cmds(struct list_head *work_q,
949 struct list_head *done_q)
950 {
951 struct scsi_cmnd *scmd, *next;
952 int rtn;
953
954 list_for_each_entry_safe(scmd, next, work_q, eh_entry) {
955 if (!(scmd->eh_eflags & SCSI_EH_CANCEL_CMD))
956 continue;
957 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: aborting cmd:"
958 "0x%p\n", current->comm,
959 scmd));
960 rtn = scsi_try_to_abort_cmd(scmd);
961 if (rtn == SUCCESS || rtn == FAST_IO_FAIL) {
962 scmd->eh_eflags &= ~SCSI_EH_CANCEL_CMD;
963 if (!scsi_device_online(scmd->device) ||
964 rtn == FAST_IO_FAIL ||
965 !scsi_eh_tur(scmd)) {
966 scsi_eh_finish_cmd(scmd, done_q);
967 }
968
969 } else
970 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: aborting"
971 " cmd failed:"
972 "0x%p\n",
973 current->comm,
974 scmd));
975 }
976
977 return list_empty(work_q);
978 }
979
980 /**
981 * scsi_eh_try_stu - Send START_UNIT to device.
982 * @scmd: &scsi_cmnd to send START_UNIT
983 *
984 * Return value:
985 * 0 - Device is ready. 1 - Device NOT ready.
986 */
987 static int scsi_eh_try_stu(struct scsi_cmnd *scmd)
988 {
989 static unsigned char stu_command[6] = {START_STOP, 0, 0, 0, 1, 0};
990
991 if (scmd->device->allow_restart) {
992 int i, rtn = NEEDS_RETRY;
993
994 for (i = 0; rtn == NEEDS_RETRY && i < 2; i++)
995 rtn = scsi_send_eh_cmnd(scmd, stu_command, 6, scmd->device->request_queue->rq_timeout, 0);
996
997 if (rtn == SUCCESS)
998 return 0;
999 }
1000
1001 return 1;
1002 }
1003
1004 /**
1005 * scsi_eh_stu - send START_UNIT if needed
1006 * @shost: &scsi host being recovered.
1007 * @work_q: &list_head for pending commands.
1008 * @done_q: &list_head for processed commands.
1009 *
1010 * Notes:
1011 * If commands are failing due to not ready, initializing command required,
1012 * try revalidating the device, which will end up sending a start unit.
1013 */
1014 static int scsi_eh_stu(struct Scsi_Host *shost,
1015 struct list_head *work_q,
1016 struct list_head *done_q)
1017 {
1018 struct scsi_cmnd *scmd, *stu_scmd, *next;
1019 struct scsi_device *sdev;
1020
1021 shost_for_each_device(sdev, shost) {
1022 stu_scmd = NULL;
1023 list_for_each_entry(scmd, work_q, eh_entry)
1024 if (scmd->device == sdev && SCSI_SENSE_VALID(scmd) &&
1025 scsi_check_sense(scmd) == FAILED ) {
1026 stu_scmd = scmd;
1027 break;
1028 }
1029
1030 if (!stu_scmd)
1031 continue;
1032
1033 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending START_UNIT to sdev:"
1034 " 0x%p\n", current->comm, sdev));
1035
1036 if (!scsi_eh_try_stu(stu_scmd)) {
1037 if (!scsi_device_online(sdev) ||
1038 !scsi_eh_tur(stu_scmd)) {
1039 list_for_each_entry_safe(scmd, next,
1040 work_q, eh_entry) {
1041 if (scmd->device == sdev)
1042 scsi_eh_finish_cmd(scmd, done_q);
1043 }
1044 }
1045 } else {
1046 SCSI_LOG_ERROR_RECOVERY(3,
1047 printk("%s: START_UNIT failed to sdev:"
1048 " 0x%p\n", current->comm, sdev));
1049 }
1050 }
1051
1052 return list_empty(work_q);
1053 }
1054
1055
1056 /**
1057 * scsi_eh_bus_device_reset - send bdr if needed
1058 * @shost: scsi host being recovered.
1059 * @work_q: &list_head for pending commands.
1060 * @done_q: &list_head for processed commands.
1061 *
1062 * Notes:
1063 * Try a bus device reset. Still, look to see whether we have multiple
1064 * devices that are jammed or not - if we have multiple devices, it
1065 * makes no sense to try bus_device_reset - we really would need to try
1066 * a bus_reset instead.
1067 */
1068 static int scsi_eh_bus_device_reset(struct Scsi_Host *shost,
1069 struct list_head *work_q,
1070 struct list_head *done_q)
1071 {
1072 struct scsi_cmnd *scmd, *bdr_scmd, *next;
1073 struct scsi_device *sdev;
1074 int rtn;
1075
1076 shost_for_each_device(sdev, shost) {
1077 bdr_scmd = NULL;
1078 list_for_each_entry(scmd, work_q, eh_entry)
1079 if (scmd->device == sdev) {
1080 bdr_scmd = scmd;
1081 break;
1082 }
1083
1084 if (!bdr_scmd)
1085 continue;
1086
1087 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending BDR sdev:"
1088 " 0x%p\n", current->comm,
1089 sdev));
1090 rtn = scsi_try_bus_device_reset(bdr_scmd);
1091 if (rtn == SUCCESS || rtn == FAST_IO_FAIL) {
1092 if (!scsi_device_online(sdev) ||
1093 rtn == FAST_IO_FAIL ||
1094 !scsi_eh_tur(bdr_scmd)) {
1095 list_for_each_entry_safe(scmd, next,
1096 work_q, eh_entry) {
1097 if (scmd->device == sdev)
1098 scsi_eh_finish_cmd(scmd,
1099 done_q);
1100 }
1101 }
1102 } else {
1103 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: BDR"
1104 " failed sdev:"
1105 "0x%p\n",
1106 current->comm,
1107 sdev));
1108 }
1109 }
1110
1111 return list_empty(work_q);
1112 }
1113
1114 /**
1115 * scsi_eh_target_reset - send target reset if needed
1116 * @shost: scsi host being recovered.
1117 * @work_q: &list_head for pending commands.
1118 * @done_q: &list_head for processed commands.
1119 *
1120 * Notes:
1121 * Try a target reset.
1122 */
1123 static int scsi_eh_target_reset(struct Scsi_Host *shost,
1124 struct list_head *work_q,
1125 struct list_head *done_q)
1126 {
1127 struct scsi_cmnd *scmd, *tgtr_scmd, *next;
1128 unsigned int id = 0;
1129 int rtn;
1130
1131 do {
1132 tgtr_scmd = NULL;
1133 list_for_each_entry(scmd, work_q, eh_entry) {
1134 if (id == scmd_id(scmd)) {
1135 tgtr_scmd = scmd;
1136 break;
1137 }
1138 }
1139 if (!tgtr_scmd) {
1140 /* not one exactly equal; find the next highest */
1141 list_for_each_entry(scmd, work_q, eh_entry) {
1142 if (scmd_id(scmd) > id &&
1143 (!tgtr_scmd ||
1144 scmd_id(tgtr_scmd) > scmd_id(scmd)))
1145 tgtr_scmd = scmd;
1146 }
1147 }
1148 if (!tgtr_scmd)
1149 /* no more commands, that's it */
1150 break;
1151
1152 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending target reset "
1153 "to target %d\n",
1154 current->comm, id));
1155 rtn = scsi_try_target_reset(tgtr_scmd);
1156 if (rtn == SUCCESS || rtn == FAST_IO_FAIL) {
1157 list_for_each_entry_safe(scmd, next, work_q, eh_entry) {
1158 if (id == scmd_id(scmd))
1159 if (!scsi_device_online(scmd->device) ||
1160 rtn == FAST_IO_FAIL ||
1161 !scsi_eh_tur(tgtr_scmd))
1162 scsi_eh_finish_cmd(scmd,
1163 done_q);
1164 }
1165 } else
1166 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Target reset"
1167 " failed target: "
1168 "%d\n",
1169 current->comm, id));
1170 id++;
1171 } while(id != 0);
1172
1173 return list_empty(work_q);
1174 }
1175
1176 /**
1177 * scsi_eh_bus_reset - send a bus reset
1178 * @shost: &scsi host being recovered.
1179 * @work_q: &list_head for pending commands.
1180 * @done_q: &list_head for processed commands.
1181 */
1182 static int scsi_eh_bus_reset(struct Scsi_Host *shost,
1183 struct list_head *work_q,
1184 struct list_head *done_q)
1185 {
1186 struct scsi_cmnd *scmd, *chan_scmd, *next;
1187 unsigned int channel;
1188 int rtn;
1189
1190 /*
1191 * we really want to loop over the various channels, and do this on
1192 * a channel by channel basis. we should also check to see if any
1193 * of the failed commands are on soft_reset devices, and if so, skip
1194 * the reset.
1195 */
1196
1197 for (channel = 0; channel <= shost->max_channel; channel++) {
1198 chan_scmd = NULL;
1199 list_for_each_entry(scmd, work_q, eh_entry) {
1200 if (channel == scmd_channel(scmd)) {
1201 chan_scmd = scmd;
1202 break;
1203 /*
1204 * FIXME add back in some support for
1205 * soft_reset devices.
1206 */
1207 }
1208 }
1209
1210 if (!chan_scmd)
1211 continue;
1212 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending BRST chan:"
1213 " %d\n", current->comm,
1214 channel));
1215 rtn = scsi_try_bus_reset(chan_scmd);
1216 if (rtn == SUCCESS || rtn == FAST_IO_FAIL) {
1217 list_for_each_entry_safe(scmd, next, work_q, eh_entry) {
1218 if (channel == scmd_channel(scmd))
1219 if (!scsi_device_online(scmd->device) ||
1220 rtn == FAST_IO_FAIL ||
1221 !scsi_eh_tur(scmd))
1222 scsi_eh_finish_cmd(scmd,
1223 done_q);
1224 }
1225 } else {
1226 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: BRST"
1227 " failed chan: %d\n",
1228 current->comm,
1229 channel));
1230 }
1231 }
1232 return list_empty(work_q);
1233 }
1234
1235 /**
1236 * scsi_eh_host_reset - send a host reset
1237 * @work_q: list_head for processed commands.
1238 * @done_q: list_head for processed commands.
1239 */
1240 static int scsi_eh_host_reset(struct list_head *work_q,
1241 struct list_head *done_q)
1242 {
1243 struct scsi_cmnd *scmd, *next;
1244 int rtn;
1245
1246 if (!list_empty(work_q)) {
1247 scmd = list_entry(work_q->next,
1248 struct scsi_cmnd, eh_entry);
1249
1250 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending HRST\n"
1251 , current->comm));
1252
1253 rtn = scsi_try_host_reset(scmd);
1254 if (rtn == SUCCESS || rtn == FAST_IO_FAIL) {
1255 list_for_each_entry_safe(scmd, next, work_q, eh_entry) {
1256 if (!scsi_device_online(scmd->device) ||
1257 rtn == FAST_IO_FAIL ||
1258 (!scsi_eh_try_stu(scmd) && !scsi_eh_tur(scmd)) ||
1259 !scsi_eh_tur(scmd))
1260 scsi_eh_finish_cmd(scmd, done_q);
1261 }
1262 } else {
1263 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: HRST"
1264 " failed\n",
1265 current->comm));
1266 }
1267 }
1268 return list_empty(work_q);
1269 }
1270
1271 /**
1272 * scsi_eh_offline_sdevs - offline scsi devices that fail to recover
1273 * @work_q: list_head for processed commands.
1274 * @done_q: list_head for processed commands.
1275 */
1276 static void scsi_eh_offline_sdevs(struct list_head *work_q,
1277 struct list_head *done_q)
1278 {
1279 struct scsi_cmnd *scmd, *next;
1280
1281 list_for_each_entry_safe(scmd, next, work_q, eh_entry) {
1282 sdev_printk(KERN_INFO, scmd->device, "Device offlined - "
1283 "not ready after error recovery\n");
1284 scsi_device_set_state(scmd->device, SDEV_OFFLINE);
1285 if (scmd->eh_eflags & SCSI_EH_CANCEL_CMD) {
1286 /*
1287 * FIXME: Handle lost cmds.
1288 */
1289 }
1290 scsi_eh_finish_cmd(scmd, done_q);
1291 }
1292 return;
1293 }
1294
1295 /**
1296 * scsi_noretry_cmd - determinte if command should be failed fast
1297 * @scmd: SCSI cmd to examine.
1298 */
1299 int scsi_noretry_cmd(struct scsi_cmnd *scmd)
1300 {
1301 switch (host_byte(scmd->result)) {
1302 case DID_OK:
1303 break;
1304 case DID_BUS_BUSY:
1305 return (scmd->request->cmd_flags & REQ_FAILFAST_TRANSPORT);
1306 case DID_PARITY:
1307 return (scmd->request->cmd_flags & REQ_FAILFAST_DEV);
1308 case DID_ERROR:
1309 if (msg_byte(scmd->result) == COMMAND_COMPLETE &&
1310 status_byte(scmd->result) == RESERVATION_CONFLICT)
1311 return 0;
1312 /* fall through */
1313 case DID_SOFT_ERROR:
1314 return (scmd->request->cmd_flags & REQ_FAILFAST_DRIVER);
1315 }
1316
1317 switch (status_byte(scmd->result)) {
1318 case CHECK_CONDITION:
1319 /*
1320 * assume caller has checked sense and determinted
1321 * the check condition was retryable.
1322 */
1323 if (scmd->request->cmd_flags & REQ_FAILFAST_DEV ||
1324 scmd->request->cmd_type == REQ_TYPE_BLOCK_PC)
1325 return 1;
1326 }
1327
1328 return 0;
1329 }
1330
1331 /**
1332 * scsi_decide_disposition - Disposition a cmd on return from LLD.
1333 * @scmd: SCSI cmd to examine.
1334 *
1335 * Notes:
1336 * This is *only* called when we are examining the status after sending
1337 * out the actual data command. any commands that are queued for error
1338 * recovery (e.g. test_unit_ready) do *not* come through here.
1339 *
1340 * When this routine returns failed, it means the error handler thread
1341 * is woken. In cases where the error code indicates an error that
1342 * doesn't require the error handler read (i.e. we don't need to
1343 * abort/reset), this function should return SUCCESS.
1344 */
1345 int scsi_decide_disposition(struct scsi_cmnd *scmd)
1346 {
1347 int rtn;
1348
1349 /*
1350 * if the device is offline, then we clearly just pass the result back
1351 * up to the top level.
1352 */
1353 if (!scsi_device_online(scmd->device)) {
1354 SCSI_LOG_ERROR_RECOVERY(5, printk("%s: device offline - report"
1355 " as SUCCESS\n",
1356 __func__));
1357 return SUCCESS;
1358 }
1359
1360 /*
1361 * first check the host byte, to see if there is anything in there
1362 * that would indicate what we need to do.
1363 */
1364 switch (host_byte(scmd->result)) {
1365 case DID_PASSTHROUGH:
1366 /*
1367 * no matter what, pass this through to the upper layer.
1368 * nuke this special code so that it looks like we are saying
1369 * did_ok.
1370 */
1371 scmd->result &= 0xff00ffff;
1372 return SUCCESS;
1373 case DID_OK:
1374 /*
1375 * looks good. drop through, and check the next byte.
1376 */
1377 break;
1378 case DID_NO_CONNECT:
1379 case DID_BAD_TARGET:
1380 case DID_ABORT:
1381 /*
1382 * note - this means that we just report the status back
1383 * to the top level driver, not that we actually think
1384 * that it indicates SUCCESS.
1385 */
1386 return SUCCESS;
1387 /*
1388 * when the low level driver returns did_soft_error,
1389 * it is responsible for keeping an internal retry counter
1390 * in order to avoid endless loops (db)
1391 *
1392 * actually this is a bug in this function here. we should
1393 * be mindful of the maximum number of retries specified
1394 * and not get stuck in a loop.
1395 */
1396 case DID_SOFT_ERROR:
1397 goto maybe_retry;
1398 case DID_IMM_RETRY:
1399 return NEEDS_RETRY;
1400
1401 case DID_REQUEUE:
1402 return ADD_TO_MLQUEUE;
1403 case DID_TRANSPORT_DISRUPTED:
1404 /*
1405 * LLD/transport was disrupted during processing of the IO.
1406 * The transport class is now blocked/blocking,
1407 * and the transport will decide what to do with the IO
1408 * based on its timers and recovery capablilities if
1409 * there are enough retries.
1410 */
1411 goto maybe_retry;
1412 case DID_TRANSPORT_FAILFAST:
1413 /*
1414 * The transport decided to failfast the IO (most likely
1415 * the fast io fail tmo fired), so send IO directly upwards.
1416 */
1417 return SUCCESS;
1418 case DID_ERROR:
1419 if (msg_byte(scmd->result) == COMMAND_COMPLETE &&
1420 status_byte(scmd->result) == RESERVATION_CONFLICT)
1421 /*
1422 * execute reservation conflict processing code
1423 * lower down
1424 */
1425 break;
1426 /* fallthrough */
1427
1428 case DID_BUS_BUSY:
1429 case DID_PARITY:
1430 goto maybe_retry;
1431 case DID_TIME_OUT:
1432 /*
1433 * when we scan the bus, we get timeout messages for
1434 * these commands if there is no device available.
1435 * other hosts report did_no_connect for the same thing.
1436 */
1437 if ((scmd->cmnd[0] == TEST_UNIT_READY ||
1438 scmd->cmnd[0] == INQUIRY)) {
1439 return SUCCESS;
1440 } else {
1441 return FAILED;
1442 }
1443 case DID_RESET:
1444 return SUCCESS;
1445 default:
1446 return FAILED;
1447 }
1448
1449 /*
1450 * next, check the message byte.
1451 */
1452 if (msg_byte(scmd->result) != COMMAND_COMPLETE)
1453 return FAILED;
1454
1455 /*
1456 * check the status byte to see if this indicates anything special.
1457 */
1458 switch (status_byte(scmd->result)) {
1459 case QUEUE_FULL:
1460 scsi_handle_queue_full(scmd->device);
1461 /*
1462 * the case of trying to send too many commands to a
1463 * tagged queueing device.
1464 */
1465 case BUSY:
1466 /*
1467 * device can't talk to us at the moment. Should only
1468 * occur (SAM-3) when the task queue is empty, so will cause
1469 * the empty queue handling to trigger a stall in the
1470 * device.
1471 */
1472 return ADD_TO_MLQUEUE;
1473 case GOOD:
1474 scsi_handle_queue_ramp_up(scmd->device);
1475 case COMMAND_TERMINATED:
1476 return SUCCESS;
1477 case TASK_ABORTED:
1478 goto maybe_retry;
1479 case CHECK_CONDITION:
1480 rtn = scsi_check_sense(scmd);
1481 if (rtn == NEEDS_RETRY)
1482 goto maybe_retry;
1483 /* if rtn == FAILED, we have no sense information;
1484 * returning FAILED will wake the error handler thread
1485 * to collect the sense and redo the decide
1486 * disposition */
1487 return rtn;
1488 case CONDITION_GOOD:
1489 case INTERMEDIATE_GOOD:
1490 case INTERMEDIATE_C_GOOD:
1491 case ACA_ACTIVE:
1492 /*
1493 * who knows? FIXME(eric)
1494 */
1495 return SUCCESS;
1496
1497 case RESERVATION_CONFLICT:
1498 sdev_printk(KERN_INFO, scmd->device,
1499 "reservation conflict\n");
1500 return SUCCESS; /* causes immediate i/o error */
1501 default:
1502 return FAILED;
1503 }
1504 return FAILED;
1505
1506 maybe_retry:
1507
1508 /* we requeue for retry because the error was retryable, and
1509 * the request was not marked fast fail. Note that above,
1510 * even if the request is marked fast fail, we still requeue
1511 * for queue congestion conditions (QUEUE_FULL or BUSY) */
1512 if ((++scmd->retries) <= scmd->allowed
1513 && !scsi_noretry_cmd(scmd)) {
1514 return NEEDS_RETRY;
1515 } else {
1516 /*
1517 * no more retries - report this one back to upper level.
1518 */
1519 return SUCCESS;
1520 }
1521 }
1522
1523 static void eh_lock_door_done(struct request *req, int uptodate)
1524 {
1525 __blk_put_request(req->q, req);
1526 }
1527
1528 /**
1529 * scsi_eh_lock_door - Prevent medium removal for the specified device
1530 * @sdev: SCSI device to prevent medium removal
1531 *
1532 * Locking:
1533 * We must be called from process context.
1534 *
1535 * Notes:
1536 * We queue up an asynchronous "ALLOW MEDIUM REMOVAL" request on the
1537 * head of the devices request queue, and continue.
1538 */
1539 static void scsi_eh_lock_door(struct scsi_device *sdev)
1540 {
1541 struct request *req;
1542
1543 /*
1544 * blk_get_request with GFP_KERNEL (__GFP_WAIT) sleeps until a
1545 * request becomes available
1546 */
1547 req = blk_get_request(sdev->request_queue, READ, GFP_KERNEL);
1548
1549 req->cmd[0] = ALLOW_MEDIUM_REMOVAL;
1550 req->cmd[1] = 0;
1551 req->cmd[2] = 0;
1552 req->cmd[3] = 0;
1553 req->cmd[4] = SCSI_REMOVAL_PREVENT;
1554 req->cmd[5] = 0;
1555
1556 req->cmd_len = COMMAND_SIZE(req->cmd[0]);
1557
1558 req->cmd_type = REQ_TYPE_BLOCK_PC;
1559 req->cmd_flags |= REQ_QUIET;
1560 req->timeout = 10 * HZ;
1561 req->retries = 5;
1562
1563 blk_execute_rq_nowait(req->q, NULL, req, 1, eh_lock_door_done);
1564 }
1565
1566 /**
1567 * scsi_restart_operations - restart io operations to the specified host.
1568 * @shost: Host we are restarting.
1569 *
1570 * Notes:
1571 * When we entered the error handler, we blocked all further i/o to
1572 * this device. we need to 'reverse' this process.
1573 */
1574 static void scsi_restart_operations(struct Scsi_Host *shost)
1575 {
1576 struct scsi_device *sdev;
1577 unsigned long flags;
1578
1579 /*
1580 * If the door was locked, we need to insert a door lock request
1581 * onto the head of the SCSI request queue for the device. There
1582 * is no point trying to lock the door of an off-line device.
1583 */
1584 shost_for_each_device(sdev, shost) {
1585 if (scsi_device_online(sdev) && sdev->locked)
1586 scsi_eh_lock_door(sdev);
1587 }
1588
1589 /*
1590 * next free up anything directly waiting upon the host. this
1591 * will be requests for character device operations, and also for
1592 * ioctls to queued block devices.
1593 */
1594 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: waking up host to restart\n",
1595 __func__));
1596
1597 spin_lock_irqsave(shost->host_lock, flags);
1598 if (scsi_host_set_state(shost, SHOST_RUNNING))
1599 if (scsi_host_set_state(shost, SHOST_CANCEL))
1600 BUG_ON(scsi_host_set_state(shost, SHOST_DEL));
1601 spin_unlock_irqrestore(shost->host_lock, flags);
1602
1603 wake_up(&shost->host_wait);
1604
1605 /*
1606 * finally we need to re-initiate requests that may be pending. we will
1607 * have had everything blocked while error handling is taking place, and
1608 * now that error recovery is done, we will need to ensure that these
1609 * requests are started.
1610 */
1611 scsi_run_host_queues(shost);
1612 }
1613
1614 /**
1615 * scsi_eh_ready_devs - check device ready state and recover if not.
1616 * @shost: host to be recovered.
1617 * @work_q: &list_head for pending commands.
1618 * @done_q: &list_head for processed commands.
1619 */
1620 void scsi_eh_ready_devs(struct Scsi_Host *shost,
1621 struct list_head *work_q,
1622 struct list_head *done_q)
1623 {
1624 if (!scsi_eh_stu(shost, work_q, done_q))
1625 if (!scsi_eh_bus_device_reset(shost, work_q, done_q))
1626 if (!scsi_eh_target_reset(shost, work_q, done_q))
1627 if (!scsi_eh_bus_reset(shost, work_q, done_q))
1628 if (!scsi_eh_host_reset(work_q, done_q))
1629 scsi_eh_offline_sdevs(work_q,
1630 done_q);
1631 }
1632 EXPORT_SYMBOL_GPL(scsi_eh_ready_devs);
1633
1634 /**
1635 * scsi_eh_flush_done_q - finish processed commands or retry them.
1636 * @done_q: list_head of processed commands.
1637 */
1638 void scsi_eh_flush_done_q(struct list_head *done_q)
1639 {
1640 struct scsi_cmnd *scmd, *next;
1641
1642 list_for_each_entry_safe(scmd, next, done_q, eh_entry) {
1643 list_del_init(&scmd->eh_entry);
1644 if (scsi_device_online(scmd->device) &&
1645 !scsi_noretry_cmd(scmd) &&
1646 (++scmd->retries <= scmd->allowed)) {
1647 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: flush"
1648 " retry cmd: %p\n",
1649 current->comm,
1650 scmd));
1651 scsi_queue_insert(scmd, SCSI_MLQUEUE_EH_RETRY);
1652 } else {
1653 /*
1654 * If just we got sense for the device (called
1655 * scsi_eh_get_sense), scmd->result is already
1656 * set, do not set DRIVER_TIMEOUT.
1657 */
1658 if (!scmd->result)
1659 scmd->result |= (DRIVER_TIMEOUT << 24);
1660 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: flush finish"
1661 " cmd: %p\n",
1662 current->comm, scmd));
1663 scsi_finish_command(scmd);
1664 }
1665 }
1666 }
1667 EXPORT_SYMBOL(scsi_eh_flush_done_q);
1668
1669 /**
1670 * scsi_unjam_host - Attempt to fix a host which has a cmd that failed.
1671 * @shost: Host to unjam.
1672 *
1673 * Notes:
1674 * When we come in here, we *know* that all commands on the bus have
1675 * either completed, failed or timed out. we also know that no further
1676 * commands are being sent to the host, so things are relatively quiet
1677 * and we have freedom to fiddle with things as we wish.
1678 *
1679 * This is only the *default* implementation. it is possible for
1680 * individual drivers to supply their own version of this function, and
1681 * if the maintainer wishes to do this, it is strongly suggested that
1682 * this function be taken as a template and modified. this function
1683 * was designed to correctly handle problems for about 95% of the
1684 * different cases out there, and it should always provide at least a
1685 * reasonable amount of error recovery.
1686 *
1687 * Any command marked 'failed' or 'timeout' must eventually have
1688 * scsi_finish_cmd() called for it. we do all of the retry stuff
1689 * here, so when we restart the host after we return it should have an
1690 * empty queue.
1691 */
1692 static void scsi_unjam_host(struct Scsi_Host *shost)
1693 {
1694 unsigned long flags;
1695 LIST_HEAD(eh_work_q);
1696 LIST_HEAD(eh_done_q);
1697
1698 spin_lock_irqsave(shost->host_lock, flags);
1699 list_splice_init(&shost->eh_cmd_q, &eh_work_q);
1700 spin_unlock_irqrestore(shost->host_lock, flags);
1701
1702 SCSI_LOG_ERROR_RECOVERY(1, scsi_eh_prt_fail_stats(shost, &eh_work_q));
1703
1704 if (!scsi_eh_get_sense(&eh_work_q, &eh_done_q))
1705 if (!scsi_eh_abort_cmds(&eh_work_q, &eh_done_q))
1706 scsi_eh_ready_devs(shost, &eh_work_q, &eh_done_q);
1707
1708 scsi_eh_flush_done_q(&eh_done_q);
1709 }
1710
1711 /**
1712 * scsi_error_handler - SCSI error handler thread
1713 * @data: Host for which we are running.
1714 *
1715 * Notes:
1716 * This is the main error handling loop. This is run as a kernel thread
1717 * for every SCSI host and handles all error handling activity.
1718 */
1719 int scsi_error_handler(void *data)
1720 {
1721 struct Scsi_Host *shost = data;
1722
1723 /*
1724 * We use TASK_INTERRUPTIBLE so that the thread is not
1725 * counted against the load average as a running process.
1726 * We never actually get interrupted because kthread_run
1727 * disables signal delivery for the created thread.
1728 */
1729 set_current_state(TASK_INTERRUPTIBLE);
1730 while (!kthread_should_stop()) {
1731 if ((shost->host_failed == 0 && shost->host_eh_scheduled == 0) ||
1732 shost->host_failed != shost->host_busy) {
1733 SCSI_LOG_ERROR_RECOVERY(1,
1734 printk("Error handler scsi_eh_%d sleeping\n",
1735 shost->host_no));
1736 schedule();
1737 set_current_state(TASK_INTERRUPTIBLE);
1738 continue;
1739 }
1740
1741 __set_current_state(TASK_RUNNING);
1742 SCSI_LOG_ERROR_RECOVERY(1,
1743 printk("Error handler scsi_eh_%d waking up\n",
1744 shost->host_no));
1745
1746 /*
1747 * We have a host that is failing for some reason. Figure out
1748 * what we need to do to get it up and online again (if we can).
1749 * If we fail, we end up taking the thing offline.
1750 */
1751 if (scsi_autopm_get_host(shost) != 0) {
1752 SCSI_LOG_ERROR_RECOVERY(1,
1753 printk(KERN_ERR "Error handler scsi_eh_%d "
1754 "unable to autoresume\n",
1755 shost->host_no));
1756 continue;
1757 }
1758
1759 if (shost->transportt->eh_strategy_handler)
1760 shost->transportt->eh_strategy_handler(shost);
1761 else
1762 scsi_unjam_host(shost);
1763
1764 /*
1765 * Note - if the above fails completely, the action is to take
1766 * individual devices offline and flush the queue of any
1767 * outstanding requests that may have been pending. When we
1768 * restart, we restart any I/O to any other devices on the bus
1769 * which are still online.
1770 */
1771 scsi_restart_operations(shost);
1772 scsi_autopm_put_host(shost);
1773 set_current_state(TASK_INTERRUPTIBLE);
1774 }
1775 __set_current_state(TASK_RUNNING);
1776
1777 SCSI_LOG_ERROR_RECOVERY(1,
1778 printk("Error handler scsi_eh_%d exiting\n", shost->host_no));
1779 shost->ehandler = NULL;
1780 return 0;
1781 }
1782
1783 /*
1784 * Function: scsi_report_bus_reset()
1785 *
1786 * Purpose: Utility function used by low-level drivers to report that
1787 * they have observed a bus reset on the bus being handled.
1788 *
1789 * Arguments: shost - Host in question
1790 * channel - channel on which reset was observed.
1791 *
1792 * Returns: Nothing
1793 *
1794 * Lock status: Host lock must be held.
1795 *
1796 * Notes: This only needs to be called if the reset is one which
1797 * originates from an unknown location. Resets originated
1798 * by the mid-level itself don't need to call this, but there
1799 * should be no harm.
1800 *
1801 * The main purpose of this is to make sure that a CHECK_CONDITION
1802 * is properly treated.
1803 */
1804 void scsi_report_bus_reset(struct Scsi_Host *shost, int channel)
1805 {
1806 struct scsi_device *sdev;
1807
1808 __shost_for_each_device(sdev, shost) {
1809 if (channel == sdev_channel(sdev))
1810 __scsi_report_device_reset(sdev, NULL);
1811 }
1812 }
1813 EXPORT_SYMBOL(scsi_report_bus_reset);
1814
1815 /*
1816 * Function: scsi_report_device_reset()
1817 *
1818 * Purpose: Utility function used by low-level drivers to report that
1819 * they have observed a device reset on the device being handled.
1820 *
1821 * Arguments: shost - Host in question
1822 * channel - channel on which reset was observed
1823 * target - target on which reset was observed
1824 *
1825 * Returns: Nothing
1826 *
1827 * Lock status: Host lock must be held
1828 *
1829 * Notes: This only needs to be called if the reset is one which
1830 * originates from an unknown location. Resets originated
1831 * by the mid-level itself don't need to call this, but there
1832 * should be no harm.
1833 *
1834 * The main purpose of this is to make sure that a CHECK_CONDITION
1835 * is properly treated.
1836 */
1837 void scsi_report_device_reset(struct Scsi_Host *shost, int channel, int target)
1838 {
1839 struct scsi_device *sdev;
1840
1841 __shost_for_each_device(sdev, shost) {
1842 if (channel == sdev_channel(sdev) &&
1843 target == sdev_id(sdev))
1844 __scsi_report_device_reset(sdev, NULL);
1845 }
1846 }
1847 EXPORT_SYMBOL(scsi_report_device_reset);
1848
1849 static void
1850 scsi_reset_provider_done_command(struct scsi_cmnd *scmd)
1851 {
1852 }
1853
1854 /*
1855 * Function: scsi_reset_provider
1856 *
1857 * Purpose: Send requested reset to a bus or device at any phase.
1858 *
1859 * Arguments: device - device to send reset to
1860 * flag - reset type (see scsi.h)
1861 *
1862 * Returns: SUCCESS/FAILURE.
1863 *
1864 * Notes: This is used by the SCSI Generic driver to provide
1865 * Bus/Device reset capability.
1866 */
1867 int
1868 scsi_reset_provider(struct scsi_device *dev, int flag)
1869 {
1870 struct scsi_cmnd *scmd;
1871 struct Scsi_Host *shost = dev->host;
1872 struct request req;
1873 unsigned long flags;
1874 int rtn;
1875
1876 if (scsi_autopm_get_host(shost) < 0)
1877 return FAILED;
1878
1879 scmd = scsi_get_command(dev, GFP_KERNEL);
1880 blk_rq_init(NULL, &req);
1881 scmd->request = &req;
1882
1883 scmd->cmnd = req.cmd;
1884
1885 scmd->scsi_done = scsi_reset_provider_done_command;
1886 memset(&scmd->sdb, 0, sizeof(scmd->sdb));
1887
1888 scmd->cmd_len = 0;
1889
1890 scmd->sc_data_direction = DMA_BIDIRECTIONAL;
1891
1892 spin_lock_irqsave(shost->host_lock, flags);
1893 shost->tmf_in_progress = 1;
1894 spin_unlock_irqrestore(shost->host_lock, flags);
1895
1896 switch (flag) {
1897 case SCSI_TRY_RESET_DEVICE:
1898 rtn = scsi_try_bus_device_reset(scmd);
1899 if (rtn == SUCCESS)
1900 break;
1901 /* FALLTHROUGH */
1902 case SCSI_TRY_RESET_TARGET:
1903 rtn = scsi_try_target_reset(scmd);
1904 if (rtn == SUCCESS)
1905 break;
1906 /* FALLTHROUGH */
1907 case SCSI_TRY_RESET_BUS:
1908 rtn = scsi_try_bus_reset(scmd);
1909 if (rtn == SUCCESS)
1910 break;
1911 /* FALLTHROUGH */
1912 case SCSI_TRY_RESET_HOST:
1913 rtn = scsi_try_host_reset(scmd);
1914 break;
1915 default:
1916 rtn = FAILED;
1917 }
1918
1919 spin_lock_irqsave(shost->host_lock, flags);
1920 shost->tmf_in_progress = 0;
1921 spin_unlock_irqrestore(shost->host_lock, flags);
1922
1923 /*
1924 * be sure to wake up anyone who was sleeping or had their queue
1925 * suspended while we performed the TMF.
1926 */
1927 SCSI_LOG_ERROR_RECOVERY(3,
1928 printk("%s: waking up host to restart after TMF\n",
1929 __func__));
1930
1931 wake_up(&shost->host_wait);
1932
1933 scsi_run_host_queues(shost);
1934
1935 scsi_next_command(scmd);
1936 scsi_autopm_put_host(shost);
1937 return rtn;
1938 }
1939 EXPORT_SYMBOL(scsi_reset_provider);
1940
1941 /**
1942 * scsi_normalize_sense - normalize main elements from either fixed or
1943 * descriptor sense data format into a common format.
1944 *
1945 * @sense_buffer: byte array containing sense data returned by device
1946 * @sb_len: number of valid bytes in sense_buffer
1947 * @sshdr: pointer to instance of structure that common
1948 * elements are written to.
1949 *
1950 * Notes:
1951 * The "main elements" from sense data are: response_code, sense_key,
1952 * asc, ascq and additional_length (only for descriptor format).
1953 *
1954 * Typically this function can be called after a device has
1955 * responded to a SCSI command with the CHECK_CONDITION status.
1956 *
1957 * Return value:
1958 * 1 if valid sense data information found, else 0;
1959 */
1960 int scsi_normalize_sense(const u8 *sense_buffer, int sb_len,
1961 struct scsi_sense_hdr *sshdr)
1962 {
1963 if (!sense_buffer || !sb_len)
1964 return 0;
1965
1966 memset(sshdr, 0, sizeof(struct scsi_sense_hdr));
1967
1968 sshdr->response_code = (sense_buffer[0] & 0x7f);
1969
1970 if (!scsi_sense_valid(sshdr))
1971 return 0;
1972
1973 if (sshdr->response_code >= 0x72) {
1974 /*
1975 * descriptor format
1976 */
1977 if (sb_len > 1)
1978 sshdr->sense_key = (sense_buffer[1] & 0xf);
1979 if (sb_len > 2)
1980 sshdr->asc = sense_buffer[2];
1981 if (sb_len > 3)
1982 sshdr->ascq = sense_buffer[3];
1983 if (sb_len > 7)
1984 sshdr->additional_length = sense_buffer[7];
1985 } else {
1986 /*
1987 * fixed format
1988 */
1989 if (sb_len > 2)
1990 sshdr->sense_key = (sense_buffer[2] & 0xf);
1991 if (sb_len > 7) {
1992 sb_len = (sb_len < (sense_buffer[7] + 8)) ?
1993 sb_len : (sense_buffer[7] + 8);
1994 if (sb_len > 12)
1995 sshdr->asc = sense_buffer[12];
1996 if (sb_len > 13)
1997 sshdr->ascq = sense_buffer[13];
1998 }
1999 }
2000
2001 return 1;
2002 }
2003 EXPORT_SYMBOL(scsi_normalize_sense);
2004
2005 int scsi_command_normalize_sense(struct scsi_cmnd *cmd,
2006 struct scsi_sense_hdr *sshdr)
2007 {
2008 return scsi_normalize_sense(cmd->sense_buffer,
2009 SCSI_SENSE_BUFFERSIZE, sshdr);
2010 }
2011 EXPORT_SYMBOL(scsi_command_normalize_sense);
2012
2013 /**
2014 * scsi_sense_desc_find - search for a given descriptor type in descriptor sense data format.
2015 * @sense_buffer: byte array of descriptor format sense data
2016 * @sb_len: number of valid bytes in sense_buffer
2017 * @desc_type: value of descriptor type to find
2018 * (e.g. 0 -> information)
2019 *
2020 * Notes:
2021 * only valid when sense data is in descriptor format
2022 *
2023 * Return value:
2024 * pointer to start of (first) descriptor if found else NULL
2025 */
2026 const u8 * scsi_sense_desc_find(const u8 * sense_buffer, int sb_len,
2027 int desc_type)
2028 {
2029 int add_sen_len, add_len, desc_len, k;
2030 const u8 * descp;
2031
2032 if ((sb_len < 8) || (0 == (add_sen_len = sense_buffer[7])))
2033 return NULL;
2034 if ((sense_buffer[0] < 0x72) || (sense_buffer[0] > 0x73))
2035 return NULL;
2036 add_sen_len = (add_sen_len < (sb_len - 8)) ?
2037 add_sen_len : (sb_len - 8);
2038 descp = &sense_buffer[8];
2039 for (desc_len = 0, k = 0; k < add_sen_len; k += desc_len) {
2040 descp += desc_len;
2041 add_len = (k < (add_sen_len - 1)) ? descp[1]: -1;
2042 desc_len = add_len + 2;
2043 if (descp[0] == desc_type)
2044 return descp;
2045 if (add_len < 0) // short descriptor ??
2046 break;
2047 }
2048 return NULL;
2049 }
2050 EXPORT_SYMBOL(scsi_sense_desc_find);
2051
2052 /**
2053 * scsi_get_sense_info_fld - get information field from sense data (either fixed or descriptor format)
2054 * @sense_buffer: byte array of sense data
2055 * @sb_len: number of valid bytes in sense_buffer
2056 * @info_out: pointer to 64 integer where 8 or 4 byte information
2057 * field will be placed if found.
2058 *
2059 * Return value:
2060 * 1 if information field found, 0 if not found.
2061 */
2062 int scsi_get_sense_info_fld(const u8 * sense_buffer, int sb_len,
2063 u64 * info_out)
2064 {
2065 int j;
2066 const u8 * ucp;
2067 u64 ull;
2068
2069 if (sb_len < 7)
2070 return 0;
2071 switch (sense_buffer[0] & 0x7f) {
2072 case 0x70:
2073 case 0x71:
2074 if (sense_buffer[0] & 0x80) {
2075 *info_out = (sense_buffer[3] << 24) +
2076 (sense_buffer[4] << 16) +
2077 (sense_buffer[5] << 8) + sense_buffer[6];
2078 return 1;
2079 } else
2080 return 0;
2081 case 0x72:
2082 case 0x73:
2083 ucp = scsi_sense_desc_find(sense_buffer, sb_len,
2084 0 /* info desc */);
2085 if (ucp && (0xa == ucp[1])) {
2086 ull = 0;
2087 for (j = 0; j < 8; ++j) {
2088 if (j > 0)
2089 ull <<= 8;
2090 ull |= ucp[4 + j];
2091 }
2092 *info_out = ull;
2093 return 1;
2094 } else
2095 return 0;
2096 default:
2097 return 0;
2098 }
2099 }
2100 EXPORT_SYMBOL(scsi_get_sense_info_fld);
2101
2102 /**
2103 * scsi_build_sense_buffer - build sense data in a buffer
2104 * @desc: Sense format (non zero == descriptor format,
2105 * 0 == fixed format)
2106 * @buf: Where to build sense data
2107 * @key: Sense key
2108 * @asc: Additional sense code
2109 * @ascq: Additional sense code qualifier
2110 *
2111 **/
2112 void scsi_build_sense_buffer(int desc, u8 *buf, u8 key, u8 asc, u8 ascq)
2113 {
2114 if (desc) {
2115 buf[0] = 0x72; /* descriptor, current */
2116 buf[1] = key;
2117 buf[2] = asc;
2118 buf[3] = ascq;
2119 buf[7] = 0;
2120 } else {
2121 buf[0] = 0x70; /* fixed, current */
2122 buf[2] = key;
2123 buf[7] = 0xa;
2124 buf[12] = asc;
2125 buf[13] = ascq;
2126 }
2127 }
2128 EXPORT_SYMBOL(scsi_build_sense_buffer);
This page took 0.072714 seconds and 6 git commands to generate.