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