scsi_error.c 50 KB

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