scsi_error.c 51 KB

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