ide-io.c 49 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764
  1. /*
  2. * IDE I/O functions
  3. *
  4. * Basic PIO and command management functionality.
  5. *
  6. * This code was split off from ide.c. See ide.c for history and original
  7. * copyrights.
  8. *
  9. * This program is free software; you can redistribute it and/or modify it
  10. * under the terms of the GNU General Public License as published by the
  11. * Free Software Foundation; either version 2, or (at your option) any
  12. * later version.
  13. *
  14. * This program is distributed in the hope that it will be useful, but
  15. * WITHOUT ANY WARRANTY; without even the implied warranty of
  16. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
  17. * General Public License for more details.
  18. *
  19. * For the avoidance of doubt the "preferred form" of this code is one which
  20. * is in an open non patent encumbered format. Where cryptographic key signing
  21. * forms part of the process of creating an executable the information
  22. * including keys needed to generate an equivalently functional executable
  23. * are deemed to be part of the source code.
  24. */
  25. #include <linux/module.h>
  26. #include <linux/types.h>
  27. #include <linux/string.h>
  28. #include <linux/kernel.h>
  29. #include <linux/timer.h>
  30. #include <linux/mm.h>
  31. #include <linux/interrupt.h>
  32. #include <linux/major.h>
  33. #include <linux/errno.h>
  34. #include <linux/genhd.h>
  35. #include <linux/blkpg.h>
  36. #include <linux/slab.h>
  37. #include <linux/init.h>
  38. #include <linux/pci.h>
  39. #include <linux/delay.h>
  40. #include <linux/ide.h>
  41. #include <linux/completion.h>
  42. #include <linux/reboot.h>
  43. #include <linux/cdrom.h>
  44. #include <linux/seq_file.h>
  45. #include <linux/device.h>
  46. #include <linux/kmod.h>
  47. #include <linux/scatterlist.h>
  48. #include <linux/bitops.h>
  49. #include <asm/byteorder.h>
  50. #include <asm/irq.h>
  51. #include <asm/uaccess.h>
  52. #include <asm/io.h>
  53. static int __ide_end_request(ide_drive_t *drive, struct request *rq,
  54. int uptodate, unsigned int nr_bytes, int dequeue)
  55. {
  56. int ret = 1;
  57. /*
  58. * if failfast is set on a request, override number of sectors and
  59. * complete the whole request right now
  60. */
  61. if (blk_noretry_request(rq) && end_io_error(uptodate))
  62. nr_bytes = rq->hard_nr_sectors << 9;
  63. if (!blk_fs_request(rq) && end_io_error(uptodate) && !rq->errors)
  64. rq->errors = -EIO;
  65. /*
  66. * decide whether to reenable DMA -- 3 is a random magic for now,
  67. * if we DMA timeout more than 3 times, just stay in PIO
  68. */
  69. if (drive->state == DMA_PIO_RETRY && drive->retry_pio <= 3) {
  70. drive->state = 0;
  71. ide_dma_on(drive);
  72. }
  73. if (!end_that_request_chunk(rq, uptodate, nr_bytes)) {
  74. add_disk_randomness(rq->rq_disk);
  75. if (dequeue) {
  76. if (!list_empty(&rq->queuelist))
  77. blkdev_dequeue_request(rq);
  78. HWGROUP(drive)->rq = NULL;
  79. }
  80. end_that_request_last(rq, uptodate);
  81. ret = 0;
  82. }
  83. return ret;
  84. }
  85. /**
  86. * ide_end_request - complete an IDE I/O
  87. * @drive: IDE device for the I/O
  88. * @uptodate:
  89. * @nr_sectors: number of sectors completed
  90. *
  91. * This is our end_request wrapper function. We complete the I/O
  92. * update random number input and dequeue the request, which if
  93. * it was tagged may be out of order.
  94. */
  95. int ide_end_request (ide_drive_t *drive, int uptodate, int nr_sectors)
  96. {
  97. unsigned int nr_bytes = nr_sectors << 9;
  98. struct request *rq;
  99. unsigned long flags;
  100. int ret = 1;
  101. /*
  102. * room for locking improvements here, the calls below don't
  103. * need the queue lock held at all
  104. */
  105. spin_lock_irqsave(&ide_lock, flags);
  106. rq = HWGROUP(drive)->rq;
  107. if (!nr_bytes) {
  108. if (blk_pc_request(rq))
  109. nr_bytes = rq->data_len;
  110. else
  111. nr_bytes = rq->hard_cur_sectors << 9;
  112. }
  113. ret = __ide_end_request(drive, rq, uptodate, nr_bytes, 1);
  114. spin_unlock_irqrestore(&ide_lock, flags);
  115. return ret;
  116. }
  117. EXPORT_SYMBOL(ide_end_request);
  118. /*
  119. * Power Management state machine. This one is rather trivial for now,
  120. * we should probably add more, like switching back to PIO on suspend
  121. * to help some BIOSes, re-do the door locking on resume, etc...
  122. */
  123. enum {
  124. ide_pm_flush_cache = ide_pm_state_start_suspend,
  125. idedisk_pm_standby,
  126. idedisk_pm_restore_pio = ide_pm_state_start_resume,
  127. idedisk_pm_idle,
  128. ide_pm_restore_dma,
  129. };
  130. static void ide_complete_power_step(ide_drive_t *drive, struct request *rq, u8 stat, u8 error)
  131. {
  132. struct request_pm_state *pm = rq->data;
  133. if (drive->media != ide_disk)
  134. return;
  135. switch (pm->pm_step) {
  136. case ide_pm_flush_cache: /* Suspend step 1 (flush cache) complete */
  137. if (pm->pm_state == PM_EVENT_FREEZE)
  138. pm->pm_step = ide_pm_state_completed;
  139. else
  140. pm->pm_step = idedisk_pm_standby;
  141. break;
  142. case idedisk_pm_standby: /* Suspend step 2 (standby) complete */
  143. pm->pm_step = ide_pm_state_completed;
  144. break;
  145. case idedisk_pm_restore_pio: /* Resume step 1 complete */
  146. pm->pm_step = idedisk_pm_idle;
  147. break;
  148. case idedisk_pm_idle: /* Resume step 2 (idle) complete */
  149. pm->pm_step = ide_pm_restore_dma;
  150. break;
  151. }
  152. }
  153. static ide_startstop_t ide_start_power_step(ide_drive_t *drive, struct request *rq)
  154. {
  155. struct request_pm_state *pm = rq->data;
  156. ide_task_t *args = rq->special;
  157. memset(args, 0, sizeof(*args));
  158. switch (pm->pm_step) {
  159. case ide_pm_flush_cache: /* Suspend step 1 (flush cache) */
  160. if (drive->media != ide_disk)
  161. break;
  162. /* Not supported? Switch to next step now. */
  163. if (!drive->wcache || !ide_id_has_flush_cache(drive->id)) {
  164. ide_complete_power_step(drive, rq, 0, 0);
  165. return ide_stopped;
  166. }
  167. if (ide_id_has_flush_cache_ext(drive->id))
  168. args->tf.command = WIN_FLUSH_CACHE_EXT;
  169. else
  170. args->tf.command = WIN_FLUSH_CACHE;
  171. goto out_do_tf;
  172. case idedisk_pm_standby: /* Suspend step 2 (standby) */
  173. args->tf.command = WIN_STANDBYNOW1;
  174. goto out_do_tf;
  175. case idedisk_pm_restore_pio: /* Resume step 1 (restore PIO) */
  176. ide_set_max_pio(drive);
  177. /*
  178. * skip idedisk_pm_idle for ATAPI devices
  179. */
  180. if (drive->media != ide_disk)
  181. pm->pm_step = ide_pm_restore_dma;
  182. else
  183. ide_complete_power_step(drive, rq, 0, 0);
  184. return ide_stopped;
  185. case idedisk_pm_idle: /* Resume step 2 (idle) */
  186. args->tf.command = WIN_IDLEIMMEDIATE;
  187. goto out_do_tf;
  188. case ide_pm_restore_dma: /* Resume step 3 (restore DMA) */
  189. /*
  190. * Right now, all we do is call ide_set_dma(drive),
  191. * we could be smarter and check for current xfer_speed
  192. * in struct drive etc...
  193. */
  194. if (drive->hwif->dma_host_set == NULL)
  195. break;
  196. /*
  197. * TODO: respect ->using_dma setting
  198. */
  199. ide_set_dma(drive);
  200. break;
  201. }
  202. pm->pm_step = ide_pm_state_completed;
  203. return ide_stopped;
  204. out_do_tf:
  205. args->tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
  206. args->data_phase = TASKFILE_NO_DATA;
  207. return do_rw_taskfile(drive, args);
  208. }
  209. /**
  210. * ide_end_dequeued_request - complete an IDE I/O
  211. * @drive: IDE device for the I/O
  212. * @uptodate:
  213. * @nr_sectors: number of sectors completed
  214. *
  215. * Complete an I/O that is no longer on the request queue. This
  216. * typically occurs when we pull the request and issue a REQUEST_SENSE.
  217. * We must still finish the old request but we must not tamper with the
  218. * queue in the meantime.
  219. *
  220. * NOTE: This path does not handle barrier, but barrier is not supported
  221. * on ide-cd anyway.
  222. */
  223. int ide_end_dequeued_request(ide_drive_t *drive, struct request *rq,
  224. int uptodate, int nr_sectors)
  225. {
  226. unsigned long flags;
  227. int ret;
  228. spin_lock_irqsave(&ide_lock, flags);
  229. BUG_ON(!blk_rq_started(rq));
  230. ret = __ide_end_request(drive, rq, uptodate, nr_sectors << 9, 0);
  231. spin_unlock_irqrestore(&ide_lock, flags);
  232. return ret;
  233. }
  234. EXPORT_SYMBOL_GPL(ide_end_dequeued_request);
  235. /**
  236. * ide_complete_pm_request - end the current Power Management request
  237. * @drive: target drive
  238. * @rq: request
  239. *
  240. * This function cleans up the current PM request and stops the queue
  241. * if necessary.
  242. */
  243. static void ide_complete_pm_request (ide_drive_t *drive, struct request *rq)
  244. {
  245. unsigned long flags;
  246. #ifdef DEBUG_PM
  247. printk("%s: completing PM request, %s\n", drive->name,
  248. blk_pm_suspend_request(rq) ? "suspend" : "resume");
  249. #endif
  250. spin_lock_irqsave(&ide_lock, flags);
  251. if (blk_pm_suspend_request(rq)) {
  252. blk_stop_queue(drive->queue);
  253. } else {
  254. drive->blocked = 0;
  255. blk_start_queue(drive->queue);
  256. }
  257. blkdev_dequeue_request(rq);
  258. HWGROUP(drive)->rq = NULL;
  259. end_that_request_last(rq, 1);
  260. spin_unlock_irqrestore(&ide_lock, flags);
  261. }
  262. void ide_tf_read(ide_drive_t *drive, ide_task_t *task)
  263. {
  264. ide_hwif_t *hwif = drive->hwif;
  265. struct ide_taskfile *tf = &task->tf;
  266. if (task->tf_flags & IDE_TFLAG_IN_DATA) {
  267. u16 data = hwif->INW(IDE_DATA_REG);
  268. tf->data = data & 0xff;
  269. tf->hob_data = (data >> 8) & 0xff;
  270. }
  271. /* be sure we're looking at the low order bits */
  272. hwif->OUTB(drive->ctl & ~0x80, IDE_CONTROL_REG);
  273. if (task->tf_flags & IDE_TFLAG_IN_NSECT)
  274. tf->nsect = hwif->INB(IDE_NSECTOR_REG);
  275. if (task->tf_flags & IDE_TFLAG_IN_LBAL)
  276. tf->lbal = hwif->INB(IDE_SECTOR_REG);
  277. if (task->tf_flags & IDE_TFLAG_IN_LBAM)
  278. tf->lbam = hwif->INB(IDE_LCYL_REG);
  279. if (task->tf_flags & IDE_TFLAG_IN_LBAH)
  280. tf->lbah = hwif->INB(IDE_HCYL_REG);
  281. if (task->tf_flags & IDE_TFLAG_IN_DEVICE)
  282. tf->device = hwif->INB(IDE_SELECT_REG);
  283. if (task->tf_flags & IDE_TFLAG_LBA48) {
  284. hwif->OUTB(drive->ctl | 0x80, IDE_CONTROL_REG);
  285. if (task->tf_flags & IDE_TFLAG_IN_HOB_FEATURE)
  286. tf->hob_feature = hwif->INB(IDE_FEATURE_REG);
  287. if (task->tf_flags & IDE_TFLAG_IN_HOB_NSECT)
  288. tf->hob_nsect = hwif->INB(IDE_NSECTOR_REG);
  289. if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAL)
  290. tf->hob_lbal = hwif->INB(IDE_SECTOR_REG);
  291. if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAM)
  292. tf->hob_lbam = hwif->INB(IDE_LCYL_REG);
  293. if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAH)
  294. tf->hob_lbah = hwif->INB(IDE_HCYL_REG);
  295. }
  296. }
  297. /**
  298. * ide_end_drive_cmd - end an explicit drive command
  299. * @drive: command
  300. * @stat: status bits
  301. * @err: error bits
  302. *
  303. * Clean up after success/failure of an explicit drive command.
  304. * These get thrown onto the queue so they are synchronized with
  305. * real I/O operations on the drive.
  306. *
  307. * In LBA48 mode we have to read the register set twice to get
  308. * all the extra information out.
  309. */
  310. void ide_end_drive_cmd (ide_drive_t *drive, u8 stat, u8 err)
  311. {
  312. ide_hwif_t *hwif = HWIF(drive);
  313. unsigned long flags;
  314. struct request *rq;
  315. spin_lock_irqsave(&ide_lock, flags);
  316. rq = HWGROUP(drive)->rq;
  317. spin_unlock_irqrestore(&ide_lock, flags);
  318. if (rq->cmd_type == REQ_TYPE_ATA_CMD) {
  319. u8 *args = (u8 *) rq->buffer;
  320. if (rq->errors == 0)
  321. rq->errors = !OK_STAT(stat,READY_STAT,BAD_STAT);
  322. if (args) {
  323. args[0] = stat;
  324. args[1] = err;
  325. /* be sure we're looking at the low order bits */
  326. hwif->OUTB(drive->ctl & ~0x80, IDE_CONTROL_REG);
  327. args[2] = hwif->INB(IDE_NSECTOR_REG);
  328. }
  329. } else if (rq->cmd_type == REQ_TYPE_ATA_TASKFILE) {
  330. ide_task_t *args = (ide_task_t *) rq->special;
  331. if (rq->errors == 0)
  332. rq->errors = !OK_STAT(stat,READY_STAT,BAD_STAT);
  333. if (args) {
  334. struct ide_taskfile *tf = &args->tf;
  335. tf->error = err;
  336. tf->status = stat;
  337. ide_tf_read(drive, args);
  338. }
  339. } else if (blk_pm_request(rq)) {
  340. struct request_pm_state *pm = rq->data;
  341. #ifdef DEBUG_PM
  342. printk("%s: complete_power_step(step: %d, stat: %x, err: %x)\n",
  343. drive->name, rq->pm->pm_step, stat, err);
  344. #endif
  345. ide_complete_power_step(drive, rq, stat, err);
  346. if (pm->pm_step == ide_pm_state_completed)
  347. ide_complete_pm_request(drive, rq);
  348. return;
  349. }
  350. spin_lock_irqsave(&ide_lock, flags);
  351. blkdev_dequeue_request(rq);
  352. HWGROUP(drive)->rq = NULL;
  353. rq->errors = err;
  354. end_that_request_last(rq, !rq->errors);
  355. spin_unlock_irqrestore(&ide_lock, flags);
  356. }
  357. EXPORT_SYMBOL(ide_end_drive_cmd);
  358. /**
  359. * try_to_flush_leftover_data - flush junk
  360. * @drive: drive to flush
  361. *
  362. * try_to_flush_leftover_data() is invoked in response to a drive
  363. * unexpectedly having its DRQ_STAT bit set. As an alternative to
  364. * resetting the drive, this routine tries to clear the condition
  365. * by read a sector's worth of data from the drive. Of course,
  366. * this may not help if the drive is *waiting* for data from *us*.
  367. */
  368. static void try_to_flush_leftover_data (ide_drive_t *drive)
  369. {
  370. int i = (drive->mult_count ? drive->mult_count : 1) * SECTOR_WORDS;
  371. if (drive->media != ide_disk)
  372. return;
  373. while (i > 0) {
  374. u32 buffer[16];
  375. u32 wcount = (i > 16) ? 16 : i;
  376. i -= wcount;
  377. HWIF(drive)->ata_input_data(drive, buffer, wcount);
  378. }
  379. }
  380. static void ide_kill_rq(ide_drive_t *drive, struct request *rq)
  381. {
  382. if (rq->rq_disk) {
  383. ide_driver_t *drv;
  384. drv = *(ide_driver_t **)rq->rq_disk->private_data;
  385. drv->end_request(drive, 0, 0);
  386. } else
  387. ide_end_request(drive, 0, 0);
  388. }
  389. static ide_startstop_t ide_ata_error(ide_drive_t *drive, struct request *rq, u8 stat, u8 err)
  390. {
  391. ide_hwif_t *hwif = drive->hwif;
  392. if (stat & BUSY_STAT || ((stat & WRERR_STAT) && !drive->nowerr)) {
  393. /* other bits are useless when BUSY */
  394. rq->errors |= ERROR_RESET;
  395. } else if (stat & ERR_STAT) {
  396. /* err has different meaning on cdrom and tape */
  397. if (err == ABRT_ERR) {
  398. if (drive->select.b.lba &&
  399. /* some newer drives don't support WIN_SPECIFY */
  400. hwif->INB(IDE_COMMAND_REG) == WIN_SPECIFY)
  401. return ide_stopped;
  402. } else if ((err & BAD_CRC) == BAD_CRC) {
  403. /* UDMA crc error, just retry the operation */
  404. drive->crc_count++;
  405. } else if (err & (BBD_ERR | ECC_ERR)) {
  406. /* retries won't help these */
  407. rq->errors = ERROR_MAX;
  408. } else if (err & TRK0_ERR) {
  409. /* help it find track zero */
  410. rq->errors |= ERROR_RECAL;
  411. }
  412. }
  413. if ((stat & DRQ_STAT) && rq_data_dir(rq) == READ &&
  414. (hwif->host_flags & IDE_HFLAG_ERROR_STOPS_FIFO) == 0)
  415. try_to_flush_leftover_data(drive);
  416. if (rq->errors >= ERROR_MAX || blk_noretry_request(rq)) {
  417. ide_kill_rq(drive, rq);
  418. return ide_stopped;
  419. }
  420. if (hwif->INB(IDE_STATUS_REG) & (BUSY_STAT|DRQ_STAT))
  421. rq->errors |= ERROR_RESET;
  422. if ((rq->errors & ERROR_RESET) == ERROR_RESET) {
  423. ++rq->errors;
  424. return ide_do_reset(drive);
  425. }
  426. if ((rq->errors & ERROR_RECAL) == ERROR_RECAL)
  427. drive->special.b.recalibrate = 1;
  428. ++rq->errors;
  429. return ide_stopped;
  430. }
  431. static ide_startstop_t ide_atapi_error(ide_drive_t *drive, struct request *rq, u8 stat, u8 err)
  432. {
  433. ide_hwif_t *hwif = drive->hwif;
  434. if (stat & BUSY_STAT || ((stat & WRERR_STAT) && !drive->nowerr)) {
  435. /* other bits are useless when BUSY */
  436. rq->errors |= ERROR_RESET;
  437. } else {
  438. /* add decoding error stuff */
  439. }
  440. if (hwif->INB(IDE_STATUS_REG) & (BUSY_STAT|DRQ_STAT))
  441. /* force an abort */
  442. hwif->OUTB(WIN_IDLEIMMEDIATE, IDE_COMMAND_REG);
  443. if (rq->errors >= ERROR_MAX) {
  444. ide_kill_rq(drive, rq);
  445. } else {
  446. if ((rq->errors & ERROR_RESET) == ERROR_RESET) {
  447. ++rq->errors;
  448. return ide_do_reset(drive);
  449. }
  450. ++rq->errors;
  451. }
  452. return ide_stopped;
  453. }
  454. ide_startstop_t
  455. __ide_error(ide_drive_t *drive, struct request *rq, u8 stat, u8 err)
  456. {
  457. if (drive->media == ide_disk)
  458. return ide_ata_error(drive, rq, stat, err);
  459. return ide_atapi_error(drive, rq, stat, err);
  460. }
  461. EXPORT_SYMBOL_GPL(__ide_error);
  462. /**
  463. * ide_error - handle an error on the IDE
  464. * @drive: drive the error occurred on
  465. * @msg: message to report
  466. * @stat: status bits
  467. *
  468. * ide_error() takes action based on the error returned by the drive.
  469. * For normal I/O that may well include retries. We deal with
  470. * both new-style (taskfile) and old style command handling here.
  471. * In the case of taskfile command handling there is work left to
  472. * do
  473. */
  474. ide_startstop_t ide_error (ide_drive_t *drive, const char *msg, u8 stat)
  475. {
  476. struct request *rq;
  477. u8 err;
  478. err = ide_dump_status(drive, msg, stat);
  479. if ((rq = HWGROUP(drive)->rq) == NULL)
  480. return ide_stopped;
  481. /* retry only "normal" I/O: */
  482. if (!blk_fs_request(rq)) {
  483. rq->errors = 1;
  484. ide_end_drive_cmd(drive, stat, err);
  485. return ide_stopped;
  486. }
  487. if (rq->rq_disk) {
  488. ide_driver_t *drv;
  489. drv = *(ide_driver_t **)rq->rq_disk->private_data;
  490. return drv->error(drive, rq, stat, err);
  491. } else
  492. return __ide_error(drive, rq, stat, err);
  493. }
  494. EXPORT_SYMBOL_GPL(ide_error);
  495. ide_startstop_t __ide_abort(ide_drive_t *drive, struct request *rq)
  496. {
  497. if (drive->media != ide_disk)
  498. rq->errors |= ERROR_RESET;
  499. ide_kill_rq(drive, rq);
  500. return ide_stopped;
  501. }
  502. EXPORT_SYMBOL_GPL(__ide_abort);
  503. /**
  504. * ide_abort - abort pending IDE operations
  505. * @drive: drive the error occurred on
  506. * @msg: message to report
  507. *
  508. * ide_abort kills and cleans up when we are about to do a
  509. * host initiated reset on active commands. Longer term we
  510. * want handlers to have sensible abort handling themselves
  511. *
  512. * This differs fundamentally from ide_error because in
  513. * this case the command is doing just fine when we
  514. * blow it away.
  515. */
  516. ide_startstop_t ide_abort(ide_drive_t *drive, const char *msg)
  517. {
  518. struct request *rq;
  519. if (drive == NULL || (rq = HWGROUP(drive)->rq) == NULL)
  520. return ide_stopped;
  521. /* retry only "normal" I/O: */
  522. if (!blk_fs_request(rq)) {
  523. rq->errors = 1;
  524. ide_end_drive_cmd(drive, BUSY_STAT, 0);
  525. return ide_stopped;
  526. }
  527. if (rq->rq_disk) {
  528. ide_driver_t *drv;
  529. drv = *(ide_driver_t **)rq->rq_disk->private_data;
  530. return drv->abort(drive, rq);
  531. } else
  532. return __ide_abort(drive, rq);
  533. }
  534. /**
  535. * drive_cmd_intr - drive command completion interrupt
  536. * @drive: drive the completion interrupt occurred on
  537. *
  538. * drive_cmd_intr() is invoked on completion of a special DRIVE_CMD.
  539. * We do any necessary data reading and then wait for the drive to
  540. * go non busy. At that point we may read the error data and complete
  541. * the request
  542. */
  543. static ide_startstop_t drive_cmd_intr (ide_drive_t *drive)
  544. {
  545. struct request *rq = HWGROUP(drive)->rq;
  546. ide_hwif_t *hwif = HWIF(drive);
  547. u8 *args = (u8 *) rq->buffer;
  548. u8 stat = hwif->INB(IDE_STATUS_REG);
  549. local_irq_enable_in_hardirq();
  550. if (rq->cmd_type == REQ_TYPE_ATA_CMD &&
  551. (stat & DRQ_STAT) && args && args[3]) {
  552. u8 io_32bit = drive->io_32bit;
  553. drive->io_32bit = 0;
  554. hwif->ata_input_data(drive, &args[4], args[3] * SECTOR_WORDS);
  555. drive->io_32bit = io_32bit;
  556. stat = wait_drive_not_busy(drive);
  557. }
  558. if (!OK_STAT(stat, READY_STAT, BAD_STAT))
  559. return ide_error(drive, "drive_cmd", stat);
  560. /* calls ide_end_drive_cmd */
  561. ide_end_drive_cmd(drive, stat, hwif->INB(IDE_ERROR_REG));
  562. return ide_stopped;
  563. }
  564. static void ide_tf_set_specify_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
  565. {
  566. tf->nsect = drive->sect;
  567. tf->lbal = drive->sect;
  568. tf->lbam = drive->cyl;
  569. tf->lbah = drive->cyl >> 8;
  570. tf->device = ((drive->head - 1) | drive->select.all) & ~ATA_LBA;
  571. tf->command = WIN_SPECIFY;
  572. }
  573. static void ide_tf_set_restore_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
  574. {
  575. tf->nsect = drive->sect;
  576. tf->command = WIN_RESTORE;
  577. }
  578. static void ide_tf_set_setmult_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
  579. {
  580. tf->nsect = drive->mult_req;
  581. tf->command = WIN_SETMULT;
  582. }
  583. static ide_startstop_t ide_disk_special(ide_drive_t *drive)
  584. {
  585. special_t *s = &drive->special;
  586. ide_task_t args;
  587. memset(&args, 0, sizeof(ide_task_t));
  588. args.data_phase = TASKFILE_NO_DATA;
  589. if (s->b.set_geometry) {
  590. s->b.set_geometry = 0;
  591. ide_tf_set_specify_cmd(drive, &args.tf);
  592. } else if (s->b.recalibrate) {
  593. s->b.recalibrate = 0;
  594. ide_tf_set_restore_cmd(drive, &args.tf);
  595. } else if (s->b.set_multmode) {
  596. s->b.set_multmode = 0;
  597. if (drive->mult_req > drive->id->max_multsect)
  598. drive->mult_req = drive->id->max_multsect;
  599. ide_tf_set_setmult_cmd(drive, &args.tf);
  600. } else if (s->all) {
  601. int special = s->all;
  602. s->all = 0;
  603. printk(KERN_ERR "%s: bad special flag: 0x%02x\n", drive->name, special);
  604. return ide_stopped;
  605. }
  606. args.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE |
  607. IDE_TFLAG_CUSTOM_HANDLER;
  608. do_rw_taskfile(drive, &args);
  609. return ide_started;
  610. }
  611. /*
  612. * handle HDIO_SET_PIO_MODE ioctl abusers here, eventually it will go away
  613. */
  614. static int set_pio_mode_abuse(ide_hwif_t *hwif, u8 req_pio)
  615. {
  616. switch (req_pio) {
  617. case 202:
  618. case 201:
  619. case 200:
  620. case 102:
  621. case 101:
  622. case 100:
  623. return (hwif->host_flags & IDE_HFLAG_ABUSE_DMA_MODES) ? 1 : 0;
  624. case 9:
  625. case 8:
  626. return (hwif->host_flags & IDE_HFLAG_ABUSE_PREFETCH) ? 1 : 0;
  627. case 7:
  628. case 6:
  629. return (hwif->host_flags & IDE_HFLAG_ABUSE_FAST_DEVSEL) ? 1 : 0;
  630. default:
  631. return 0;
  632. }
  633. }
  634. /**
  635. * do_special - issue some special commands
  636. * @drive: drive the command is for
  637. *
  638. * do_special() is used to issue WIN_SPECIFY, WIN_RESTORE, and WIN_SETMULT
  639. * commands to a drive. It used to do much more, but has been scaled
  640. * back.
  641. */
  642. static ide_startstop_t do_special (ide_drive_t *drive)
  643. {
  644. special_t *s = &drive->special;
  645. #ifdef DEBUG
  646. printk("%s: do_special: 0x%02x\n", drive->name, s->all);
  647. #endif
  648. if (s->b.set_tune) {
  649. ide_hwif_t *hwif = drive->hwif;
  650. u8 req_pio = drive->tune_req;
  651. s->b.set_tune = 0;
  652. if (set_pio_mode_abuse(drive->hwif, req_pio)) {
  653. if (hwif->set_pio_mode == NULL)
  654. return ide_stopped;
  655. /*
  656. * take ide_lock for drive->[no_]unmask/[no_]io_32bit
  657. */
  658. if (req_pio == 8 || req_pio == 9) {
  659. unsigned long flags;
  660. spin_lock_irqsave(&ide_lock, flags);
  661. hwif->set_pio_mode(drive, req_pio);
  662. spin_unlock_irqrestore(&ide_lock, flags);
  663. } else
  664. hwif->set_pio_mode(drive, req_pio);
  665. } else {
  666. int keep_dma = drive->using_dma;
  667. ide_set_pio(drive, req_pio);
  668. if (hwif->host_flags & IDE_HFLAG_SET_PIO_MODE_KEEP_DMA) {
  669. if (keep_dma)
  670. ide_dma_on(drive);
  671. }
  672. }
  673. return ide_stopped;
  674. } else {
  675. if (drive->media == ide_disk)
  676. return ide_disk_special(drive);
  677. s->all = 0;
  678. drive->mult_req = 0;
  679. return ide_stopped;
  680. }
  681. }
  682. void ide_map_sg(ide_drive_t *drive, struct request *rq)
  683. {
  684. ide_hwif_t *hwif = drive->hwif;
  685. struct scatterlist *sg = hwif->sg_table;
  686. if (hwif->sg_mapped) /* needed by ide-scsi */
  687. return;
  688. if (rq->cmd_type != REQ_TYPE_ATA_TASKFILE) {
  689. hwif->sg_nents = blk_rq_map_sg(drive->queue, rq, sg);
  690. } else {
  691. sg_init_one(sg, rq->buffer, rq->nr_sectors * SECTOR_SIZE);
  692. hwif->sg_nents = 1;
  693. }
  694. }
  695. EXPORT_SYMBOL_GPL(ide_map_sg);
  696. void ide_init_sg_cmd(ide_drive_t *drive, struct request *rq)
  697. {
  698. ide_hwif_t *hwif = drive->hwif;
  699. hwif->nsect = hwif->nleft = rq->nr_sectors;
  700. hwif->cursg_ofs = 0;
  701. hwif->cursg = NULL;
  702. }
  703. EXPORT_SYMBOL_GPL(ide_init_sg_cmd);
  704. /**
  705. * execute_drive_command - issue special drive command
  706. * @drive: the drive to issue the command on
  707. * @rq: the request structure holding the command
  708. *
  709. * execute_drive_cmd() issues a special drive command, usually
  710. * initiated by ioctl() from the external hdparm program. The
  711. * command can be a drive command, drive task or taskfile
  712. * operation. Weirdly you can call it with NULL to wait for
  713. * all commands to finish. Don't do this as that is due to change
  714. */
  715. static ide_startstop_t execute_drive_cmd (ide_drive_t *drive,
  716. struct request *rq)
  717. {
  718. ide_hwif_t *hwif = HWIF(drive);
  719. u8 *args = rq->buffer;
  720. ide_task_t ltask;
  721. struct ide_taskfile *tf = &ltask.tf;
  722. if (rq->cmd_type == REQ_TYPE_ATA_TASKFILE) {
  723. ide_task_t *task = rq->special;
  724. if (task == NULL)
  725. goto done;
  726. hwif->data_phase = task->data_phase;
  727. switch (hwif->data_phase) {
  728. case TASKFILE_MULTI_OUT:
  729. case TASKFILE_OUT:
  730. case TASKFILE_MULTI_IN:
  731. case TASKFILE_IN:
  732. ide_init_sg_cmd(drive, rq);
  733. ide_map_sg(drive, rq);
  734. default:
  735. break;
  736. }
  737. return do_rw_taskfile(drive, task);
  738. }
  739. if (args == NULL)
  740. goto done;
  741. memset(&ltask, 0, sizeof(ltask));
  742. if (rq->cmd_type == REQ_TYPE_ATA_CMD) {
  743. #ifdef DEBUG
  744. printk("%s: DRIVE_CMD\n", drive->name);
  745. #endif
  746. tf->feature = args[2];
  747. if (args[0] == WIN_SMART) {
  748. tf->nsect = args[3];
  749. tf->lbal = args[1];
  750. tf->lbam = 0x4f;
  751. tf->lbah = 0xc2;
  752. ltask.tf_flags = IDE_TFLAG_OUT_TF;
  753. } else {
  754. tf->nsect = args[1];
  755. ltask.tf_flags = IDE_TFLAG_OUT_FEATURE |
  756. IDE_TFLAG_OUT_NSECT;
  757. }
  758. }
  759. tf->command = args[0];
  760. ide_tf_load(drive, &ltask);
  761. ide_execute_command(drive, args[0], &drive_cmd_intr, WAIT_WORSTCASE, NULL);
  762. return ide_started;
  763. done:
  764. /*
  765. * NULL is actually a valid way of waiting for
  766. * all current requests to be flushed from the queue.
  767. */
  768. #ifdef DEBUG
  769. printk("%s: DRIVE_CMD (null)\n", drive->name);
  770. #endif
  771. ide_end_drive_cmd(drive,
  772. hwif->INB(IDE_STATUS_REG),
  773. hwif->INB(IDE_ERROR_REG));
  774. return ide_stopped;
  775. }
  776. static void ide_check_pm_state(ide_drive_t *drive, struct request *rq)
  777. {
  778. struct request_pm_state *pm = rq->data;
  779. if (blk_pm_suspend_request(rq) &&
  780. pm->pm_step == ide_pm_state_start_suspend)
  781. /* Mark drive blocked when starting the suspend sequence. */
  782. drive->blocked = 1;
  783. else if (blk_pm_resume_request(rq) &&
  784. pm->pm_step == ide_pm_state_start_resume) {
  785. /*
  786. * The first thing we do on wakeup is to wait for BSY bit to
  787. * go away (with a looong timeout) as a drive on this hwif may
  788. * just be POSTing itself.
  789. * We do that before even selecting as the "other" device on
  790. * the bus may be broken enough to walk on our toes at this
  791. * point.
  792. */
  793. int rc;
  794. #ifdef DEBUG_PM
  795. printk("%s: Wakeup request inited, waiting for !BSY...\n", drive->name);
  796. #endif
  797. rc = ide_wait_not_busy(HWIF(drive), 35000);
  798. if (rc)
  799. printk(KERN_WARNING "%s: bus not ready on wakeup\n", drive->name);
  800. SELECT_DRIVE(drive);
  801. ide_set_irq(drive, 1);
  802. rc = ide_wait_not_busy(HWIF(drive), 100000);
  803. if (rc)
  804. printk(KERN_WARNING "%s: drive not ready on wakeup\n", drive->name);
  805. }
  806. }
  807. /**
  808. * start_request - start of I/O and command issuing for IDE
  809. *
  810. * start_request() initiates handling of a new I/O request. It
  811. * accepts commands and I/O (read/write) requests. It also does
  812. * the final remapping for weird stuff like EZDrive. Once
  813. * device mapper can work sector level the EZDrive stuff can go away
  814. *
  815. * FIXME: this function needs a rename
  816. */
  817. static ide_startstop_t start_request (ide_drive_t *drive, struct request *rq)
  818. {
  819. ide_startstop_t startstop;
  820. sector_t block;
  821. BUG_ON(!blk_rq_started(rq));
  822. #ifdef DEBUG
  823. printk("%s: start_request: current=0x%08lx\n",
  824. HWIF(drive)->name, (unsigned long) rq);
  825. #endif
  826. /* bail early if we've exceeded max_failures */
  827. if (drive->max_failures && (drive->failures > drive->max_failures)) {
  828. rq->cmd_flags |= REQ_FAILED;
  829. goto kill_rq;
  830. }
  831. block = rq->sector;
  832. if (blk_fs_request(rq) &&
  833. (drive->media == ide_disk || drive->media == ide_floppy)) {
  834. block += drive->sect0;
  835. }
  836. /* Yecch - this will shift the entire interval,
  837. possibly killing some innocent following sector */
  838. if (block == 0 && drive->remap_0_to_1 == 1)
  839. block = 1; /* redirect MBR access to EZ-Drive partn table */
  840. if (blk_pm_request(rq))
  841. ide_check_pm_state(drive, rq);
  842. SELECT_DRIVE(drive);
  843. if (ide_wait_stat(&startstop, drive, drive->ready_stat, BUSY_STAT|DRQ_STAT, WAIT_READY)) {
  844. printk(KERN_ERR "%s: drive not ready for command\n", drive->name);
  845. return startstop;
  846. }
  847. if (!drive->special.all) {
  848. ide_driver_t *drv;
  849. /*
  850. * We reset the drive so we need to issue a SETFEATURES.
  851. * Do it _after_ do_special() restored device parameters.
  852. */
  853. if (drive->current_speed == 0xff)
  854. ide_config_drive_speed(drive, drive->desired_speed);
  855. if (rq->cmd_type == REQ_TYPE_ATA_CMD ||
  856. rq->cmd_type == REQ_TYPE_ATA_TASKFILE)
  857. return execute_drive_cmd(drive, rq);
  858. else if (blk_pm_request(rq)) {
  859. struct request_pm_state *pm = rq->data;
  860. #ifdef DEBUG_PM
  861. printk("%s: start_power_step(step: %d)\n",
  862. drive->name, rq->pm->pm_step);
  863. #endif
  864. startstop = ide_start_power_step(drive, rq);
  865. if (startstop == ide_stopped &&
  866. pm->pm_step == ide_pm_state_completed)
  867. ide_complete_pm_request(drive, rq);
  868. return startstop;
  869. }
  870. drv = *(ide_driver_t **)rq->rq_disk->private_data;
  871. return drv->do_request(drive, rq, block);
  872. }
  873. return do_special(drive);
  874. kill_rq:
  875. ide_kill_rq(drive, rq);
  876. return ide_stopped;
  877. }
  878. /**
  879. * ide_stall_queue - pause an IDE device
  880. * @drive: drive to stall
  881. * @timeout: time to stall for (jiffies)
  882. *
  883. * ide_stall_queue() can be used by a drive to give excess bandwidth back
  884. * to the hwgroup by sleeping for timeout jiffies.
  885. */
  886. void ide_stall_queue (ide_drive_t *drive, unsigned long timeout)
  887. {
  888. if (timeout > WAIT_WORSTCASE)
  889. timeout = WAIT_WORSTCASE;
  890. drive->sleep = timeout + jiffies;
  891. drive->sleeping = 1;
  892. }
  893. EXPORT_SYMBOL(ide_stall_queue);
  894. #define WAKEUP(drive) ((drive)->service_start + 2 * (drive)->service_time)
  895. /**
  896. * choose_drive - select a drive to service
  897. * @hwgroup: hardware group to select on
  898. *
  899. * choose_drive() selects the next drive which will be serviced.
  900. * This is necessary because the IDE layer can't issue commands
  901. * to both drives on the same cable, unlike SCSI.
  902. */
  903. static inline ide_drive_t *choose_drive (ide_hwgroup_t *hwgroup)
  904. {
  905. ide_drive_t *drive, *best;
  906. repeat:
  907. best = NULL;
  908. drive = hwgroup->drive;
  909. /*
  910. * drive is doing pre-flush, ordered write, post-flush sequence. even
  911. * though that is 3 requests, it must be seen as a single transaction.
  912. * we must not preempt this drive until that is complete
  913. */
  914. if (blk_queue_flushing(drive->queue)) {
  915. /*
  916. * small race where queue could get replugged during
  917. * the 3-request flush cycle, just yank the plug since
  918. * we want it to finish asap
  919. */
  920. blk_remove_plug(drive->queue);
  921. return drive;
  922. }
  923. do {
  924. if ((!drive->sleeping || time_after_eq(jiffies, drive->sleep))
  925. && !elv_queue_empty(drive->queue)) {
  926. if (!best
  927. || (drive->sleeping && (!best->sleeping || time_before(drive->sleep, best->sleep)))
  928. || (!best->sleeping && time_before(WAKEUP(drive), WAKEUP(best))))
  929. {
  930. if (!blk_queue_plugged(drive->queue))
  931. best = drive;
  932. }
  933. }
  934. } while ((drive = drive->next) != hwgroup->drive);
  935. if (best && best->nice1 && !best->sleeping && best != hwgroup->drive && best->service_time > WAIT_MIN_SLEEP) {
  936. long t = (signed long)(WAKEUP(best) - jiffies);
  937. if (t >= WAIT_MIN_SLEEP) {
  938. /*
  939. * We *may* have some time to spare, but first let's see if
  940. * someone can potentially benefit from our nice mood today..
  941. */
  942. drive = best->next;
  943. do {
  944. if (!drive->sleeping
  945. && time_before(jiffies - best->service_time, WAKEUP(drive))
  946. && time_before(WAKEUP(drive), jiffies + t))
  947. {
  948. ide_stall_queue(best, min_t(long, t, 10 * WAIT_MIN_SLEEP));
  949. goto repeat;
  950. }
  951. } while ((drive = drive->next) != best);
  952. }
  953. }
  954. return best;
  955. }
  956. /*
  957. * Issue a new request to a drive from hwgroup
  958. * Caller must have already done spin_lock_irqsave(&ide_lock, ..);
  959. *
  960. * A hwgroup is a serialized group of IDE interfaces. Usually there is
  961. * exactly one hwif (interface) per hwgroup, but buggy controllers (eg. CMD640)
  962. * may have both interfaces in a single hwgroup to "serialize" access.
  963. * Or possibly multiple ISA interfaces can share a common IRQ by being grouped
  964. * together into one hwgroup for serialized access.
  965. *
  966. * Note also that several hwgroups can end up sharing a single IRQ,
  967. * possibly along with many other devices. This is especially common in
  968. * PCI-based systems with off-board IDE controller cards.
  969. *
  970. * The IDE driver uses the single global ide_lock spinlock to protect
  971. * access to the request queues, and to protect the hwgroup->busy flag.
  972. *
  973. * The first thread into the driver for a particular hwgroup sets the
  974. * hwgroup->busy flag to indicate that this hwgroup is now active,
  975. * and then initiates processing of the top request from the request queue.
  976. *
  977. * Other threads attempting entry notice the busy setting, and will simply
  978. * queue their new requests and exit immediately. Note that hwgroup->busy
  979. * remains set even when the driver is merely awaiting the next interrupt.
  980. * Thus, the meaning is "this hwgroup is busy processing a request".
  981. *
  982. * When processing of a request completes, the completing thread or IRQ-handler
  983. * will start the next request from the queue. If no more work remains,
  984. * the driver will clear the hwgroup->busy flag and exit.
  985. *
  986. * The ide_lock (spinlock) is used to protect all access to the
  987. * hwgroup->busy flag, but is otherwise not needed for most processing in
  988. * the driver. This makes the driver much more friendlier to shared IRQs
  989. * than previous designs, while remaining 100% (?) SMP safe and capable.
  990. */
  991. static void ide_do_request (ide_hwgroup_t *hwgroup, int masked_irq)
  992. {
  993. ide_drive_t *drive;
  994. ide_hwif_t *hwif;
  995. struct request *rq;
  996. ide_startstop_t startstop;
  997. int loops = 0;
  998. /* for atari only: POSSIBLY BROKEN HERE(?) */
  999. ide_get_lock(ide_intr, hwgroup);
  1000. /* caller must own ide_lock */
  1001. BUG_ON(!irqs_disabled());
  1002. while (!hwgroup->busy) {
  1003. hwgroup->busy = 1;
  1004. drive = choose_drive(hwgroup);
  1005. if (drive == NULL) {
  1006. int sleeping = 0;
  1007. unsigned long sleep = 0; /* shut up, gcc */
  1008. hwgroup->rq = NULL;
  1009. drive = hwgroup->drive;
  1010. do {
  1011. if (drive->sleeping && (!sleeping || time_before(drive->sleep, sleep))) {
  1012. sleeping = 1;
  1013. sleep = drive->sleep;
  1014. }
  1015. } while ((drive = drive->next) != hwgroup->drive);
  1016. if (sleeping) {
  1017. /*
  1018. * Take a short snooze, and then wake up this hwgroup again.
  1019. * This gives other hwgroups on the same a chance to
  1020. * play fairly with us, just in case there are big differences
  1021. * in relative throughputs.. don't want to hog the cpu too much.
  1022. */
  1023. if (time_before(sleep, jiffies + WAIT_MIN_SLEEP))
  1024. sleep = jiffies + WAIT_MIN_SLEEP;
  1025. #if 1
  1026. if (timer_pending(&hwgroup->timer))
  1027. printk(KERN_CRIT "ide_set_handler: timer already active\n");
  1028. #endif
  1029. /* so that ide_timer_expiry knows what to do */
  1030. hwgroup->sleeping = 1;
  1031. hwgroup->req_gen_timer = hwgroup->req_gen;
  1032. mod_timer(&hwgroup->timer, sleep);
  1033. /* we purposely leave hwgroup->busy==1
  1034. * while sleeping */
  1035. } else {
  1036. /* Ugly, but how can we sleep for the lock
  1037. * otherwise? perhaps from tq_disk?
  1038. */
  1039. /* for atari only */
  1040. ide_release_lock();
  1041. hwgroup->busy = 0;
  1042. }
  1043. /* no more work for this hwgroup (for now) */
  1044. return;
  1045. }
  1046. again:
  1047. hwif = HWIF(drive);
  1048. if (hwgroup->hwif->sharing_irq && hwif != hwgroup->hwif) {
  1049. /*
  1050. * set nIEN for previous hwif, drives in the
  1051. * quirk_list may not like intr setups/cleanups
  1052. */
  1053. if (drive->quirk_list != 1)
  1054. ide_set_irq(drive, 0);
  1055. }
  1056. hwgroup->hwif = hwif;
  1057. hwgroup->drive = drive;
  1058. drive->sleeping = 0;
  1059. drive->service_start = jiffies;
  1060. if (blk_queue_plugged(drive->queue)) {
  1061. printk(KERN_ERR "ide: huh? queue was plugged!\n");
  1062. break;
  1063. }
  1064. /*
  1065. * we know that the queue isn't empty, but this can happen
  1066. * if the q->prep_rq_fn() decides to kill a request
  1067. */
  1068. rq = elv_next_request(drive->queue);
  1069. if (!rq) {
  1070. hwgroup->busy = 0;
  1071. break;
  1072. }
  1073. /*
  1074. * Sanity: don't accept a request that isn't a PM request
  1075. * if we are currently power managed. This is very important as
  1076. * blk_stop_queue() doesn't prevent the elv_next_request()
  1077. * above to return us whatever is in the queue. Since we call
  1078. * ide_do_request() ourselves, we end up taking requests while
  1079. * the queue is blocked...
  1080. *
  1081. * We let requests forced at head of queue with ide-preempt
  1082. * though. I hope that doesn't happen too much, hopefully not
  1083. * unless the subdriver triggers such a thing in its own PM
  1084. * state machine.
  1085. *
  1086. * We count how many times we loop here to make sure we service
  1087. * all drives in the hwgroup without looping for ever
  1088. */
  1089. if (drive->blocked && !blk_pm_request(rq) && !(rq->cmd_flags & REQ_PREEMPT)) {
  1090. drive = drive->next ? drive->next : hwgroup->drive;
  1091. if (loops++ < 4 && !blk_queue_plugged(drive->queue))
  1092. goto again;
  1093. /* We clear busy, there should be no pending ATA command at this point. */
  1094. hwgroup->busy = 0;
  1095. break;
  1096. }
  1097. hwgroup->rq = rq;
  1098. /*
  1099. * Some systems have trouble with IDE IRQs arriving while
  1100. * the driver is still setting things up. So, here we disable
  1101. * the IRQ used by this interface while the request is being started.
  1102. * This may look bad at first, but pretty much the same thing
  1103. * happens anyway when any interrupt comes in, IDE or otherwise
  1104. * -- the kernel masks the IRQ while it is being handled.
  1105. */
  1106. if (masked_irq != IDE_NO_IRQ && hwif->irq != masked_irq)
  1107. disable_irq_nosync(hwif->irq);
  1108. spin_unlock(&ide_lock);
  1109. local_irq_enable_in_hardirq();
  1110. /* allow other IRQs while we start this request */
  1111. startstop = start_request(drive, rq);
  1112. spin_lock_irq(&ide_lock);
  1113. if (masked_irq != IDE_NO_IRQ && hwif->irq != masked_irq)
  1114. enable_irq(hwif->irq);
  1115. if (startstop == ide_stopped)
  1116. hwgroup->busy = 0;
  1117. }
  1118. }
  1119. /*
  1120. * Passes the stuff to ide_do_request
  1121. */
  1122. void do_ide_request(struct request_queue *q)
  1123. {
  1124. ide_drive_t *drive = q->queuedata;
  1125. ide_do_request(HWGROUP(drive), IDE_NO_IRQ);
  1126. }
  1127. /*
  1128. * un-busy the hwgroup etc, and clear any pending DMA status. we want to
  1129. * retry the current request in pio mode instead of risking tossing it
  1130. * all away
  1131. */
  1132. static ide_startstop_t ide_dma_timeout_retry(ide_drive_t *drive, int error)
  1133. {
  1134. ide_hwif_t *hwif = HWIF(drive);
  1135. struct request *rq;
  1136. ide_startstop_t ret = ide_stopped;
  1137. /*
  1138. * end current dma transaction
  1139. */
  1140. if (error < 0) {
  1141. printk(KERN_WARNING "%s: DMA timeout error\n", drive->name);
  1142. (void)HWIF(drive)->ide_dma_end(drive);
  1143. ret = ide_error(drive, "dma timeout error",
  1144. hwif->INB(IDE_STATUS_REG));
  1145. } else {
  1146. printk(KERN_WARNING "%s: DMA timeout retry\n", drive->name);
  1147. hwif->dma_timeout(drive);
  1148. }
  1149. /*
  1150. * disable dma for now, but remember that we did so because of
  1151. * a timeout -- we'll reenable after we finish this next request
  1152. * (or rather the first chunk of it) in pio.
  1153. */
  1154. drive->retry_pio++;
  1155. drive->state = DMA_PIO_RETRY;
  1156. ide_dma_off_quietly(drive);
  1157. /*
  1158. * un-busy drive etc (hwgroup->busy is cleared on return) and
  1159. * make sure request is sane
  1160. */
  1161. rq = HWGROUP(drive)->rq;
  1162. if (!rq)
  1163. goto out;
  1164. HWGROUP(drive)->rq = NULL;
  1165. rq->errors = 0;
  1166. if (!rq->bio)
  1167. goto out;
  1168. rq->sector = rq->bio->bi_sector;
  1169. rq->current_nr_sectors = bio_iovec(rq->bio)->bv_len >> 9;
  1170. rq->hard_cur_sectors = rq->current_nr_sectors;
  1171. rq->buffer = bio_data(rq->bio);
  1172. out:
  1173. return ret;
  1174. }
  1175. /**
  1176. * ide_timer_expiry - handle lack of an IDE interrupt
  1177. * @data: timer callback magic (hwgroup)
  1178. *
  1179. * An IDE command has timed out before the expected drive return
  1180. * occurred. At this point we attempt to clean up the current
  1181. * mess. If the current handler includes an expiry handler then
  1182. * we invoke the expiry handler, and providing it is happy the
  1183. * work is done. If that fails we apply generic recovery rules
  1184. * invoking the handler and checking the drive DMA status. We
  1185. * have an excessively incestuous relationship with the DMA
  1186. * logic that wants cleaning up.
  1187. */
  1188. void ide_timer_expiry (unsigned long data)
  1189. {
  1190. ide_hwgroup_t *hwgroup = (ide_hwgroup_t *) data;
  1191. ide_handler_t *handler;
  1192. ide_expiry_t *expiry;
  1193. unsigned long flags;
  1194. unsigned long wait = -1;
  1195. spin_lock_irqsave(&ide_lock, flags);
  1196. if (((handler = hwgroup->handler) == NULL) ||
  1197. (hwgroup->req_gen != hwgroup->req_gen_timer)) {
  1198. /*
  1199. * Either a marginal timeout occurred
  1200. * (got the interrupt just as timer expired),
  1201. * or we were "sleeping" to give other devices a chance.
  1202. * Either way, we don't really want to complain about anything.
  1203. */
  1204. if (hwgroup->sleeping) {
  1205. hwgroup->sleeping = 0;
  1206. hwgroup->busy = 0;
  1207. }
  1208. } else {
  1209. ide_drive_t *drive = hwgroup->drive;
  1210. if (!drive) {
  1211. printk(KERN_ERR "ide_timer_expiry: hwgroup->drive was NULL\n");
  1212. hwgroup->handler = NULL;
  1213. } else {
  1214. ide_hwif_t *hwif;
  1215. ide_startstop_t startstop = ide_stopped;
  1216. if (!hwgroup->busy) {
  1217. hwgroup->busy = 1; /* paranoia */
  1218. printk(KERN_ERR "%s: ide_timer_expiry: hwgroup->busy was 0 ??\n", drive->name);
  1219. }
  1220. if ((expiry = hwgroup->expiry) != NULL) {
  1221. /* continue */
  1222. if ((wait = expiry(drive)) > 0) {
  1223. /* reset timer */
  1224. hwgroup->timer.expires = jiffies + wait;
  1225. hwgroup->req_gen_timer = hwgroup->req_gen;
  1226. add_timer(&hwgroup->timer);
  1227. spin_unlock_irqrestore(&ide_lock, flags);
  1228. return;
  1229. }
  1230. }
  1231. hwgroup->handler = NULL;
  1232. /*
  1233. * We need to simulate a real interrupt when invoking
  1234. * the handler() function, which means we need to
  1235. * globally mask the specific IRQ:
  1236. */
  1237. spin_unlock(&ide_lock);
  1238. hwif = HWIF(drive);
  1239. /* disable_irq_nosync ?? */
  1240. disable_irq(hwif->irq);
  1241. /* local CPU only,
  1242. * as if we were handling an interrupt */
  1243. local_irq_disable();
  1244. if (hwgroup->polling) {
  1245. startstop = handler(drive);
  1246. } else if (drive_is_ready(drive)) {
  1247. if (drive->waiting_for_dma)
  1248. hwgroup->hwif->dma_lost_irq(drive);
  1249. (void)ide_ack_intr(hwif);
  1250. printk(KERN_WARNING "%s: lost interrupt\n", drive->name);
  1251. startstop = handler(drive);
  1252. } else {
  1253. if (drive->waiting_for_dma) {
  1254. startstop = ide_dma_timeout_retry(drive, wait);
  1255. } else
  1256. startstop =
  1257. ide_error(drive, "irq timeout", hwif->INB(IDE_STATUS_REG));
  1258. }
  1259. drive->service_time = jiffies - drive->service_start;
  1260. spin_lock_irq(&ide_lock);
  1261. enable_irq(hwif->irq);
  1262. if (startstop == ide_stopped)
  1263. hwgroup->busy = 0;
  1264. }
  1265. }
  1266. ide_do_request(hwgroup, IDE_NO_IRQ);
  1267. spin_unlock_irqrestore(&ide_lock, flags);
  1268. }
  1269. /**
  1270. * unexpected_intr - handle an unexpected IDE interrupt
  1271. * @irq: interrupt line
  1272. * @hwgroup: hwgroup being processed
  1273. *
  1274. * There's nothing really useful we can do with an unexpected interrupt,
  1275. * other than reading the status register (to clear it), and logging it.
  1276. * There should be no way that an irq can happen before we're ready for it,
  1277. * so we needn't worry much about losing an "important" interrupt here.
  1278. *
  1279. * On laptops (and "green" PCs), an unexpected interrupt occurs whenever
  1280. * the drive enters "idle", "standby", or "sleep" mode, so if the status
  1281. * looks "good", we just ignore the interrupt completely.
  1282. *
  1283. * This routine assumes __cli() is in effect when called.
  1284. *
  1285. * If an unexpected interrupt happens on irq15 while we are handling irq14
  1286. * and if the two interfaces are "serialized" (CMD640), then it looks like
  1287. * we could screw up by interfering with a new request being set up for
  1288. * irq15.
  1289. *
  1290. * In reality, this is a non-issue. The new command is not sent unless
  1291. * the drive is ready to accept one, in which case we know the drive is
  1292. * not trying to interrupt us. And ide_set_handler() is always invoked
  1293. * before completing the issuance of any new drive command, so we will not
  1294. * be accidentally invoked as a result of any valid command completion
  1295. * interrupt.
  1296. *
  1297. * Note that we must walk the entire hwgroup here. We know which hwif
  1298. * is doing the current command, but we don't know which hwif burped
  1299. * mysteriously.
  1300. */
  1301. static void unexpected_intr (int irq, ide_hwgroup_t *hwgroup)
  1302. {
  1303. u8 stat;
  1304. ide_hwif_t *hwif = hwgroup->hwif;
  1305. /*
  1306. * handle the unexpected interrupt
  1307. */
  1308. do {
  1309. if (hwif->irq == irq) {
  1310. stat = hwif->INB(hwif->io_ports[IDE_STATUS_OFFSET]);
  1311. if (!OK_STAT(stat, READY_STAT, BAD_STAT)) {
  1312. /* Try to not flood the console with msgs */
  1313. static unsigned long last_msgtime, count;
  1314. ++count;
  1315. if (time_after(jiffies, last_msgtime + HZ)) {
  1316. last_msgtime = jiffies;
  1317. printk(KERN_ERR "%s%s: unexpected interrupt, "
  1318. "status=0x%02x, count=%ld\n",
  1319. hwif->name,
  1320. (hwif->next==hwgroup->hwif) ? "" : "(?)", stat, count);
  1321. }
  1322. }
  1323. }
  1324. } while ((hwif = hwif->next) != hwgroup->hwif);
  1325. }
  1326. /**
  1327. * ide_intr - default IDE interrupt handler
  1328. * @irq: interrupt number
  1329. * @dev_id: hwif group
  1330. * @regs: unused weirdness from the kernel irq layer
  1331. *
  1332. * This is the default IRQ handler for the IDE layer. You should
  1333. * not need to override it. If you do be aware it is subtle in
  1334. * places
  1335. *
  1336. * hwgroup->hwif is the interface in the group currently performing
  1337. * a command. hwgroup->drive is the drive and hwgroup->handler is
  1338. * the IRQ handler to call. As we issue a command the handlers
  1339. * step through multiple states, reassigning the handler to the
  1340. * next step in the process. Unlike a smart SCSI controller IDE
  1341. * expects the main processor to sequence the various transfer
  1342. * stages. We also manage a poll timer to catch up with most
  1343. * timeout situations. There are still a few where the handlers
  1344. * don't ever decide to give up.
  1345. *
  1346. * The handler eventually returns ide_stopped to indicate the
  1347. * request completed. At this point we issue the next request
  1348. * on the hwgroup and the process begins again.
  1349. */
  1350. irqreturn_t ide_intr (int irq, void *dev_id)
  1351. {
  1352. unsigned long flags;
  1353. ide_hwgroup_t *hwgroup = (ide_hwgroup_t *)dev_id;
  1354. ide_hwif_t *hwif;
  1355. ide_drive_t *drive;
  1356. ide_handler_t *handler;
  1357. ide_startstop_t startstop;
  1358. spin_lock_irqsave(&ide_lock, flags);
  1359. hwif = hwgroup->hwif;
  1360. if (!ide_ack_intr(hwif)) {
  1361. spin_unlock_irqrestore(&ide_lock, flags);
  1362. return IRQ_NONE;
  1363. }
  1364. if ((handler = hwgroup->handler) == NULL || hwgroup->polling) {
  1365. /*
  1366. * Not expecting an interrupt from this drive.
  1367. * That means this could be:
  1368. * (1) an interrupt from another PCI device
  1369. * sharing the same PCI INT# as us.
  1370. * or (2) a drive just entered sleep or standby mode,
  1371. * and is interrupting to let us know.
  1372. * or (3) a spurious interrupt of unknown origin.
  1373. *
  1374. * For PCI, we cannot tell the difference,
  1375. * so in that case we just ignore it and hope it goes away.
  1376. *
  1377. * FIXME: unexpected_intr should be hwif-> then we can
  1378. * remove all the ifdef PCI crap
  1379. */
  1380. #ifdef CONFIG_BLK_DEV_IDEPCI
  1381. if (hwif->pci_dev && !hwif->pci_dev->vendor)
  1382. #endif /* CONFIG_BLK_DEV_IDEPCI */
  1383. {
  1384. /*
  1385. * Probably not a shared PCI interrupt,
  1386. * so we can safely try to do something about it:
  1387. */
  1388. unexpected_intr(irq, hwgroup);
  1389. #ifdef CONFIG_BLK_DEV_IDEPCI
  1390. } else {
  1391. /*
  1392. * Whack the status register, just in case
  1393. * we have a leftover pending IRQ.
  1394. */
  1395. (void) hwif->INB(hwif->io_ports[IDE_STATUS_OFFSET]);
  1396. #endif /* CONFIG_BLK_DEV_IDEPCI */
  1397. }
  1398. spin_unlock_irqrestore(&ide_lock, flags);
  1399. return IRQ_NONE;
  1400. }
  1401. drive = hwgroup->drive;
  1402. if (!drive) {
  1403. /*
  1404. * This should NEVER happen, and there isn't much
  1405. * we could do about it here.
  1406. *
  1407. * [Note - this can occur if the drive is hot unplugged]
  1408. */
  1409. spin_unlock_irqrestore(&ide_lock, flags);
  1410. return IRQ_HANDLED;
  1411. }
  1412. if (!drive_is_ready(drive)) {
  1413. /*
  1414. * This happens regularly when we share a PCI IRQ with
  1415. * another device. Unfortunately, it can also happen
  1416. * with some buggy drives that trigger the IRQ before
  1417. * their status register is up to date. Hopefully we have
  1418. * enough advance overhead that the latter isn't a problem.
  1419. */
  1420. spin_unlock_irqrestore(&ide_lock, flags);
  1421. return IRQ_NONE;
  1422. }
  1423. if (!hwgroup->busy) {
  1424. hwgroup->busy = 1; /* paranoia */
  1425. printk(KERN_ERR "%s: ide_intr: hwgroup->busy was 0 ??\n", drive->name);
  1426. }
  1427. hwgroup->handler = NULL;
  1428. hwgroup->req_gen++;
  1429. del_timer(&hwgroup->timer);
  1430. spin_unlock(&ide_lock);
  1431. /* Some controllers might set DMA INTR no matter DMA or PIO;
  1432. * bmdma status might need to be cleared even for
  1433. * PIO interrupts to prevent spurious/lost irq.
  1434. */
  1435. if (hwif->ide_dma_clear_irq && !(drive->waiting_for_dma))
  1436. /* ide_dma_end() needs bmdma status for error checking.
  1437. * So, skip clearing bmdma status here and leave it
  1438. * to ide_dma_end() if this is dma interrupt.
  1439. */
  1440. hwif->ide_dma_clear_irq(drive);
  1441. if (drive->unmask)
  1442. local_irq_enable_in_hardirq();
  1443. /* service this interrupt, may set handler for next interrupt */
  1444. startstop = handler(drive);
  1445. spin_lock_irq(&ide_lock);
  1446. /*
  1447. * Note that handler() may have set things up for another
  1448. * interrupt to occur soon, but it cannot happen until
  1449. * we exit from this routine, because it will be the
  1450. * same irq as is currently being serviced here, and Linux
  1451. * won't allow another of the same (on any CPU) until we return.
  1452. */
  1453. drive->service_time = jiffies - drive->service_start;
  1454. if (startstop == ide_stopped) {
  1455. if (hwgroup->handler == NULL) { /* paranoia */
  1456. hwgroup->busy = 0;
  1457. ide_do_request(hwgroup, hwif->irq);
  1458. } else {
  1459. printk(KERN_ERR "%s: ide_intr: huh? expected NULL handler "
  1460. "on exit\n", drive->name);
  1461. }
  1462. }
  1463. spin_unlock_irqrestore(&ide_lock, flags);
  1464. return IRQ_HANDLED;
  1465. }
  1466. /**
  1467. * ide_init_drive_cmd - initialize a drive command request
  1468. * @rq: request object
  1469. *
  1470. * Initialize a request before we fill it in and send it down to
  1471. * ide_do_drive_cmd. Commands must be set up by this function. Right
  1472. * now it doesn't do a lot, but if that changes abusers will have a
  1473. * nasty surprise.
  1474. */
  1475. void ide_init_drive_cmd (struct request *rq)
  1476. {
  1477. memset(rq, 0, sizeof(*rq));
  1478. rq->ref_count = 1;
  1479. }
  1480. EXPORT_SYMBOL(ide_init_drive_cmd);
  1481. /**
  1482. * ide_do_drive_cmd - issue IDE special command
  1483. * @drive: device to issue command
  1484. * @rq: request to issue
  1485. * @action: action for processing
  1486. *
  1487. * This function issues a special IDE device request
  1488. * onto the request queue.
  1489. *
  1490. * If action is ide_wait, then the rq is queued at the end of the
  1491. * request queue, and the function sleeps until it has been processed.
  1492. * This is for use when invoked from an ioctl handler.
  1493. *
  1494. * If action is ide_preempt, then the rq is queued at the head of
  1495. * the request queue, displacing the currently-being-processed
  1496. * request and this function returns immediately without waiting
  1497. * for the new rq to be completed. This is VERY DANGEROUS, and is
  1498. * intended for careful use by the ATAPI tape/cdrom driver code.
  1499. *
  1500. * If action is ide_end, then the rq is queued at the end of the
  1501. * request queue, and the function returns immediately without waiting
  1502. * for the new rq to be completed. This is again intended for careful
  1503. * use by the ATAPI tape/cdrom driver code.
  1504. */
  1505. int ide_do_drive_cmd (ide_drive_t *drive, struct request *rq, ide_action_t action)
  1506. {
  1507. unsigned long flags;
  1508. ide_hwgroup_t *hwgroup = HWGROUP(drive);
  1509. DECLARE_COMPLETION_ONSTACK(wait);
  1510. int where = ELEVATOR_INSERT_BACK, err;
  1511. int must_wait = (action == ide_wait || action == ide_head_wait);
  1512. rq->errors = 0;
  1513. /*
  1514. * we need to hold an extra reference to request for safe inspection
  1515. * after completion
  1516. */
  1517. if (must_wait) {
  1518. rq->ref_count++;
  1519. rq->end_io_data = &wait;
  1520. rq->end_io = blk_end_sync_rq;
  1521. }
  1522. spin_lock_irqsave(&ide_lock, flags);
  1523. if (action == ide_preempt)
  1524. hwgroup->rq = NULL;
  1525. if (action == ide_preempt || action == ide_head_wait) {
  1526. where = ELEVATOR_INSERT_FRONT;
  1527. rq->cmd_flags |= REQ_PREEMPT;
  1528. }
  1529. __elv_add_request(drive->queue, rq, where, 0);
  1530. ide_do_request(hwgroup, IDE_NO_IRQ);
  1531. spin_unlock_irqrestore(&ide_lock, flags);
  1532. err = 0;
  1533. if (must_wait) {
  1534. wait_for_completion(&wait);
  1535. if (rq->errors)
  1536. err = -EIO;
  1537. blk_put_request(rq);
  1538. }
  1539. return err;
  1540. }
  1541. EXPORT_SYMBOL(ide_do_drive_cmd);
  1542. void ide_pktcmd_tf_load(ide_drive_t *drive, u32 tf_flags, u16 bcount, u8 dma)
  1543. {
  1544. ide_task_t task;
  1545. memset(&task, 0, sizeof(task));
  1546. task.tf_flags = IDE_TFLAG_OUT_LBAH | IDE_TFLAG_OUT_LBAM |
  1547. IDE_TFLAG_OUT_FEATURE | tf_flags;
  1548. task.tf.feature = dma; /* Use PIO/DMA */
  1549. task.tf.lbam = bcount & 0xff;
  1550. task.tf.lbah = (bcount >> 8) & 0xff;
  1551. ide_tf_load(drive, &task);
  1552. }
  1553. EXPORT_SYMBOL_GPL(ide_pktcmd_tf_load);