Automatic merge of ../scsi-misc-2.6-old/
[linux-2.6] / 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/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 */
49 void 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  **/
66 int 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;
82         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  **/
101 void 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 }
123 EXPORT_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  **/
136 int 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 }
151 EXPORT_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  **/
163 void 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  **/
201 int 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 }
214 EXPORT_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  **/
222 static 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  **/
274 static 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  **/
372 static 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  **/
431 static 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
437         up(scmd->device->host->eh_action);
438 }
439
440 /**
441  * scsi_eh_done - Completion function for error handling.
442  * @scmd:       Cmd that is done.
443  **/
444 static 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
459                 up(scmd->device->host->eh_action);
460         }
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  **/
475 static int scsi_send_eh_cmnd(struct scsi_cmnd *scmd, int timeout)
476 {
477         struct scsi_device *sdev = scmd->device;
478         struct Scsi_Host *shost = sdev->host;
479         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
489         if (sdev->scsi_level <= SCSI_2)
490                 scmd->cmnd[1] = (scmd->cmnd[1] & 0x1f) |
491                         (sdev->lun << 5 & 0xe0);
492
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          */
498         shost->eh_action = &sem;
499         scmd->request->rq_status = RQ_SCSI_BUSY;
500
501         spin_lock_irqsave(shost->host_lock, flags);
502         scsi_log_send(scmd);
503         shost->hostt->queuecommand(scmd, scsi_eh_done);
504         spin_unlock_irqrestore(shost->host_lock, flags);
505
506         down(&sem);
507         scsi_log_completion(scmd, SUCCESS);
508
509         shost->eh_action = NULL;
510
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                  */
529                 spin_lock_irqsave(shost->host_lock, flags);
530                 if (shost->hostt->eh_abort_handler)
531                         shost->hostt->eh_abort_handler(scmd);
532                 spin_unlock_irqrestore(shost->host_lock, flags);
533                         
534                 scmd->request->rq_status = RQ_SCSI_DONE;
535                 scmd->owner = SCSI_OWNER_ERROR_HANDLER;
536                         
537                 rtn = FAILED;
538         }
539
540         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: scmd: %p, rtn:%x\n",
541                                           __FUNCTION__, scmd, rtn));
542
543         /*
544          * now examine the actual status codes to see whether the command
545          * actually did complete normally.
546          */
547         if (rtn == SUCCESS) {
548                 rtn = scsi_eh_completed_normally(scmd);
549                 SCSI_LOG_ERROR_RECOVERY(3,
550                         printk("%s: scsi_eh_completed_normally %x\n",
551                                __FUNCTION__, rtn));
552                 switch (rtn) {
553                 case SUCCESS:
554                 case NEEDS_RETRY:
555                 case FAILED:
556                         break;
557                 default:
558                         rtn = FAILED;
559                         break;
560                 }
561         }
562
563         return rtn;
564 }
565
566 /**
567  * scsi_request_sense - Request sense data from a particular target.
568  * @scmd:       SCSI cmd for request sense.
569  *
570  * Notes:
571  *    Some hosts automatically obtain this information, others require
572  *    that we obtain it on our own. This function will *not* return until
573  *    the command either times out, or it completes.
574  **/
575 static int scsi_request_sense(struct scsi_cmnd *scmd)
576 {
577         static unsigned char generic_sense[6] =
578         {REQUEST_SENSE, 0, 0, 0, 252, 0};
579         unsigned char *scsi_result;
580         int saved_result;
581         int rtn;
582
583         memcpy(scmd->cmnd, generic_sense, sizeof(generic_sense));
584
585         scsi_result = kmalloc(252, GFP_ATOMIC | ((scmd->device->host->hostt->unchecked_isa_dma) ? __GFP_DMA : 0));
586
587
588         if (unlikely(!scsi_result)) {
589                 printk(KERN_ERR "%s: cannot allocate scsi_result.\n",
590                        __FUNCTION__);
591                 return FAILED;
592         }
593
594         /*
595          * zero the sense buffer.  some host adapters automatically always
596          * request sense, so it is not a good idea that
597          * scmd->request_buffer and scmd->sense_buffer point to the same
598          * address (db).  0 is not a valid sense code. 
599          */
600         memset(scmd->sense_buffer, 0, sizeof(scmd->sense_buffer));
601         memset(scsi_result, 0, 252);
602
603         saved_result = scmd->result;
604         scmd->request_buffer = scsi_result;
605         scmd->request_bufflen = 252;
606         scmd->use_sg = 0;
607         scmd->cmd_len = COMMAND_SIZE(scmd->cmnd[0]);
608         scmd->sc_data_direction = DMA_FROM_DEVICE;
609         scmd->underflow = 0;
610
611         rtn = scsi_send_eh_cmnd(scmd, SENSE_TIMEOUT);
612
613         /* last chance to have valid sense data */
614         if(!SCSI_SENSE_VALID(scmd)) {
615                 memcpy(scmd->sense_buffer, scmd->request_buffer,
616                        sizeof(scmd->sense_buffer));
617         }
618
619         kfree(scsi_result);
620
621         /*
622          * when we eventually call scsi_finish, we really wish to complete
623          * the original request, so let's restore the original data. (db)
624          */
625         scsi_setup_cmd_retry(scmd);
626         scmd->result = saved_result;
627         return rtn;
628 }
629
630 /**
631  * scsi_eh_finish_cmd - Handle a cmd that eh is finished with.
632  * @scmd:       Original SCSI cmd that eh has finished.
633  * @done_q:     Queue for processed commands.
634  *
635  * Notes:
636  *    We don't want to use the normal command completion while we are are
637  *    still handling errors - it may cause other commands to be queued,
638  *    and that would disturb what we are doing.  thus we really want to
639  *    keep a list of pending commands for final completion, and once we
640  *    are ready to leave error handling we handle completion for real.
641  **/
642 static void scsi_eh_finish_cmd(struct scsi_cmnd *scmd,
643                                struct list_head *done_q)
644 {
645         scmd->device->host->host_failed--;
646         scmd->state = SCSI_STATE_BHQUEUE;
647
648         scsi_eh_eflags_clr_all(scmd);
649
650         /*
651          * set this back so that the upper level can correctly free up
652          * things.
653          */
654         scsi_setup_cmd_retry(scmd);
655         list_move_tail(&scmd->eh_entry, done_q);
656 }
657
658 /**
659  * scsi_eh_get_sense - Get device sense data.
660  * @work_q:     Queue of commands to process.
661  * @done_q:     Queue of proccessed commands..
662  *
663  * Description:
664  *    See if we need to request sense information.  if so, then get it
665  *    now, so we have a better idea of what to do.  
666  *
667  * Notes:
668  *    This has the unfortunate side effect that if a shost adapter does
669  *    not automatically request sense information, that we end up shutting
670  *    it down before we request it.
671  *
672  *    All drivers should request sense information internally these days,
673  *    so for now all I have to say is tough noogies if you end up in here.
674  *
675  *    XXX: Long term this code should go away, but that needs an audit of
676  *         all LLDDs first.
677  **/
678 static int scsi_eh_get_sense(struct list_head *work_q,
679                              struct list_head *done_q)
680 {
681         struct list_head *lh, *lh_sf;
682         struct scsi_cmnd *scmd;
683         int rtn;
684
685         list_for_each_safe(lh, lh_sf, work_q) {
686                 scmd = list_entry(lh, struct scsi_cmnd, eh_entry);
687                 if (scsi_eh_eflags_chk(scmd, SCSI_EH_CANCEL_CMD) ||
688                     SCSI_SENSE_VALID(scmd))
689                         continue;
690
691                 SCSI_LOG_ERROR_RECOVERY(2, printk("%s: requesting sense"
692                                                   " for id: %d\n",
693                                                   current->comm,
694                                                   scmd->device->id));
695                 rtn = scsi_request_sense(scmd);
696                 if (rtn != SUCCESS)
697                         continue;
698
699                 SCSI_LOG_ERROR_RECOVERY(3, printk("sense requested for %p"
700                                                   " result %x\n", scmd,
701                                                   scmd->result));
702                 SCSI_LOG_ERROR_RECOVERY(3, scsi_print_sense("bh", scmd));
703
704                 rtn = scsi_decide_disposition(scmd);
705
706                 /*
707                  * if the result was normal, then just pass it along to the
708                  * upper level.
709                  */
710                 if (rtn == SUCCESS)
711                         /* we don't want this command reissued, just
712                          * finished with the sense data, so set
713                          * retries to the max allowed to ensure it
714                          * won't get reissued */
715                         scmd->retries = scmd->allowed;
716                 else if (rtn != NEEDS_RETRY)
717                         continue;
718
719                 scsi_eh_finish_cmd(scmd, done_q);
720         }
721
722         return list_empty(work_q);
723 }
724
725 /**
726  * scsi_try_to_abort_cmd - Ask host to abort a running command.
727  * @scmd:       SCSI cmd to abort from Lower Level.
728  *
729  * Notes:
730  *    This function will not return until the user's completion function
731  *    has been called.  there is no timeout on this operation.  if the
732  *    author of the low-level driver wishes this operation to be timed,
733  *    they can provide this facility themselves.  helper functions in
734  *    scsi_error.c can be supplied to make this easier to do.
735  **/
736 static int scsi_try_to_abort_cmd(struct scsi_cmnd *scmd)
737 {
738         unsigned long flags;
739         int rtn = FAILED;
740
741         if (!scmd->device->host->hostt->eh_abort_handler)
742                 return rtn;
743
744         /*
745          * scsi_done was called just after the command timed out and before
746          * we had a chance to process it. (db)
747          */
748         if (scmd->serial_number == 0)
749                 return SUCCESS;
750
751         scmd->owner = SCSI_OWNER_LOWLEVEL;
752
753         spin_lock_irqsave(scmd->device->host->host_lock, flags);
754         rtn = scmd->device->host->hostt->eh_abort_handler(scmd);
755         spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
756
757         return rtn;
758 }
759
760 /**
761  * scsi_eh_tur - Send TUR to device.
762  * @scmd:       Scsi cmd to send TUR
763  *
764  * Return value:
765  *    0 - Device is ready. 1 - Device NOT ready.
766  **/
767 static int scsi_eh_tur(struct scsi_cmnd *scmd)
768 {
769         static unsigned char tur_command[6] = {TEST_UNIT_READY, 0, 0, 0, 0, 0};
770         int retry_cnt = 1, rtn;
771         int saved_result;
772
773 retry_tur:
774         memcpy(scmd->cmnd, tur_command, sizeof(tur_command));
775
776         /*
777          * zero the sense buffer.  the scsi spec mandates that any
778          * untransferred sense data should be interpreted as being zero.
779          */
780         memset(scmd->sense_buffer, 0, sizeof(scmd->sense_buffer));
781
782         saved_result = scmd->result;
783         scmd->request_buffer = NULL;
784         scmd->request_bufflen = 0;
785         scmd->use_sg = 0;
786         scmd->cmd_len = COMMAND_SIZE(scmd->cmnd[0]);
787         scmd->underflow = 0;
788         scmd->sc_data_direction = DMA_NONE;
789
790         rtn = scsi_send_eh_cmnd(scmd, SENSE_TIMEOUT);
791
792         /*
793          * when we eventually call scsi_finish, we really wish to complete
794          * the original request, so let's restore the original data. (db)
795          */
796         scsi_setup_cmd_retry(scmd);
797         scmd->result = saved_result;
798
799         /*
800          * hey, we are done.  let's look to see what happened.
801          */
802         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: scmd %p rtn %x\n",
803                 __FUNCTION__, scmd, rtn));
804         if (rtn == SUCCESS)
805                 return 0;
806         else if (rtn == NEEDS_RETRY)
807                 if (retry_cnt--)
808                         goto retry_tur;
809         return 1;
810 }
811
812 /**
813  * scsi_eh_abort_cmds - abort canceled commands.
814  * @shost:      scsi host being recovered.
815  * @eh_done_q:  list_head for processed commands.
816  *
817  * Decription:
818  *    Try and see whether or not it makes sense to try and abort the
819  *    running command.  this only works out to be the case if we have one
820  *    command that has timed out.  if the command simply failed, it makes
821  *    no sense to try and abort the command, since as far as the shost
822  *    adapter is concerned, it isn't running.
823  **/
824 static int scsi_eh_abort_cmds(struct list_head *work_q,
825                               struct list_head *done_q)
826 {
827         struct list_head *lh, *lh_sf;
828         struct scsi_cmnd *scmd;
829         int rtn;
830
831         list_for_each_safe(lh, lh_sf, work_q) {
832                 scmd = list_entry(lh, struct scsi_cmnd, eh_entry);
833                 if (!scsi_eh_eflags_chk(scmd, SCSI_EH_CANCEL_CMD))
834                         continue;
835                 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: aborting cmd:"
836                                                   "0x%p\n", current->comm,
837                                                   scmd));
838                 rtn = scsi_try_to_abort_cmd(scmd);
839                 if (rtn == SUCCESS) {
840                         scsi_eh_eflags_clr(scmd,  SCSI_EH_CANCEL_CMD);
841                         if (!scsi_device_online(scmd->device) ||
842                             !scsi_eh_tur(scmd)) {
843                                 scsi_eh_finish_cmd(scmd, done_q);
844                         }
845                                 
846                 } else
847                         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: aborting"
848                                                           " cmd failed:"
849                                                           "0x%p\n",
850                                                           current->comm,
851                                                           scmd));
852         }
853
854         return list_empty(work_q);
855 }
856
857 /**
858  * scsi_try_bus_device_reset - Ask host to perform a BDR on a dev
859  * @scmd:       SCSI cmd used to send BDR       
860  *
861  * Notes:
862  *    There is no timeout for this operation.  if this operation is
863  *    unreliable for a given host, then the host itself needs to put a
864  *    timer on it, and set the host back to a consistent state prior to
865  *    returning.
866  **/
867 static int scsi_try_bus_device_reset(struct scsi_cmnd *scmd)
868 {
869         unsigned long flags;
870         int rtn = FAILED;
871
872         if (!scmd->device->host->hostt->eh_device_reset_handler)
873                 return rtn;
874
875         scmd->owner = SCSI_OWNER_LOWLEVEL;
876
877         spin_lock_irqsave(scmd->device->host->host_lock, flags);
878         rtn = scmd->device->host->hostt->eh_device_reset_handler(scmd);
879         spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
880
881         if (rtn == SUCCESS) {
882                 scmd->device->was_reset = 1;
883                 scmd->device->expecting_cc_ua = 1;
884         }
885
886         return rtn;
887 }
888
889 /**
890  * scsi_eh_try_stu - Send START_UNIT to device.
891  * @scmd:       Scsi cmd to send START_UNIT
892  *
893  * Return value:
894  *    0 - Device is ready. 1 - Device NOT ready.
895  **/
896 static int scsi_eh_try_stu(struct scsi_cmnd *scmd)
897 {
898         static unsigned char stu_command[6] = {START_STOP, 0, 0, 0, 1, 0};
899         int rtn;
900         int saved_result;
901
902         if (!scmd->device->allow_restart)
903                 return 1;
904
905         memcpy(scmd->cmnd, stu_command, sizeof(stu_command));
906
907         /*
908          * zero the sense buffer.  the scsi spec mandates that any
909          * untransferred sense data should be interpreted as being zero.
910          */
911         memset(scmd->sense_buffer, 0, sizeof(scmd->sense_buffer));
912
913         saved_result = scmd->result;
914         scmd->request_buffer = NULL;
915         scmd->request_bufflen = 0;
916         scmd->use_sg = 0;
917         scmd->cmd_len = COMMAND_SIZE(scmd->cmnd[0]);
918         scmd->underflow = 0;
919         scmd->sc_data_direction = DMA_NONE;
920
921         rtn = scsi_send_eh_cmnd(scmd, START_UNIT_TIMEOUT);
922
923         /*
924          * when we eventually call scsi_finish, we really wish to complete
925          * the original request, so let's restore the original data. (db)
926          */
927         scsi_setup_cmd_retry(scmd);
928         scmd->result = saved_result;
929
930         /*
931          * hey, we are done.  let's look to see what happened.
932          */
933         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: scmd %p rtn %x\n",
934                 __FUNCTION__, scmd, rtn));
935         if (rtn == SUCCESS)
936                 return 0;
937         return 1;
938 }
939
940  /**
941  * scsi_eh_stu - send START_UNIT if needed
942  * @shost:      scsi host being recovered.
943  * @eh_done_q:  list_head for processed commands.
944  *
945  * Notes:
946  *    If commands are failing due to not ready, initializing command required,
947  *      try revalidating the device, which will end up sending a start unit. 
948  **/
949 static int scsi_eh_stu(struct Scsi_Host *shost,
950                               struct list_head *work_q,
951                               struct list_head *done_q)
952 {
953         struct list_head *lh, *lh_sf;
954         struct scsi_cmnd *scmd, *stu_scmd;
955         struct scsi_device *sdev;
956
957         shost_for_each_device(sdev, shost) {
958                 stu_scmd = NULL;
959                 list_for_each_entry(scmd, work_q, eh_entry)
960                         if (scmd->device == sdev && SCSI_SENSE_VALID(scmd) &&
961                             scsi_check_sense(scmd) == FAILED ) {
962                                 stu_scmd = scmd;
963                                 break;
964                         }
965
966                 if (!stu_scmd)
967                         continue;
968
969                 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending START_UNIT to sdev:"
970                                                   " 0x%p\n", current->comm, sdev));
971
972                 if (!scsi_eh_try_stu(stu_scmd)) {
973                         if (!scsi_device_online(sdev) ||
974                             !scsi_eh_tur(stu_scmd)) {
975                                 list_for_each_safe(lh, lh_sf, work_q) {
976                                         scmd = list_entry(lh, struct scsi_cmnd, eh_entry);
977                                         if (scmd->device == sdev)
978                                                 scsi_eh_finish_cmd(scmd, done_q);
979                                 }
980                         }
981                 } else {
982                         SCSI_LOG_ERROR_RECOVERY(3,
983                                                 printk("%s: START_UNIT failed to sdev:"
984                                                        " 0x%p\n", current->comm, sdev));
985                 }
986         }
987
988         return list_empty(work_q);
989 }
990
991
992 /**
993  * scsi_eh_bus_device_reset - send bdr if needed
994  * @shost:      scsi host being recovered.
995  * @eh_done_q:  list_head for processed commands.
996  *
997  * Notes:
998  *    Try a bus device reset.  still, look to see whether we have multiple
999  *    devices that are jammed or not - if we have multiple devices, it
1000  *    makes no sense to try bus_device_reset - we really would need to try
1001  *    a bus_reset instead. 
1002  **/
1003 static int scsi_eh_bus_device_reset(struct Scsi_Host *shost,
1004                                     struct list_head *work_q,
1005                                     struct list_head *done_q)
1006 {
1007         struct list_head *lh, *lh_sf;
1008         struct scsi_cmnd *scmd, *bdr_scmd;
1009         struct scsi_device *sdev;
1010         int rtn;
1011
1012         shost_for_each_device(sdev, shost) {
1013                 bdr_scmd = NULL;
1014                 list_for_each_entry(scmd, work_q, eh_entry)
1015                         if (scmd->device == sdev) {
1016                                 bdr_scmd = scmd;
1017                                 break;
1018                         }
1019
1020                 if (!bdr_scmd)
1021                         continue;
1022
1023                 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending BDR sdev:"
1024                                                   " 0x%p\n", current->comm,
1025                                                   sdev));
1026                 rtn = scsi_try_bus_device_reset(bdr_scmd);
1027                 if (rtn == SUCCESS) {
1028                         if (!scsi_device_online(sdev) ||
1029                             !scsi_eh_tur(bdr_scmd)) {
1030                                 list_for_each_safe(lh, lh_sf,
1031                                                    work_q) {
1032                                         scmd = list_entry(lh, struct
1033                                                           scsi_cmnd,
1034                                                           eh_entry);
1035                                         if (scmd->device == sdev)
1036                                                 scsi_eh_finish_cmd(scmd,
1037                                                                    done_q);
1038                                 }
1039                         }
1040                 } else {
1041                         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: BDR"
1042                                                           " failed sdev:"
1043                                                           "0x%p\n",
1044                                                           current->comm,
1045                                                            sdev));
1046                 }
1047         }
1048
1049         return list_empty(work_q);
1050 }
1051
1052 /**
1053  * scsi_try_bus_reset - ask host to perform a bus reset
1054  * @scmd:       SCSI cmd to send bus reset.
1055  **/
1056 static int scsi_try_bus_reset(struct scsi_cmnd *scmd)
1057 {
1058         unsigned long flags;
1059         int rtn;
1060
1061         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Snd Bus RST\n",
1062                                           __FUNCTION__));
1063         scmd->owner = SCSI_OWNER_LOWLEVEL;
1064
1065         if (!scmd->device->host->hostt->eh_bus_reset_handler)
1066                 return FAILED;
1067
1068         spin_lock_irqsave(scmd->device->host->host_lock, flags);
1069         rtn = scmd->device->host->hostt->eh_bus_reset_handler(scmd);
1070         spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
1071
1072         if (rtn == SUCCESS) {
1073                 if (!scmd->device->host->hostt->skip_settle_delay)
1074                         ssleep(BUS_RESET_SETTLE_TIME);
1075                 spin_lock_irqsave(scmd->device->host->host_lock, flags);
1076                 scsi_report_bus_reset(scmd->device->host, scmd->device->channel);
1077                 spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
1078         }
1079
1080         return rtn;
1081 }
1082
1083 /**
1084  * scsi_try_host_reset - ask host adapter to reset itself
1085  * @scmd:       SCSI cmd to send hsot reset.
1086  **/
1087 static int scsi_try_host_reset(struct scsi_cmnd *scmd)
1088 {
1089         unsigned long flags;
1090         int rtn;
1091
1092         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Snd Host RST\n",
1093                                           __FUNCTION__));
1094         scmd->owner = SCSI_OWNER_LOWLEVEL;
1095
1096         if (!scmd->device->host->hostt->eh_host_reset_handler)
1097                 return FAILED;
1098
1099         spin_lock_irqsave(scmd->device->host->host_lock, flags);
1100         rtn = scmd->device->host->hostt->eh_host_reset_handler(scmd);
1101         spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
1102
1103         if (rtn == SUCCESS) {
1104                 if (!scmd->device->host->hostt->skip_settle_delay)
1105                         ssleep(HOST_RESET_SETTLE_TIME);
1106                 spin_lock_irqsave(scmd->device->host->host_lock, flags);
1107                 scsi_report_bus_reset(scmd->device->host, scmd->device->channel);
1108                 spin_unlock_irqrestore(scmd->device->host->host_lock, flags);
1109         }
1110
1111         return rtn;
1112 }
1113
1114 /**
1115  * scsi_eh_bus_reset - send a bus reset 
1116  * @shost:      scsi host being recovered.
1117  * @eh_done_q:  list_head for processed commands.
1118  **/
1119 static int scsi_eh_bus_reset(struct Scsi_Host *shost,
1120                              struct list_head *work_q,
1121                              struct list_head *done_q)
1122 {
1123         struct list_head *lh, *lh_sf;
1124         struct scsi_cmnd *scmd;
1125         struct scsi_cmnd *chan_scmd;
1126         unsigned int channel;
1127         int rtn;
1128
1129         /*
1130          * we really want to loop over the various channels, and do this on
1131          * a channel by channel basis.  we should also check to see if any
1132          * of the failed commands are on soft_reset devices, and if so, skip
1133          * the reset.  
1134          */
1135
1136         for (channel = 0; channel <= shost->max_channel; channel++) {
1137                 chan_scmd = NULL;
1138                 list_for_each_entry(scmd, work_q, eh_entry) {
1139                         if (channel == scmd->device->channel) {
1140                                 chan_scmd = scmd;
1141                                 break;
1142                                 /*
1143                                  * FIXME add back in some support for
1144                                  * soft_reset devices.
1145                                  */
1146                         }
1147                 }
1148
1149                 if (!chan_scmd)
1150                         continue;
1151                 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending BRST chan:"
1152                                                   " %d\n", current->comm,
1153                                                   channel));
1154                 rtn = scsi_try_bus_reset(chan_scmd);
1155                 if (rtn == SUCCESS) {
1156                         list_for_each_safe(lh, lh_sf, work_q) {
1157                                 scmd = list_entry(lh, struct scsi_cmnd,
1158                                                   eh_entry);
1159                                 if (channel == scmd->device->channel)
1160                                         if (!scsi_device_online(scmd->device) ||
1161                                             !scsi_eh_tur(scmd))
1162                                                 scsi_eh_finish_cmd(scmd,
1163                                                                    done_q);
1164                         }
1165                 } else {
1166                         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: BRST"
1167                                                           " failed chan: %d\n",
1168                                                           current->comm,
1169                                                           channel));
1170                 }
1171         }
1172         return list_empty(work_q);
1173 }
1174
1175 /**
1176  * scsi_eh_host_reset - send a host reset 
1177  * @work_q:     list_head for processed commands.
1178  * @done_q:     list_head for processed commands.
1179  **/
1180 static int scsi_eh_host_reset(struct list_head *work_q,
1181                               struct list_head *done_q)
1182 {
1183         int rtn;
1184         struct list_head *lh, *lh_sf;
1185         struct scsi_cmnd *scmd;
1186
1187         if (!list_empty(work_q)) {
1188                 scmd = list_entry(work_q->next,
1189                                   struct scsi_cmnd, eh_entry);
1190
1191                 SCSI_LOG_ERROR_RECOVERY(3, printk("%s: Sending HRST\n"
1192                                                   , current->comm));
1193
1194                 rtn = scsi_try_host_reset(scmd);
1195                 if (rtn == SUCCESS) {
1196                         list_for_each_safe(lh, lh_sf, work_q) {
1197                                 scmd = list_entry(lh, struct scsi_cmnd, eh_entry);
1198                                 if (!scsi_device_online(scmd->device) ||
1199                                     (!scsi_eh_try_stu(scmd) && !scsi_eh_tur(scmd)) ||
1200                                     !scsi_eh_tur(scmd))
1201                                         scsi_eh_finish_cmd(scmd, done_q);
1202                         }
1203                 } else {
1204                         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: HRST"
1205                                                           " failed\n",
1206                                                           current->comm));
1207                 }
1208         }
1209         return list_empty(work_q);
1210 }
1211
1212 /**
1213  * scsi_eh_offline_sdevs - offline scsi devices that fail to recover
1214  * @work_q:     list_head for processed commands.
1215  * @done_q:     list_head for processed commands.
1216  *
1217  **/
1218 static void scsi_eh_offline_sdevs(struct list_head *work_q,
1219                                   struct list_head *done_q)
1220 {
1221         struct list_head *lh, *lh_sf;
1222         struct scsi_cmnd *scmd;
1223
1224         list_for_each_safe(lh, lh_sf, work_q) {
1225                 scmd = list_entry(lh, struct scsi_cmnd, eh_entry);
1226                 printk(KERN_INFO "scsi: Device offlined - not"
1227                                 " ready after error recovery: host"
1228                                 " %d channel %d id %d lun %d\n",
1229                                 scmd->device->host->host_no,
1230                                 scmd->device->channel,
1231                                 scmd->device->id,
1232                                 scmd->device->lun);
1233                 scsi_device_set_state(scmd->device, SDEV_OFFLINE);
1234                 if (scsi_eh_eflags_chk(scmd, SCSI_EH_CANCEL_CMD)) {
1235                         /*
1236                          * FIXME: Handle lost cmds.
1237                          */
1238                 }
1239                 scsi_eh_finish_cmd(scmd, done_q);
1240         }
1241         return;
1242 }
1243
1244 /**
1245  * scsi_decide_disposition - Disposition a cmd on return from LLD.
1246  * @scmd:       SCSI cmd to examine.
1247  *
1248  * Notes:
1249  *    This is *only* called when we are examining the status after sending
1250  *    out the actual data command.  any commands that are queued for error
1251  *    recovery (e.g. test_unit_ready) do *not* come through here.
1252  *
1253  *    When this routine returns failed, it means the error handler thread
1254  *    is woken.  In cases where the error code indicates an error that
1255  *    doesn't require the error handler read (i.e. we don't need to
1256  *    abort/reset), this function should return SUCCESS.
1257  **/
1258 int scsi_decide_disposition(struct scsi_cmnd *scmd)
1259 {
1260         int rtn;
1261
1262         /*
1263          * if the device is offline, then we clearly just pass the result back
1264          * up to the top level.
1265          */
1266         if (!scsi_device_online(scmd->device)) {
1267                 SCSI_LOG_ERROR_RECOVERY(5, printk("%s: device offline - report"
1268                                                   " as SUCCESS\n",
1269                                                   __FUNCTION__));
1270                 return SUCCESS;
1271         }
1272
1273         /*
1274          * first check the host byte, to see if there is anything in there
1275          * that would indicate what we need to do.
1276          */
1277         switch (host_byte(scmd->result)) {
1278         case DID_PASSTHROUGH:
1279                 /*
1280                  * no matter what, pass this through to the upper layer.
1281                  * nuke this special code so that it looks like we are saying
1282                  * did_ok.
1283                  */
1284                 scmd->result &= 0xff00ffff;
1285                 return SUCCESS;
1286         case DID_OK:
1287                 /*
1288                  * looks good.  drop through, and check the next byte.
1289                  */
1290                 break;
1291         case DID_NO_CONNECT:
1292         case DID_BAD_TARGET:
1293         case DID_ABORT:
1294                 /*
1295                  * note - this means that we just report the status back
1296                  * to the top level driver, not that we actually think
1297                  * that it indicates SUCCESS.
1298                  */
1299                 return SUCCESS;
1300                 /*
1301                  * when the low level driver returns did_soft_error,
1302                  * it is responsible for keeping an internal retry counter 
1303                  * in order to avoid endless loops (db)
1304                  *
1305                  * actually this is a bug in this function here.  we should
1306                  * be mindful of the maximum number of retries specified
1307                  * and not get stuck in a loop.
1308                  */
1309         case DID_SOFT_ERROR:
1310                 goto maybe_retry;
1311         case DID_IMM_RETRY:
1312                 return NEEDS_RETRY;
1313
1314         case DID_REQUEUE:
1315                 return ADD_TO_MLQUEUE;
1316
1317         case DID_ERROR:
1318                 if (msg_byte(scmd->result) == COMMAND_COMPLETE &&
1319                     status_byte(scmd->result) == RESERVATION_CONFLICT)
1320                         /*
1321                          * execute reservation conflict processing code
1322                          * lower down
1323                          */
1324                         break;
1325                 /* fallthrough */
1326
1327         case DID_BUS_BUSY:
1328         case DID_PARITY:
1329                 goto maybe_retry;
1330         case DID_TIME_OUT:
1331                 /*
1332                  * when we scan the bus, we get timeout messages for
1333                  * these commands if there is no device available.
1334                  * other hosts report did_no_connect for the same thing.
1335                  */
1336                 if ((scmd->cmnd[0] == TEST_UNIT_READY ||
1337                      scmd->cmnd[0] == INQUIRY)) {
1338                         return SUCCESS;
1339                 } else {
1340                         return FAILED;
1341                 }
1342         case DID_RESET:
1343                 return SUCCESS;
1344         default:
1345                 return FAILED;
1346         }
1347
1348         /*
1349          * next, check the message byte.
1350          */
1351         if (msg_byte(scmd->result) != COMMAND_COMPLETE)
1352                 return FAILED;
1353
1354         /*
1355          * check the status byte to see if this indicates anything special.
1356          */
1357         switch (status_byte(scmd->result)) {
1358         case QUEUE_FULL:
1359                 /*
1360                  * the case of trying to send too many commands to a
1361                  * tagged queueing device.
1362                  */
1363         case BUSY:
1364                 /*
1365                  * device can't talk to us at the moment.  Should only
1366                  * occur (SAM-3) when the task queue is empty, so will cause
1367                  * the empty queue handling to trigger a stall in the
1368                  * device.
1369                  */
1370                 return ADD_TO_MLQUEUE;
1371         case GOOD:
1372         case COMMAND_TERMINATED:
1373         case TASK_ABORTED:
1374                 return SUCCESS;
1375         case CHECK_CONDITION:
1376                 rtn = scsi_check_sense(scmd);
1377                 if (rtn == NEEDS_RETRY)
1378                         goto maybe_retry;
1379                 /* if rtn == FAILED, we have no sense information;
1380                  * returning FAILED will wake the error handler thread
1381                  * to collect the sense and redo the decide
1382                  * disposition */
1383                 return rtn;
1384         case CONDITION_GOOD:
1385         case INTERMEDIATE_GOOD:
1386         case INTERMEDIATE_C_GOOD:
1387         case ACA_ACTIVE:
1388                 /*
1389                  * who knows?  FIXME(eric)
1390                  */
1391                 return SUCCESS;
1392
1393         case RESERVATION_CONFLICT:
1394                 printk(KERN_INFO "scsi: reservation conflict: host"
1395                                 " %d channel %d id %d lun %d\n",
1396                        scmd->device->host->host_no, scmd->device->channel,
1397                        scmd->device->id, scmd->device->lun);
1398                 return SUCCESS; /* causes immediate i/o error */
1399         default:
1400                 return FAILED;
1401         }
1402         return FAILED;
1403
1404       maybe_retry:
1405
1406         /* we requeue for retry because the error was retryable, and
1407          * the request was not marked fast fail.  Note that above,
1408          * even if the request is marked fast fail, we still requeue
1409          * for queue congestion conditions (QUEUE_FULL or BUSY) */
1410         if ((++scmd->retries) < scmd->allowed 
1411             && !blk_noretry_request(scmd->request)) {
1412                 return NEEDS_RETRY;
1413         } else {
1414                 /*
1415                  * no more retries - report this one back to upper level.
1416                  */
1417                 return SUCCESS;
1418         }
1419 }
1420
1421 /**
1422  * scsi_eh_lock_done - done function for eh door lock request
1423  * @scmd:       SCSI command block for the door lock request
1424  *
1425  * Notes:
1426  *      We completed the asynchronous door lock request, and it has either
1427  *      locked the door or failed.  We must free the command structures
1428  *      associated with this request.
1429  **/
1430 static void scsi_eh_lock_done(struct scsi_cmnd *scmd)
1431 {
1432         struct scsi_request *sreq = scmd->sc_request;
1433
1434         scsi_release_request(sreq);
1435 }
1436
1437
1438 /**
1439  * scsi_eh_lock_door - Prevent medium removal for the specified device
1440  * @sdev:       SCSI device to prevent medium removal
1441  *
1442  * Locking:
1443  *      We must be called from process context; scsi_allocate_request()
1444  *      may sleep.
1445  *
1446  * Notes:
1447  *      We queue up an asynchronous "ALLOW MEDIUM REMOVAL" request on the
1448  *      head of the devices request queue, and continue.
1449  *
1450  * Bugs:
1451  *      scsi_allocate_request() may sleep waiting for existing requests to
1452  *      be processed.  However, since we haven't kicked off any request
1453  *      processing for this host, this may deadlock.
1454  *
1455  *      If scsi_allocate_request() fails for what ever reason, we
1456  *      completely forget to lock the door.
1457  **/
1458 static void scsi_eh_lock_door(struct scsi_device *sdev)
1459 {
1460         struct scsi_request *sreq = scsi_allocate_request(sdev, GFP_KERNEL);
1461
1462         if (unlikely(!sreq)) {
1463                 printk(KERN_ERR "%s: request allocate failed,"
1464                        "prevent media removal cmd not sent\n", __FUNCTION__);
1465                 return;
1466         }
1467
1468         sreq->sr_cmnd[0] = ALLOW_MEDIUM_REMOVAL;
1469         sreq->sr_cmnd[1] = 0;
1470         sreq->sr_cmnd[2] = 0;
1471         sreq->sr_cmnd[3] = 0;
1472         sreq->sr_cmnd[4] = SCSI_REMOVAL_PREVENT;
1473         sreq->sr_cmnd[5] = 0;
1474         sreq->sr_data_direction = DMA_NONE;
1475         sreq->sr_bufflen = 0;
1476         sreq->sr_buffer = NULL;
1477         sreq->sr_allowed = 5;
1478         sreq->sr_done = scsi_eh_lock_done;
1479         sreq->sr_timeout_per_command = 10 * HZ;
1480         sreq->sr_cmd_len = COMMAND_SIZE(sreq->sr_cmnd[0]);
1481
1482         scsi_insert_special_req(sreq, 1);
1483 }
1484
1485
1486 /**
1487  * scsi_restart_operations - restart io operations to the specified host.
1488  * @shost:      Host we are restarting.
1489  *
1490  * Notes:
1491  *    When we entered the error handler, we blocked all further i/o to
1492  *    this device.  we need to 'reverse' this process.
1493  **/
1494 static void scsi_restart_operations(struct Scsi_Host *shost)
1495 {
1496         struct scsi_device *sdev;
1497
1498         /*
1499          * If the door was locked, we need to insert a door lock request
1500          * onto the head of the SCSI request queue for the device.  There
1501          * is no point trying to lock the door of an off-line device.
1502          */
1503         shost_for_each_device(sdev, shost) {
1504                 if (scsi_device_online(sdev) && sdev->locked)
1505                         scsi_eh_lock_door(sdev);
1506         }
1507
1508         /*
1509          * next free up anything directly waiting upon the host.  this
1510          * will be requests for character device operations, and also for
1511          * ioctls to queued block devices.
1512          */
1513         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: waking up host to restart\n",
1514                                           __FUNCTION__));
1515
1516         clear_bit(SHOST_RECOVERY, &shost->shost_state);
1517
1518         wake_up(&shost->host_wait);
1519
1520         /*
1521          * finally we need to re-initiate requests that may be pending.  we will
1522          * have had everything blocked while error handling is taking place, and
1523          * now that error recovery is done, we will need to ensure that these
1524          * requests are started.
1525          */
1526         scsi_run_host_queues(shost);
1527 }
1528
1529 /**
1530  * scsi_eh_ready_devs - check device ready state and recover if not.
1531  * @shost:      host to be recovered.
1532  * @eh_done_q:  list_head for processed commands.
1533  *
1534  **/
1535 static void scsi_eh_ready_devs(struct Scsi_Host *shost,
1536                                struct list_head *work_q,
1537                                struct list_head *done_q)
1538 {
1539         if (!scsi_eh_stu(shost, work_q, done_q))
1540                 if (!scsi_eh_bus_device_reset(shost, work_q, done_q))
1541                         if (!scsi_eh_bus_reset(shost, work_q, done_q))
1542                                 if (!scsi_eh_host_reset(work_q, done_q))
1543                                         scsi_eh_offline_sdevs(work_q, done_q);
1544 }
1545
1546 /**
1547  * scsi_eh_flush_done_q - finish processed commands or retry them.
1548  * @done_q:     list_head of processed commands.
1549  *
1550  **/
1551 static void scsi_eh_flush_done_q(struct list_head *done_q)
1552 {
1553         struct list_head *lh, *lh_sf;
1554         struct scsi_cmnd *scmd;
1555
1556         list_for_each_safe(lh, lh_sf, done_q) {
1557                 scmd = list_entry(lh, struct scsi_cmnd, eh_entry);
1558                 list_del_init(lh);
1559                 if (scsi_device_online(scmd->device) &&
1560                     !blk_noretry_request(scmd->request) &&
1561                     (++scmd->retries < scmd->allowed)) {
1562                         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: flush"
1563                                                           " retry cmd: %p\n",
1564                                                           current->comm,
1565                                                           scmd));
1566                                 scsi_queue_insert(scmd, SCSI_MLQUEUE_EH_RETRY);
1567                 } else {
1568                         /*
1569                          * If just we got sense for the device (called
1570                          * scsi_eh_get_sense), scmd->result is already
1571                          * set, do not set DRIVER_TIMEOUT.
1572                          */
1573                         if (!scmd->result)
1574                                 scmd->result |= (DRIVER_TIMEOUT << 24);
1575                         SCSI_LOG_ERROR_RECOVERY(3, printk("%s: flush finish"
1576                                                         " cmd: %p\n",
1577                                                         current->comm, scmd));
1578                         scsi_finish_command(scmd);
1579                 }
1580         }
1581 }
1582
1583 /**
1584  * scsi_unjam_host - Attempt to fix a host which has a cmd that failed.
1585  * @shost:      Host to unjam.
1586  *
1587  * Notes:
1588  *    When we come in here, we *know* that all commands on the bus have
1589  *    either completed, failed or timed out.  we also know that no further
1590  *    commands are being sent to the host, so things are relatively quiet
1591  *    and we have freedom to fiddle with things as we wish.
1592  *
1593  *    This is only the *default* implementation.  it is possible for
1594  *    individual drivers to supply their own version of this function, and
1595  *    if the maintainer wishes to do this, it is strongly suggested that
1596  *    this function be taken as a template and modified.  this function
1597  *    was designed to correctly handle problems for about 95% of the
1598  *    different cases out there, and it should always provide at least a
1599  *    reasonable amount of error recovery.
1600  *
1601  *    Any command marked 'failed' or 'timeout' must eventually have
1602  *    scsi_finish_cmd() called for it.  we do all of the retry stuff
1603  *    here, so when we restart the host after we return it should have an
1604  *    empty queue.
1605  **/
1606 static void scsi_unjam_host(struct Scsi_Host *shost)
1607 {
1608         unsigned long flags;
1609         LIST_HEAD(eh_work_q);
1610         LIST_HEAD(eh_done_q);
1611
1612         spin_lock_irqsave(shost->host_lock, flags);
1613         list_splice_init(&shost->eh_cmd_q, &eh_work_q);
1614         spin_unlock_irqrestore(shost->host_lock, flags);
1615
1616         SCSI_LOG_ERROR_RECOVERY(1, scsi_eh_prt_fail_stats(shost, &eh_work_q));
1617
1618         if (!scsi_eh_get_sense(&eh_work_q, &eh_done_q))
1619                 if (!scsi_eh_abort_cmds(&eh_work_q, &eh_done_q))
1620                         scsi_eh_ready_devs(shost, &eh_work_q, &eh_done_q);
1621
1622         scsi_eh_flush_done_q(&eh_done_q);
1623 }
1624
1625 /**
1626  * scsi_error_handler - Handle errors/timeouts of SCSI cmds.
1627  * @data:       Host for which we are running.
1628  *
1629  * Notes:
1630  *    This is always run in the context of a kernel thread.  The idea is
1631  *    that we start this thing up when the kernel starts up (one per host
1632  *    that we detect), and it immediately goes to sleep and waits for some
1633  *    event (i.e. failure).  When this takes place, we have the job of
1634  *    trying to unjam the bus and restarting things.
1635  **/
1636 int scsi_error_handler(void *data)
1637 {
1638         struct Scsi_Host *shost = (struct Scsi_Host *) data;
1639         int rtn;
1640         DECLARE_MUTEX_LOCKED(sem);
1641
1642         /*
1643          *    Flush resources
1644          */
1645
1646         daemonize("scsi_eh_%d", shost->host_no);
1647
1648         current->flags |= PF_NOFREEZE;
1649
1650         shost->eh_wait = &sem;
1651         shost->ehandler = current;
1652
1653         /*
1654          * Wake up the thread that created us.
1655          */
1656         SCSI_LOG_ERROR_RECOVERY(3, printk("Wake up parent of"
1657                                           " scsi_eh_%d\n",shost->host_no));
1658
1659         complete(shost->eh_notify);
1660
1661         while (1) {
1662                 /*
1663                  * If we get a signal, it means we are supposed to go
1664                  * away and die.  This typically happens if the user is
1665                  * trying to unload a module.
1666                  */
1667                 SCSI_LOG_ERROR_RECOVERY(1, printk("Error handler"
1668                                                   " scsi_eh_%d"
1669                                                   " sleeping\n",shost->host_no));
1670
1671                 /*
1672                  * Note - we always use down_interruptible with the semaphore
1673                  * even if the module was loaded as part of the kernel.  The
1674                  * reason is that down() will cause this thread to be counted
1675                  * in the load average as a running process, and down
1676                  * interruptible doesn't.  Given that we need to allow this
1677                  * thread to die if the driver was loaded as a module, using
1678                  * semaphores isn't unreasonable.
1679                  */
1680                 down_interruptible(&sem);
1681                 if (shost->eh_kill)
1682                         break;
1683
1684                 SCSI_LOG_ERROR_RECOVERY(1, printk("Error handler"
1685                                                   " scsi_eh_%d waking"
1686                                                   " up\n",shost->host_no));
1687
1688                 shost->eh_active = 1;
1689
1690                 /*
1691                  * We have a host that is failing for some reason.  Figure out
1692                  * what we need to do to get it up and online again (if we can).
1693                  * If we fail, we end up taking the thing offline.
1694                  */
1695                 if (shost->hostt->eh_strategy_handler) 
1696                         rtn = shost->hostt->eh_strategy_handler(shost);
1697                 else
1698                         scsi_unjam_host(shost);
1699
1700                 shost->eh_active = 0;
1701
1702                 /*
1703                  * Note - if the above fails completely, the action is to take
1704                  * individual devices offline and flush the queue of any
1705                  * outstanding requests that may have been pending.  When we
1706                  * restart, we restart any I/O to any other devices on the bus
1707                  * which are still online.
1708                  */
1709                 scsi_restart_operations(shost);
1710
1711         }
1712
1713         SCSI_LOG_ERROR_RECOVERY(1, printk("Error handler scsi_eh_%d"
1714                                           " exiting\n",shost->host_no));
1715
1716         /*
1717          * Make sure that nobody tries to wake us up again.
1718          */
1719         shost->eh_wait = NULL;
1720
1721         /*
1722          * Knock this down too.  From this point on, the host is flying
1723          * without a pilot.  If this is because the module is being unloaded,
1724          * that's fine.  If the user sent a signal to this thing, we are
1725          * potentially in real danger.
1726          */
1727         shost->eh_active = 0;
1728         shost->ehandler = NULL;
1729
1730         /*
1731          * If anyone is waiting for us to exit (i.e. someone trying to unload
1732          * a driver), then wake up that process to let them know we are on
1733          * the way out the door.
1734          */
1735         complete_and_exit(shost->eh_notify, 0);
1736         return 0;
1737 }
1738
1739 /*
1740  * Function:    scsi_report_bus_reset()
1741  *
1742  * Purpose:     Utility function used by low-level drivers to report that
1743  *              they have observed a bus reset on the bus being handled.
1744  *
1745  * Arguments:   shost       - Host in question
1746  *              channel     - channel on which reset was observed.
1747  *
1748  * Returns:     Nothing
1749  *
1750  * Lock status: Host lock must be held.
1751  *
1752  * Notes:       This only needs to be called if the reset is one which
1753  *              originates from an unknown location.  Resets originated
1754  *              by the mid-level itself don't need to call this, but there
1755  *              should be no harm.
1756  *
1757  *              The main purpose of this is to make sure that a CHECK_CONDITION
1758  *              is properly treated.
1759  */
1760 void scsi_report_bus_reset(struct Scsi_Host *shost, int channel)
1761 {
1762         struct scsi_device *sdev;
1763
1764         __shost_for_each_device(sdev, shost) {
1765                 if (channel == sdev->channel) {
1766                         sdev->was_reset = 1;
1767                         sdev->expecting_cc_ua = 1;
1768                 }
1769         }
1770 }
1771 EXPORT_SYMBOL(scsi_report_bus_reset);
1772
1773 /*
1774  * Function:    scsi_report_device_reset()
1775  *
1776  * Purpose:     Utility function used by low-level drivers to report that
1777  *              they have observed a device reset on the device being handled.
1778  *
1779  * Arguments:   shost       - Host in question
1780  *              channel     - channel on which reset was observed
1781  *              target      - target on which reset was observed
1782  *
1783  * Returns:     Nothing
1784  *
1785  * Lock status: Host lock must be held
1786  *
1787  * Notes:       This only needs to be called if the reset is one which
1788  *              originates from an unknown location.  Resets originated
1789  *              by the mid-level itself don't need to call this, but there
1790  *              should be no harm.
1791  *
1792  *              The main purpose of this is to make sure that a CHECK_CONDITION
1793  *              is properly treated.
1794  */
1795 void scsi_report_device_reset(struct Scsi_Host *shost, int channel, int target)
1796 {
1797         struct scsi_device *sdev;
1798
1799         __shost_for_each_device(sdev, shost) {
1800                 if (channel == sdev->channel &&
1801                     target == sdev->id) {
1802                         sdev->was_reset = 1;
1803                         sdev->expecting_cc_ua = 1;
1804                 }
1805         }
1806 }
1807 EXPORT_SYMBOL(scsi_report_device_reset);
1808
1809 static void
1810 scsi_reset_provider_done_command(struct scsi_cmnd *scmd)
1811 {
1812 }
1813
1814 /*
1815  * Function:    scsi_reset_provider
1816  *
1817  * Purpose:     Send requested reset to a bus or device at any phase.
1818  *
1819  * Arguments:   device  - device to send reset to
1820  *              flag - reset type (see scsi.h)
1821  *
1822  * Returns:     SUCCESS/FAILURE.
1823  *
1824  * Notes:       This is used by the SCSI Generic driver to provide
1825  *              Bus/Device reset capability.
1826  */
1827 int
1828 scsi_reset_provider(struct scsi_device *dev, int flag)
1829 {
1830         struct scsi_cmnd *scmd = scsi_get_command(dev, GFP_KERNEL);
1831         struct request req;
1832         int rtn;
1833
1834         scmd->request = &req;
1835         memset(&scmd->eh_timeout, 0, sizeof(scmd->eh_timeout));
1836         scmd->request->rq_status        = RQ_SCSI_BUSY;
1837         scmd->state                     = SCSI_STATE_INITIALIZING;
1838         scmd->owner                     = SCSI_OWNER_MIDLEVEL;
1839     
1840         memset(&scmd->cmnd, '\0', sizeof(scmd->cmnd));
1841     
1842         scmd->scsi_done         = scsi_reset_provider_done_command;
1843         scmd->done                      = NULL;
1844         scmd->buffer                    = NULL;
1845         scmd->bufflen                   = 0;
1846         scmd->request_buffer            = NULL;
1847         scmd->request_bufflen           = 0;
1848         scmd->abort_reason              = DID_ABORT;
1849
1850         scmd->cmd_len                   = 0;
1851
1852         scmd->sc_data_direction         = DMA_BIDIRECTIONAL;
1853         scmd->sc_request                = NULL;
1854         scmd->sc_magic                  = SCSI_CMND_MAGIC;
1855
1856         init_timer(&scmd->eh_timeout);
1857
1858         /*
1859          * Sometimes the command can get back into the timer chain,
1860          * so use the pid as an identifier.
1861          */
1862         scmd->pid                       = 0;
1863
1864         switch (flag) {
1865         case SCSI_TRY_RESET_DEVICE:
1866                 rtn = scsi_try_bus_device_reset(scmd);
1867                 if (rtn == SUCCESS)
1868                         break;
1869                 /* FALLTHROUGH */
1870         case SCSI_TRY_RESET_BUS:
1871                 rtn = scsi_try_bus_reset(scmd);
1872                 if (rtn == SUCCESS)
1873                         break;
1874                 /* FALLTHROUGH */
1875         case SCSI_TRY_RESET_HOST:
1876                 rtn = scsi_try_host_reset(scmd);
1877                 break;
1878         default:
1879                 rtn = FAILED;
1880         }
1881
1882         scsi_next_command(scmd);
1883         return rtn;
1884 }
1885 EXPORT_SYMBOL(scsi_reset_provider);
1886
1887 /**
1888  * scsi_normalize_sense - normalize main elements from either fixed or
1889  *                      descriptor sense data format into a common format.
1890  *
1891  * @sense_buffer:       byte array containing sense data returned by device
1892  * @sb_len:             number of valid bytes in sense_buffer
1893  * @sshdr:              pointer to instance of structure that common
1894  *                      elements are written to.
1895  *
1896  * Notes:
1897  *      The "main elements" from sense data are: response_code, sense_key,
1898  *      asc, ascq and additional_length (only for descriptor format).
1899  *
1900  *      Typically this function can be called after a device has
1901  *      responded to a SCSI command with the CHECK_CONDITION status.
1902  *
1903  * Return value:
1904  *      1 if valid sense data information found, else 0;
1905  **/
1906 int scsi_normalize_sense(const u8 *sense_buffer, int sb_len,
1907                          struct scsi_sense_hdr *sshdr)
1908 {
1909         if (!sense_buffer || !sb_len || (sense_buffer[0] & 0x70) != 0x70)
1910                 return 0;
1911
1912         memset(sshdr, 0, sizeof(struct scsi_sense_hdr));
1913
1914         sshdr->response_code = (sense_buffer[0] & 0x7f);
1915         if (sshdr->response_code >= 0x72) {
1916                 /*
1917                  * descriptor format
1918                  */
1919                 if (sb_len > 1)
1920                         sshdr->sense_key = (sense_buffer[1] & 0xf);
1921                 if (sb_len > 2)
1922                         sshdr->asc = sense_buffer[2];
1923                 if (sb_len > 3)
1924                         sshdr->ascq = sense_buffer[3];
1925                 if (sb_len > 7)
1926                         sshdr->additional_length = sense_buffer[7];
1927         } else {
1928                 /* 
1929                  * fixed format
1930                  */
1931                 if (sb_len > 2)
1932                         sshdr->sense_key = (sense_buffer[2] & 0xf);
1933                 if (sb_len > 7) {
1934                         sb_len = (sb_len < (sense_buffer[7] + 8)) ?
1935                                          sb_len : (sense_buffer[7] + 8);
1936                         if (sb_len > 12)
1937                                 sshdr->asc = sense_buffer[12];
1938                         if (sb_len > 13)
1939                                 sshdr->ascq = sense_buffer[13];
1940                 }
1941         }
1942
1943         return 1;
1944 }
1945 EXPORT_SYMBOL(scsi_normalize_sense);
1946
1947 int scsi_request_normalize_sense(struct scsi_request *sreq,
1948                                  struct scsi_sense_hdr *sshdr)
1949 {
1950         return scsi_normalize_sense(sreq->sr_sense_buffer,
1951                         sizeof(sreq->sr_sense_buffer), sshdr);
1952 }
1953 EXPORT_SYMBOL(scsi_request_normalize_sense);
1954
1955 int scsi_command_normalize_sense(struct scsi_cmnd *cmd,
1956                                  struct scsi_sense_hdr *sshdr)
1957 {
1958         return scsi_normalize_sense(cmd->sense_buffer,
1959                         sizeof(cmd->sense_buffer), sshdr);
1960 }
1961 EXPORT_SYMBOL(scsi_command_normalize_sense);
1962
1963 /**
1964  * scsi_sense_desc_find - search for a given descriptor type in
1965  *                      descriptor sense data format.
1966  *
1967  * @sense_buffer:       byte array of descriptor format sense data
1968  * @sb_len:             number of valid bytes in sense_buffer
1969  * @desc_type:          value of descriptor type to find
1970  *                      (e.g. 0 -> information)
1971  *
1972  * Notes:
1973  *      only valid when sense data is in descriptor format
1974  *
1975  * Return value:
1976  *      pointer to start of (first) descriptor if found else NULL
1977  **/
1978 const u8 * scsi_sense_desc_find(const u8 * sense_buffer, int sb_len,
1979                                 int desc_type)
1980 {
1981         int add_sen_len, add_len, desc_len, k;
1982         const u8 * descp;
1983
1984         if ((sb_len < 8) || (0 == (add_sen_len = sense_buffer[7])))
1985                 return NULL;
1986         if ((sense_buffer[0] < 0x72) || (sense_buffer[0] > 0x73))
1987                 return NULL;
1988         add_sen_len = (add_sen_len < (sb_len - 8)) ?
1989                         add_sen_len : (sb_len - 8);
1990         descp = &sense_buffer[8];
1991         for (desc_len = 0, k = 0; k < add_sen_len; k += desc_len) {
1992                 descp += desc_len;
1993                 add_len = (k < (add_sen_len - 1)) ? descp[1]: -1;
1994                 desc_len = add_len + 2;
1995                 if (descp[0] == desc_type)
1996                         return descp;
1997                 if (add_len < 0) // short descriptor ??
1998                         break;
1999         }
2000         return NULL;
2001 }
2002 EXPORT_SYMBOL(scsi_sense_desc_find);
2003
2004 /**
2005  * scsi_get_sense_info_fld - attempts to get information field from
2006  *                      sense data (either fixed or descriptor format)
2007  *
2008  * @sense_buffer:       byte array of sense data
2009  * @sb_len:             number of valid bytes in sense_buffer
2010  * @info_out:           pointer to 64 integer where 8 or 4 byte information
2011  *                      field will be placed if found.
2012  *
2013  * Return value:
2014  *      1 if information field found, 0 if not found.
2015  **/
2016 int scsi_get_sense_info_fld(const u8 * sense_buffer, int sb_len,
2017                             u64 * info_out)
2018 {
2019         int j;
2020         const u8 * ucp;
2021         u64 ull;
2022
2023         if (sb_len < 7)
2024                 return 0;
2025         switch (sense_buffer[0] & 0x7f) {
2026         case 0x70:
2027         case 0x71:
2028                 if (sense_buffer[0] & 0x80) {
2029                         *info_out = (sense_buffer[3] << 24) +
2030                                     (sense_buffer[4] << 16) +
2031                                     (sense_buffer[5] << 8) + sense_buffer[6];
2032                         return 1;
2033                 } else
2034                         return 0;
2035         case 0x72:
2036         case 0x73:
2037                 ucp = scsi_sense_desc_find(sense_buffer, sb_len,
2038                                            0 /* info desc */);
2039                 if (ucp && (0xa == ucp[1])) {
2040                         ull = 0;
2041                         for (j = 0; j < 8; ++j) {
2042                                 if (j > 0)
2043                                         ull <<= 8;
2044                                 ull |= ucp[4 + j];
2045                         }
2046                         *info_out = ull;
2047                         return 1;
2048                 } else
2049                         return 0;
2050         default:
2051                 return 0;
2052         }
2053 }
2054 EXPORT_SYMBOL(scsi_get_sense_info_fld);