blob: ef806ab88fb4913e1abf6a19434dc2a775087f6e [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
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
26
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <linux/module.h>
28#include <linux/types.h>
29#include <linux/string.h>
30#include <linux/kernel.h>
31#include <linux/timer.h>
32#include <linux/mm.h>
33#include <linux/interrupt.h>
34#include <linux/major.h>
35#include <linux/errno.h>
36#include <linux/genhd.h>
37#include <linux/blkpg.h>
38#include <linux/slab.h>
39#include <linux/init.h>
40#include <linux/pci.h>
41#include <linux/delay.h>
42#include <linux/ide.h>
43#include <linux/completion.h>
44#include <linux/reboot.h>
45#include <linux/cdrom.h>
46#include <linux/seq_file.h>
47#include <linux/device.h>
48#include <linux/kmod.h>
49#include <linux/scatterlist.h>
Jiri Slaby1977f032007-10-18 23:40:25 -070050#include <linux/bitops.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070051
52#include <asm/byteorder.h>
53#include <asm/irq.h>
54#include <asm/uaccess.h>
55#include <asm/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070056
Bartlomiej Zolnierkiewicz37245aa2009-03-27 12:46:43 +010057int ide_end_rq(ide_drive_t *drive, struct request *rq, int error,
Bartlomiej Zolnierkiewicz1caf2362009-03-27 12:46:42 +010058 unsigned int nr_bytes)
Linus Torvalds1da177e2005-04-16 15:20:36 -070059{
Linus Torvalds1da177e2005-04-16 15:20:36 -070060 /*
61 * decide whether to reenable DMA -- 3 is a random magic for now,
62 * if we DMA timeout more than 3 times, just stay in PIO
63 */
Bartlomiej Zolnierkiewiczc3922042008-10-13 21:39:37 +020064 if ((drive->dev_flags & IDE_DFLAG_DMA_PIO_RETRY) &&
65 drive->retry_pio <= 3) {
66 drive->dev_flags &= ~IDE_DFLAG_DMA_PIO_RETRY;
Bartlomiej Zolnierkiewicz4a546e02008-01-26 20:13:01 +010067 ide_dma_on(drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -070068 }
69
Bartlomiej Zolnierkiewicz1caf2362009-03-27 12:46:42 +010070 return blk_end_request(rq, error, nr_bytes);
Linus Torvalds1da177e2005-04-16 15:20:36 -070071}
Bartlomiej Zolnierkiewicz1caf2362009-03-27 12:46:42 +010072EXPORT_SYMBOL_GPL(ide_end_rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -070073
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010074void ide_complete_cmd(ide_drive_t *drive, struct ide_cmd *cmd, u8 stat, u8 err)
Bartlomiej Zolnierkiewicze1202372009-03-27 12:46:29 +010075{
Sergei Shtylyov35218d12009-03-31 20:15:31 +020076 const struct ide_tp_ops *tp_ops = drive->hwif->tp_ops;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010077 struct ide_taskfile *tf = &cmd->tf;
78 struct request *rq = cmd->rq;
Bartlomiej Zolnierkiewicze7fedc32009-03-27 12:46:41 +010079 u8 tf_cmd = tf->command;
Bartlomiej Zolnierkiewicze1202372009-03-27 12:46:29 +010080
81 tf->error = err;
82 tf->status = stat;
83
Sergei Shtylyov35218d12009-03-31 20:15:31 +020084 if (cmd->ftf_flags & IDE_FTFLAG_IN_DATA) {
85 u8 data[2];
86
87 tp_ops->input_data(drive, cmd, data, 2);
88
Sergei Shtylyov745483f2009-04-08 14:13:02 +020089 cmd->tf.data = data[0];
90 cmd->hob.data = data[1];
Sergei Shtylyov35218d12009-03-31 20:15:31 +020091 }
92
Sergei Shtylyov3153c262009-04-08 14:13:03 +020093 ide_tf_readback(drive, cmd);
Bartlomiej Zolnierkiewicze1202372009-03-27 12:46:29 +010094
Bartlomiej Zolnierkiewicze7fedc32009-03-27 12:46:41 +010095 if ((cmd->tf_flags & IDE_TFLAG_CUSTOM_HANDLER) &&
96 tf_cmd == ATA_CMD_IDLEIMMEDIATE) {
97 if (tf->lbal != 0xc4) {
98 printk(KERN_ERR "%s: head unload failed!\n",
99 drive->name);
Sergei Shtylyov745483f2009-04-08 14:13:02 +0200100 ide_tf_dump(drive->name, cmd);
Bartlomiej Zolnierkiewicze7fedc32009-03-27 12:46:41 +0100101 } else
102 drive->dev_flags |= IDE_DFLAG_PARKED;
103 }
104
Bartlomiej Zolnierkiewiczf505d492009-04-18 17:42:20 +0200105 if (rq && rq->cmd_type == REQ_TYPE_ATA_TASKFILE) {
106 struct ide_cmd *orig_cmd = rq->special;
Bartlomiej Zolnierkiewicza09485d2009-03-27 12:46:31 +0100107
Bartlomiej Zolnierkiewiczf505d492009-04-18 17:42:20 +0200108 if (cmd->tf_flags & IDE_TFLAG_DYN)
109 kfree(orig_cmd);
110 else
111 memcpy(orig_cmd, cmd, sizeof(*cmd));
112 }
Bartlomiej Zolnierkiewicze1202372009-03-27 12:46:29 +0100113}
114
Bartlomiej Zolnierkiewicz130e8862009-03-27 12:46:45 +0100115/* obsolete, blk_rq_bytes() should be used instead */
116unsigned int ide_rq_bytes(struct request *rq)
117{
118 if (blk_pc_request(rq))
119 return rq->data_len;
120 else
121 return rq->hard_cur_sectors << 9;
122}
123EXPORT_SYMBOL_GPL(ide_rq_bytes);
124
Bartlomiej Zolnierkiewiczf974b192009-03-27 12:46:44 +0100125int ide_complete_rq(ide_drive_t *drive, int error, unsigned int nr_bytes)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126{
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100127 ide_hwif_t *hwif = drive->hwif;
128 struct request *rq = hwif->rq;
Bartlomiej Zolnierkiewicza9587fd2009-03-27 12:46:44 +0100129 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130
Bartlomiej Zolnierkiewicz130e8862009-03-27 12:46:45 +0100131 /*
132 * if failfast is set on a request, override number of sectors
133 * and complete the whole request right now
134 */
135 if (blk_noretry_request(rq) && error <= 0)
136 nr_bytes = rq->hard_nr_sectors << 9;
137
Bartlomiej Zolnierkiewiczba7d4792009-03-27 12:46:44 +0100138 rc = ide_end_rq(drive, rq, error, nr_bytes);
Bartlomiej Zolnierkiewicza9587fd2009-03-27 12:46:44 +0100139 if (rc == 0)
140 hwif->rq = NULL;
Bartlomiej Zolnierkiewicz1d0bf582008-12-29 20:27:30 +0100141
Bartlomiej Zolnierkiewicza9587fd2009-03-27 12:46:44 +0100142 return rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143}
Bartlomiej Zolnierkiewicza09485d2009-03-27 12:46:31 +0100144EXPORT_SYMBOL(ide_complete_rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700145
Bartlomiej Zolnierkiewicz327fa1c2009-03-24 23:22:47 +0100146void ide_kill_rq(ide_drive_t *drive, struct request *rq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700147{
Bartlomiej Zolnierkiewicz3ee38302009-03-27 12:46:36 +0100148 u8 drv_req = blk_special_request(rq) && rq->rq_disk;
149 u8 media = drive->media;
150
Bartlomiej Zolnierkiewiczc152cc12009-03-27 12:46:34 +0100151 drive->failed_pc = NULL;
152
Bartlomiej Zolnierkiewicz6902a532009-03-27 12:46:43 +0100153 if ((media == ide_floppy || media == ide_tape) && drv_req) {
154 rq->errors = 0;
Bartlomiej Zolnierkiewiczf974b192009-03-27 12:46:44 +0100155 ide_complete_rq(drive, 0, blk_rq_bytes(rq));
Bartlomiej Zolnierkiewicz6902a532009-03-27 12:46:43 +0100156 } else {
157 if (media == ide_tape)
158 rq->errors = IDE_DRV_ERROR_GENERAL;
Bartlomiej Zolnierkiewicz89f78b32009-03-27 12:46:43 +0100159 else if (blk_fs_request(rq) == 0 && rq->errors == 0)
160 rq->errors = -EIO;
Bartlomiej Zolnierkiewicz130e8862009-03-27 12:46:45 +0100161 ide_complete_rq(drive, -EIO, ide_rq_bytes(rq));
Bartlomiej Zolnierkiewicz6902a532009-03-27 12:46:43 +0100162 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163}
164
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +0100165static void ide_tf_set_specify_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700166{
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +0100167 tf->nsect = drive->sect;
168 tf->lbal = drive->sect;
169 tf->lbam = drive->cyl;
170 tf->lbah = drive->cyl >> 8;
Bartlomiej Zolnierkiewicz7f612f22008-10-13 21:39:40 +0200171 tf->device = (drive->head - 1) | drive->select;
Bartlomiej Zolnierkiewiczaaaade32008-10-10 22:39:21 +0200172 tf->command = ATA_CMD_INIT_DEV_PARAMS;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700173}
174
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +0100175static void ide_tf_set_restore_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700176{
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +0100177 tf->nsect = drive->sect;
Bartlomiej Zolnierkiewiczaaaade32008-10-10 22:39:21 +0200178 tf->command = ATA_CMD_RESTORE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179}
180
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +0100181static void ide_tf_set_setmult_cmd(ide_drive_t *drive, struct ide_taskfile *tf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182{
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +0100183 tf->nsect = drive->mult_req;
Bartlomiej Zolnierkiewiczaaaade32008-10-10 22:39:21 +0200184 tf->command = ATA_CMD_SET_MULTI;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700185}
186
187static ide_startstop_t ide_disk_special(ide_drive_t *drive)
188{
189 special_t *s = &drive->special;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100190 struct ide_cmd cmd;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700191
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100192 memset(&cmd, 0, sizeof(cmd));
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100193 cmd.protocol = ATA_PROT_NODATA;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700194
195 if (s->b.set_geometry) {
196 s->b.set_geometry = 0;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100197 ide_tf_set_specify_cmd(drive, &cmd.tf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 } else if (s->b.recalibrate) {
199 s->b.recalibrate = 0;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100200 ide_tf_set_restore_cmd(drive, &cmd.tf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201 } else if (s->b.set_multmode) {
202 s->b.set_multmode = 0;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100203 ide_tf_set_setmult_cmd(drive, &cmd.tf);
Bartlomiej Zolnierkiewicz5f582c82009-05-17 19:12:18 +0200204 } else
205 BUG();
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206
Sergei Shtylyov60f85012009-04-08 14:13:01 +0200207 cmd.valid.out.tf = IDE_VALID_OUT_TF | IDE_VALID_DEVICE;
208 cmd.valid.in.tf = IDE_VALID_IN_TF | IDE_VALID_DEVICE;
209 cmd.tf_flags = IDE_TFLAG_CUSTOM_HANDLER;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100210
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100211 do_rw_taskfile(drive, &cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212
213 return ide_started;
214}
215
216/**
217 * do_special - issue some special commands
218 * @drive: drive the command is for
219 *
Bartlomiej Zolnierkiewiczaaaade32008-10-10 22:39:21 +0200220 * do_special() is used to issue ATA_CMD_INIT_DEV_PARAMS,
221 * ATA_CMD_RESTORE and ATA_CMD_SET_MULTI commands to a drive.
222 *
223 * It used to do much more, but has been scaled back.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700224 */
225
226static ide_startstop_t do_special (ide_drive_t *drive)
227{
228 special_t *s = &drive->special;
229
230#ifdef DEBUG
231 printk("%s: do_special: 0x%02x\n", drive->name, s->all);
232#endif
Bartlomiej Zolnierkiewicz6982daf2008-10-13 21:39:40 +0200233 if (drive->media == ide_disk)
234 return ide_disk_special(drive);
Bartlomiej Zolnierkiewicz26bcb872007-10-11 23:54:00 +0200235
Bartlomiej Zolnierkiewicz6982daf2008-10-13 21:39:40 +0200236 s->all = 0;
237 drive->mult_req = 0;
238 return ide_stopped;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239}
240
Bartlomiej Zolnierkiewicz229816942009-03-27 12:46:46 +0100241void ide_map_sg(ide_drive_t *drive, struct ide_cmd *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700242{
243 ide_hwif_t *hwif = drive->hwif;
244 struct scatterlist *sg = hwif->sg_table;
Bartlomiej Zolnierkiewicz229816942009-03-27 12:46:46 +0100245 struct request *rq = cmd->rq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246
Tejun Heo2c316bb2009-04-19 08:46:03 +0900247 cmd->sg_nents = blk_rq_map_sg(drive->queue, rq, sg);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249EXPORT_SYMBOL_GPL(ide_map_sg);
250
Bartlomiej Zolnierkiewiczbf717c02009-03-27 12:46:47 +0100251void ide_init_sg_cmd(struct ide_cmd *cmd, unsigned int nr_bytes)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252{
Bartlomiej Zolnierkiewiczbf717c02009-03-27 12:46:47 +0100253 cmd->nbytes = cmd->nleft = nr_bytes;
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100254 cmd->cursg_ofs = 0;
255 cmd->cursg = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257EXPORT_SYMBOL_GPL(ide_init_sg_cmd);
258
259/**
260 * execute_drive_command - issue special drive command
Adrian Bunk338cec32005-09-10 00:26:54 -0700261 * @drive: the drive to issue the command on
Linus Torvalds1da177e2005-04-16 15:20:36 -0700262 * @rq: the request structure holding the command
263 *
264 * execute_drive_cmd() issues a special drive command, usually
265 * initiated by ioctl() from the external hdparm program. The
266 * command can be a drive command, drive task or taskfile
267 * operation. Weirdly you can call it with NULL to wait for
268 * all commands to finish. Don't do this as that is due to change
269 */
270
271static ide_startstop_t execute_drive_cmd (ide_drive_t *drive,
272 struct request *rq)
273{
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100274 struct ide_cmd *cmd = rq->special;
Bartlomiej Zolnierkiewicz21d535c2008-01-25 22:17:09 +0100275
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100276 if (cmd) {
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100277 if (cmd->protocol == ATA_PROT_PIO) {
Bartlomiej Zolnierkiewiczbf717c02009-03-27 12:46:47 +0100278 ide_init_sg_cmd(cmd, rq->nr_sectors << 9);
Bartlomiej Zolnierkiewicz229816942009-03-27 12:46:46 +0100279 ide_map_sg(drive, cmd);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280 }
281
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100282 return do_rw_taskfile(drive, cmd);
Bartlomiej Zolnierkiewicz21d535c2008-01-25 22:17:09 +0100283 }
284
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285 /*
286 * NULL is actually a valid way of waiting for
287 * all current requests to be flushed from the queue.
288 */
289#ifdef DEBUG
290 printk("%s: DRIVE_CMD (null)\n", drive->name);
291#endif
Bartlomiej Zolnierkiewicz6902a532009-03-27 12:46:43 +0100292 rq->errors = 0;
Bartlomiej Zolnierkiewiczf974b192009-03-27 12:46:44 +0100293 ide_complete_rq(drive, 0, blk_rq_bytes(rq));
Bartlomiej Zolnierkiewicz64a57fe2008-02-06 02:57:51 +0100294
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 return ide_stopped;
296}
297
Elias Oltmanns79e36a92008-07-16 20:33:48 +0200298static ide_startstop_t ide_special_rq(ide_drive_t *drive, struct request *rq)
299{
Elias Oltmanns4abdc6e2008-10-13 21:39:50 +0200300 u8 cmd = rq->cmd[0];
301
Elias Oltmanns4abdc6e2008-10-13 21:39:50 +0200302 switch (cmd) {
Bartlomiej Zolnierkiewicz1bc6daa2009-03-24 23:22:44 +0100303 case REQ_PARK_HEADS:
304 case REQ_UNPARK_HEADS:
305 return ide_do_park_unpark(drive, rq);
Elias Oltmanns92f1f8f2008-10-10 22:39:40 +0200306 case REQ_DEVSET_EXEC:
Bartlomiej Zolnierkiewicz1bc6daa2009-03-24 23:22:44 +0100307 return ide_do_devset(drive, rq);
Elias Oltmanns79e36a92008-07-16 20:33:48 +0200308 case REQ_DRIVE_RESET:
309 return ide_do_reset(drive);
310 default:
Bartlomiej Zolnierkiewicz17137882009-03-27 12:46:42 +0100311 BUG();
Elias Oltmanns79e36a92008-07-16 20:33:48 +0200312 }
313}
314
Linus Torvalds1da177e2005-04-16 15:20:36 -0700315/**
316 * start_request - start of I/O and command issuing for IDE
317 *
318 * start_request() initiates handling of a new I/O request. It
Bartlomiej Zolnierkiewicz3c619ff2008-10-10 22:39:22 +0200319 * accepts commands and I/O (read/write) requests.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700320 *
321 * FIXME: this function needs a rename
322 */
323
324static ide_startstop_t start_request (ide_drive_t *drive, struct request *rq)
325{
326 ide_startstop_t startstop;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700327
Jens Axboe4aff5e22006-08-10 08:44:47 +0200328 BUG_ON(!blk_rq_started(rq));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329
330#ifdef DEBUG
331 printk("%s: start_request: current=0x%08lx\n",
Bartlomiej Zolnierkiewicz898ec222009-01-06 17:20:52 +0100332 drive->hwif->name, (unsigned long) rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700333#endif
334
335 /* bail early if we've exceeded max_failures */
336 if (drive->max_failures && (drive->failures > drive->max_failures)) {
Aristeu Rozanskib5e1a4e2008-01-25 22:17:04 +0100337 rq->cmd_flags |= REQ_FAILED;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700338 goto kill_rq;
339 }
340
Jens Axboead3cadd2006-06-13 08:46:57 +0200341 if (blk_pm_request(rq))
342 ide_check_pm_state(drive, rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700343
Sergei Shtylyovfdd88f02009-03-31 20:15:33 +0200344 drive->hwif->tp_ops->dev_select(drive);
Bartlomiej Zolnierkiewicz3a7d2482008-10-10 22:39:21 +0200345 if (ide_wait_stat(&startstop, drive, drive->ready_stat,
346 ATA_BUSY | ATA_DRQ, WAIT_READY)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347 printk(KERN_ERR "%s: drive not ready for command\n", drive->name);
348 return startstop;
349 }
350 if (!drive->special.all) {
Bartlomiej Zolnierkiewicz7f3c8682009-01-06 17:20:53 +0100351 struct ide_driver *drv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352
Suleiman Souhlal513daad2007-03-26 23:03:20 +0200353 /*
354 * We reset the drive so we need to issue a SETFEATURES.
355 * Do it _after_ do_special() restored device parameters.
356 */
357 if (drive->current_speed == 0xff)
358 ide_config_drive_speed(drive, drive->desired_speed);
359
Bartlomiej Zolnierkiewicz7267c332008-01-26 20:13:13 +0100360 if (rq->cmd_type == REQ_TYPE_ATA_TASKFILE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361 return execute_drive_cmd(drive, rq);
362 else if (blk_pm_request(rq)) {
Tejun Heofc38b522009-04-19 07:00:43 +0900363 struct request_pm_state *pm = rq->special;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700364#ifdef DEBUG_PM
365 printk("%s: start_power_step(step: %d)\n",
Bartlomiej Zolnierkiewicz6b7d8fc2008-12-02 20:40:03 +0100366 drive->name, pm->pm_step);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367#endif
368 startstop = ide_start_power_step(drive, rq);
369 if (startstop == ide_stopped &&
Bartlomiej Zolnierkiewicz0d346ba2008-10-13 21:39:38 +0200370 pm->pm_step == IDE_PM_COMPLETED)
Bartlomiej Zolnierkiewicz3616b652009-03-27 12:46:29 +0100371 ide_complete_pm_rq(drive, rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372 return startstop;
Elias Oltmanns79e36a92008-07-16 20:33:48 +0200373 } else if (!rq->rq_disk && blk_special_request(rq))
374 /*
375 * TODO: Once all ULDs have been modified to
376 * check for specific op codes rather than
377 * blindly accepting any special request, the
378 * check for ->rq_disk above may be replaced
379 * by a more suitable mechanism or even
380 * dropped entirely.
381 */
382 return ide_special_rq(drive, rq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700383
Bartlomiej Zolnierkiewicz7f3c8682009-01-06 17:20:53 +0100384 drv = *(struct ide_driver **)rq->rq_disk->private_data;
Bartlomiej Zolnierkiewicz3c619ff2008-10-10 22:39:22 +0200385
386 return drv->do_request(drive, rq, rq->sector);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387 }
388 return do_special(drive);
389kill_rq:
390 ide_kill_rq(drive, rq);
391 return ide_stopped;
392}
393
394/**
395 * ide_stall_queue - pause an IDE device
396 * @drive: drive to stall
397 * @timeout: time to stall for (jiffies)
398 *
399 * ide_stall_queue() can be used by a drive to give excess bandwidth back
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100400 * to the port by sleeping for timeout jiffies.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 */
402
403void ide_stall_queue (ide_drive_t *drive, unsigned long timeout)
404{
405 if (timeout > WAIT_WORSTCASE)
406 timeout = WAIT_WORSTCASE;
407 drive->sleep = timeout + jiffies;
Bartlomiej Zolnierkiewicz97100fc2008-10-13 21:39:36 +0200408 drive->dev_flags |= IDE_DFLAG_SLEEPING;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700409}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410EXPORT_SYMBOL(ide_stall_queue);
411
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100412static inline int ide_lock_port(ide_hwif_t *hwif)
413{
414 if (hwif->busy)
415 return 1;
416
417 hwif->busy = 1;
418
419 return 0;
420}
421
422static inline void ide_unlock_port(ide_hwif_t *hwif)
423{
424 hwif->busy = 0;
425}
426
427static inline int ide_lock_host(struct ide_host *host, ide_hwif_t *hwif)
428{
429 int rc = 0;
430
431 if (host->host_flags & IDE_HFLAG_SERIALIZE) {
432 rc = test_and_set_bit_lock(IDE_HOST_BUSY, &host->host_busy);
433 if (rc == 0) {
Bartlomiej Zolnierkiewicze354c1d2009-03-27 12:46:22 +0100434 if (host->get_lock)
435 host->get_lock(ide_intr, hwif);
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100436 }
437 }
438 return rc;
439}
440
441static inline void ide_unlock_host(struct ide_host *host)
442{
443 if (host->host_flags & IDE_HFLAG_SERIALIZE) {
Bartlomiej Zolnierkiewicze354c1d2009-03-27 12:46:22 +0100444 if (host->release_lock)
445 host->release_lock();
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100446 clear_bit_unlock(IDE_HOST_BUSY, &host->host_busy);
447 }
448}
449
Linus Torvalds1da177e2005-04-16 15:20:36 -0700450/*
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100451 * Issue a new request to a device.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700452 */
Bartlomiej Zolnierkiewicz295f0002009-01-02 16:12:48 +0100453void do_ide_request(struct request_queue *q)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700454{
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100455 ide_drive_t *drive = q->queuedata;
456 ide_hwif_t *hwif = drive->hwif;
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100457 struct ide_host *host = hwif->host;
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100458 struct request *rq = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700459 ide_startstop_t startstop;
460
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100461 /*
462 * drive is doing pre-flush, ordered write, post-flush sequence. even
463 * though that is 3 requests, it must be seen as a single transaction.
464 * we must not preempt this drive until that is complete
465 */
466 if (blk_queue_flushing(q))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467 /*
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100468 * small race where queue could get replugged during
469 * the 3-request flush cycle, just yank the plug since
470 * we want it to finish asap
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471 */
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100472 blk_remove_plug(q);
473
474 spin_unlock_irq(q->queue_lock);
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100475
Tejun Heo5c4be572009-04-19 07:00:42 +0900476 /* HLD do_request() callback might sleep, make sure it's okay */
477 might_sleep();
478
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100479 if (ide_lock_host(host, hwif))
480 goto plug_device_2;
481
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100482 spin_lock_irq(&hwif->lock);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100483
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100484 if (!ide_lock_port(hwif)) {
Bartlomiej Zolnierkiewicz42cf2612009-01-06 17:20:47 +0100485 ide_hwif_t *prev_port;
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100486repeat:
Bartlomiej Zolnierkiewiczbd53cbc2009-01-06 17:20:48 +0100487 prev_port = hwif->host->cur_port;
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100488 hwif->rq = NULL;
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100489
Elias Oltmanns90109412009-03-31 20:14:56 +0200490 if (drive->dev_flags & IDE_DFLAG_SLEEPING &&
491 time_after(drive->sleep, jiffies)) {
492 ide_unlock_port(hwif);
493 goto plug_device;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700494 }
Bartlomiej Zolnierkiewicz295f0002009-01-02 16:12:48 +0100495
Bartlomiej Zolnierkiewiczbd53cbc2009-01-06 17:20:48 +0100496 if ((hwif->host->host_flags & IDE_HFLAG_SERIALIZE) &&
497 hwif != prev_port) {
Bartlomiej Zolnierkiewicz7299a392008-01-25 22:17:14 +0100498 /*
Bartlomiej Zolnierkiewicz42cf2612009-01-06 17:20:47 +0100499 * set nIEN for previous port, drives in the
Bartlomiej Zolnierkiewicz7299a392008-01-25 22:17:14 +0100500 * quirk_list may not like intr setups/cleanups
501 */
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100502 if (prev_port && prev_port->cur_dev->quirk_list == 0)
Sergei Shtylyovecf3a312009-03-31 20:15:30 +0200503 prev_port->tp_ops->write_devctl(prev_port,
504 ATA_NIEN |
505 ATA_DEVCTL_OBS);
Bartlomiej Zolnierkiewiczbd53cbc2009-01-06 17:20:48 +0100506
507 hwif->host->cur_port = hwif;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 }
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100509 hwif->cur_dev = drive;
Elias Oltmanns4abdc6e2008-10-13 21:39:50 +0200510 drive->dev_flags &= ~(IDE_DFLAG_SLEEPING | IDE_DFLAG_PARKED);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700511
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100512 spin_unlock_irq(&hwif->lock);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100513 spin_lock_irq(q->queue_lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700514 /*
515 * we know that the queue isn't empty, but this can happen
516 * if the q->prep_rq_fn() decides to kill a request
517 */
518 rq = elv_next_request(drive->queue);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100519 spin_unlock_irq(q->queue_lock);
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100520 spin_lock_irq(&hwif->lock);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100521
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522 if (!rq) {
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100523 ide_unlock_port(hwif);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100524 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700525 }
526
527 /*
528 * Sanity: don't accept a request that isn't a PM request
529 * if we are currently power managed. This is very important as
530 * blk_stop_queue() doesn't prevent the elv_next_request()
531 * above to return us whatever is in the queue. Since we call
532 * ide_do_request() ourselves, we end up taking requests while
533 * the queue is blocked...
534 *
535 * We let requests forced at head of queue with ide-preempt
536 * though. I hope that doesn't happen too much, hopefully not
537 * unless the subdriver triggers such a thing in its own PM
538 * state machine.
539 */
Bartlomiej Zolnierkiewicz97100fc2008-10-13 21:39:36 +0200540 if ((drive->dev_flags & IDE_DFLAG_BLOCKED) &&
541 blk_pm_request(rq) == 0 &&
542 (rq->cmd_flags & REQ_PREEMPT) == 0) {
Bartlomiej Zolnierkiewicz631de372009-01-02 16:12:50 +0100543 /* there should be no pending command at this point */
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100544 ide_unlock_port(hwif);
Bartlomiej Zolnierkiewicz295f0002009-01-02 16:12:48 +0100545 goto plug_device;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700546 }
547
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100548 hwif->rq = rq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100550 spin_unlock_irq(&hwif->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 startstop = start_request(drive, rq);
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100552 spin_lock_irq(&hwif->lock);
Bartlomiej Zolnierkiewicz295f0002009-01-02 16:12:48 +0100553
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100554 if (startstop == ide_stopped)
555 goto repeat;
556 } else
557 goto plug_device;
558out:
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100559 spin_unlock_irq(&hwif->lock);
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100560 if (rq == NULL)
561 ide_unlock_host(host);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100562 spin_lock_irq(q->queue_lock);
Bartlomiej Zolnierkiewicz295f0002009-01-02 16:12:48 +0100563 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564
Bartlomiej Zolnierkiewicz295f0002009-01-02 16:12:48 +0100565plug_device:
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100566 spin_unlock_irq(&hwif->lock);
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100567 ide_unlock_host(host);
568plug_device_2:
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100569 spin_lock_irq(q->queue_lock);
570
571 if (!elv_queue_empty(q))
572 blk_plug_device(q);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573}
574
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100575static void ide_plug_device(ide_drive_t *drive)
576{
577 struct request_queue *q = drive->queue;
578 unsigned long flags;
579
580 spin_lock_irqsave(q->queue_lock, flags);
581 if (!elv_queue_empty(q))
582 blk_plug_device(q);
583 spin_unlock_irqrestore(q->queue_lock, flags);
584}
585
Bartlomiej Zolnierkiewiczb6a45a02009-03-24 23:22:43 +0100586static int drive_is_ready(ide_drive_t *drive)
587{
588 ide_hwif_t *hwif = drive->hwif;
589 u8 stat = 0;
590
591 if (drive->waiting_for_dma)
592 return hwif->dma_ops->dma_test_irq(drive);
593
594 if (hwif->io_ports.ctl_addr &&
595 (hwif->host_flags & IDE_HFLAG_BROKEN_ALTSTATUS) == 0)
596 stat = hwif->tp_ops->read_altstatus(hwif);
597 else
598 /* Note: this may clear a pending IRQ!! */
599 stat = hwif->tp_ops->read_status(hwif);
600
601 if (stat & ATA_BUSY)
602 /* drive busy: definitely not interrupting */
603 return 0;
604
605 /* drive ready: *might* be interrupting */
606 return 1;
607}
608
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609/**
610 * ide_timer_expiry - handle lack of an IDE interrupt
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100611 * @data: timer callback magic (hwif)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700612 *
613 * An IDE command has timed out before the expected drive return
614 * occurred. At this point we attempt to clean up the current
615 * mess. If the current handler includes an expiry handler then
616 * we invoke the expiry handler, and providing it is happy the
617 * work is done. If that fails we apply generic recovery rules
618 * invoking the handler and checking the drive DMA status. We
619 * have an excessively incestuous relationship with the DMA
620 * logic that wants cleaning up.
621 */
622
623void ide_timer_expiry (unsigned long data)
624{
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100625 ide_hwif_t *hwif = (ide_hwif_t *)data;
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100626 ide_drive_t *uninitialized_var(drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700627 ide_handler_t *handler;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700628 unsigned long flags;
Roel Kluine0c6dcd2009-03-05 16:10:55 +0100629 int wait = -1;
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100630 int plug_device = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700631
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100632 spin_lock_irqsave(&hwif->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700633
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100634 handler = hwif->handler;
635
636 if (handler == NULL || hwif->req_gen != hwif->req_gen_timer) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700637 /*
638 * Either a marginal timeout occurred
639 * (got the interrupt just as timer expired),
640 * or we were "sleeping" to give other devices a chance.
641 * Either way, we don't really want to complain about anything.
642 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643 } else {
Bartlomiej Zolnierkiewiczc38714e2009-01-06 17:20:59 +0100644 ide_expiry_t *expiry = hwif->expiry;
645 ide_startstop_t startstop = ide_stopped;
Bartlomiej Zolnierkiewiczb2cfb052009-01-02 16:12:49 +0100646
Bartlomiej Zolnierkiewiczc38714e2009-01-06 17:20:59 +0100647 drive = hwif->cur_dev;
648
649 if (expiry) {
650 wait = expiry(drive);
651 if (wait > 0) { /* continue */
652 /* reset timer */
653 hwif->timer.expires = jiffies + wait;
654 hwif->req_gen_timer = hwif->req_gen;
655 add_timer(&hwif->timer);
656 spin_unlock_irqrestore(&hwif->lock, flags);
657 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700658 }
Bartlomiej Zolnierkiewiczc38714e2009-01-06 17:20:59 +0100659 }
660 hwif->handler = NULL;
Bartlomiej Zolnierkiewicz60c0cd02009-03-27 12:46:46 +0100661 hwif->expiry = NULL;
Bartlomiej Zolnierkiewiczc38714e2009-01-06 17:20:59 +0100662 /*
663 * We need to simulate a real interrupt when invoking
664 * the handler() function, which means we need to
665 * globally mask the specific IRQ:
666 */
667 spin_unlock(&hwif->lock);
668 /* disable_irq_nosync ?? */
669 disable_irq(hwif->irq);
670 /* local CPU only, as if we were handling an interrupt */
671 local_irq_disable();
672 if (hwif->polling) {
673 startstop = handler(drive);
674 } else if (drive_is_ready(drive)) {
675 if (drive->waiting_for_dma)
676 hwif->dma_ops->dma_lost_irq(drive);
Bartlomiej Zolnierkiewiczd15a6132009-03-27 12:46:21 +0100677 if (hwif->ack_intr)
678 hwif->ack_intr(hwif);
Bartlomiej Zolnierkiewiczc38714e2009-01-06 17:20:59 +0100679 printk(KERN_WARNING "%s: lost interrupt\n",
680 drive->name);
681 startstop = handler(drive);
682 } else {
683 if (drive->waiting_for_dma)
684 startstop = ide_dma_timeout_retry(drive, wait);
685 else
686 startstop = ide_error(drive, "irq timeout",
687 hwif->tp_ops->read_status(hwif));
688 }
689 spin_lock_irq(&hwif->lock);
690 enable_irq(hwif->irq);
691 if (startstop == ide_stopped) {
692 ide_unlock_port(hwif);
693 plug_device = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700694 }
695 }
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100696 spin_unlock_irqrestore(&hwif->lock, flags);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100697
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100698 if (plug_device) {
699 ide_unlock_host(hwif->host);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100700 ide_plug_device(drive);
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100701 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702}
703
704/**
705 * unexpected_intr - handle an unexpected IDE interrupt
706 * @irq: interrupt line
Bartlomiej Zolnierkiewiczbd53cbc2009-01-06 17:20:48 +0100707 * @hwif: port being processed
Linus Torvalds1da177e2005-04-16 15:20:36 -0700708 *
709 * There's nothing really useful we can do with an unexpected interrupt,
710 * other than reading the status register (to clear it), and logging it.
711 * There should be no way that an irq can happen before we're ready for it,
712 * so we needn't worry much about losing an "important" interrupt here.
713 *
714 * On laptops (and "green" PCs), an unexpected interrupt occurs whenever
715 * the drive enters "idle", "standby", or "sleep" mode, so if the status
716 * looks "good", we just ignore the interrupt completely.
717 *
718 * This routine assumes __cli() is in effect when called.
719 *
720 * If an unexpected interrupt happens on irq15 while we are handling irq14
721 * and if the two interfaces are "serialized" (CMD640), then it looks like
722 * we could screw up by interfering with a new request being set up for
723 * irq15.
724 *
725 * In reality, this is a non-issue. The new command is not sent unless
726 * the drive is ready to accept one, in which case we know the drive is
727 * not trying to interrupt us. And ide_set_handler() is always invoked
728 * before completing the issuance of any new drive command, so we will not
729 * be accidentally invoked as a result of any valid command completion
730 * interrupt.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700731 */
Bartlomiej Zolnierkiewiczbd53cbc2009-01-06 17:20:48 +0100732
733static void unexpected_intr(int irq, ide_hwif_t *hwif)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734{
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100735 u8 stat = hwif->tp_ops->read_status(hwif);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700736
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100737 if (!OK_STAT(stat, ATA_DRDY, BAD_STAT)) {
738 /* Try to not flood the console with msgs */
739 static unsigned long last_msgtime, count;
740 ++count;
Bartlomiej Zolnierkiewiczb73c7ee2008-07-23 19:55:52 +0200741
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100742 if (time_after(jiffies, last_msgtime + HZ)) {
743 last_msgtime = jiffies;
744 printk(KERN_ERR "%s: unexpected interrupt, "
745 "status=0x%02x, count=%ld\n",
746 hwif->name, stat, count);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700747 }
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100748 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700749}
750
751/**
752 * ide_intr - default IDE interrupt handler
753 * @irq: interrupt number
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100754 * @dev_id: hwif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755 * @regs: unused weirdness from the kernel irq layer
756 *
757 * This is the default IRQ handler for the IDE layer. You should
758 * not need to override it. If you do be aware it is subtle in
759 * places
760 *
Bartlomiej Zolnierkiewiczbd53cbc2009-01-06 17:20:48 +0100761 * hwif is the interface in the group currently performing
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100762 * a command. hwif->cur_dev is the drive and hwif->handler is
Linus Torvalds1da177e2005-04-16 15:20:36 -0700763 * the IRQ handler to call. As we issue a command the handlers
764 * step through multiple states, reassigning the handler to the
765 * next step in the process. Unlike a smart SCSI controller IDE
766 * expects the main processor to sequence the various transfer
767 * stages. We also manage a poll timer to catch up with most
768 * timeout situations. There are still a few where the handlers
769 * don't ever decide to give up.
770 *
771 * The handler eventually returns ide_stopped to indicate the
772 * request completed. At this point we issue the next request
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100773 * on the port and the process begins again.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700774 */
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100775
David Howells7d12e782006-10-05 14:55:46 +0100776irqreturn_t ide_intr (int irq, void *dev_id)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700777{
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100778 ide_hwif_t *hwif = (ide_hwif_t *)dev_id;
Bartlomiej Zolnierkiewicz255115fb2009-03-27 12:46:27 +0100779 struct ide_host *host = hwif->host;
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100780 ide_drive_t *uninitialized_var(drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700781 ide_handler_t *handler;
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100782 unsigned long flags;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 ide_startstop_t startstop;
Bartlomiej Zolnierkiewicz3e0e29f2008-12-29 20:27:29 +0100784 irqreturn_t irq_ret = IRQ_NONE;
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100785 int plug_device = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700786
Bartlomiej Zolnierkiewicz255115fb2009-03-27 12:46:27 +0100787 if (host->host_flags & IDE_HFLAG_SERIALIZE) {
788 if (hwif != host->cur_port)
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100789 goto out_early;
790 }
Bartlomiej Zolnierkiewiczbd53cbc2009-01-06 17:20:48 +0100791
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100792 spin_lock_irqsave(&hwif->lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700793
Bartlomiej Zolnierkiewiczd15a6132009-03-27 12:46:21 +0100794 if (hwif->ack_intr && hwif->ack_intr(hwif) == 0)
Bartlomiej Zolnierkiewicz3e0e29f2008-12-29 20:27:29 +0100795 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700796
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100797 handler = hwif->handler;
798
799 if (handler == NULL || hwif->polling) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700800 /*
801 * Not expecting an interrupt from this drive.
802 * That means this could be:
803 * (1) an interrupt from another PCI device
804 * sharing the same PCI INT# as us.
805 * or (2) a drive just entered sleep or standby mode,
806 * and is interrupting to let us know.
807 * or (3) a spurious interrupt of unknown origin.
808 *
809 * For PCI, we cannot tell the difference,
810 * so in that case we just ignore it and hope it goes away.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811 */
Bartlomiej Zolnierkiewicz255115fb2009-03-27 12:46:27 +0100812 if ((host->irq_flags & IRQF_SHARED) == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700813 /*
814 * Probably not a shared PCI interrupt,
815 * so we can safely try to do something about it:
816 */
Bartlomiej Zolnierkiewiczbd53cbc2009-01-06 17:20:48 +0100817 unexpected_intr(irq, hwif);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700818 } else {
819 /*
820 * Whack the status register, just in case
821 * we have a leftover pending IRQ.
822 */
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +0200823 (void)hwif->tp_ops->read_status(hwif);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700824 }
Bartlomiej Zolnierkiewicz3e0e29f2008-12-29 20:27:29 +0100825 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700826 }
Bartlomiej Zolnierkiewicz3e0e29f2008-12-29 20:27:29 +0100827
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100828 drive = hwif->cur_dev;
Bartlomiej Zolnierkiewicz3e0e29f2008-12-29 20:27:29 +0100829
830 if (!drive_is_ready(drive))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700831 /*
832 * This happens regularly when we share a PCI IRQ with
833 * another device. Unfortunately, it can also happen
834 * with some buggy drives that trigger the IRQ before
835 * their status register is up to date. Hopefully we have
836 * enough advance overhead that the latter isn't a problem.
837 */
Bartlomiej Zolnierkiewicz3e0e29f2008-12-29 20:27:29 +0100838 goto out;
839
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100840 hwif->handler = NULL;
Bartlomiej Zolnierkiewicz60c0cd02009-03-27 12:46:46 +0100841 hwif->expiry = NULL;
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100842 hwif->req_gen++;
843 del_timer(&hwif->timer);
844 spin_unlock(&hwif->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700845
Bartlomiej Zolnierkiewiczbfa7d8e2008-10-13 21:39:42 +0200846 if (hwif->port_ops && hwif->port_ops->clear_irq)
847 hwif->port_ops->clear_irq(drive);
Albert Leef0dd8712007-02-17 02:40:21 +0100848
Bartlomiej Zolnierkiewicz97100fc2008-10-13 21:39:36 +0200849 if (drive->dev_flags & IDE_DFLAG_UNMASK)
Ingo Molnar366c7f52006-07-03 00:25:25 -0700850 local_irq_enable_in_hardirq();
Bartlomiej Zolnierkiewiczbfa7d8e2008-10-13 21:39:42 +0200851
Linus Torvalds1da177e2005-04-16 15:20:36 -0700852 /* service this interrupt, may set handler for next interrupt */
853 startstop = handler(drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700854
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100855 spin_lock_irq(&hwif->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700856 /*
857 * Note that handler() may have set things up for another
858 * interrupt to occur soon, but it cannot happen until
859 * we exit from this routine, because it will be the
860 * same irq as is currently being serviced here, and Linux
861 * won't allow another of the same (on any CPU) until we return.
862 */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700863 if (startstop == ide_stopped) {
Bartlomiej Zolnierkiewicz9600dcf2009-01-06 17:20:58 +0100864 BUG_ON(hwif->handler);
865 ide_unlock_port(hwif);
866 plug_device = 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700867 }
Bartlomiej Zolnierkiewicz3e0e29f2008-12-29 20:27:29 +0100868 irq_ret = IRQ_HANDLED;
869out:
Bartlomiej Zolnierkiewiczb65fac32009-01-06 17:20:50 +0100870 spin_unlock_irqrestore(&hwif->lock, flags);
Bartlomiej Zolnierkiewiczae86afa2009-01-06 17:20:48 +0100871out_early:
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100872 if (plug_device) {
873 ide_unlock_host(hwif->host);
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100874 ide_plug_device(drive);
Bartlomiej Zolnierkiewicz5b31f852009-01-06 17:20:49 +0100875 }
Bartlomiej Zolnierkiewicz201bffa2009-01-02 16:12:50 +0100876
Bartlomiej Zolnierkiewicz3e0e29f2008-12-29 20:27:29 +0100877 return irq_ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700878}
Stanislaw Gruszka849d7132009-03-05 16:10:57 +0100879EXPORT_SYMBOL_GPL(ide_intr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700880
Bartlomiej Zolnierkiewicz9f87abe2008-04-28 23:44:41 +0200881void ide_pad_transfer(ide_drive_t *drive, int write, int len)
882{
883 ide_hwif_t *hwif = drive->hwif;
884 u8 buf[4] = { 0 };
885
886 while (len > 0) {
887 if (write)
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +0200888 hwif->tp_ops->output_data(drive, NULL, buf, min(4, len));
Bartlomiej Zolnierkiewicz9f87abe2008-04-28 23:44:41 +0200889 else
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +0200890 hwif->tp_ops->input_data(drive, NULL, buf, min(4, len));
Bartlomiej Zolnierkiewicz9f87abe2008-04-28 23:44:41 +0200891 len -= 4;
892 }
893}
894EXPORT_SYMBOL_GPL(ide_pad_transfer);