scsi_lib.c 59 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325
  1. /*
  2. * scsi_lib.c Copyright (C) 1999 Eric Youngdale
  3. *
  4. * SCSI queueing library.
  5. * Initial versions: Eric Youngdale (eric@andante.org).
  6. * Based upon conversations with large numbers
  7. * of people at Linux Expo.
  8. */
  9. #include <linux/bio.h>
  10. #include <linux/blkdev.h>
  11. #include <linux/completion.h>
  12. #include <linux/kernel.h>
  13. #include <linux/mempool.h>
  14. #include <linux/slab.h>
  15. #include <linux/init.h>
  16. #include <linux/pci.h>
  17. #include <linux/delay.h>
  18. #include <linux/hardirq.h>
  19. #include <scsi/scsi.h>
  20. #include <scsi/scsi_cmnd.h>
  21. #include <scsi/scsi_dbg.h>
  22. #include <scsi/scsi_device.h>
  23. #include <scsi/scsi_driver.h>
  24. #include <scsi/scsi_eh.h>
  25. #include <scsi/scsi_host.h>
  26. #include "scsi_priv.h"
  27. #include "scsi_logging.h"
  28. #define SG_MEMPOOL_NR ARRAY_SIZE(scsi_sg_pools)
  29. #define SG_MEMPOOL_SIZE 32
  30. struct scsi_host_sg_pool {
  31. size_t size;
  32. char *name;
  33. kmem_cache_t *slab;
  34. mempool_t *pool;
  35. };
  36. #if (SCSI_MAX_PHYS_SEGMENTS < 32)
  37. #error SCSI_MAX_PHYS_SEGMENTS is too small
  38. #endif
  39. #define SP(x) { x, "sgpool-" #x }
  40. static struct scsi_host_sg_pool scsi_sg_pools[] = {
  41. SP(8),
  42. SP(16),
  43. SP(32),
  44. #if (SCSI_MAX_PHYS_SEGMENTS > 32)
  45. SP(64),
  46. #if (SCSI_MAX_PHYS_SEGMENTS > 64)
  47. SP(128),
  48. #if (SCSI_MAX_PHYS_SEGMENTS > 128)
  49. SP(256),
  50. #if (SCSI_MAX_PHYS_SEGMENTS > 256)
  51. #error SCSI_MAX_PHYS_SEGMENTS is too large
  52. #endif
  53. #endif
  54. #endif
  55. #endif
  56. };
  57. #undef SP
  58. static void scsi_run_queue(struct request_queue *q);
  59. /*
  60. * Function: scsi_unprep_request()
  61. *
  62. * Purpose: Remove all preparation done for a request, including its
  63. * associated scsi_cmnd, so that it can be requeued.
  64. *
  65. * Arguments: req - request to unprepare
  66. *
  67. * Lock status: Assumed that no locks are held upon entry.
  68. *
  69. * Returns: Nothing.
  70. */
  71. static void scsi_unprep_request(struct request *req)
  72. {
  73. struct scsi_cmnd *cmd = req->special;
  74. req->flags &= ~REQ_DONTPREP;
  75. req->special = NULL;
  76. scsi_put_command(cmd);
  77. }
  78. /*
  79. * Function: scsi_queue_insert()
  80. *
  81. * Purpose: Insert a command in the midlevel queue.
  82. *
  83. * Arguments: cmd - command that we are adding to queue.
  84. * reason - why we are inserting command to queue.
  85. *
  86. * Lock status: Assumed that lock is not held upon entry.
  87. *
  88. * Returns: Nothing.
  89. *
  90. * Notes: We do this for one of two cases. Either the host is busy
  91. * and it cannot accept any more commands for the time being,
  92. * or the device returned QUEUE_FULL and can accept no more
  93. * commands.
  94. * Notes: This could be called either from an interrupt context or a
  95. * normal process context.
  96. */
  97. int scsi_queue_insert(struct scsi_cmnd *cmd, int reason)
  98. {
  99. struct Scsi_Host *host = cmd->device->host;
  100. struct scsi_device *device = cmd->device;
  101. struct request_queue *q = device->request_queue;
  102. unsigned long flags;
  103. SCSI_LOG_MLQUEUE(1,
  104. printk("Inserting command %p into mlqueue\n", cmd));
  105. /*
  106. * Set the appropriate busy bit for the device/host.
  107. *
  108. * If the host/device isn't busy, assume that something actually
  109. * completed, and that we should be able to queue a command now.
  110. *
  111. * Note that the prior mid-layer assumption that any host could
  112. * always queue at least one command is now broken. The mid-layer
  113. * will implement a user specifiable stall (see
  114. * scsi_host.max_host_blocked and scsi_device.max_device_blocked)
  115. * if a command is requeued with no other commands outstanding
  116. * either for the device or for the host.
  117. */
  118. if (reason == SCSI_MLQUEUE_HOST_BUSY)
  119. host->host_blocked = host->max_host_blocked;
  120. else if (reason == SCSI_MLQUEUE_DEVICE_BUSY)
  121. device->device_blocked = device->max_device_blocked;
  122. /*
  123. * Decrement the counters, since these commands are no longer
  124. * active on the host/device.
  125. */
  126. scsi_device_unbusy(device);
  127. /*
  128. * Requeue this command. It will go before all other commands
  129. * that are already in the queue.
  130. *
  131. * NOTE: there is magic here about the way the queue is plugged if
  132. * we have no outstanding commands.
  133. *
  134. * Although we *don't* plug the queue, we call the request
  135. * function. The SCSI request function detects the blocked condition
  136. * and plugs the queue appropriately.
  137. */
  138. spin_lock_irqsave(q->queue_lock, flags);
  139. blk_requeue_request(q, cmd->request);
  140. spin_unlock_irqrestore(q->queue_lock, flags);
  141. scsi_run_queue(q);
  142. return 0;
  143. }
  144. /**
  145. * scsi_execute - insert request and wait for the result
  146. * @sdev: scsi device
  147. * @cmd: scsi command
  148. * @data_direction: data direction
  149. * @buffer: data buffer
  150. * @bufflen: len of buffer
  151. * @sense: optional sense buffer
  152. * @timeout: request timeout in seconds
  153. * @retries: number of times to retry request
  154. * @flags: or into request flags;
  155. *
  156. * returns the req->errors value which is the the scsi_cmnd result
  157. * field.
  158. **/
  159. int scsi_execute(struct scsi_device *sdev, const unsigned char *cmd,
  160. int data_direction, void *buffer, unsigned bufflen,
  161. unsigned char *sense, int timeout, int retries, int flags)
  162. {
  163. struct request *req;
  164. int write = (data_direction == DMA_TO_DEVICE);
  165. int ret = DRIVER_ERROR << 24;
  166. req = blk_get_request(sdev->request_queue, write, __GFP_WAIT);
  167. if (bufflen && blk_rq_map_kern(sdev->request_queue, req,
  168. buffer, bufflen, __GFP_WAIT))
  169. goto out;
  170. req->cmd_len = COMMAND_SIZE(cmd[0]);
  171. memcpy(req->cmd, cmd, req->cmd_len);
  172. req->sense = sense;
  173. req->sense_len = 0;
  174. req->retries = retries;
  175. req->timeout = timeout;
  176. req->flags |= flags | REQ_BLOCK_PC | REQ_SPECIAL | REQ_QUIET;
  177. /*
  178. * head injection *required* here otherwise quiesce won't work
  179. */
  180. blk_execute_rq(req->q, NULL, req, 1);
  181. ret = req->errors;
  182. out:
  183. blk_put_request(req);
  184. return ret;
  185. }
  186. EXPORT_SYMBOL(scsi_execute);
  187. int scsi_execute_req(struct scsi_device *sdev, const unsigned char *cmd,
  188. int data_direction, void *buffer, unsigned bufflen,
  189. struct scsi_sense_hdr *sshdr, int timeout, int retries)
  190. {
  191. char *sense = NULL;
  192. int result;
  193. if (sshdr) {
  194. sense = kzalloc(SCSI_SENSE_BUFFERSIZE, GFP_NOIO);
  195. if (!sense)
  196. return DRIVER_ERROR << 24;
  197. }
  198. result = scsi_execute(sdev, cmd, data_direction, buffer, bufflen,
  199. sense, timeout, retries, 0);
  200. if (sshdr)
  201. scsi_normalize_sense(sense, SCSI_SENSE_BUFFERSIZE, sshdr);
  202. kfree(sense);
  203. return result;
  204. }
  205. EXPORT_SYMBOL(scsi_execute_req);
  206. struct scsi_io_context {
  207. void *data;
  208. void (*done)(void *data, char *sense, int result, int resid);
  209. char sense[SCSI_SENSE_BUFFERSIZE];
  210. };
  211. static kmem_cache_t *scsi_io_context_cache;
  212. static void scsi_end_async(struct request *req, int uptodate)
  213. {
  214. struct scsi_io_context *sioc = req->end_io_data;
  215. if (sioc->done)
  216. sioc->done(sioc->data, sioc->sense, req->errors, req->data_len);
  217. kmem_cache_free(scsi_io_context_cache, sioc);
  218. __blk_put_request(req->q, req);
  219. }
  220. static int scsi_merge_bio(struct request *rq, struct bio *bio)
  221. {
  222. struct request_queue *q = rq->q;
  223. bio->bi_flags &= ~(1 << BIO_SEG_VALID);
  224. if (rq_data_dir(rq) == WRITE)
  225. bio->bi_rw |= (1 << BIO_RW);
  226. blk_queue_bounce(q, &bio);
  227. if (!rq->bio)
  228. blk_rq_bio_prep(q, rq, bio);
  229. else if (!q->back_merge_fn(q, rq, bio))
  230. return -EINVAL;
  231. else {
  232. rq->biotail->bi_next = bio;
  233. rq->biotail = bio;
  234. rq->hard_nr_sectors += bio_sectors(bio);
  235. rq->nr_sectors = rq->hard_nr_sectors;
  236. }
  237. return 0;
  238. }
  239. static int scsi_bi_endio(struct bio *bio, unsigned int bytes_done, int error)
  240. {
  241. if (bio->bi_size)
  242. return 1;
  243. bio_put(bio);
  244. return 0;
  245. }
  246. /**
  247. * scsi_req_map_sg - map a scatterlist into a request
  248. * @rq: request to fill
  249. * @sg: scatterlist
  250. * @nsegs: number of elements
  251. * @bufflen: len of buffer
  252. * @gfp: memory allocation flags
  253. *
  254. * scsi_req_map_sg maps a scatterlist into a request so that the
  255. * request can be sent to the block layer. We do not trust the scatterlist
  256. * sent to use, as some ULDs use that struct to only organize the pages.
  257. */
  258. static int scsi_req_map_sg(struct request *rq, struct scatterlist *sgl,
  259. int nsegs, unsigned bufflen, gfp_t gfp)
  260. {
  261. struct request_queue *q = rq->q;
  262. int nr_pages = (bufflen + sgl[0].offset + PAGE_SIZE - 1) >> PAGE_SHIFT;
  263. unsigned int data_len = 0, len, bytes, off;
  264. struct page *page;
  265. struct bio *bio = NULL;
  266. int i, err, nr_vecs = 0;
  267. for (i = 0; i < nsegs; i++) {
  268. page = sgl[i].page;
  269. off = sgl[i].offset;
  270. len = sgl[i].length;
  271. data_len += len;
  272. while (len > 0) {
  273. bytes = min_t(unsigned int, len, PAGE_SIZE - off);
  274. if (!bio) {
  275. nr_vecs = min_t(int, BIO_MAX_PAGES, nr_pages);
  276. nr_pages -= nr_vecs;
  277. bio = bio_alloc(gfp, nr_vecs);
  278. if (!bio) {
  279. err = -ENOMEM;
  280. goto free_bios;
  281. }
  282. bio->bi_end_io = scsi_bi_endio;
  283. }
  284. if (bio_add_pc_page(q, bio, page, bytes, off) !=
  285. bytes) {
  286. bio_put(bio);
  287. err = -EINVAL;
  288. goto free_bios;
  289. }
  290. if (bio->bi_vcnt >= nr_vecs) {
  291. err = scsi_merge_bio(rq, bio);
  292. if (err) {
  293. bio_endio(bio, bio->bi_size, 0);
  294. goto free_bios;
  295. }
  296. bio = NULL;
  297. }
  298. page++;
  299. len -= bytes;
  300. off = 0;
  301. }
  302. }
  303. rq->buffer = rq->data = NULL;
  304. rq->data_len = data_len;
  305. return 0;
  306. free_bios:
  307. while ((bio = rq->bio) != NULL) {
  308. rq->bio = bio->bi_next;
  309. /*
  310. * call endio instead of bio_put incase it was bounced
  311. */
  312. bio_endio(bio, bio->bi_size, 0);
  313. }
  314. return err;
  315. }
  316. /**
  317. * scsi_execute_async - insert request
  318. * @sdev: scsi device
  319. * @cmd: scsi command
  320. * @cmd_len: length of scsi cdb
  321. * @data_direction: data direction
  322. * @buffer: data buffer (this can be a kernel buffer or scatterlist)
  323. * @bufflen: len of buffer
  324. * @use_sg: if buffer is a scatterlist this is the number of elements
  325. * @timeout: request timeout in seconds
  326. * @retries: number of times to retry request
  327. * @flags: or into request flags
  328. **/
  329. int scsi_execute_async(struct scsi_device *sdev, const unsigned char *cmd,
  330. int cmd_len, int data_direction, void *buffer, unsigned bufflen,
  331. int use_sg, int timeout, int retries, void *privdata,
  332. void (*done)(void *, char *, int, int), gfp_t gfp)
  333. {
  334. struct request *req;
  335. struct scsi_io_context *sioc;
  336. int err = 0;
  337. int write = (data_direction == DMA_TO_DEVICE);
  338. sioc = kmem_cache_alloc(scsi_io_context_cache, gfp);
  339. if (!sioc)
  340. return DRIVER_ERROR << 24;
  341. memset(sioc, 0, sizeof(*sioc));
  342. req = blk_get_request(sdev->request_queue, write, gfp);
  343. if (!req)
  344. goto free_sense;
  345. req->flags |= REQ_BLOCK_PC | REQ_QUIET;
  346. if (use_sg)
  347. err = scsi_req_map_sg(req, buffer, use_sg, bufflen, gfp);
  348. else if (bufflen)
  349. err = blk_rq_map_kern(req->q, req, buffer, bufflen, gfp);
  350. if (err)
  351. goto free_req;
  352. req->cmd_len = cmd_len;
  353. memcpy(req->cmd, cmd, req->cmd_len);
  354. req->sense = sioc->sense;
  355. req->sense_len = 0;
  356. req->timeout = timeout;
  357. req->retries = retries;
  358. req->end_io_data = sioc;
  359. sioc->data = privdata;
  360. sioc->done = done;
  361. blk_execute_rq_nowait(req->q, NULL, req, 1, scsi_end_async);
  362. return 0;
  363. free_req:
  364. blk_put_request(req);
  365. free_sense:
  366. kfree(sioc);
  367. return DRIVER_ERROR << 24;
  368. }
  369. EXPORT_SYMBOL_GPL(scsi_execute_async);
  370. /*
  371. * Function: scsi_init_cmd_errh()
  372. *
  373. * Purpose: Initialize cmd fields related to error handling.
  374. *
  375. * Arguments: cmd - command that is ready to be queued.
  376. *
  377. * Returns: Nothing
  378. *
  379. * Notes: This function has the job of initializing a number of
  380. * fields related to error handling. Typically this will
  381. * be called once for each command, as required.
  382. */
  383. static int scsi_init_cmd_errh(struct scsi_cmnd *cmd)
  384. {
  385. cmd->serial_number = 0;
  386. memset(cmd->sense_buffer, 0, sizeof cmd->sense_buffer);
  387. if (cmd->cmd_len == 0)
  388. cmd->cmd_len = COMMAND_SIZE(cmd->cmnd[0]);
  389. /*
  390. * We need saved copies of a number of fields - this is because
  391. * error handling may need to overwrite these with different values
  392. * to run different commands, and once error handling is complete,
  393. * we will need to restore these values prior to running the actual
  394. * command.
  395. */
  396. cmd->old_use_sg = cmd->use_sg;
  397. cmd->old_cmd_len = cmd->cmd_len;
  398. cmd->sc_old_data_direction = cmd->sc_data_direction;
  399. cmd->old_underflow = cmd->underflow;
  400. memcpy(cmd->data_cmnd, cmd->cmnd, sizeof(cmd->cmnd));
  401. cmd->buffer = cmd->request_buffer;
  402. cmd->bufflen = cmd->request_bufflen;
  403. return 1;
  404. }
  405. /*
  406. * Function: scsi_setup_cmd_retry()
  407. *
  408. * Purpose: Restore the command state for a retry
  409. *
  410. * Arguments: cmd - command to be restored
  411. *
  412. * Returns: Nothing
  413. *
  414. * Notes: Immediately prior to retrying a command, we need
  415. * to restore certain fields that we saved above.
  416. */
  417. void scsi_setup_cmd_retry(struct scsi_cmnd *cmd)
  418. {
  419. memcpy(cmd->cmnd, cmd->data_cmnd, sizeof(cmd->data_cmnd));
  420. cmd->request_buffer = cmd->buffer;
  421. cmd->request_bufflen = cmd->bufflen;
  422. cmd->use_sg = cmd->old_use_sg;
  423. cmd->cmd_len = cmd->old_cmd_len;
  424. cmd->sc_data_direction = cmd->sc_old_data_direction;
  425. cmd->underflow = cmd->old_underflow;
  426. }
  427. void scsi_device_unbusy(struct scsi_device *sdev)
  428. {
  429. struct Scsi_Host *shost = sdev->host;
  430. unsigned long flags;
  431. spin_lock_irqsave(shost->host_lock, flags);
  432. shost->host_busy--;
  433. if (unlikely(scsi_host_in_recovery(shost) &&
  434. (shost->host_failed || shost->host_eh_scheduled)))
  435. scsi_eh_wakeup(shost);
  436. spin_unlock(shost->host_lock);
  437. spin_lock(sdev->request_queue->queue_lock);
  438. sdev->device_busy--;
  439. spin_unlock_irqrestore(sdev->request_queue->queue_lock, flags);
  440. }
  441. /*
  442. * Called for single_lun devices on IO completion. Clear starget_sdev_user,
  443. * and call blk_run_queue for all the scsi_devices on the target -
  444. * including current_sdev first.
  445. *
  446. * Called with *no* scsi locks held.
  447. */
  448. static void scsi_single_lun_run(struct scsi_device *current_sdev)
  449. {
  450. struct Scsi_Host *shost = current_sdev->host;
  451. struct scsi_device *sdev, *tmp;
  452. struct scsi_target *starget = scsi_target(current_sdev);
  453. unsigned long flags;
  454. spin_lock_irqsave(shost->host_lock, flags);
  455. starget->starget_sdev_user = NULL;
  456. spin_unlock_irqrestore(shost->host_lock, flags);
  457. /*
  458. * Call blk_run_queue for all LUNs on the target, starting with
  459. * current_sdev. We race with others (to set starget_sdev_user),
  460. * but in most cases, we will be first. Ideally, each LU on the
  461. * target would get some limited time or requests on the target.
  462. */
  463. blk_run_queue(current_sdev->request_queue);
  464. spin_lock_irqsave(shost->host_lock, flags);
  465. if (starget->starget_sdev_user)
  466. goto out;
  467. list_for_each_entry_safe(sdev, tmp, &starget->devices,
  468. same_target_siblings) {
  469. if (sdev == current_sdev)
  470. continue;
  471. if (scsi_device_get(sdev))
  472. continue;
  473. spin_unlock_irqrestore(shost->host_lock, flags);
  474. blk_run_queue(sdev->request_queue);
  475. spin_lock_irqsave(shost->host_lock, flags);
  476. scsi_device_put(sdev);
  477. }
  478. out:
  479. spin_unlock_irqrestore(shost->host_lock, flags);
  480. }
  481. /*
  482. * Function: scsi_run_queue()
  483. *
  484. * Purpose: Select a proper request queue to serve next
  485. *
  486. * Arguments: q - last request's queue
  487. *
  488. * Returns: Nothing
  489. *
  490. * Notes: The previous command was completely finished, start
  491. * a new one if possible.
  492. */
  493. static void scsi_run_queue(struct request_queue *q)
  494. {
  495. struct scsi_device *sdev = q->queuedata;
  496. struct Scsi_Host *shost = sdev->host;
  497. unsigned long flags;
  498. if (sdev->single_lun)
  499. scsi_single_lun_run(sdev);
  500. spin_lock_irqsave(shost->host_lock, flags);
  501. while (!list_empty(&shost->starved_list) &&
  502. !shost->host_blocked && !shost->host_self_blocked &&
  503. !((shost->can_queue > 0) &&
  504. (shost->host_busy >= shost->can_queue))) {
  505. /*
  506. * As long as shost is accepting commands and we have
  507. * starved queues, call blk_run_queue. scsi_request_fn
  508. * drops the queue_lock and can add us back to the
  509. * starved_list.
  510. *
  511. * host_lock protects the starved_list and starved_entry.
  512. * scsi_request_fn must get the host_lock before checking
  513. * or modifying starved_list or starved_entry.
  514. */
  515. sdev = list_entry(shost->starved_list.next,
  516. struct scsi_device, starved_entry);
  517. list_del_init(&sdev->starved_entry);
  518. spin_unlock_irqrestore(shost->host_lock, flags);
  519. blk_run_queue(sdev->request_queue);
  520. spin_lock_irqsave(shost->host_lock, flags);
  521. if (unlikely(!list_empty(&sdev->starved_entry)))
  522. /*
  523. * sdev lost a race, and was put back on the
  524. * starved list. This is unlikely but without this
  525. * in theory we could loop forever.
  526. */
  527. break;
  528. }
  529. spin_unlock_irqrestore(shost->host_lock, flags);
  530. blk_run_queue(q);
  531. }
  532. /*
  533. * Function: scsi_requeue_command()
  534. *
  535. * Purpose: Handle post-processing of completed commands.
  536. *
  537. * Arguments: q - queue to operate on
  538. * cmd - command that may need to be requeued.
  539. *
  540. * Returns: Nothing
  541. *
  542. * Notes: After command completion, there may be blocks left
  543. * over which weren't finished by the previous command
  544. * this can be for a number of reasons - the main one is
  545. * I/O errors in the middle of the request, in which case
  546. * we need to request the blocks that come after the bad
  547. * sector.
  548. * Notes: Upon return, cmd is a stale pointer.
  549. */
  550. static void scsi_requeue_command(struct request_queue *q, struct scsi_cmnd *cmd)
  551. {
  552. struct request *req = cmd->request;
  553. unsigned long flags;
  554. scsi_unprep_request(req);
  555. spin_lock_irqsave(q->queue_lock, flags);
  556. blk_requeue_request(q, req);
  557. spin_unlock_irqrestore(q->queue_lock, flags);
  558. scsi_run_queue(q);
  559. }
  560. void scsi_next_command(struct scsi_cmnd *cmd)
  561. {
  562. struct scsi_device *sdev = cmd->device;
  563. struct request_queue *q = sdev->request_queue;
  564. /* need to hold a reference on the device before we let go of the cmd */
  565. get_device(&sdev->sdev_gendev);
  566. scsi_put_command(cmd);
  567. scsi_run_queue(q);
  568. /* ok to remove device now */
  569. put_device(&sdev->sdev_gendev);
  570. }
  571. void scsi_run_host_queues(struct Scsi_Host *shost)
  572. {
  573. struct scsi_device *sdev;
  574. shost_for_each_device(sdev, shost)
  575. scsi_run_queue(sdev->request_queue);
  576. }
  577. /*
  578. * Function: scsi_end_request()
  579. *
  580. * Purpose: Post-processing of completed commands (usually invoked at end
  581. * of upper level post-processing and scsi_io_completion).
  582. *
  583. * Arguments: cmd - command that is complete.
  584. * uptodate - 1 if I/O indicates success, <= 0 for I/O error.
  585. * bytes - number of bytes of completed I/O
  586. * requeue - indicates whether we should requeue leftovers.
  587. *
  588. * Lock status: Assumed that lock is not held upon entry.
  589. *
  590. * Returns: cmd if requeue required, NULL otherwise.
  591. *
  592. * Notes: This is called for block device requests in order to
  593. * mark some number of sectors as complete.
  594. *
  595. * We are guaranteeing that the request queue will be goosed
  596. * at some point during this call.
  597. * Notes: If cmd was requeued, upon return it will be a stale pointer.
  598. */
  599. static struct scsi_cmnd *scsi_end_request(struct scsi_cmnd *cmd, int uptodate,
  600. int bytes, int requeue)
  601. {
  602. request_queue_t *q = cmd->device->request_queue;
  603. struct request *req = cmd->request;
  604. unsigned long flags;
  605. /*
  606. * If there are blocks left over at the end, set up the command
  607. * to queue the remainder of them.
  608. */
  609. if (end_that_request_chunk(req, uptodate, bytes)) {
  610. int leftover = (req->hard_nr_sectors << 9);
  611. if (blk_pc_request(req))
  612. leftover = req->data_len;
  613. /* kill remainder if no retrys */
  614. if (!uptodate && blk_noretry_request(req))
  615. end_that_request_chunk(req, 0, leftover);
  616. else {
  617. if (requeue) {
  618. /*
  619. * Bleah. Leftovers again. Stick the
  620. * leftovers in the front of the
  621. * queue, and goose the queue again.
  622. */
  623. scsi_requeue_command(q, cmd);
  624. cmd = NULL;
  625. }
  626. return cmd;
  627. }
  628. }
  629. add_disk_randomness(req->rq_disk);
  630. spin_lock_irqsave(q->queue_lock, flags);
  631. if (blk_rq_tagged(req))
  632. blk_queue_end_tag(q, req);
  633. end_that_request_last(req, uptodate);
  634. spin_unlock_irqrestore(q->queue_lock, flags);
  635. /*
  636. * This will goose the queue request function at the end, so we don't
  637. * need to worry about launching another command.
  638. */
  639. scsi_next_command(cmd);
  640. return NULL;
  641. }
  642. static struct scatterlist *scsi_alloc_sgtable(struct scsi_cmnd *cmd, gfp_t gfp_mask)
  643. {
  644. struct scsi_host_sg_pool *sgp;
  645. struct scatterlist *sgl;
  646. BUG_ON(!cmd->use_sg);
  647. switch (cmd->use_sg) {
  648. case 1 ... 8:
  649. cmd->sglist_len = 0;
  650. break;
  651. case 9 ... 16:
  652. cmd->sglist_len = 1;
  653. break;
  654. case 17 ... 32:
  655. cmd->sglist_len = 2;
  656. break;
  657. #if (SCSI_MAX_PHYS_SEGMENTS > 32)
  658. case 33 ... 64:
  659. cmd->sglist_len = 3;
  660. break;
  661. #if (SCSI_MAX_PHYS_SEGMENTS > 64)
  662. case 65 ... 128:
  663. cmd->sglist_len = 4;
  664. break;
  665. #if (SCSI_MAX_PHYS_SEGMENTS > 128)
  666. case 129 ... 256:
  667. cmd->sglist_len = 5;
  668. break;
  669. #endif
  670. #endif
  671. #endif
  672. default:
  673. return NULL;
  674. }
  675. sgp = scsi_sg_pools + cmd->sglist_len;
  676. sgl = mempool_alloc(sgp->pool, gfp_mask);
  677. return sgl;
  678. }
  679. static void scsi_free_sgtable(struct scatterlist *sgl, int index)
  680. {
  681. struct scsi_host_sg_pool *sgp;
  682. BUG_ON(index >= SG_MEMPOOL_NR);
  683. sgp = scsi_sg_pools + index;
  684. mempool_free(sgl, sgp->pool);
  685. }
  686. /*
  687. * Function: scsi_release_buffers()
  688. *
  689. * Purpose: Completion processing for block device I/O requests.
  690. *
  691. * Arguments: cmd - command that we are bailing.
  692. *
  693. * Lock status: Assumed that no lock is held upon entry.
  694. *
  695. * Returns: Nothing
  696. *
  697. * Notes: In the event that an upper level driver rejects a
  698. * command, we must release resources allocated during
  699. * the __init_io() function. Primarily this would involve
  700. * the scatter-gather table, and potentially any bounce
  701. * buffers.
  702. */
  703. static void scsi_release_buffers(struct scsi_cmnd *cmd)
  704. {
  705. struct request *req = cmd->request;
  706. /*
  707. * Free up any indirection buffers we allocated for DMA purposes.
  708. */
  709. if (cmd->use_sg)
  710. scsi_free_sgtable(cmd->request_buffer, cmd->sglist_len);
  711. else if (cmd->request_buffer != req->buffer)
  712. kfree(cmd->request_buffer);
  713. /*
  714. * Zero these out. They now point to freed memory, and it is
  715. * dangerous to hang onto the pointers.
  716. */
  717. cmd->buffer = NULL;
  718. cmd->bufflen = 0;
  719. cmd->request_buffer = NULL;
  720. cmd->request_bufflen = 0;
  721. }
  722. /*
  723. * Function: scsi_io_completion()
  724. *
  725. * Purpose: Completion processing for block device I/O requests.
  726. *
  727. * Arguments: cmd - command that is finished.
  728. *
  729. * Lock status: Assumed that no lock is held upon entry.
  730. *
  731. * Returns: Nothing
  732. *
  733. * Notes: This function is matched in terms of capabilities to
  734. * the function that created the scatter-gather list.
  735. * In other words, if there are no bounce buffers
  736. * (the normal case for most drivers), we don't need
  737. * the logic to deal with cleaning up afterwards.
  738. *
  739. * We must do one of several things here:
  740. *
  741. * a) Call scsi_end_request. This will finish off the
  742. * specified number of sectors. If we are done, the
  743. * command block will be released, and the queue
  744. * function will be goosed. If we are not done, then
  745. * scsi_end_request will directly goose the queue.
  746. *
  747. * b) We can just use scsi_requeue_command() here. This would
  748. * be used if we just wanted to retry, for example.
  749. */
  750. void scsi_io_completion(struct scsi_cmnd *cmd, unsigned int good_bytes)
  751. {
  752. int result = cmd->result;
  753. int this_count = cmd->bufflen;
  754. request_queue_t *q = cmd->device->request_queue;
  755. struct request *req = cmd->request;
  756. int clear_errors = 1;
  757. struct scsi_sense_hdr sshdr;
  758. int sense_valid = 0;
  759. int sense_deferred = 0;
  760. /*
  761. * Free up any indirection buffers we allocated for DMA purposes.
  762. * For the case of a READ, we need to copy the data out of the
  763. * bounce buffer and into the real buffer.
  764. */
  765. if (cmd->use_sg)
  766. scsi_free_sgtable(cmd->buffer, cmd->sglist_len);
  767. else if (cmd->buffer != req->buffer) {
  768. if (rq_data_dir(req) == READ) {
  769. unsigned long flags;
  770. char *to = bio_kmap_irq(req->bio, &flags);
  771. memcpy(to, cmd->buffer, cmd->bufflen);
  772. bio_kunmap_irq(to, &flags);
  773. }
  774. kfree(cmd->buffer);
  775. }
  776. if (result) {
  777. sense_valid = scsi_command_normalize_sense(cmd, &sshdr);
  778. if (sense_valid)
  779. sense_deferred = scsi_sense_is_deferred(&sshdr);
  780. }
  781. if (blk_pc_request(req)) { /* SG_IO ioctl from block level */
  782. req->errors = result;
  783. if (result) {
  784. clear_errors = 0;
  785. if (sense_valid && req->sense) {
  786. /*
  787. * SG_IO wants current and deferred errors
  788. */
  789. int len = 8 + cmd->sense_buffer[7];
  790. if (len > SCSI_SENSE_BUFFERSIZE)
  791. len = SCSI_SENSE_BUFFERSIZE;
  792. memcpy(req->sense, cmd->sense_buffer, len);
  793. req->sense_len = len;
  794. }
  795. } else
  796. req->data_len = cmd->resid;
  797. }
  798. /*
  799. * Zero these out. They now point to freed memory, and it is
  800. * dangerous to hang onto the pointers.
  801. */
  802. cmd->buffer = NULL;
  803. cmd->bufflen = 0;
  804. cmd->request_buffer = NULL;
  805. cmd->request_bufflen = 0;
  806. /*
  807. * Next deal with any sectors which we were able to correctly
  808. * handle.
  809. */
  810. if (good_bytes > 0) {
  811. SCSI_LOG_HLCOMPLETE(1, printk("%ld sectors total, "
  812. "%d bytes done.\n",
  813. req->nr_sectors, good_bytes));
  814. SCSI_LOG_HLCOMPLETE(1, printk("use_sg is %d\n", cmd->use_sg));
  815. if (clear_errors)
  816. req->errors = 0;
  817. /* A number of bytes were successfully read. If there
  818. * is leftovers and there is some kind of error
  819. * (result != 0), retry the rest.
  820. */
  821. if (scsi_end_request(cmd, 1, good_bytes, !!result) == NULL)
  822. return;
  823. }
  824. /* good_bytes = 0, or (inclusive) there were leftovers and
  825. * result = 0, so scsi_end_request couldn't retry.
  826. */
  827. if (sense_valid && !sense_deferred) {
  828. switch (sshdr.sense_key) {
  829. case UNIT_ATTENTION:
  830. if (cmd->device->removable) {
  831. /* Detected disc change. Set a bit
  832. * and quietly refuse further access.
  833. */
  834. cmd->device->changed = 1;
  835. scsi_end_request(cmd, 0, this_count, 1);
  836. return;
  837. } else {
  838. /* Must have been a power glitch, or a
  839. * bus reset. Could not have been a
  840. * media change, so we just retry the
  841. * request and see what happens.
  842. */
  843. scsi_requeue_command(q, cmd);
  844. return;
  845. }
  846. break;
  847. case ILLEGAL_REQUEST:
  848. /* If we had an ILLEGAL REQUEST returned, then
  849. * we may have performed an unsupported
  850. * command. The only thing this should be
  851. * would be a ten byte read where only a six
  852. * byte read was supported. Also, on a system
  853. * where READ CAPACITY failed, we may have
  854. * read past the end of the disk.
  855. */
  856. if ((cmd->device->use_10_for_rw &&
  857. sshdr.asc == 0x20 && sshdr.ascq == 0x00) &&
  858. (cmd->cmnd[0] == READ_10 ||
  859. cmd->cmnd[0] == WRITE_10)) {
  860. cmd->device->use_10_for_rw = 0;
  861. /* This will cause a retry with a
  862. * 6-byte command.
  863. */
  864. scsi_requeue_command(q, cmd);
  865. return;
  866. } else {
  867. scsi_end_request(cmd, 0, this_count, 1);
  868. return;
  869. }
  870. break;
  871. case NOT_READY:
  872. /* If the device is in the process of becoming
  873. * ready, or has a temporary blockage, retry.
  874. */
  875. if (sshdr.asc == 0x04) {
  876. switch (sshdr.ascq) {
  877. case 0x01: /* becoming ready */
  878. case 0x04: /* format in progress */
  879. case 0x05: /* rebuild in progress */
  880. case 0x06: /* recalculation in progress */
  881. case 0x07: /* operation in progress */
  882. case 0x08: /* Long write in progress */
  883. case 0x09: /* self test in progress */
  884. scsi_requeue_command(q, cmd);
  885. return;
  886. default:
  887. break;
  888. }
  889. }
  890. if (!(req->flags & REQ_QUIET)) {
  891. scmd_printk(KERN_INFO, cmd,
  892. "Device not ready: ");
  893. scsi_print_sense_hdr("", &sshdr);
  894. }
  895. scsi_end_request(cmd, 0, this_count, 1);
  896. return;
  897. case VOLUME_OVERFLOW:
  898. if (!(req->flags & REQ_QUIET)) {
  899. scmd_printk(KERN_INFO, cmd,
  900. "Volume overflow, CDB: ");
  901. __scsi_print_command(cmd->data_cmnd);
  902. scsi_print_sense("", cmd);
  903. }
  904. /* See SSC3rXX or current. */
  905. scsi_end_request(cmd, 0, this_count, 1);
  906. return;
  907. default:
  908. break;
  909. }
  910. }
  911. if (host_byte(result) == DID_RESET) {
  912. /* Third party bus reset or reset for error recovery
  913. * reasons. Just retry the request and see what
  914. * happens.
  915. */
  916. scsi_requeue_command(q, cmd);
  917. return;
  918. }
  919. if (result) {
  920. if (!(req->flags & REQ_QUIET)) {
  921. scmd_printk(KERN_INFO, cmd,
  922. "SCSI error: return code = 0x%08x\n",
  923. result);
  924. if (driver_byte(result) & DRIVER_SENSE)
  925. scsi_print_sense("", cmd);
  926. }
  927. }
  928. scsi_end_request(cmd, 0, this_count, !result);
  929. }
  930. EXPORT_SYMBOL(scsi_io_completion);
  931. /*
  932. * Function: scsi_init_io()
  933. *
  934. * Purpose: SCSI I/O initialize function.
  935. *
  936. * Arguments: cmd - Command descriptor we wish to initialize
  937. *
  938. * Returns: 0 on success
  939. * BLKPREP_DEFER if the failure is retryable
  940. * BLKPREP_KILL if the failure is fatal
  941. */
  942. static int scsi_init_io(struct scsi_cmnd *cmd)
  943. {
  944. struct request *req = cmd->request;
  945. struct scatterlist *sgpnt;
  946. int count;
  947. /*
  948. * if this is a rq->data based REQ_BLOCK_PC, setup for a non-sg xfer
  949. */
  950. if ((req->flags & REQ_BLOCK_PC) && !req->bio) {
  951. cmd->request_bufflen = req->data_len;
  952. cmd->request_buffer = req->data;
  953. req->buffer = req->data;
  954. cmd->use_sg = 0;
  955. return 0;
  956. }
  957. /*
  958. * we used to not use scatter-gather for single segment request,
  959. * but now we do (it makes highmem I/O easier to support without
  960. * kmapping pages)
  961. */
  962. cmd->use_sg = req->nr_phys_segments;
  963. /*
  964. * if sg table allocation fails, requeue request later.
  965. */
  966. sgpnt = scsi_alloc_sgtable(cmd, GFP_ATOMIC);
  967. if (unlikely(!sgpnt)) {
  968. scsi_unprep_request(req);
  969. return BLKPREP_DEFER;
  970. }
  971. cmd->request_buffer = (char *) sgpnt;
  972. cmd->request_bufflen = req->nr_sectors << 9;
  973. if (blk_pc_request(req))
  974. cmd->request_bufflen = req->data_len;
  975. req->buffer = NULL;
  976. /*
  977. * Next, walk the list, and fill in the addresses and sizes of
  978. * each segment.
  979. */
  980. count = blk_rq_map_sg(req->q, req, cmd->request_buffer);
  981. /*
  982. * mapped well, send it off
  983. */
  984. if (likely(count <= cmd->use_sg)) {
  985. cmd->use_sg = count;
  986. return 0;
  987. }
  988. printk(KERN_ERR "Incorrect number of segments after building list\n");
  989. printk(KERN_ERR "counted %d, received %d\n", count, cmd->use_sg);
  990. printk(KERN_ERR "req nr_sec %lu, cur_nr_sec %u\n", req->nr_sectors,
  991. req->current_nr_sectors);
  992. /* release the command and kill it */
  993. scsi_release_buffers(cmd);
  994. scsi_put_command(cmd);
  995. return BLKPREP_KILL;
  996. }
  997. static int scsi_issue_flush_fn(request_queue_t *q, struct gendisk *disk,
  998. sector_t *error_sector)
  999. {
  1000. struct scsi_device *sdev = q->queuedata;
  1001. struct scsi_driver *drv;
  1002. if (sdev->sdev_state != SDEV_RUNNING)
  1003. return -ENXIO;
  1004. drv = *(struct scsi_driver **) disk->private_data;
  1005. if (drv->issue_flush)
  1006. return drv->issue_flush(&sdev->sdev_gendev, error_sector);
  1007. return -EOPNOTSUPP;
  1008. }
  1009. static void scsi_blk_pc_done(struct scsi_cmnd *cmd)
  1010. {
  1011. BUG_ON(!blk_pc_request(cmd->request));
  1012. /*
  1013. * This will complete the whole command with uptodate=1 so
  1014. * as far as the block layer is concerned the command completed
  1015. * successfully. Since this is a REQ_BLOCK_PC command the
  1016. * caller should check the request's errors value
  1017. */
  1018. scsi_io_completion(cmd, cmd->bufflen);
  1019. }
  1020. static void scsi_setup_blk_pc_cmnd(struct scsi_cmnd *cmd)
  1021. {
  1022. struct request *req = cmd->request;
  1023. BUG_ON(sizeof(req->cmd) > sizeof(cmd->cmnd));
  1024. memcpy(cmd->cmnd, req->cmd, sizeof(cmd->cmnd));
  1025. cmd->cmd_len = req->cmd_len;
  1026. if (!req->data_len)
  1027. cmd->sc_data_direction = DMA_NONE;
  1028. else if (rq_data_dir(req) == WRITE)
  1029. cmd->sc_data_direction = DMA_TO_DEVICE;
  1030. else
  1031. cmd->sc_data_direction = DMA_FROM_DEVICE;
  1032. cmd->transfersize = req->data_len;
  1033. cmd->allowed = req->retries;
  1034. cmd->timeout_per_command = req->timeout;
  1035. cmd->done = scsi_blk_pc_done;
  1036. }
  1037. static int scsi_prep_fn(struct request_queue *q, struct request *req)
  1038. {
  1039. struct scsi_device *sdev = q->queuedata;
  1040. struct scsi_cmnd *cmd;
  1041. int specials_only = 0;
  1042. /*
  1043. * Just check to see if the device is online. If it isn't, we
  1044. * refuse to process any commands. The device must be brought
  1045. * online before trying any recovery commands
  1046. */
  1047. if (unlikely(!scsi_device_online(sdev))) {
  1048. sdev_printk(KERN_ERR, sdev,
  1049. "rejecting I/O to offline device\n");
  1050. goto kill;
  1051. }
  1052. if (unlikely(sdev->sdev_state != SDEV_RUNNING)) {
  1053. /* OK, we're not in a running state don't prep
  1054. * user commands */
  1055. if (sdev->sdev_state == SDEV_DEL) {
  1056. /* Device is fully deleted, no commands
  1057. * at all allowed down */
  1058. sdev_printk(KERN_ERR, sdev,
  1059. "rejecting I/O to dead device\n");
  1060. goto kill;
  1061. }
  1062. /* OK, we only allow special commands (i.e. not
  1063. * user initiated ones */
  1064. specials_only = sdev->sdev_state;
  1065. }
  1066. /*
  1067. * Find the actual device driver associated with this command.
  1068. * The SPECIAL requests are things like character device or
  1069. * ioctls, which did not originate from ll_rw_blk. Note that
  1070. * the special field is also used to indicate the cmd for
  1071. * the remainder of a partially fulfilled request that can
  1072. * come up when there is a medium error. We have to treat
  1073. * these two cases differently. We differentiate by looking
  1074. * at request->cmd, as this tells us the real story.
  1075. */
  1076. if (req->flags & REQ_SPECIAL && req->special) {
  1077. cmd = req->special;
  1078. } else if (req->flags & (REQ_CMD | REQ_BLOCK_PC)) {
  1079. if(unlikely(specials_only) && !(req->flags & REQ_SPECIAL)) {
  1080. if(specials_only == SDEV_QUIESCE ||
  1081. specials_only == SDEV_BLOCK)
  1082. goto defer;
  1083. sdev_printk(KERN_ERR, sdev,
  1084. "rejecting I/O to device being removed\n");
  1085. goto kill;
  1086. }
  1087. /*
  1088. * Now try and find a command block that we can use.
  1089. */
  1090. if (!req->special) {
  1091. cmd = scsi_get_command(sdev, GFP_ATOMIC);
  1092. if (unlikely(!cmd))
  1093. goto defer;
  1094. } else
  1095. cmd = req->special;
  1096. /* pull a tag out of the request if we have one */
  1097. cmd->tag = req->tag;
  1098. } else {
  1099. blk_dump_rq_flags(req, "SCSI bad req");
  1100. goto kill;
  1101. }
  1102. /* note the overloading of req->special. When the tag
  1103. * is active it always means cmd. If the tag goes
  1104. * back for re-queueing, it may be reset */
  1105. req->special = cmd;
  1106. cmd->request = req;
  1107. /*
  1108. * FIXME: drop the lock here because the functions below
  1109. * expect to be called without the queue lock held. Also,
  1110. * previously, we dequeued the request before dropping the
  1111. * lock. We hope REQ_STARTED prevents anything untoward from
  1112. * happening now.
  1113. */
  1114. if (req->flags & (REQ_CMD | REQ_BLOCK_PC)) {
  1115. int ret;
  1116. /*
  1117. * This will do a couple of things:
  1118. * 1) Fill in the actual SCSI command.
  1119. * 2) Fill in any other upper-level specific fields
  1120. * (timeout).
  1121. *
  1122. * If this returns 0, it means that the request failed
  1123. * (reading past end of disk, reading offline device,
  1124. * etc). This won't actually talk to the device, but
  1125. * some kinds of consistency checking may cause the
  1126. * request to be rejected immediately.
  1127. */
  1128. /*
  1129. * This sets up the scatter-gather table (allocating if
  1130. * required).
  1131. */
  1132. ret = scsi_init_io(cmd);
  1133. switch(ret) {
  1134. /* For BLKPREP_KILL/DEFER the cmd was released */
  1135. case BLKPREP_KILL:
  1136. goto kill;
  1137. case BLKPREP_DEFER:
  1138. goto defer;
  1139. }
  1140. /*
  1141. * Initialize the actual SCSI command for this request.
  1142. */
  1143. if (req->flags & REQ_BLOCK_PC) {
  1144. scsi_setup_blk_pc_cmnd(cmd);
  1145. } else if (req->rq_disk) {
  1146. struct scsi_driver *drv;
  1147. drv = *(struct scsi_driver **)req->rq_disk->private_data;
  1148. if (unlikely(!drv->init_command(cmd))) {
  1149. scsi_release_buffers(cmd);
  1150. scsi_put_command(cmd);
  1151. goto kill;
  1152. }
  1153. }
  1154. }
  1155. /*
  1156. * The request is now prepped, no need to come back here
  1157. */
  1158. req->flags |= REQ_DONTPREP;
  1159. return BLKPREP_OK;
  1160. defer:
  1161. /* If we defer, the elv_next_request() returns NULL, but the
  1162. * queue must be restarted, so we plug here if no returning
  1163. * command will automatically do that. */
  1164. if (sdev->device_busy == 0)
  1165. blk_plug_device(q);
  1166. return BLKPREP_DEFER;
  1167. kill:
  1168. req->errors = DID_NO_CONNECT << 16;
  1169. return BLKPREP_KILL;
  1170. }
  1171. /*
  1172. * scsi_dev_queue_ready: if we can send requests to sdev, return 1 else
  1173. * return 0.
  1174. *
  1175. * Called with the queue_lock held.
  1176. */
  1177. static inline int scsi_dev_queue_ready(struct request_queue *q,
  1178. struct scsi_device *sdev)
  1179. {
  1180. if (sdev->device_busy >= sdev->queue_depth)
  1181. return 0;
  1182. if (sdev->device_busy == 0 && sdev->device_blocked) {
  1183. /*
  1184. * unblock after device_blocked iterates to zero
  1185. */
  1186. if (--sdev->device_blocked == 0) {
  1187. SCSI_LOG_MLQUEUE(3,
  1188. sdev_printk(KERN_INFO, sdev,
  1189. "unblocking device at zero depth\n"));
  1190. } else {
  1191. blk_plug_device(q);
  1192. return 0;
  1193. }
  1194. }
  1195. if (sdev->device_blocked)
  1196. return 0;
  1197. return 1;
  1198. }
  1199. /*
  1200. * scsi_host_queue_ready: if we can send requests to shost, return 1 else
  1201. * return 0. We must end up running the queue again whenever 0 is
  1202. * returned, else IO can hang.
  1203. *
  1204. * Called with host_lock held.
  1205. */
  1206. static inline int scsi_host_queue_ready(struct request_queue *q,
  1207. struct Scsi_Host *shost,
  1208. struct scsi_device *sdev)
  1209. {
  1210. if (scsi_host_in_recovery(shost))
  1211. return 0;
  1212. if (shost->host_busy == 0 && shost->host_blocked) {
  1213. /*
  1214. * unblock after host_blocked iterates to zero
  1215. */
  1216. if (--shost->host_blocked == 0) {
  1217. SCSI_LOG_MLQUEUE(3,
  1218. printk("scsi%d unblocking host at zero depth\n",
  1219. shost->host_no));
  1220. } else {
  1221. blk_plug_device(q);
  1222. return 0;
  1223. }
  1224. }
  1225. if ((shost->can_queue > 0 && shost->host_busy >= shost->can_queue) ||
  1226. shost->host_blocked || shost->host_self_blocked) {
  1227. if (list_empty(&sdev->starved_entry))
  1228. list_add_tail(&sdev->starved_entry, &shost->starved_list);
  1229. return 0;
  1230. }
  1231. /* We're OK to process the command, so we can't be starved */
  1232. if (!list_empty(&sdev->starved_entry))
  1233. list_del_init(&sdev->starved_entry);
  1234. return 1;
  1235. }
  1236. /*
  1237. * Kill a request for a dead device
  1238. */
  1239. static void scsi_kill_request(struct request *req, request_queue_t *q)
  1240. {
  1241. struct scsi_cmnd *cmd = req->special;
  1242. struct scsi_device *sdev = cmd->device;
  1243. struct Scsi_Host *shost = sdev->host;
  1244. blkdev_dequeue_request(req);
  1245. if (unlikely(cmd == NULL)) {
  1246. printk(KERN_CRIT "impossible request in %s.\n",
  1247. __FUNCTION__);
  1248. BUG();
  1249. }
  1250. scsi_init_cmd_errh(cmd);
  1251. cmd->result = DID_NO_CONNECT << 16;
  1252. atomic_inc(&cmd->device->iorequest_cnt);
  1253. /*
  1254. * SCSI request completion path will do scsi_device_unbusy(),
  1255. * bump busy counts. To bump the counters, we need to dance
  1256. * with the locks as normal issue path does.
  1257. */
  1258. sdev->device_busy++;
  1259. spin_unlock(sdev->request_queue->queue_lock);
  1260. spin_lock(shost->host_lock);
  1261. shost->host_busy++;
  1262. spin_unlock(shost->host_lock);
  1263. spin_lock(sdev->request_queue->queue_lock);
  1264. __scsi_done(cmd);
  1265. }
  1266. static void scsi_softirq_done(struct request *rq)
  1267. {
  1268. struct scsi_cmnd *cmd = rq->completion_data;
  1269. unsigned long wait_for = (cmd->allowed + 1) * cmd->timeout_per_command;
  1270. int disposition;
  1271. INIT_LIST_HEAD(&cmd->eh_entry);
  1272. disposition = scsi_decide_disposition(cmd);
  1273. if (disposition != SUCCESS &&
  1274. time_before(cmd->jiffies_at_alloc + wait_for, jiffies)) {
  1275. sdev_printk(KERN_ERR, cmd->device,
  1276. "timing out command, waited %lus\n",
  1277. wait_for/HZ);
  1278. disposition = SUCCESS;
  1279. }
  1280. scsi_log_completion(cmd, disposition);
  1281. switch (disposition) {
  1282. case SUCCESS:
  1283. scsi_finish_command(cmd);
  1284. break;
  1285. case NEEDS_RETRY:
  1286. scsi_retry_command(cmd);
  1287. break;
  1288. case ADD_TO_MLQUEUE:
  1289. scsi_queue_insert(cmd, SCSI_MLQUEUE_DEVICE_BUSY);
  1290. break;
  1291. default:
  1292. if (!scsi_eh_scmd_add(cmd, 0))
  1293. scsi_finish_command(cmd);
  1294. }
  1295. }
  1296. /*
  1297. * Function: scsi_request_fn()
  1298. *
  1299. * Purpose: Main strategy routine for SCSI.
  1300. *
  1301. * Arguments: q - Pointer to actual queue.
  1302. *
  1303. * Returns: Nothing
  1304. *
  1305. * Lock status: IO request lock assumed to be held when called.
  1306. */
  1307. static void scsi_request_fn(struct request_queue *q)
  1308. {
  1309. struct scsi_device *sdev = q->queuedata;
  1310. struct Scsi_Host *shost;
  1311. struct scsi_cmnd *cmd;
  1312. struct request *req;
  1313. if (!sdev) {
  1314. printk("scsi: killing requests for dead queue\n");
  1315. while ((req = elv_next_request(q)) != NULL)
  1316. scsi_kill_request(req, q);
  1317. return;
  1318. }
  1319. if(!get_device(&sdev->sdev_gendev))
  1320. /* We must be tearing the block queue down already */
  1321. return;
  1322. /*
  1323. * To start with, we keep looping until the queue is empty, or until
  1324. * the host is no longer able to accept any more requests.
  1325. */
  1326. shost = sdev->host;
  1327. while (!blk_queue_plugged(q)) {
  1328. int rtn;
  1329. /*
  1330. * get next queueable request. We do this early to make sure
  1331. * that the request is fully prepared even if we cannot
  1332. * accept it.
  1333. */
  1334. req = elv_next_request(q);
  1335. if (!req || !scsi_dev_queue_ready(q, sdev))
  1336. break;
  1337. if (unlikely(!scsi_device_online(sdev))) {
  1338. sdev_printk(KERN_ERR, sdev,
  1339. "rejecting I/O to offline device\n");
  1340. scsi_kill_request(req, q);
  1341. continue;
  1342. }
  1343. /*
  1344. * Remove the request from the request list.
  1345. */
  1346. if (!(blk_queue_tagged(q) && !blk_queue_start_tag(q, req)))
  1347. blkdev_dequeue_request(req);
  1348. sdev->device_busy++;
  1349. spin_unlock(q->queue_lock);
  1350. cmd = req->special;
  1351. if (unlikely(cmd == NULL)) {
  1352. printk(KERN_CRIT "impossible request in %s.\n"
  1353. "please mail a stack trace to "
  1354. "linux-scsi@vger.kernel.org",
  1355. __FUNCTION__);
  1356. BUG();
  1357. }
  1358. spin_lock(shost->host_lock);
  1359. if (!scsi_host_queue_ready(q, shost, sdev))
  1360. goto not_ready;
  1361. if (sdev->single_lun) {
  1362. if (scsi_target(sdev)->starget_sdev_user &&
  1363. scsi_target(sdev)->starget_sdev_user != sdev)
  1364. goto not_ready;
  1365. scsi_target(sdev)->starget_sdev_user = sdev;
  1366. }
  1367. shost->host_busy++;
  1368. /*
  1369. * XXX(hch): This is rather suboptimal, scsi_dispatch_cmd will
  1370. * take the lock again.
  1371. */
  1372. spin_unlock_irq(shost->host_lock);
  1373. /*
  1374. * Finally, initialize any error handling parameters, and set up
  1375. * the timers for timeouts.
  1376. */
  1377. scsi_init_cmd_errh(cmd);
  1378. /*
  1379. * Dispatch the command to the low-level driver.
  1380. */
  1381. rtn = scsi_dispatch_cmd(cmd);
  1382. spin_lock_irq(q->queue_lock);
  1383. if(rtn) {
  1384. /* we're refusing the command; because of
  1385. * the way locks get dropped, we need to
  1386. * check here if plugging is required */
  1387. if(sdev->device_busy == 0)
  1388. blk_plug_device(q);
  1389. break;
  1390. }
  1391. }
  1392. goto out;
  1393. not_ready:
  1394. spin_unlock_irq(shost->host_lock);
  1395. /*
  1396. * lock q, handle tag, requeue req, and decrement device_busy. We
  1397. * must return with queue_lock held.
  1398. *
  1399. * Decrementing device_busy without checking it is OK, as all such
  1400. * cases (host limits or settings) should run the queue at some
  1401. * later time.
  1402. */
  1403. spin_lock_irq(q->queue_lock);
  1404. blk_requeue_request(q, req);
  1405. sdev->device_busy--;
  1406. if(sdev->device_busy == 0)
  1407. blk_plug_device(q);
  1408. out:
  1409. /* must be careful here...if we trigger the ->remove() function
  1410. * we cannot be holding the q lock */
  1411. spin_unlock_irq(q->queue_lock);
  1412. put_device(&sdev->sdev_gendev);
  1413. spin_lock_irq(q->queue_lock);
  1414. }
  1415. u64 scsi_calculate_bounce_limit(struct Scsi_Host *shost)
  1416. {
  1417. struct device *host_dev;
  1418. u64 bounce_limit = 0xffffffff;
  1419. if (shost->unchecked_isa_dma)
  1420. return BLK_BOUNCE_ISA;
  1421. /*
  1422. * Platforms with virtual-DMA translation
  1423. * hardware have no practical limit.
  1424. */
  1425. if (!PCI_DMA_BUS_IS_PHYS)
  1426. return BLK_BOUNCE_ANY;
  1427. host_dev = scsi_get_device(shost);
  1428. if (host_dev && host_dev->dma_mask)
  1429. bounce_limit = *host_dev->dma_mask;
  1430. return bounce_limit;
  1431. }
  1432. EXPORT_SYMBOL(scsi_calculate_bounce_limit);
  1433. struct request_queue *scsi_alloc_queue(struct scsi_device *sdev)
  1434. {
  1435. struct Scsi_Host *shost = sdev->host;
  1436. struct request_queue *q;
  1437. q = blk_init_queue(scsi_request_fn, NULL);
  1438. if (!q)
  1439. return NULL;
  1440. blk_queue_prep_rq(q, scsi_prep_fn);
  1441. blk_queue_max_hw_segments(q, shost->sg_tablesize);
  1442. blk_queue_max_phys_segments(q, SCSI_MAX_PHYS_SEGMENTS);
  1443. blk_queue_max_sectors(q, shost->max_sectors);
  1444. blk_queue_bounce_limit(q, scsi_calculate_bounce_limit(shost));
  1445. blk_queue_segment_boundary(q, shost->dma_boundary);
  1446. blk_queue_issue_flush_fn(q, scsi_issue_flush_fn);
  1447. blk_queue_softirq_done(q, scsi_softirq_done);
  1448. if (!shost->use_clustering)
  1449. clear_bit(QUEUE_FLAG_CLUSTER, &q->queue_flags);
  1450. return q;
  1451. }
  1452. void scsi_free_queue(struct request_queue *q)
  1453. {
  1454. blk_cleanup_queue(q);
  1455. }
  1456. /*
  1457. * Function: scsi_block_requests()
  1458. *
  1459. * Purpose: Utility function used by low-level drivers to prevent further
  1460. * commands from being queued to the device.
  1461. *
  1462. * Arguments: shost - Host in question
  1463. *
  1464. * Returns: Nothing
  1465. *
  1466. * Lock status: No locks are assumed held.
  1467. *
  1468. * Notes: There is no timer nor any other means by which the requests
  1469. * get unblocked other than the low-level driver calling
  1470. * scsi_unblock_requests().
  1471. */
  1472. void scsi_block_requests(struct Scsi_Host *shost)
  1473. {
  1474. shost->host_self_blocked = 1;
  1475. }
  1476. EXPORT_SYMBOL(scsi_block_requests);
  1477. /*
  1478. * Function: scsi_unblock_requests()
  1479. *
  1480. * Purpose: Utility function used by low-level drivers to allow further
  1481. * commands from being queued to the device.
  1482. *
  1483. * Arguments: shost - Host in question
  1484. *
  1485. * Returns: Nothing
  1486. *
  1487. * Lock status: No locks are assumed held.
  1488. *
  1489. * Notes: There is no timer nor any other means by which the requests
  1490. * get unblocked other than the low-level driver calling
  1491. * scsi_unblock_requests().
  1492. *
  1493. * This is done as an API function so that changes to the
  1494. * internals of the scsi mid-layer won't require wholesale
  1495. * changes to drivers that use this feature.
  1496. */
  1497. void scsi_unblock_requests(struct Scsi_Host *shost)
  1498. {
  1499. shost->host_self_blocked = 0;
  1500. scsi_run_host_queues(shost);
  1501. }
  1502. EXPORT_SYMBOL(scsi_unblock_requests);
  1503. int __init scsi_init_queue(void)
  1504. {
  1505. int i;
  1506. scsi_io_context_cache = kmem_cache_create("scsi_io_context",
  1507. sizeof(struct scsi_io_context),
  1508. 0, 0, NULL, NULL);
  1509. if (!scsi_io_context_cache) {
  1510. printk(KERN_ERR "SCSI: can't init scsi io context cache\n");
  1511. return -ENOMEM;
  1512. }
  1513. for (i = 0; i < SG_MEMPOOL_NR; i++) {
  1514. struct scsi_host_sg_pool *sgp = scsi_sg_pools + i;
  1515. int size = sgp->size * sizeof(struct scatterlist);
  1516. sgp->slab = kmem_cache_create(sgp->name, size, 0,
  1517. SLAB_HWCACHE_ALIGN, NULL, NULL);
  1518. if (!sgp->slab) {
  1519. printk(KERN_ERR "SCSI: can't init sg slab %s\n",
  1520. sgp->name);
  1521. }
  1522. sgp->pool = mempool_create_slab_pool(SG_MEMPOOL_SIZE,
  1523. sgp->slab);
  1524. if (!sgp->pool) {
  1525. printk(KERN_ERR "SCSI: can't init sg mempool %s\n",
  1526. sgp->name);
  1527. }
  1528. }
  1529. return 0;
  1530. }
  1531. void scsi_exit_queue(void)
  1532. {
  1533. int i;
  1534. kmem_cache_destroy(scsi_io_context_cache);
  1535. for (i = 0; i < SG_MEMPOOL_NR; i++) {
  1536. struct scsi_host_sg_pool *sgp = scsi_sg_pools + i;
  1537. mempool_destroy(sgp->pool);
  1538. kmem_cache_destroy(sgp->slab);
  1539. }
  1540. }
  1541. /**
  1542. * scsi_mode_select - issue a mode select
  1543. * @sdev: SCSI device to be queried
  1544. * @pf: Page format bit (1 == standard, 0 == vendor specific)
  1545. * @sp: Save page bit (0 == don't save, 1 == save)
  1546. * @modepage: mode page being requested
  1547. * @buffer: request buffer (may not be smaller than eight bytes)
  1548. * @len: length of request buffer.
  1549. * @timeout: command timeout
  1550. * @retries: number of retries before failing
  1551. * @data: returns a structure abstracting the mode header data
  1552. * @sense: place to put sense data (or NULL if no sense to be collected).
  1553. * must be SCSI_SENSE_BUFFERSIZE big.
  1554. *
  1555. * Returns zero if successful; negative error number or scsi
  1556. * status on error
  1557. *
  1558. */
  1559. int
  1560. scsi_mode_select(struct scsi_device *sdev, int pf, int sp, int modepage,
  1561. unsigned char *buffer, int len, int timeout, int retries,
  1562. struct scsi_mode_data *data, struct scsi_sense_hdr *sshdr)
  1563. {
  1564. unsigned char cmd[10];
  1565. unsigned char *real_buffer;
  1566. int ret;
  1567. memset(cmd, 0, sizeof(cmd));
  1568. cmd[1] = (pf ? 0x10 : 0) | (sp ? 0x01 : 0);
  1569. if (sdev->use_10_for_ms) {
  1570. if (len > 65535)
  1571. return -EINVAL;
  1572. real_buffer = kmalloc(8 + len, GFP_KERNEL);
  1573. if (!real_buffer)
  1574. return -ENOMEM;
  1575. memcpy(real_buffer + 8, buffer, len);
  1576. len += 8;
  1577. real_buffer[0] = 0;
  1578. real_buffer[1] = 0;
  1579. real_buffer[2] = data->medium_type;
  1580. real_buffer[3] = data->device_specific;
  1581. real_buffer[4] = data->longlba ? 0x01 : 0;
  1582. real_buffer[5] = 0;
  1583. real_buffer[6] = data->block_descriptor_length >> 8;
  1584. real_buffer[7] = data->block_descriptor_length;
  1585. cmd[0] = MODE_SELECT_10;
  1586. cmd[7] = len >> 8;
  1587. cmd[8] = len;
  1588. } else {
  1589. if (len > 255 || data->block_descriptor_length > 255 ||
  1590. data->longlba)
  1591. return -EINVAL;
  1592. real_buffer = kmalloc(4 + len, GFP_KERNEL);
  1593. if (!real_buffer)
  1594. return -ENOMEM;
  1595. memcpy(real_buffer + 4, buffer, len);
  1596. len += 4;
  1597. real_buffer[0] = 0;
  1598. real_buffer[1] = data->medium_type;
  1599. real_buffer[2] = data->device_specific;
  1600. real_buffer[3] = data->block_descriptor_length;
  1601. cmd[0] = MODE_SELECT;
  1602. cmd[4] = len;
  1603. }
  1604. ret = scsi_execute_req(sdev, cmd, DMA_TO_DEVICE, real_buffer, len,
  1605. sshdr, timeout, retries);
  1606. kfree(real_buffer);
  1607. return ret;
  1608. }
  1609. EXPORT_SYMBOL_GPL(scsi_mode_select);
  1610. /**
  1611. * scsi_mode_sense - issue a mode sense, falling back from 10 to
  1612. * six bytes if necessary.
  1613. * @sdev: SCSI device to be queried
  1614. * @dbd: set if mode sense will allow block descriptors to be returned
  1615. * @modepage: mode page being requested
  1616. * @buffer: request buffer (may not be smaller than eight bytes)
  1617. * @len: length of request buffer.
  1618. * @timeout: command timeout
  1619. * @retries: number of retries before failing
  1620. * @data: returns a structure abstracting the mode header data
  1621. * @sense: place to put sense data (or NULL if no sense to be collected).
  1622. * must be SCSI_SENSE_BUFFERSIZE big.
  1623. *
  1624. * Returns zero if unsuccessful, or the header offset (either 4
  1625. * or 8 depending on whether a six or ten byte command was
  1626. * issued) if successful.
  1627. **/
  1628. int
  1629. scsi_mode_sense(struct scsi_device *sdev, int dbd, int modepage,
  1630. unsigned char *buffer, int len, int timeout, int retries,
  1631. struct scsi_mode_data *data, struct scsi_sense_hdr *sshdr)
  1632. {
  1633. unsigned char cmd[12];
  1634. int use_10_for_ms;
  1635. int header_length;
  1636. int result;
  1637. struct scsi_sense_hdr my_sshdr;
  1638. memset(data, 0, sizeof(*data));
  1639. memset(&cmd[0], 0, 12);
  1640. cmd[1] = dbd & 0x18; /* allows DBD and LLBA bits */
  1641. cmd[2] = modepage;
  1642. /* caller might not be interested in sense, but we need it */
  1643. if (!sshdr)
  1644. sshdr = &my_sshdr;
  1645. retry:
  1646. use_10_for_ms = sdev->use_10_for_ms;
  1647. if (use_10_for_ms) {
  1648. if (len < 8)
  1649. len = 8;
  1650. cmd[0] = MODE_SENSE_10;
  1651. cmd[8] = len;
  1652. header_length = 8;
  1653. } else {
  1654. if (len < 4)
  1655. len = 4;
  1656. cmd[0] = MODE_SENSE;
  1657. cmd[4] = len;
  1658. header_length = 4;
  1659. }
  1660. memset(buffer, 0, len);
  1661. result = scsi_execute_req(sdev, cmd, DMA_FROM_DEVICE, buffer, len,
  1662. sshdr, timeout, retries);
  1663. /* This code looks awful: what it's doing is making sure an
  1664. * ILLEGAL REQUEST sense return identifies the actual command
  1665. * byte as the problem. MODE_SENSE commands can return
  1666. * ILLEGAL REQUEST if the code page isn't supported */
  1667. if (use_10_for_ms && !scsi_status_is_good(result) &&
  1668. (driver_byte(result) & DRIVER_SENSE)) {
  1669. if (scsi_sense_valid(sshdr)) {
  1670. if ((sshdr->sense_key == ILLEGAL_REQUEST) &&
  1671. (sshdr->asc == 0x20) && (sshdr->ascq == 0)) {
  1672. /*
  1673. * Invalid command operation code
  1674. */
  1675. sdev->use_10_for_ms = 0;
  1676. goto retry;
  1677. }
  1678. }
  1679. }
  1680. if(scsi_status_is_good(result)) {
  1681. if (unlikely(buffer[0] == 0x86 && buffer[1] == 0x0b &&
  1682. (modepage == 6 || modepage == 8))) {
  1683. /* Initio breakage? */
  1684. header_length = 0;
  1685. data->length = 13;
  1686. data->medium_type = 0;
  1687. data->device_specific = 0;
  1688. data->longlba = 0;
  1689. data->block_descriptor_length = 0;
  1690. } else if(use_10_for_ms) {
  1691. data->length = buffer[0]*256 + buffer[1] + 2;
  1692. data->medium_type = buffer[2];
  1693. data->device_specific = buffer[3];
  1694. data->longlba = buffer[4] & 0x01;
  1695. data->block_descriptor_length = buffer[6]*256
  1696. + buffer[7];
  1697. } else {
  1698. data->length = buffer[0] + 1;
  1699. data->medium_type = buffer[1];
  1700. data->device_specific = buffer[2];
  1701. data->block_descriptor_length = buffer[3];
  1702. }
  1703. data->header_length = header_length;
  1704. }
  1705. return result;
  1706. }
  1707. EXPORT_SYMBOL(scsi_mode_sense);
  1708. int
  1709. scsi_test_unit_ready(struct scsi_device *sdev, int timeout, int retries)
  1710. {
  1711. char cmd[] = {
  1712. TEST_UNIT_READY, 0, 0, 0, 0, 0,
  1713. };
  1714. struct scsi_sense_hdr sshdr;
  1715. int result;
  1716. result = scsi_execute_req(sdev, cmd, DMA_NONE, NULL, 0, &sshdr,
  1717. timeout, retries);
  1718. if ((driver_byte(result) & DRIVER_SENSE) && sdev->removable) {
  1719. if ((scsi_sense_valid(&sshdr)) &&
  1720. ((sshdr.sense_key == UNIT_ATTENTION) ||
  1721. (sshdr.sense_key == NOT_READY))) {
  1722. sdev->changed = 1;
  1723. result = 0;
  1724. }
  1725. }
  1726. return result;
  1727. }
  1728. EXPORT_SYMBOL(scsi_test_unit_ready);
  1729. /**
  1730. * scsi_device_set_state - Take the given device through the device
  1731. * state model.
  1732. * @sdev: scsi device to change the state of.
  1733. * @state: state to change to.
  1734. *
  1735. * Returns zero if unsuccessful or an error if the requested
  1736. * transition is illegal.
  1737. **/
  1738. int
  1739. scsi_device_set_state(struct scsi_device *sdev, enum scsi_device_state state)
  1740. {
  1741. enum scsi_device_state oldstate = sdev->sdev_state;
  1742. if (state == oldstate)
  1743. return 0;
  1744. switch (state) {
  1745. case SDEV_CREATED:
  1746. /* There are no legal states that come back to
  1747. * created. This is the manually initialised start
  1748. * state */
  1749. goto illegal;
  1750. case SDEV_RUNNING:
  1751. switch (oldstate) {
  1752. case SDEV_CREATED:
  1753. case SDEV_OFFLINE:
  1754. case SDEV_QUIESCE:
  1755. case SDEV_BLOCK:
  1756. break;
  1757. default:
  1758. goto illegal;
  1759. }
  1760. break;
  1761. case SDEV_QUIESCE:
  1762. switch (oldstate) {
  1763. case SDEV_RUNNING:
  1764. case SDEV_OFFLINE:
  1765. break;
  1766. default:
  1767. goto illegal;
  1768. }
  1769. break;
  1770. case SDEV_OFFLINE:
  1771. switch (oldstate) {
  1772. case SDEV_CREATED:
  1773. case SDEV_RUNNING:
  1774. case SDEV_QUIESCE:
  1775. case SDEV_BLOCK:
  1776. break;
  1777. default:
  1778. goto illegal;
  1779. }
  1780. break;
  1781. case SDEV_BLOCK:
  1782. switch (oldstate) {
  1783. case SDEV_CREATED:
  1784. case SDEV_RUNNING:
  1785. break;
  1786. default:
  1787. goto illegal;
  1788. }
  1789. break;
  1790. case SDEV_CANCEL:
  1791. switch (oldstate) {
  1792. case SDEV_CREATED:
  1793. case SDEV_RUNNING:
  1794. case SDEV_OFFLINE:
  1795. case SDEV_BLOCK:
  1796. break;
  1797. default:
  1798. goto illegal;
  1799. }
  1800. break;
  1801. case SDEV_DEL:
  1802. switch (oldstate) {
  1803. case SDEV_CANCEL:
  1804. break;
  1805. default:
  1806. goto illegal;
  1807. }
  1808. break;
  1809. }
  1810. sdev->sdev_state = state;
  1811. return 0;
  1812. illegal:
  1813. SCSI_LOG_ERROR_RECOVERY(1,
  1814. sdev_printk(KERN_ERR, sdev,
  1815. "Illegal state transition %s->%s\n",
  1816. scsi_device_state_name(oldstate),
  1817. scsi_device_state_name(state))
  1818. );
  1819. return -EINVAL;
  1820. }
  1821. EXPORT_SYMBOL(scsi_device_set_state);
  1822. /**
  1823. * scsi_device_quiesce - Block user issued commands.
  1824. * @sdev: scsi device to quiesce.
  1825. *
  1826. * This works by trying to transition to the SDEV_QUIESCE state
  1827. * (which must be a legal transition). When the device is in this
  1828. * state, only special requests will be accepted, all others will
  1829. * be deferred. Since special requests may also be requeued requests,
  1830. * a successful return doesn't guarantee the device will be
  1831. * totally quiescent.
  1832. *
  1833. * Must be called with user context, may sleep.
  1834. *
  1835. * Returns zero if unsuccessful or an error if not.
  1836. **/
  1837. int
  1838. scsi_device_quiesce(struct scsi_device *sdev)
  1839. {
  1840. int err = scsi_device_set_state(sdev, SDEV_QUIESCE);
  1841. if (err)
  1842. return err;
  1843. scsi_run_queue(sdev->request_queue);
  1844. while (sdev->device_busy) {
  1845. msleep_interruptible(200);
  1846. scsi_run_queue(sdev->request_queue);
  1847. }
  1848. return 0;
  1849. }
  1850. EXPORT_SYMBOL(scsi_device_quiesce);
  1851. /**
  1852. * scsi_device_resume - Restart user issued commands to a quiesced device.
  1853. * @sdev: scsi device to resume.
  1854. *
  1855. * Moves the device from quiesced back to running and restarts the
  1856. * queues.
  1857. *
  1858. * Must be called with user context, may sleep.
  1859. **/
  1860. void
  1861. scsi_device_resume(struct scsi_device *sdev)
  1862. {
  1863. if(scsi_device_set_state(sdev, SDEV_RUNNING))
  1864. return;
  1865. scsi_run_queue(sdev->request_queue);
  1866. }
  1867. EXPORT_SYMBOL(scsi_device_resume);
  1868. static void
  1869. device_quiesce_fn(struct scsi_device *sdev, void *data)
  1870. {
  1871. scsi_device_quiesce(sdev);
  1872. }
  1873. void
  1874. scsi_target_quiesce(struct scsi_target *starget)
  1875. {
  1876. starget_for_each_device(starget, NULL, device_quiesce_fn);
  1877. }
  1878. EXPORT_SYMBOL(scsi_target_quiesce);
  1879. static void
  1880. device_resume_fn(struct scsi_device *sdev, void *data)
  1881. {
  1882. scsi_device_resume(sdev);
  1883. }
  1884. void
  1885. scsi_target_resume(struct scsi_target *starget)
  1886. {
  1887. starget_for_each_device(starget, NULL, device_resume_fn);
  1888. }
  1889. EXPORT_SYMBOL(scsi_target_resume);
  1890. /**
  1891. * scsi_internal_device_block - internal function to put a device
  1892. * temporarily into the SDEV_BLOCK state
  1893. * @sdev: device to block
  1894. *
  1895. * Block request made by scsi lld's to temporarily stop all
  1896. * scsi commands on the specified device. Called from interrupt
  1897. * or normal process context.
  1898. *
  1899. * Returns zero if successful or error if not
  1900. *
  1901. * Notes:
  1902. * This routine transitions the device to the SDEV_BLOCK state
  1903. * (which must be a legal transition). When the device is in this
  1904. * state, all commands are deferred until the scsi lld reenables
  1905. * the device with scsi_device_unblock or device_block_tmo fires.
  1906. * This routine assumes the host_lock is held on entry.
  1907. **/
  1908. int
  1909. scsi_internal_device_block(struct scsi_device *sdev)
  1910. {
  1911. request_queue_t *q = sdev->request_queue;
  1912. unsigned long flags;
  1913. int err = 0;
  1914. err = scsi_device_set_state(sdev, SDEV_BLOCK);
  1915. if (err)
  1916. return err;
  1917. /*
  1918. * The device has transitioned to SDEV_BLOCK. Stop the
  1919. * block layer from calling the midlayer with this device's
  1920. * request queue.
  1921. */
  1922. spin_lock_irqsave(q->queue_lock, flags);
  1923. blk_stop_queue(q);
  1924. spin_unlock_irqrestore(q->queue_lock, flags);
  1925. return 0;
  1926. }
  1927. EXPORT_SYMBOL_GPL(scsi_internal_device_block);
  1928. /**
  1929. * scsi_internal_device_unblock - resume a device after a block request
  1930. * @sdev: device to resume
  1931. *
  1932. * Called by scsi lld's or the midlayer to restart the device queue
  1933. * for the previously suspended scsi device. Called from interrupt or
  1934. * normal process context.
  1935. *
  1936. * Returns zero if successful or error if not.
  1937. *
  1938. * Notes:
  1939. * This routine transitions the device to the SDEV_RUNNING state
  1940. * (which must be a legal transition) allowing the midlayer to
  1941. * goose the queue for this device. This routine assumes the
  1942. * host_lock is held upon entry.
  1943. **/
  1944. int
  1945. scsi_internal_device_unblock(struct scsi_device *sdev)
  1946. {
  1947. request_queue_t *q = sdev->request_queue;
  1948. int err;
  1949. unsigned long flags;
  1950. /*
  1951. * Try to transition the scsi device to SDEV_RUNNING
  1952. * and goose the device queue if successful.
  1953. */
  1954. err = scsi_device_set_state(sdev, SDEV_RUNNING);
  1955. if (err)
  1956. return err;
  1957. spin_lock_irqsave(q->queue_lock, flags);
  1958. blk_start_queue(q);
  1959. spin_unlock_irqrestore(q->queue_lock, flags);
  1960. return 0;
  1961. }
  1962. EXPORT_SYMBOL_GPL(scsi_internal_device_unblock);
  1963. static void
  1964. device_block(struct scsi_device *sdev, void *data)
  1965. {
  1966. scsi_internal_device_block(sdev);
  1967. }
  1968. static int
  1969. target_block(struct device *dev, void *data)
  1970. {
  1971. if (scsi_is_target_device(dev))
  1972. starget_for_each_device(to_scsi_target(dev), NULL,
  1973. device_block);
  1974. return 0;
  1975. }
  1976. void
  1977. scsi_target_block(struct device *dev)
  1978. {
  1979. if (scsi_is_target_device(dev))
  1980. starget_for_each_device(to_scsi_target(dev), NULL,
  1981. device_block);
  1982. else
  1983. device_for_each_child(dev, NULL, target_block);
  1984. }
  1985. EXPORT_SYMBOL_GPL(scsi_target_block);
  1986. static void
  1987. device_unblock(struct scsi_device *sdev, void *data)
  1988. {
  1989. scsi_internal_device_unblock(sdev);
  1990. }
  1991. static int
  1992. target_unblock(struct device *dev, void *data)
  1993. {
  1994. if (scsi_is_target_device(dev))
  1995. starget_for_each_device(to_scsi_target(dev), NULL,
  1996. device_unblock);
  1997. return 0;
  1998. }
  1999. void
  2000. scsi_target_unblock(struct device *dev)
  2001. {
  2002. if (scsi_is_target_device(dev))
  2003. starget_for_each_device(to_scsi_target(dev), NULL,
  2004. device_unblock);
  2005. else
  2006. device_for_each_child(dev, NULL, target_unblock);
  2007. }
  2008. EXPORT_SYMBOL_GPL(scsi_target_unblock);
  2009. /**
  2010. * scsi_kmap_atomic_sg - find and atomically map an sg-elemnt
  2011. * @sg: scatter-gather list
  2012. * @sg_count: number of segments in sg
  2013. * @offset: offset in bytes into sg, on return offset into the mapped area
  2014. * @len: bytes to map, on return number of bytes mapped
  2015. *
  2016. * Returns virtual address of the start of the mapped page
  2017. */
  2018. void *scsi_kmap_atomic_sg(struct scatterlist *sg, int sg_count,
  2019. size_t *offset, size_t *len)
  2020. {
  2021. int i;
  2022. size_t sg_len = 0, len_complete = 0;
  2023. struct page *page;
  2024. for (i = 0; i < sg_count; i++) {
  2025. len_complete = sg_len; /* Complete sg-entries */
  2026. sg_len += sg[i].length;
  2027. if (sg_len > *offset)
  2028. break;
  2029. }
  2030. if (unlikely(i == sg_count)) {
  2031. printk(KERN_ERR "%s: Bytes in sg: %zu, requested offset %zu, "
  2032. "elements %d\n",
  2033. __FUNCTION__, sg_len, *offset, sg_count);
  2034. WARN_ON(1);
  2035. return NULL;
  2036. }
  2037. /* Offset starting from the beginning of first page in this sg-entry */
  2038. *offset = *offset - len_complete + sg[i].offset;
  2039. /* Assumption: contiguous pages can be accessed as "page + i" */
  2040. page = nth_page(sg[i].page, (*offset >> PAGE_SHIFT));
  2041. *offset &= ~PAGE_MASK;
  2042. /* Bytes in this sg-entry from *offset to the end of the page */
  2043. sg_len = PAGE_SIZE - *offset;
  2044. if (*len > sg_len)
  2045. *len = sg_len;
  2046. return kmap_atomic(page, KM_BIO_SRC_IRQ);
  2047. }
  2048. EXPORT_SYMBOL(scsi_kmap_atomic_sg);
  2049. /**
  2050. * scsi_kunmap_atomic_sg - atomically unmap a virtual address, previously
  2051. * mapped with scsi_kmap_atomic_sg
  2052. * @virt: virtual address to be unmapped
  2053. */
  2054. void scsi_kunmap_atomic_sg(void *virt)
  2055. {
  2056. kunmap_atomic(virt, KM_BIO_SRC_IRQ);
  2057. }
  2058. EXPORT_SYMBOL(scsi_kunmap_atomic_sg);