scsi_error.c 50 KB

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