blob: f5cf04cf5712ab9b01cc78da9dedeea00c310f80 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Bartlomiej Zolnierkiewicz59bca8c2008-02-01 23:09:33 +01002 * Copyright (C) 2000-2002 Michael Cornwell <cornwell@acm.org>
3 * Copyright (C) 2000-2002 Andre Hedrick <andre@linux-ide.org>
4 * Copyright (C) 2001-2002 Klaus Smolin
Linus Torvalds1da177e2005-04-16 15:20:36 -07005 * IBM Storage Technology Division
Bartlomiej Zolnierkiewicz59bca8c2008-02-01 23:09:33 +01006 * Copyright (C) 2003-2004, 2007 Bartlomiej Zolnierkiewicz
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
8 * The big the bad and the ugly.
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 */
10
Linus Torvalds1da177e2005-04-16 15:20:36 -070011#include <linux/types.h>
12#include <linux/string.h>
13#include <linux/kernel.h>
Andrew Morton651c29a2006-02-15 15:17:37 -080014#include <linux/sched.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <linux/interrupt.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <linux/errno.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070017#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070018#include <linux/delay.h>
19#include <linux/hdreg.h>
20#include <linux/ide.h>
Jens Axboe55c16a72007-07-25 08:13:56 +020021#include <linux/scatterlist.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070022
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <asm/uaccess.h>
24#include <asm/io.h>
25
Bartlomiej Zolnierkiewicz089c5c72008-04-28 23:44:39 +020026void ide_tf_dump(const char *s, struct ide_taskfile *tf)
27{
28#ifdef DEBUG
29 printk("%s: tf: feat 0x%02x nsect 0x%02x lbal 0x%02x "
30 "lbam 0x%02x lbah 0x%02x dev 0x%02x cmd 0x%02x\n",
31 s, tf->feature, tf->nsect, tf->lbal,
32 tf->lbam, tf->lbah, tf->device, tf->command);
33 printk("%s: hob: nsect 0x%02x lbal 0x%02x "
34 "lbam 0x%02x lbah 0x%02x\n",
35 s, tf->hob_nsect, tf->hob_lbal,
36 tf->hob_lbam, tf->hob_lbah);
37#endif
38}
39
Linus Torvalds1da177e2005-04-16 15:20:36 -070040int taskfile_lib_get_identify (ide_drive_t *drive, u8 *buf)
41{
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010042 struct ide_cmd cmd;
Bartlomiej Zolnierkiewicz650d8412008-01-25 22:17:06 +010043
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010044 memset(&cmd, 0, sizeof(cmd));
45 cmd.tf.nsect = 0x01;
Linus Torvalds1da177e2005-04-16 15:20:36 -070046 if (drive->media == ide_disk)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010047 cmd.tf.command = ATA_CMD_ID_ATA;
Linus Torvalds1da177e2005-04-16 15:20:36 -070048 else
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010049 cmd.tf.command = ATA_CMD_ID_ATAPI;
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +010050 cmd.tf_flags = IDE_TFLAG_TF | IDE_TFLAG_DEVICE;
51 cmd.protocol = ATA_PROT_PIO;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010052
53 return ide_raw_taskfile(drive, &cmd, buf, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -070054}
55
Bartlomiej Zolnierkiewicz1192e522008-01-25 22:17:16 +010056static ide_startstop_t task_no_data_intr(ide_drive_t *);
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +010057static ide_startstop_t pre_task_out_intr(ide_drive_t *, struct ide_cmd *);
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +010058static ide_startstop_t task_pio_intr(ide_drive_t *);
Bartlomiej Zolnierkiewicz1192e522008-01-25 22:17:16 +010059
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +010060ide_startstop_t do_rw_taskfile(ide_drive_t *drive, struct ide_cmd *orig_cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -070061{
Bartlomiej Zolnierkiewicz898ec222009-01-06 17:20:52 +010062 ide_hwif_t *hwif = drive->hwif;
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +010063 struct ide_cmd *cmd = &hwif->cmd;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010064 struct ide_taskfile *tf = &cmd->tf;
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +010065 ide_handler_t *handler = NULL;
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +020066 const struct ide_tp_ops *tp_ops = hwif->tp_ops;
Bartlomiej Zolnierkiewiczf37afda2008-04-26 22:25:24 +020067 const struct ide_dma_ops *dma_ops = hwif->dma_ops;
Linus Torvalds1da177e2005-04-16 15:20:36 -070068
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +010069 if (orig_cmd->protocol == ATA_PROT_PIO &&
70 (orig_cmd->tf_flags & IDE_TFLAG_MULTI_PIO) &&
71 drive->mult_count == 0) {
72 printk(KERN_ERR "%s: multimode not set!\n", drive->name);
73 return ide_stopped;
Bartlomiej Zolnierkiewicz1edee602008-01-25 22:17:15 +010074 }
75
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +010076 if (orig_cmd->ftf_flags & IDE_FTFLAG_FLAGGED)
77 orig_cmd->ftf_flags |= IDE_FTFLAG_SET_IN_FLAGS;
Bartlomiej Zolnierkiewicz1edee602008-01-25 22:17:15 +010078
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +010079 memcpy(cmd, orig_cmd, sizeof(*cmd));
Bartlomiej Zolnierkiewiczd6ff9f62008-10-13 21:39:41 +020080
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010081 if ((cmd->tf_flags & IDE_TFLAG_DMA_PIO_FALLBACK) == 0) {
Bartlomiej Zolnierkiewicz089c5c72008-04-28 23:44:39 +020082 ide_tf_dump(drive->name, tf);
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +020083 tp_ops->set_irq(hwif, 1);
Bartlomiej Zolnierkiewiczed4af482008-07-15 21:21:48 +020084 SELECT_MASK(drive, 0);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010085 tp_ops->tf_load(drive, cmd);
Bartlomiej Zolnierkiewicz089c5c72008-04-28 23:44:39 +020086 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070087
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +010088 switch (cmd->protocol) {
89 case ATA_PROT_PIO:
90 if (cmd->tf_flags & IDE_TFLAG_WRITE) {
91 tp_ops->exec_command(hwif, tf->command);
92 ndelay(400); /* FIXME */
93 return pre_task_out_intr(drive, cmd);
94 }
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +010095 handler = task_pio_intr;
Bartlomiej Zolnierkiewicz1192e522008-01-25 22:17:16 +010096 /* fall-through */
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +010097 case ATA_PROT_NODATA:
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +010098 if (handler == NULL)
99 handler = task_no_data_intr;
Bartlomiej Zolnierkiewicz57d73662008-01-25 22:17:16 +0100100 ide_execute_command(drive, tf->command, handler,
Bartlomiej Zolnierkiewicz22117d62009-03-27 12:46:47 +0100101 WAIT_WORSTCASE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 return ide_started;
Bartlomiej Zolnierkiewiczb788ee92009-03-27 12:46:46 +0100103 case ATA_PROT_DMA:
Bartlomiej Zolnierkiewicz97100fc2008-10-13 21:39:36 +0200104 if ((drive->dev_flags & IDE_DFLAG_USING_DMA) == 0 ||
Bartlomiej Zolnierkiewicz229816942009-03-27 12:46:46 +0100105 ide_build_sglist(drive, cmd) == 0 ||
106 dma_ops->dma_setup(drive, cmd))
Bartlomiej Zolnierkiewicz10d90152008-01-25 22:17:16 +0100107 return ide_stopped;
Bartlomiej Zolnierkiewicz22117d62009-03-27 12:46:47 +0100108 hwif->expiry = dma_ops->dma_timer_expiry;
109 ide_execute_command(drive, tf->command, ide_dma_intr,
110 2 * WAIT_CMD);
Bartlomiej Zolnierkiewicz5e37bdc2008-04-26 22:25:24 +0200111 dma_ops->dma_start(drive);
Bartlomiej Zolnierkiewiczb788ee92009-03-27 12:46:46 +0100112 default:
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100113 return ide_started;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700115}
Bartlomiej Zolnierkiewiczf6e29e32008-01-25 22:17:16 +0100116EXPORT_SYMBOL_GPL(do_rw_taskfile);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117
Bartlomiej Zolnierkiewiczd6ff9f62008-10-13 21:39:41 +0200118static ide_startstop_t task_no_data_intr(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700119{
Bartlomiej Zolnierkiewiczb73c7ee2008-07-23 19:55:52 +0200120 ide_hwif_t *hwif = drive->hwif;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100121 struct ide_cmd *cmd = &hwif->cmd;
122 struct ide_taskfile *tf = &cmd->tf;
123 int custom = (cmd->tf_flags & IDE_TFLAG_CUSTOM_HANDLER) ? 1 : 0;
Bartlomiej Zolnierkiewiczd6ff9f62008-10-13 21:39:41 +0200124 int retries = (custom && tf->command == ATA_CMD_INIT_DEV_PARAMS) ? 5 : 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700125 u8 stat;
126
Bartlomiej Zolnierkiewicz90d2c6b2008-07-24 22:53:36 +0200127 local_irq_enable_in_hardirq();
128
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +0200129 while (1) {
130 stat = hwif->tp_ops->read_status(hwif);
Bartlomiej Zolnierkiewicz3a7d2482008-10-10 22:39:21 +0200131 if ((stat & ATA_BUSY) == 0 || retries-- == 0)
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +0200132 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700133 udelay(10);
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +0200134 };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135
Bartlomiej Zolnierkiewiczd6ff9f62008-10-13 21:39:41 +0200136 if (!OK_STAT(stat, ATA_DRDY, BAD_STAT)) {
137 if (custom && tf->command == ATA_CMD_SET_MULTI) {
138 drive->mult_req = drive->mult_count = 0;
139 drive->special.b.recalibrate = 1;
140 (void)ide_dump_status(drive, __func__, stat);
141 return ide_stopped;
142 } else if (custom && tf->command == ATA_CMD_INIT_DEV_PARAMS) {
143 if ((stat & (ATA_ERR | ATA_DRQ)) == 0) {
144 ide_set_handler(drive, &task_no_data_intr,
Bartlomiej Zolnierkiewicz60c0cd02009-03-27 12:46:46 +0100145 WAIT_WORSTCASE);
Bartlomiej Zolnierkiewiczd6ff9f62008-10-13 21:39:41 +0200146 return ide_started;
147 }
148 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 return ide_error(drive, "task_no_data_intr", stat);
Bartlomiej Zolnierkiewiczd6ff9f62008-10-13 21:39:41 +0200150 }
Bartlomiej Zolnierkiewiczc47137a2008-02-06 02:57:51 +0100151
Bartlomiej Zolnierkiewicze7fedc32009-03-27 12:46:41 +0100152 if (custom && tf->command == ATA_CMD_SET_MULTI)
Bartlomiej Zolnierkiewiczd6ff9f62008-10-13 21:39:41 +0200153 drive->mult_count = drive->mult_req;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154
Bartlomiej Zolnierkiewiczd364c7f2009-03-27 12:46:42 +0100155 if (custom == 0 || tf->command == ATA_CMD_IDLEIMMEDIATE ||
156 tf->command == ATA_CMD_CHK_POWER) {
Bartlomiej Zolnierkiewicza09485d2009-03-27 12:46:31 +0100157 struct request *rq = hwif->rq;
Bartlomiej Zolnierkiewicza09485d2009-03-27 12:46:31 +0100158
159 if (blk_pm_request(rq))
160 ide_complete_pm_rq(drive, rq);
Bartlomiej Zolnierkiewicz2230d90d2009-03-27 12:46:42 +0100161 else
162 ide_finish_cmd(drive, cmd, stat);
Bartlomiej Zolnierkiewicza09485d2009-03-27 12:46:31 +0100163 }
164
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165 return ide_stopped;
166}
167
Adrian Bunkda6f4c72008-02-01 23:09:16 +0100168static u8 wait_drive_not_busy(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169{
Bartlomiej Zolnierkiewiczb73c7ee2008-07-23 19:55:52 +0200170 ide_hwif_t *hwif = drive->hwif;
Masatake YAMATOb42fa132007-07-03 22:28:34 +0200171 int retries;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172 u8 stat;
173
174 /*
Bartlomiej Zolnierkiewiczf54feaf2008-06-20 20:53:33 +0200175 * Last sector was transfered, wait until device is ready. This can
176 * take up to 6 ms on some ATAPI devices, so we will wait max 10 ms.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177 */
Bartlomiej Zolnierkiewiczf54feaf2008-06-20 20:53:33 +0200178 for (retries = 0; retries < 1000; retries++) {
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +0200179 stat = hwif->tp_ops->read_status(hwif);
Bartlomiej Zolnierkiewiczc47137a2008-02-06 02:57:51 +0100180
Bartlomiej Zolnierkiewicz3a7d2482008-10-10 22:39:21 +0200181 if (stat & ATA_BUSY)
Masatake YAMATOb42fa132007-07-03 22:28:34 +0200182 udelay(10);
183 else
184 break;
185 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186
Bartlomiej Zolnierkiewicz3a7d2482008-10-10 22:39:21 +0200187 if (stat & ATA_BUSY)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700188 printk(KERN_ERR "%s: drive still BUSY!\n", drive->name);
189
190 return stat;
191}
192
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100193static void ide_pio_sector(ide_drive_t *drive, struct ide_cmd *cmd,
Bartlomiej Zolnierkiewicz92d3ab22008-04-28 23:44:36 +0200194 unsigned int write)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700195{
196 ide_hwif_t *hwif = drive->hwif;
197 struct scatterlist *sg = hwif->sg_table;
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100198 struct scatterlist *cursg = cmd->cursg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199 struct page *page;
200#ifdef CONFIG_HIGHMEM
201 unsigned long flags;
202#endif
203 unsigned int offset;
204 u8 *buf;
205
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100206 cursg = cmd->cursg;
Jens Axboe55c16a72007-07-25 08:13:56 +0200207 if (!cursg) {
208 cursg = sg;
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100209 cmd->cursg = sg;
Jens Axboe55c16a72007-07-25 08:13:56 +0200210 }
211
Jens Axboe45711f12007-10-22 21:19:53 +0200212 page = sg_page(cursg);
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100213 offset = cursg->offset + cmd->cursg_ofs * SECTOR_SIZE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214
215 /* get the current page and offset */
216 page = nth_page(page, (offset >> PAGE_SHIFT));
217 offset %= PAGE_SIZE;
218
219#ifdef CONFIG_HIGHMEM
220 local_irq_save(flags);
221#endif
222 buf = kmap_atomic(page, KM_BIO_SRC_IRQ) + offset;
223
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100224 cmd->nleft--;
225 cmd->cursg_ofs++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100227 if ((cmd->cursg_ofs * SECTOR_SIZE) == cursg->length) {
228 cmd->cursg = sg_next(cmd->cursg);
229 cmd->cursg_ofs = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230 }
231
232 /* do the actual data transfer */
233 if (write)
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100234 hwif->tp_ops->output_data(drive, cmd, buf, SECTOR_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700235 else
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100236 hwif->tp_ops->input_data(drive, cmd, buf, SECTOR_SIZE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237
238 kunmap_atomic(buf, KM_BIO_SRC_IRQ);
239#ifdef CONFIG_HIGHMEM
240 local_irq_restore(flags);
241#endif
242}
243
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100244static void ide_pio_multi(ide_drive_t *drive, struct ide_cmd *cmd,
Bartlomiej Zolnierkiewicz92d3ab22008-04-28 23:44:36 +0200245 unsigned int write)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700246{
247 unsigned int nsect;
248
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100249 nsect = min_t(unsigned int, cmd->nleft, drive->mult_count);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 while (nsect--)
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100251 ide_pio_sector(drive, cmd, write);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252}
253
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100254static void ide_pio_datablock(ide_drive_t *drive, struct ide_cmd *cmd,
255 unsigned int write)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256{
Tejun Heo35cf2b92008-01-26 20:13:10 +0100257 u8 saved_io_32bit = drive->io_32bit;
258
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100259 if (cmd->tf_flags & IDE_TFLAG_FS)
260 cmd->rq->errors = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100262 if (cmd->tf_flags & IDE_TFLAG_IO_16BIT)
Bartlomiej Zolnierkiewicze3d9a732009-03-27 12:46:32 +0100263 drive->io_32bit = 0;
Tejun Heo35cf2b92008-01-26 20:13:10 +0100264
Andrew Morton651c29a2006-02-15 15:17:37 -0800265 touch_softlockup_watchdog();
266
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100267 if (cmd->tf_flags & IDE_TFLAG_MULTI_PIO)
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100268 ide_pio_multi(drive, cmd, write);
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100269 else
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100270 ide_pio_sector(drive, cmd, write);
Tejun Heo35cf2b92008-01-26 20:13:10 +0100271
272 drive->io_32bit = saved_io_32bit;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700273}
274
Bartlomiej Zolnierkiewicz041cea12009-03-27 12:46:41 +0100275static void ide_error_cmd(ide_drive_t *drive, struct ide_cmd *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700276{
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100277 if (cmd->tf_flags & IDE_TFLAG_FS) {
Bartlomiej Zolnierkiewiczb6308ee2009-03-27 12:46:38 +0100278 int sectors = cmd->nsect - cmd->nleft;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100280 if (cmd->protocol == ATA_PROT_PIO &&
281 ((cmd->tf_flags & IDE_TFLAG_WRITE) || cmd->nleft == 0)) {
282 if (cmd->tf_flags & IDE_TFLAG_MULTI_PIO)
283 sectors -= drive->mult_count;
284 else
285 sectors--;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700286 }
287
Bartlomiej Zolnierkiewiczc152cc12009-03-27 12:46:34 +0100288 if (sectors > 0)
Bartlomiej Zolnierkiewicz130e8862009-03-27 12:46:45 +0100289 ide_complete_rq(drive, 0, sectors << 9);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700291}
292
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100293void ide_finish_cmd(ide_drive_t *drive, struct ide_cmd *cmd, u8 stat)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700294{
Bartlomiej Zolnierkiewicz6902a532009-03-27 12:46:43 +0100295 struct request *rq = drive->hwif->rq;
Bartlomiej Zolnierkiewicz2230d90d2009-03-27 12:46:42 +0100296 u8 err = ide_read_error(drive);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297
Bartlomiej Zolnierkiewicz2230d90d2009-03-27 12:46:42 +0100298 ide_complete_cmd(drive, cmd, stat, err);
Bartlomiej Zolnierkiewicz6902a532009-03-27 12:46:43 +0100299 rq->errors = err;
Bartlomiej Zolnierkiewiczf974b192009-03-27 12:46:44 +0100300 ide_complete_rq(drive, err ? -EIO : 0, blk_rq_bytes(rq));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301}
302
303/*
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100304 * Handler for command with PIO data phase.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700305 */
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100306static ide_startstop_t task_pio_intr(ide_drive_t *drive)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307{
308 ide_hwif_t *hwif = drive->hwif;
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100309 struct ide_cmd *cmd = &drive->hwif->cmd;
Bartlomiej Zolnierkiewicz374e0422008-07-23 19:55:56 +0200310 u8 stat = hwif->tp_ops->read_status(hwif);
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100311 u8 write = !!(cmd->tf_flags & IDE_TFLAG_WRITE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700312
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100313 if (write == 0) {
314 /* Error? */
315 if (stat & ATA_ERR)
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100316 goto out_err;
Linus Torvalds6c3c3152008-03-18 21:26:24 -0700317
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100318 /* Didn't want any data? Odd. */
Bartlomiej Zolnierkiewicz151055e2009-03-27 12:46:39 +0100319 if ((stat & ATA_DRQ) == 0) {
320 /* Command all done? */
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100321 if (OK_STAT(stat, ATA_DRDY, ATA_BUSY))
322 goto out_end;
Bartlomiej Zolnierkiewicz151055e2009-03-27 12:46:39 +0100323
324 /* Assume it was a spurious irq */
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100325 goto out_wait;
Bartlomiej Zolnierkiewicz151055e2009-03-27 12:46:39 +0100326 }
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100327 } else {
328 if (!OK_STAT(stat, DRIVE_READY, drive->bad_wstat))
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100329 goto out_err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700330
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100331 /* Deal with unexpected ATA data phase. */
332 if (((stat & ATA_DRQ) == 0) ^ (cmd->nleft == 0))
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100333 goto out_err;
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100334 }
335
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100336 if (write && cmd->nleft == 0)
337 goto out_end;
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100338
339 /* Still data left to transfer. */
340 ide_pio_datablock(drive, cmd, write);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700341
Linus Torvalds6c3c3152008-03-18 21:26:24 -0700342 /* Are we done? Check status and finish transfer. */
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100343 if (write == 0 && cmd->nleft == 0) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700344 stat = wait_drive_not_busy(drive);
Bartlomiej Zolnierkiewicz73d7de02008-01-26 20:13:10 +0100345 if (!OK_STAT(stat, 0, BAD_STAT))
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100346 goto out_err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100348 goto out_end;
349 }
350out_wait:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 /* Still data left to transfer. */
Bartlomiej Zolnierkiewicz60c0cd02009-03-27 12:46:46 +0100352 ide_set_handler(drive, &task_pio_intr, WAIT_WORSTCASE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700353 return ide_started;
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100354out_end:
Bartlomiej Zolnierkiewicz2230d90d2009-03-27 12:46:42 +0100355 if ((cmd->tf_flags & IDE_TFLAG_FS) == 0)
356 ide_finish_cmd(drive, cmd, stat);
357 else
Bartlomiej Zolnierkiewicz130e8862009-03-27 12:46:45 +0100358 ide_complete_rq(drive, 0, cmd->rq->nr_sectors << 9);
Bartlomiej Zolnierkiewicz0a1248c2009-03-27 12:46:41 +0100359 return ide_stopped;
360out_err:
Bartlomiej Zolnierkiewicz041cea12009-03-27 12:46:41 +0100361 ide_error_cmd(drive, cmd);
362 return ide_error(drive, __func__, stat);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363}
364
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100365static ide_startstop_t pre_task_out_intr(ide_drive_t *drive,
366 struct ide_cmd *cmd)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700367{
368 ide_startstop_t startstop;
369
Bartlomiej Zolnierkiewicz3a7d2482008-10-10 22:39:21 +0200370 if (ide_wait_stat(&startstop, drive, ATA_DRQ,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371 drive->bad_wstat, WAIT_DRQ)) {
372 printk(KERN_ERR "%s: no DRQ after issuing %sWRITE%s\n",
Bartlomiej Zolnierkiewiczc7db9662009-03-27 12:46:27 +0100373 drive->name,
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100374 (cmd->tf_flags & IDE_TFLAG_MULTI_PIO) ? "MULT" : "",
Bartlomiej Zolnierkiewicz97100fc2008-10-13 21:39:36 +0200375 (drive->dev_flags & IDE_DFLAG_LBA48) ? "_EXT" : "");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376 return startstop;
377 }
378
Bartlomiej Zolnierkiewicz97100fc2008-10-13 21:39:36 +0200379 if ((drive->dev_flags & IDE_DFLAG_UNMASK) == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380 local_irq_disable();
381
Bartlomiej Zolnierkiewicz60c0cd02009-03-27 12:46:46 +0100382 ide_set_handler(drive, &task_pio_intr, WAIT_WORSTCASE);
Bartlomiej Zolnierkiewicz901bd08a2009-03-27 12:46:39 +0100383
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100384 ide_pio_datablock(drive, cmd, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385
386 return ide_started;
387}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100389int ide_raw_taskfile(ide_drive_t *drive, struct ide_cmd *cmd, u8 *buf,
390 u16 nsect)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700391{
FUJITA Tomonori154ed282008-07-15 21:21:43 +0200392 struct request *rq;
393 int error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700394
FUJITA Tomonori154ed282008-07-15 21:21:43 +0200395 rq = blk_get_request(drive->queue, READ, __GFP_WAIT);
396 rq->cmd_type = REQ_TYPE_ATA_TASKFILE;
397 rq->buffer = buf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700398
399 /*
400 * (ks) We transfer currently only whole sectors.
401 * This is suffient for now. But, it would be great,
402 * if we would find a solution to transfer any size.
403 * To support special commands like READ LONG.
404 */
FUJITA Tomonori154ed282008-07-15 21:21:43 +0200405 rq->hard_nr_sectors = rq->nr_sectors = nsect;
406 rq->hard_cur_sectors = rq->current_nr_sectors = nsect;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100408 if (cmd->tf_flags & IDE_TFLAG_WRITE)
FUJITA Tomonori154ed282008-07-15 21:21:43 +0200409 rq->cmd_flags |= REQ_RW;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700410
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100411 rq->special = cmd;
412 cmd->rq = rq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413
FUJITA Tomonori154ed282008-07-15 21:21:43 +0200414 error = blk_execute_rq(drive->queue, NULL, rq, 0);
415 blk_put_request(rq);
416
417 return error;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418}
419
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420EXPORT_SYMBOL(ide_raw_taskfile);
421
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100422int ide_no_data_taskfile(ide_drive_t *drive, struct ide_cmd *cmd)
Bartlomiej Zolnierkiewicz9a3c49b2008-01-25 22:17:07 +0100423{
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100424 cmd->protocol = ATA_PROT_NODATA;
Bartlomiej Zolnierkiewicz9a3c49b2008-01-25 22:17:07 +0100425
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100426 return ide_raw_taskfile(drive, cmd, NULL, 0);
Bartlomiej Zolnierkiewicz9a3c49b2008-01-25 22:17:07 +0100427}
428EXPORT_SYMBOL_GPL(ide_no_data_taskfile);
429
Bartlomiej Zolnierkiewicz26a5b042007-11-05 21:42:27 +0100430#ifdef CONFIG_IDE_TASK_IOCTL
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100431int ide_taskfile_ioctl(ide_drive_t *drive, unsigned long arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432{
433 ide_task_request_t *req_task;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100434 struct ide_cmd cmd;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700435 u8 *outbuf = NULL;
436 u8 *inbuf = NULL;
Bartlomiej Zolnierkiewiczac026ff2008-01-25 22:17:14 +0100437 u8 *data_buf = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438 int err = 0;
439 int tasksize = sizeof(struct ide_task_request_s);
Alan Cox3a42bb22006-10-16 16:31:02 +0100440 unsigned int taskin = 0;
441 unsigned int taskout = 0;
Bartlomiej Zolnierkiewiczac026ff2008-01-25 22:17:14 +0100442 u16 nsect = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443 char __user *buf = (char __user *)arg;
444
445// printk("IDE Taskfile ...\n");
446
Deepak Saxenaf5e3c2f2005-11-07 01:01:25 -0800447 req_task = kzalloc(tasksize, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448 if (req_task == NULL) return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 if (copy_from_user(req_task, buf, tasksize)) {
450 kfree(req_task);
451 return -EFAULT;
452 }
453
Alan Cox3a42bb22006-10-16 16:31:02 +0100454 taskout = req_task->out_size;
455 taskin = req_task->in_size;
456
457 if (taskin > 65536 || taskout > 65536) {
458 err = -EINVAL;
459 goto abort;
460 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461
462 if (taskout) {
463 int outtotal = tasksize;
Deepak Saxenaf5e3c2f2005-11-07 01:01:25 -0800464 outbuf = kzalloc(taskout, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700465 if (outbuf == NULL) {
466 err = -ENOMEM;
467 goto abort;
468 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700469 if (copy_from_user(outbuf, buf + outtotal, taskout)) {
470 err = -EFAULT;
471 goto abort;
472 }
473 }
474
475 if (taskin) {
476 int intotal = tasksize + taskout;
Deepak Saxenaf5e3c2f2005-11-07 01:01:25 -0800477 inbuf = kzalloc(taskin, GFP_KERNEL);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700478 if (inbuf == NULL) {
479 err = -ENOMEM;
480 goto abort;
481 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700482 if (copy_from_user(inbuf, buf + intotal, taskin)) {
483 err = -EFAULT;
484 goto abort;
485 }
486 }
487
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100488 memset(&cmd, 0, sizeof(cmd));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700489
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100490 memcpy(&cmd.tf_array[0], req_task->hob_ports,
491 HDIO_DRIVE_HOB_HDR_SIZE - 2);
492 memcpy(&cmd.tf_array[6], req_task->io_ports,
493 HDIO_DRIVE_TASK_HDR_SIZE);
Bartlomiej Zolnierkiewicz866e2ec2008-01-25 22:17:14 +0100494
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100495 cmd.tf_flags = IDE_TFLAG_IO_16BIT | IDE_TFLAG_DEVICE |
496 IDE_TFLAG_IN_TF;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497
Bartlomiej Zolnierkiewicz97100fc2008-10-13 21:39:36 +0200498 if (drive->dev_flags & IDE_DFLAG_LBA48)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100499 cmd.tf_flags |= (IDE_TFLAG_LBA48 | IDE_TFLAG_IN_HOB);
Bartlomiej Zolnierkiewicza3bbb9d2008-01-25 22:17:10 +0100500
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100501 if (req_task->out_flags.all) {
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100502 cmd.ftf_flags |= IDE_FTFLAG_FLAGGED;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100503
504 if (req_task->out_flags.b.data)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100505 cmd.ftf_flags |= IDE_FTFLAG_OUT_DATA;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100506
507 if (req_task->out_flags.b.nsector_hob)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100508 cmd.tf_flags |= IDE_TFLAG_OUT_HOB_NSECT;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100509 if (req_task->out_flags.b.sector_hob)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100510 cmd.tf_flags |= IDE_TFLAG_OUT_HOB_LBAL;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100511 if (req_task->out_flags.b.lcyl_hob)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100512 cmd.tf_flags |= IDE_TFLAG_OUT_HOB_LBAM;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100513 if (req_task->out_flags.b.hcyl_hob)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100514 cmd.tf_flags |= IDE_TFLAG_OUT_HOB_LBAH;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100515
516 if (req_task->out_flags.b.error_feature)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100517 cmd.tf_flags |= IDE_TFLAG_OUT_FEATURE;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100518 if (req_task->out_flags.b.nsector)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100519 cmd.tf_flags |= IDE_TFLAG_OUT_NSECT;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100520 if (req_task->out_flags.b.sector)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100521 cmd.tf_flags |= IDE_TFLAG_OUT_LBAL;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100522 if (req_task->out_flags.b.lcyl)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100523 cmd.tf_flags |= IDE_TFLAG_OUT_LBAM;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100524 if (req_task->out_flags.b.hcyl)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100525 cmd.tf_flags |= IDE_TFLAG_OUT_LBAH;
Bartlomiej Zolnierkiewicza3bbb9d2008-01-25 22:17:10 +0100526 } else {
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100527 cmd.tf_flags |= IDE_TFLAG_OUT_TF;
528 if (cmd.tf_flags & IDE_TFLAG_LBA48)
529 cmd.tf_flags |= IDE_TFLAG_OUT_HOB;
Bartlomiej Zolnierkiewicz74095a92008-01-25 22:17:07 +0100530 }
531
Bartlomiej Zolnierkiewicz866e2ec2008-01-25 22:17:14 +0100532 if (req_task->in_flags.b.data)
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100533 cmd.ftf_flags |= IDE_FTFLAG_IN_DATA;
Bartlomiej Zolnierkiewicz866e2ec2008-01-25 22:17:14 +0100534
Bartlomiej Zolnierkiewicz04d09b02009-03-27 12:46:38 +0100535 if (req_task->req_cmd == IDE_DRIVE_TASK_RAW_WRITE) {
536 /* fixup data phase if needed */
537 if (req_task->data_phase == TASKFILE_IN_DMAQ ||
538 req_task->data_phase == TASKFILE_IN_DMA)
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100539 cmd.tf_flags |= IDE_TFLAG_WRITE;
Bartlomiej Zolnierkiewicz04d09b02009-03-27 12:46:38 +0100540 }
541
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100542 cmd.protocol = ATA_PROT_DMA;
543
544 switch (req_task->data_phase) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700545 case TASKFILE_MULTI_OUT:
546 if (!drive->mult_count) {
547 /* (hs): give up if multcount is not set */
548 printk(KERN_ERR "%s: %s Multimode Write " \
549 "multcount is not set\n",
Harvey Harrisoneb639632008-04-26 22:25:20 +0200550 drive->name, __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 err = -EPERM;
552 goto abort;
553 }
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100554 cmd.tf_flags |= IDE_TFLAG_MULTI_PIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555 /* fall through */
556 case TASKFILE_OUT:
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100557 cmd.protocol = ATA_PROT_PIO;
Bartlomiej Zolnierkiewiczac026ff2008-01-25 22:17:14 +0100558 /* fall through */
559 case TASKFILE_OUT_DMAQ:
560 case TASKFILE_OUT_DMA:
Bartlomiej Zolnierkiewicz04d09b02009-03-27 12:46:38 +0100561 cmd.tf_flags |= IDE_TFLAG_WRITE;
Bartlomiej Zolnierkiewiczac026ff2008-01-25 22:17:14 +0100562 nsect = taskout / SECTOR_SIZE;
563 data_buf = outbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564 break;
565 case TASKFILE_MULTI_IN:
566 if (!drive->mult_count) {
567 /* (hs): give up if multcount is not set */
568 printk(KERN_ERR "%s: %s Multimode Read failure " \
569 "multcount is not set\n",
Harvey Harrisoneb639632008-04-26 22:25:20 +0200570 drive->name, __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700571 err = -EPERM;
572 goto abort;
573 }
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100574 cmd.tf_flags |= IDE_TFLAG_MULTI_PIO;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700575 /* fall through */
576 case TASKFILE_IN:
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100577 cmd.protocol = ATA_PROT_PIO;
Bartlomiej Zolnierkiewiczac026ff2008-01-25 22:17:14 +0100578 /* fall through */
579 case TASKFILE_IN_DMAQ:
580 case TASKFILE_IN_DMA:
581 nsect = taskin / SECTOR_SIZE;
582 data_buf = inbuf;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700583 break;
584 case TASKFILE_NO_DATA:
Bartlomiej Zolnierkiewicz0dfb9912009-03-27 12:46:39 +0100585 cmd.protocol = ATA_PROT_NODATA;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700586 break;
587 default:
588 err = -EFAULT;
589 goto abort;
590 }
591
Bartlomiej Zolnierkiewiczac026ff2008-01-25 22:17:14 +0100592 if (req_task->req_cmd == IDE_DRIVE_TASK_NO_DATA)
593 nsect = 0;
594 else if (!nsect) {
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100595 nsect = (cmd.tf.hob_nsect << 8) | cmd.tf.nsect;
Bartlomiej Zolnierkiewiczac026ff2008-01-25 22:17:14 +0100596
597 if (!nsect) {
598 printk(KERN_ERR "%s: in/out command without data\n",
599 drive->name);
600 err = -EFAULT;
601 goto abort;
602 }
603 }
604
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100605 err = ide_raw_taskfile(drive, &cmd, data_buf, nsect);
Bartlomiej Zolnierkiewiczac026ff2008-01-25 22:17:14 +0100606
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100607 memcpy(req_task->hob_ports, &cmd.tf_array[0],
608 HDIO_DRIVE_HOB_HDR_SIZE - 2);
609 memcpy(req_task->io_ports, &cmd.tf_array[6],
610 HDIO_DRIVE_TASK_HDR_SIZE);
Bartlomiej Zolnierkiewicz866e2ec2008-01-25 22:17:14 +0100611
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100612 if ((cmd.ftf_flags & IDE_FTFLAG_SET_IN_FLAGS) &&
Bartlomiej Zolnierkiewicz866e2ec2008-01-25 22:17:14 +0100613 req_task->in_flags.all == 0) {
614 req_task->in_flags.all = IDE_TASKFILE_STD_IN_FLAGS;
Bartlomiej Zolnierkiewicz97100fc2008-10-13 21:39:36 +0200615 if (drive->dev_flags & IDE_DFLAG_LBA48)
Bartlomiej Zolnierkiewicz866e2ec2008-01-25 22:17:14 +0100616 req_task->in_flags.all |= (IDE_HOB_STD_IN_FLAGS << 8);
617 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618
619 if (copy_to_user(buf, req_task, tasksize)) {
620 err = -EFAULT;
621 goto abort;
622 }
623 if (taskout) {
624 int outtotal = tasksize;
625 if (copy_to_user(buf + outtotal, outbuf, taskout)) {
626 err = -EFAULT;
627 goto abort;
628 }
629 }
630 if (taskin) {
631 int intotal = tasksize + taskout;
632 if (copy_to_user(buf + intotal, inbuf, taskin)) {
633 err = -EFAULT;
634 goto abort;
635 }
636 }
637abort:
638 kfree(req_task);
Jesper Juhl6044ec82005-11-07 01:01:32 -0800639 kfree(outbuf);
640 kfree(inbuf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700641
642// printk("IDE Taskfile ioctl ended. rc = %i\n", err);
643
Linus Torvalds1da177e2005-04-16 15:20:36 -0700644 return err;
645}
Bartlomiej Zolnierkiewicz26a5b042007-11-05 21:42:27 +0100646#endif