ide-io.c 24 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902
  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. int ide_end_rq(ide_drive_t *drive, struct request *rq, int error,
  54. unsigned int nr_bytes)
  55. {
  56. /*
  57. * decide whether to reenable DMA -- 3 is a random magic for now,
  58. * if we DMA timeout more than 3 times, just stay in PIO
  59. */
  60. if ((drive->dev_flags & IDE_DFLAG_DMA_PIO_RETRY) &&
  61. drive->retry_pio <= 3) {
  62. drive->dev_flags &= ~IDE_DFLAG_DMA_PIO_RETRY;
  63. ide_dma_on(drive);
  64. }
  65. return blk_end_request(rq, error, nr_bytes);
  66. }
  67. EXPORT_SYMBOL_GPL(ide_end_rq);
  68. void ide_complete_cmd(ide_drive_t *drive, struct ide_cmd *cmd, u8 stat, u8 err)
  69. {
  70. const struct ide_tp_ops *tp_ops = drive->hwif->tp_ops;
  71. struct ide_taskfile *tf = &cmd->tf;
  72. struct request *rq = cmd->rq;
  73. u8 tf_cmd = tf->command;
  74. tf->error = err;
  75. tf->status = stat;
  76. if (cmd->ftf_flags & IDE_FTFLAG_IN_DATA) {
  77. u8 data[2];
  78. tp_ops->input_data(drive, cmd, data, 2);
  79. cmd->tf.data = data[0];
  80. cmd->hob.data = data[1];
  81. }
  82. ide_tf_readback(drive, cmd);
  83. if ((cmd->tf_flags & IDE_TFLAG_CUSTOM_HANDLER) &&
  84. tf_cmd == ATA_CMD_IDLEIMMEDIATE) {
  85. if (tf->lbal != 0xc4) {
  86. printk(KERN_ERR "%s: head unload failed!\n",
  87. drive->name);
  88. ide_tf_dump(drive->name, cmd);
  89. } else
  90. drive->dev_flags |= IDE_DFLAG_PARKED;
  91. }
  92. if (rq && rq->cmd_type == REQ_TYPE_ATA_TASKFILE) {
  93. struct ide_cmd *orig_cmd = rq->special;
  94. if (cmd->tf_flags & IDE_TFLAG_DYN)
  95. kfree(orig_cmd);
  96. else
  97. memcpy(orig_cmd, cmd, sizeof(*cmd));
  98. }
  99. }
  100. /* obsolete, blk_rq_bytes() should be used instead */
  101. unsigned int ide_rq_bytes(struct request *rq)
  102. {
  103. if (blk_pc_request(rq))
  104. return rq->data_len;
  105. else
  106. return rq->hard_cur_sectors << 9;
  107. }
  108. EXPORT_SYMBOL_GPL(ide_rq_bytes);
  109. int ide_complete_rq(ide_drive_t *drive, int error, unsigned int nr_bytes)
  110. {
  111. ide_hwif_t *hwif = drive->hwif;
  112. struct request *rq = hwif->rq;
  113. int rc;
  114. /*
  115. * if failfast is set on a request, override number of sectors
  116. * and complete the whole request right now
  117. */
  118. if (blk_noretry_request(rq) && error <= 0)
  119. nr_bytes = rq->hard_nr_sectors << 9;
  120. rc = ide_end_rq(drive, rq, error, nr_bytes);
  121. if (rc == 0)
  122. hwif->rq = NULL;
  123. return rc;
  124. }
  125. EXPORT_SYMBOL(ide_complete_rq);
  126. void ide_kill_rq(ide_drive_t *drive, struct request *rq)
  127. {
  128. u8 drv_req = blk_special_request(rq) && rq->rq_disk;
  129. u8 media = drive->media;
  130. drive->failed_pc = NULL;
  131. if ((media == ide_floppy || media == ide_tape) && drv_req) {
  132. rq->errors = 0;
  133. ide_complete_rq(drive, 0, blk_rq_bytes(rq));
  134. } else {
  135. if (media == ide_tape)
  136. rq->errors = IDE_DRV_ERROR_GENERAL;
  137. else if (blk_fs_request(rq) == 0 && rq->errors == 0)
  138. rq->errors = -EIO;
  139. ide_complete_rq(drive, -EIO, ide_rq_bytes(rq));
  140. }
  141. }
  142. static void ide_tf_set_specify_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
  143. {
  144. tf->nsect = drive->sect;
  145. tf->lbal = drive->sect;
  146. tf->lbam = drive->cyl;
  147. tf->lbah = drive->cyl >> 8;
  148. tf->device = (drive->head - 1) | drive->select;
  149. tf->command = ATA_CMD_INIT_DEV_PARAMS;
  150. }
  151. static void ide_tf_set_restore_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
  152. {
  153. tf->nsect = drive->sect;
  154. tf->command = ATA_CMD_RESTORE;
  155. }
  156. static void ide_tf_set_setmult_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
  157. {
  158. tf->nsect = drive->mult_req;
  159. tf->command = ATA_CMD_SET_MULTI;
  160. }
  161. static ide_startstop_t ide_disk_special(ide_drive_t *drive)
  162. {
  163. special_t *s = &drive->special;
  164. struct ide_cmd cmd;
  165. memset(&cmd, 0, sizeof(cmd));
  166. cmd.protocol = ATA_PROT_NODATA;
  167. if (s->b.set_geometry) {
  168. s->b.set_geometry = 0;
  169. ide_tf_set_specify_cmd(drive, &cmd.tf);
  170. } else if (s->b.recalibrate) {
  171. s->b.recalibrate = 0;
  172. ide_tf_set_restore_cmd(drive, &cmd.tf);
  173. } else if (s->b.set_multmode) {
  174. s->b.set_multmode = 0;
  175. ide_tf_set_setmult_cmd(drive, &cmd.tf);
  176. } else if (s->all) {
  177. int special = s->all;
  178. s->all = 0;
  179. printk(KERN_ERR "%s: bad special flag: 0x%02x\n", drive->name, special);
  180. return ide_stopped;
  181. }
  182. cmd.valid.out.tf = IDE_VALID_OUT_TF | IDE_VALID_DEVICE;
  183. cmd.valid.in.tf = IDE_VALID_IN_TF | IDE_VALID_DEVICE;
  184. cmd.tf_flags = IDE_TFLAG_CUSTOM_HANDLER;
  185. do_rw_taskfile(drive, &cmd);
  186. return ide_started;
  187. }
  188. /**
  189. * do_special - issue some special commands
  190. * @drive: drive the command is for
  191. *
  192. * do_special() is used to issue ATA_CMD_INIT_DEV_PARAMS,
  193. * ATA_CMD_RESTORE and ATA_CMD_SET_MULTI commands to a drive.
  194. *
  195. * It used to do much more, but has been scaled back.
  196. */
  197. static ide_startstop_t do_special (ide_drive_t *drive)
  198. {
  199. special_t *s = &drive->special;
  200. #ifdef DEBUG
  201. printk("%s: do_special: 0x%02x\n", drive->name, s->all);
  202. #endif
  203. if (drive->media == ide_disk)
  204. return ide_disk_special(drive);
  205. s->all = 0;
  206. drive->mult_req = 0;
  207. return ide_stopped;
  208. }
  209. void ide_map_sg(ide_drive_t *drive, struct ide_cmd *cmd)
  210. {
  211. ide_hwif_t *hwif = drive->hwif;
  212. struct scatterlist *sg = hwif->sg_table;
  213. struct request *rq = cmd->rq;
  214. if (!rq->bio) {
  215. sg_init_one(sg, rq->data, rq->data_len);
  216. cmd->sg_nents = 1;
  217. } else
  218. cmd->sg_nents = blk_rq_map_sg(drive->queue, rq, sg);
  219. }
  220. EXPORT_SYMBOL_GPL(ide_map_sg);
  221. void ide_init_sg_cmd(struct ide_cmd *cmd, unsigned int nr_bytes)
  222. {
  223. cmd->nbytes = cmd->nleft = nr_bytes;
  224. cmd->cursg_ofs = 0;
  225. cmd->cursg = NULL;
  226. }
  227. EXPORT_SYMBOL_GPL(ide_init_sg_cmd);
  228. /**
  229. * execute_drive_command - issue special drive command
  230. * @drive: the drive to issue the command on
  231. * @rq: the request structure holding the command
  232. *
  233. * execute_drive_cmd() issues a special drive command, usually
  234. * initiated by ioctl() from the external hdparm program. The
  235. * command can be a drive command, drive task or taskfile
  236. * operation. Weirdly you can call it with NULL to wait for
  237. * all commands to finish. Don't do this as that is due to change
  238. */
  239. static ide_startstop_t execute_drive_cmd (ide_drive_t *drive,
  240. struct request *rq)
  241. {
  242. struct ide_cmd *cmd = rq->special;
  243. if (cmd) {
  244. if (cmd->protocol == ATA_PROT_PIO) {
  245. ide_init_sg_cmd(cmd, rq->nr_sectors << 9);
  246. ide_map_sg(drive, cmd);
  247. }
  248. return do_rw_taskfile(drive, cmd);
  249. }
  250. /*
  251. * NULL is actually a valid way of waiting for
  252. * all current requests to be flushed from the queue.
  253. */
  254. #ifdef DEBUG
  255. printk("%s: DRIVE_CMD (null)\n", drive->name);
  256. #endif
  257. rq->errors = 0;
  258. ide_complete_rq(drive, 0, blk_rq_bytes(rq));
  259. return ide_stopped;
  260. }
  261. static ide_startstop_t ide_special_rq(ide_drive_t *drive, struct request *rq)
  262. {
  263. u8 cmd = rq->cmd[0];
  264. switch (cmd) {
  265. case REQ_PARK_HEADS:
  266. case REQ_UNPARK_HEADS:
  267. return ide_do_park_unpark(drive, rq);
  268. case REQ_DEVSET_EXEC:
  269. return ide_do_devset(drive, rq);
  270. case REQ_DRIVE_RESET:
  271. return ide_do_reset(drive);
  272. default:
  273. BUG();
  274. }
  275. }
  276. /**
  277. * start_request - start of I/O and command issuing for IDE
  278. *
  279. * start_request() initiates handling of a new I/O request. It
  280. * accepts commands and I/O (read/write) requests.
  281. *
  282. * FIXME: this function needs a rename
  283. */
  284. static ide_startstop_t start_request (ide_drive_t *drive, struct request *rq)
  285. {
  286. ide_startstop_t startstop;
  287. BUG_ON(!blk_rq_started(rq));
  288. #ifdef DEBUG
  289. printk("%s: start_request: current=0x%08lx\n",
  290. drive->hwif->name, (unsigned long) rq);
  291. #endif
  292. /* bail early if we've exceeded max_failures */
  293. if (drive->max_failures && (drive->failures > drive->max_failures)) {
  294. rq->cmd_flags |= REQ_FAILED;
  295. goto kill_rq;
  296. }
  297. if (blk_pm_request(rq))
  298. ide_check_pm_state(drive, rq);
  299. drive->hwif->tp_ops->dev_select(drive);
  300. if (ide_wait_stat(&startstop, drive, drive->ready_stat,
  301. ATA_BUSY | ATA_DRQ, WAIT_READY)) {
  302. printk(KERN_ERR "%s: drive not ready for command\n", drive->name);
  303. return startstop;
  304. }
  305. if (!drive->special.all) {
  306. struct ide_driver *drv;
  307. /*
  308. * We reset the drive so we need to issue a SETFEATURES.
  309. * Do it _after_ do_special() restored device parameters.
  310. */
  311. if (drive->current_speed == 0xff)
  312. ide_config_drive_speed(drive, drive->desired_speed);
  313. if (rq->cmd_type == REQ_TYPE_ATA_TASKFILE)
  314. return execute_drive_cmd(drive, rq);
  315. else if (blk_pm_request(rq)) {
  316. struct request_pm_state *pm = rq->data;
  317. #ifdef DEBUG_PM
  318. printk("%s: start_power_step(step: %d)\n",
  319. drive->name, pm->pm_step);
  320. #endif
  321. startstop = ide_start_power_step(drive, rq);
  322. if (startstop == ide_stopped &&
  323. pm->pm_step == IDE_PM_COMPLETED)
  324. ide_complete_pm_rq(drive, rq);
  325. return startstop;
  326. } else if (!rq->rq_disk && blk_special_request(rq))
  327. /*
  328. * TODO: Once all ULDs have been modified to
  329. * check for specific op codes rather than
  330. * blindly accepting any special request, the
  331. * check for ->rq_disk above may be replaced
  332. * by a more suitable mechanism or even
  333. * dropped entirely.
  334. */
  335. return ide_special_rq(drive, rq);
  336. drv = *(struct ide_driver **)rq->rq_disk->private_data;
  337. return drv->do_request(drive, rq, rq->sector);
  338. }
  339. return do_special(drive);
  340. kill_rq:
  341. ide_kill_rq(drive, rq);
  342. return ide_stopped;
  343. }
  344. /**
  345. * ide_stall_queue - pause an IDE device
  346. * @drive: drive to stall
  347. * @timeout: time to stall for (jiffies)
  348. *
  349. * ide_stall_queue() can be used by a drive to give excess bandwidth back
  350. * to the port by sleeping for timeout jiffies.
  351. */
  352. void ide_stall_queue (ide_drive_t *drive, unsigned long timeout)
  353. {
  354. if (timeout > WAIT_WORSTCASE)
  355. timeout = WAIT_WORSTCASE;
  356. drive->sleep = timeout + jiffies;
  357. drive->dev_flags |= IDE_DFLAG_SLEEPING;
  358. }
  359. EXPORT_SYMBOL(ide_stall_queue);
  360. static inline int ide_lock_port(ide_hwif_t *hwif)
  361. {
  362. if (hwif->busy)
  363. return 1;
  364. hwif->busy = 1;
  365. return 0;
  366. }
  367. static inline void ide_unlock_port(ide_hwif_t *hwif)
  368. {
  369. hwif->busy = 0;
  370. }
  371. static inline int ide_lock_host(struct ide_host *host, ide_hwif_t *hwif)
  372. {
  373. int rc = 0;
  374. if (host->host_flags & IDE_HFLAG_SERIALIZE) {
  375. rc = test_and_set_bit_lock(IDE_HOST_BUSY, &host->host_busy);
  376. if (rc == 0) {
  377. if (host->get_lock)
  378. host->get_lock(ide_intr, hwif);
  379. }
  380. }
  381. return rc;
  382. }
  383. static inline void ide_unlock_host(struct ide_host *host)
  384. {
  385. if (host->host_flags & IDE_HFLAG_SERIALIZE) {
  386. if (host->release_lock)
  387. host->release_lock();
  388. clear_bit_unlock(IDE_HOST_BUSY, &host->host_busy);
  389. }
  390. }
  391. /*
  392. * Issue a new request to a device.
  393. */
  394. void do_ide_request(struct request_queue *q)
  395. {
  396. ide_drive_t *drive = q->queuedata;
  397. ide_hwif_t *hwif = drive->hwif;
  398. struct ide_host *host = hwif->host;
  399. struct request *rq = NULL;
  400. ide_startstop_t startstop;
  401. /*
  402. * drive is doing pre-flush, ordered write, post-flush sequence. even
  403. * though that is 3 requests, it must be seen as a single transaction.
  404. * we must not preempt this drive until that is complete
  405. */
  406. if (blk_queue_flushing(q))
  407. /*
  408. * small race where queue could get replugged during
  409. * the 3-request flush cycle, just yank the plug since
  410. * we want it to finish asap
  411. */
  412. blk_remove_plug(q);
  413. spin_unlock_irq(q->queue_lock);
  414. /* HLD do_request() callback might sleep, make sure it's okay */
  415. might_sleep();
  416. if (ide_lock_host(host, hwif))
  417. goto plug_device_2;
  418. spin_lock_irq(&hwif->lock);
  419. if (!ide_lock_port(hwif)) {
  420. ide_hwif_t *prev_port;
  421. repeat:
  422. prev_port = hwif->host->cur_port;
  423. hwif->rq = NULL;
  424. if (drive->dev_flags & IDE_DFLAG_SLEEPING &&
  425. time_after(drive->sleep, jiffies)) {
  426. ide_unlock_port(hwif);
  427. goto plug_device;
  428. }
  429. if ((hwif->host->host_flags & IDE_HFLAG_SERIALIZE) &&
  430. hwif != prev_port) {
  431. /*
  432. * set nIEN for previous port, drives in the
  433. * quirk_list may not like intr setups/cleanups
  434. */
  435. if (prev_port && prev_port->cur_dev->quirk_list == 0)
  436. prev_port->tp_ops->write_devctl(prev_port,
  437. ATA_NIEN |
  438. ATA_DEVCTL_OBS);
  439. hwif->host->cur_port = hwif;
  440. }
  441. hwif->cur_dev = drive;
  442. drive->dev_flags &= ~(IDE_DFLAG_SLEEPING | IDE_DFLAG_PARKED);
  443. spin_unlock_irq(&hwif->lock);
  444. spin_lock_irq(q->queue_lock);
  445. /*
  446. * we know that the queue isn't empty, but this can happen
  447. * if the q->prep_rq_fn() decides to kill a request
  448. */
  449. rq = elv_next_request(drive->queue);
  450. spin_unlock_irq(q->queue_lock);
  451. spin_lock_irq(&hwif->lock);
  452. if (!rq) {
  453. ide_unlock_port(hwif);
  454. goto out;
  455. }
  456. /*
  457. * Sanity: don't accept a request that isn't a PM request
  458. * if we are currently power managed. This is very important as
  459. * blk_stop_queue() doesn't prevent the elv_next_request()
  460. * above to return us whatever is in the queue. Since we call
  461. * ide_do_request() ourselves, we end up taking requests while
  462. * the queue is blocked...
  463. *
  464. * We let requests forced at head of queue with ide-preempt
  465. * though. I hope that doesn't happen too much, hopefully not
  466. * unless the subdriver triggers such a thing in its own PM
  467. * state machine.
  468. */
  469. if ((drive->dev_flags & IDE_DFLAG_BLOCKED) &&
  470. blk_pm_request(rq) == 0 &&
  471. (rq->cmd_flags & REQ_PREEMPT) == 0) {
  472. /* there should be no pending command at this point */
  473. ide_unlock_port(hwif);
  474. goto plug_device;
  475. }
  476. hwif->rq = rq;
  477. spin_unlock_irq(&hwif->lock);
  478. startstop = start_request(drive, rq);
  479. spin_lock_irq(&hwif->lock);
  480. if (startstop == ide_stopped)
  481. goto repeat;
  482. } else
  483. goto plug_device;
  484. out:
  485. spin_unlock_irq(&hwif->lock);
  486. if (rq == NULL)
  487. ide_unlock_host(host);
  488. spin_lock_irq(q->queue_lock);
  489. return;
  490. plug_device:
  491. spin_unlock_irq(&hwif->lock);
  492. ide_unlock_host(host);
  493. plug_device_2:
  494. spin_lock_irq(q->queue_lock);
  495. if (!elv_queue_empty(q))
  496. blk_plug_device(q);
  497. }
  498. static void ide_plug_device(ide_drive_t *drive)
  499. {
  500. struct request_queue *q = drive->queue;
  501. unsigned long flags;
  502. spin_lock_irqsave(q->queue_lock, flags);
  503. if (!elv_queue_empty(q))
  504. blk_plug_device(q);
  505. spin_unlock_irqrestore(q->queue_lock, flags);
  506. }
  507. static int drive_is_ready(ide_drive_t *drive)
  508. {
  509. ide_hwif_t *hwif = drive->hwif;
  510. u8 stat = 0;
  511. if (drive->waiting_for_dma)
  512. return hwif->dma_ops->dma_test_irq(drive);
  513. if (hwif->io_ports.ctl_addr &&
  514. (hwif->host_flags & IDE_HFLAG_BROKEN_ALTSTATUS) == 0)
  515. stat = hwif->tp_ops->read_altstatus(hwif);
  516. else
  517. /* Note: this may clear a pending IRQ!! */
  518. stat = hwif->tp_ops->read_status(hwif);
  519. if (stat & ATA_BUSY)
  520. /* drive busy: definitely not interrupting */
  521. return 0;
  522. /* drive ready: *might* be interrupting */
  523. return 1;
  524. }
  525. /**
  526. * ide_timer_expiry - handle lack of an IDE interrupt
  527. * @data: timer callback magic (hwif)
  528. *
  529. * An IDE command has timed out before the expected drive return
  530. * occurred. At this point we attempt to clean up the current
  531. * mess. If the current handler includes an expiry handler then
  532. * we invoke the expiry handler, and providing it is happy the
  533. * work is done. If that fails we apply generic recovery rules
  534. * invoking the handler and checking the drive DMA status. We
  535. * have an excessively incestuous relationship with the DMA
  536. * logic that wants cleaning up.
  537. */
  538. void ide_timer_expiry (unsigned long data)
  539. {
  540. ide_hwif_t *hwif = (ide_hwif_t *)data;
  541. ide_drive_t *uninitialized_var(drive);
  542. ide_handler_t *handler;
  543. unsigned long flags;
  544. int wait = -1;
  545. int plug_device = 0;
  546. spin_lock_irqsave(&hwif->lock, flags);
  547. handler = hwif->handler;
  548. if (handler == NULL || hwif->req_gen != hwif->req_gen_timer) {
  549. /*
  550. * Either a marginal timeout occurred
  551. * (got the interrupt just as timer expired),
  552. * or we were "sleeping" to give other devices a chance.
  553. * Either way, we don't really want to complain about anything.
  554. */
  555. } else {
  556. ide_expiry_t *expiry = hwif->expiry;
  557. ide_startstop_t startstop = ide_stopped;
  558. drive = hwif->cur_dev;
  559. if (expiry) {
  560. wait = expiry(drive);
  561. if (wait > 0) { /* continue */
  562. /* reset timer */
  563. hwif->timer.expires = jiffies + wait;
  564. hwif->req_gen_timer = hwif->req_gen;
  565. add_timer(&hwif->timer);
  566. spin_unlock_irqrestore(&hwif->lock, flags);
  567. return;
  568. }
  569. }
  570. hwif->handler = NULL;
  571. hwif->expiry = NULL;
  572. /*
  573. * We need to simulate a real interrupt when invoking
  574. * the handler() function, which means we need to
  575. * globally mask the specific IRQ:
  576. */
  577. spin_unlock(&hwif->lock);
  578. /* disable_irq_nosync ?? */
  579. disable_irq(hwif->irq);
  580. /* local CPU only, as if we were handling an interrupt */
  581. local_irq_disable();
  582. if (hwif->polling) {
  583. startstop = handler(drive);
  584. } else if (drive_is_ready(drive)) {
  585. if (drive->waiting_for_dma)
  586. hwif->dma_ops->dma_lost_irq(drive);
  587. if (hwif->ack_intr)
  588. hwif->ack_intr(hwif);
  589. printk(KERN_WARNING "%s: lost interrupt\n",
  590. drive->name);
  591. startstop = handler(drive);
  592. } else {
  593. if (drive->waiting_for_dma)
  594. startstop = ide_dma_timeout_retry(drive, wait);
  595. else
  596. startstop = ide_error(drive, "irq timeout",
  597. hwif->tp_ops->read_status(hwif));
  598. }
  599. spin_lock_irq(&hwif->lock);
  600. enable_irq(hwif->irq);
  601. if (startstop == ide_stopped) {
  602. ide_unlock_port(hwif);
  603. plug_device = 1;
  604. }
  605. }
  606. spin_unlock_irqrestore(&hwif->lock, flags);
  607. if (plug_device) {
  608. ide_unlock_host(hwif->host);
  609. ide_plug_device(drive);
  610. }
  611. }
  612. /**
  613. * unexpected_intr - handle an unexpected IDE interrupt
  614. * @irq: interrupt line
  615. * @hwif: port being processed
  616. *
  617. * There's nothing really useful we can do with an unexpected interrupt,
  618. * other than reading the status register (to clear it), and logging it.
  619. * There should be no way that an irq can happen before we're ready for it,
  620. * so we needn't worry much about losing an "important" interrupt here.
  621. *
  622. * On laptops (and "green" PCs), an unexpected interrupt occurs whenever
  623. * the drive enters "idle", "standby", or "sleep" mode, so if the status
  624. * looks "good", we just ignore the interrupt completely.
  625. *
  626. * This routine assumes __cli() is in effect when called.
  627. *
  628. * If an unexpected interrupt happens on irq15 while we are handling irq14
  629. * and if the two interfaces are "serialized" (CMD640), then it looks like
  630. * we could screw up by interfering with a new request being set up for
  631. * irq15.
  632. *
  633. * In reality, this is a non-issue. The new command is not sent unless
  634. * the drive is ready to accept one, in which case we know the drive is
  635. * not trying to interrupt us. And ide_set_handler() is always invoked
  636. * before completing the issuance of any new drive command, so we will not
  637. * be accidentally invoked as a result of any valid command completion
  638. * interrupt.
  639. */
  640. static void unexpected_intr(int irq, ide_hwif_t *hwif)
  641. {
  642. u8 stat = hwif->tp_ops->read_status(hwif);
  643. if (!OK_STAT(stat, ATA_DRDY, BAD_STAT)) {
  644. /* Try to not flood the console with msgs */
  645. static unsigned long last_msgtime, count;
  646. ++count;
  647. if (time_after(jiffies, last_msgtime + HZ)) {
  648. last_msgtime = jiffies;
  649. printk(KERN_ERR "%s: unexpected interrupt, "
  650. "status=0x%02x, count=%ld\n",
  651. hwif->name, stat, count);
  652. }
  653. }
  654. }
  655. /**
  656. * ide_intr - default IDE interrupt handler
  657. * @irq: interrupt number
  658. * @dev_id: hwif
  659. * @regs: unused weirdness from the kernel irq layer
  660. *
  661. * This is the default IRQ handler for the IDE layer. You should
  662. * not need to override it. If you do be aware it is subtle in
  663. * places
  664. *
  665. * hwif is the interface in the group currently performing
  666. * a command. hwif->cur_dev is the drive and hwif->handler is
  667. * the IRQ handler to call. As we issue a command the handlers
  668. * step through multiple states, reassigning the handler to the
  669. * next step in the process. Unlike a smart SCSI controller IDE
  670. * expects the main processor to sequence the various transfer
  671. * stages. We also manage a poll timer to catch up with most
  672. * timeout situations. There are still a few where the handlers
  673. * don't ever decide to give up.
  674. *
  675. * The handler eventually returns ide_stopped to indicate the
  676. * request completed. At this point we issue the next request
  677. * on the port and the process begins again.
  678. */
  679. irqreturn_t ide_intr (int irq, void *dev_id)
  680. {
  681. ide_hwif_t *hwif = (ide_hwif_t *)dev_id;
  682. struct ide_host *host = hwif->host;
  683. ide_drive_t *uninitialized_var(drive);
  684. ide_handler_t *handler;
  685. unsigned long flags;
  686. ide_startstop_t startstop;
  687. irqreturn_t irq_ret = IRQ_NONE;
  688. int plug_device = 0;
  689. if (host->host_flags & IDE_HFLAG_SERIALIZE) {
  690. if (hwif != host->cur_port)
  691. goto out_early;
  692. }
  693. spin_lock_irqsave(&hwif->lock, flags);
  694. if (hwif->ack_intr && hwif->ack_intr(hwif) == 0)
  695. goto out;
  696. handler = hwif->handler;
  697. if (handler == NULL || hwif->polling) {
  698. /*
  699. * Not expecting an interrupt from this drive.
  700. * That means this could be:
  701. * (1) an interrupt from another PCI device
  702. * sharing the same PCI INT# as us.
  703. * or (2) a drive just entered sleep or standby mode,
  704. * and is interrupting to let us know.
  705. * or (3) a spurious interrupt of unknown origin.
  706. *
  707. * For PCI, we cannot tell the difference,
  708. * so in that case we just ignore it and hope it goes away.
  709. */
  710. if ((host->irq_flags & IRQF_SHARED) == 0) {
  711. /*
  712. * Probably not a shared PCI interrupt,
  713. * so we can safely try to do something about it:
  714. */
  715. unexpected_intr(irq, hwif);
  716. } else {
  717. /*
  718. * Whack the status register, just in case
  719. * we have a leftover pending IRQ.
  720. */
  721. (void)hwif->tp_ops->read_status(hwif);
  722. }
  723. goto out;
  724. }
  725. drive = hwif->cur_dev;
  726. if (!drive_is_ready(drive))
  727. /*
  728. * This happens regularly when we share a PCI IRQ with
  729. * another device. Unfortunately, it can also happen
  730. * with some buggy drives that trigger the IRQ before
  731. * their status register is up to date. Hopefully we have
  732. * enough advance overhead that the latter isn't a problem.
  733. */
  734. goto out;
  735. hwif->handler = NULL;
  736. hwif->expiry = NULL;
  737. hwif->req_gen++;
  738. del_timer(&hwif->timer);
  739. spin_unlock(&hwif->lock);
  740. if (hwif->port_ops && hwif->port_ops->clear_irq)
  741. hwif->port_ops->clear_irq(drive);
  742. if (drive->dev_flags & IDE_DFLAG_UNMASK)
  743. local_irq_enable_in_hardirq();
  744. /* service this interrupt, may set handler for next interrupt */
  745. startstop = handler(drive);
  746. spin_lock_irq(&hwif->lock);
  747. /*
  748. * Note that handler() may have set things up for another
  749. * interrupt to occur soon, but it cannot happen until
  750. * we exit from this routine, because it will be the
  751. * same irq as is currently being serviced here, and Linux
  752. * won't allow another of the same (on any CPU) until we return.
  753. */
  754. if (startstop == ide_stopped) {
  755. BUG_ON(hwif->handler);
  756. ide_unlock_port(hwif);
  757. plug_device = 1;
  758. }
  759. irq_ret = IRQ_HANDLED;
  760. out:
  761. spin_unlock_irqrestore(&hwif->lock, flags);
  762. out_early:
  763. if (plug_device) {
  764. ide_unlock_host(hwif->host);
  765. ide_plug_device(drive);
  766. }
  767. return irq_ret;
  768. }
  769. EXPORT_SYMBOL_GPL(ide_intr);
  770. void ide_pad_transfer(ide_drive_t *drive, int write, int len)
  771. {
  772. ide_hwif_t *hwif = drive->hwif;
  773. u8 buf[4] = { 0 };
  774. while (len > 0) {
  775. if (write)
  776. hwif->tp_ops->output_data(drive, NULL, buf, min(4, len));
  777. else
  778. hwif->tp_ops->input_data(drive, NULL, buf, min(4, len));
  779. len -= 4;
  780. }
  781. }
  782. EXPORT_SYMBOL_GPL(ide_pad_transfer);