ide: simplify 'struct ide_taskfile'
[linux-2.6-block.git] / drivers / ide / ide-io-std.c
CommitLineData
1574cf6c
BZ
1
2#include <linux/kernel.h>
3#include <linux/ide.h>
4
15a453a9
BZ
5#if defined(CONFIG_ARM) || defined(CONFIG_M68K) || defined(CONFIG_MIPS) || \
6 defined(CONFIG_PARISC) || defined(CONFIG_PPC) || defined(CONFIG_SPARC)
7#include <asm/ide.h>
8#else
9#include <asm-generic/ide_iops.h>
10#endif
11
1574cf6c
BZ
12/*
13 * Conventional PIO operations for ATA devices
14 */
15
16static u8 ide_inb(unsigned long port)
17{
18 return (u8) inb(port);
19}
20
21static void ide_outb(u8 val, unsigned long port)
22{
23 outb(val, port);
24}
25
26/*
27 * MMIO operations, typically used for SATA controllers
28 */
29
30static u8 ide_mm_inb(unsigned long port)
31{
32 return (u8) readb((void __iomem *) port);
33}
34
35static void ide_mm_outb(u8 value, unsigned long port)
36{
37 writeb(value, (void __iomem *) port);
38}
39
40void ide_exec_command(ide_hwif_t *hwif, u8 cmd)
41{
42 if (hwif->host_flags & IDE_HFLAG_MMIO)
43 writeb(cmd, (void __iomem *)hwif->io_ports.command_addr);
44 else
45 outb(cmd, hwif->io_ports.command_addr);
46}
47EXPORT_SYMBOL_GPL(ide_exec_command);
48
49u8 ide_read_status(ide_hwif_t *hwif)
50{
51 if (hwif->host_flags & IDE_HFLAG_MMIO)
52 return readb((void __iomem *)hwif->io_ports.status_addr);
53 else
54 return inb(hwif->io_ports.status_addr);
55}
56EXPORT_SYMBOL_GPL(ide_read_status);
57
58u8 ide_read_altstatus(ide_hwif_t *hwif)
59{
60 if (hwif->host_flags & IDE_HFLAG_MMIO)
61 return readb((void __iomem *)hwif->io_ports.ctl_addr);
62 else
63 return inb(hwif->io_ports.ctl_addr);
64}
65EXPORT_SYMBOL_GPL(ide_read_altstatus);
66
ecf3a31d 67void ide_write_devctl(ide_hwif_t *hwif, u8 ctl)
1574cf6c 68{
1574cf6c
BZ
69 if (hwif->host_flags & IDE_HFLAG_MMIO)
70 writeb(ctl, (void __iomem *)hwif->io_ports.ctl_addr);
71 else
72 outb(ctl, hwif->io_ports.ctl_addr);
73}
ecf3a31d 74EXPORT_SYMBOL_GPL(ide_write_devctl);
1574cf6c 75
abb596b2
SS
76void ide_dev_select(ide_drive_t *drive)
77{
78 ide_hwif_t *hwif = drive->hwif;
79 u8 select = drive->select | ATA_DEVICE_OBS;
80
81 if (hwif->host_flags & IDE_HFLAG_MMIO)
82 writeb(select, (void __iomem *)hwif->io_ports.device_addr);
83 else
84 outb(select, hwif->io_ports.device_addr);
85}
86EXPORT_SYMBOL_GPL(ide_dev_select);
87
22aa4b32 88void ide_tf_load(ide_drive_t *drive, struct ide_cmd *cmd)
1574cf6c
BZ
89{
90 ide_hwif_t *hwif = drive->hwif;
91 struct ide_io_ports *io_ports = &hwif->io_ports;
745483f1 92 struct ide_taskfile *tf = &cmd->hob;
1574cf6c 93 void (*tf_outb)(u8 addr, unsigned long port);
60f85019 94 u8 valid = cmd->valid.out.hob;
1574cf6c 95 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
22aa4b32 96 u8 HIHI = (cmd->tf_flags & IDE_TFLAG_LBA48) ? 0xE0 : 0xEF;
1574cf6c
BZ
97
98 if (mmio)
99 tf_outb = ide_mm_outb;
100 else
101 tf_outb = ide_outb;
102
22aa4b32 103 if (cmd->ftf_flags & IDE_FTFLAG_FLAGGED)
1574cf6c
BZ
104 HIHI = 0xFF;
105
60f85019 106 if (valid & IDE_VALID_FEATURE)
745483f1 107 tf_outb(tf->feature, io_ports->feature_addr);
60f85019 108 if (valid & IDE_VALID_NSECT)
745483f1 109 tf_outb(tf->nsect, io_ports->nsect_addr);
60f85019 110 if (valid & IDE_VALID_LBAL)
745483f1 111 tf_outb(tf->lbal, io_ports->lbal_addr);
60f85019 112 if (valid & IDE_VALID_LBAM)
745483f1 113 tf_outb(tf->lbam, io_ports->lbam_addr);
60f85019 114 if (valid & IDE_VALID_LBAH)
745483f1 115 tf_outb(tf->lbah, io_ports->lbah_addr);
1574cf6c 116
745483f1 117 tf = &cmd->tf;
60f85019
SS
118 valid = cmd->valid.out.tf;
119
120 if (valid & IDE_VALID_FEATURE)
1574cf6c 121 tf_outb(tf->feature, io_ports->feature_addr);
60f85019 122 if (valid & IDE_VALID_NSECT)
1574cf6c 123 tf_outb(tf->nsect, io_ports->nsect_addr);
60f85019 124 if (valid & IDE_VALID_LBAL)
1574cf6c 125 tf_outb(tf->lbal, io_ports->lbal_addr);
60f85019 126 if (valid & IDE_VALID_LBAM)
1574cf6c 127 tf_outb(tf->lbam, io_ports->lbam_addr);
60f85019 128 if (valid & IDE_VALID_LBAH)
1574cf6c
BZ
129 tf_outb(tf->lbah, io_ports->lbah_addr);
130
60f85019 131 if (valid & IDE_VALID_DEVICE)
1574cf6c
BZ
132 tf_outb((tf->device & HIHI) | drive->select,
133 io_ports->device_addr);
134}
135EXPORT_SYMBOL_GPL(ide_tf_load);
136
22aa4b32 137void ide_tf_read(ide_drive_t *drive, struct ide_cmd *cmd)
1574cf6c
BZ
138{
139 ide_hwif_t *hwif = drive->hwif;
140 struct ide_io_ports *io_ports = &hwif->io_ports;
22aa4b32 141 struct ide_taskfile *tf = &cmd->tf;
1574cf6c
BZ
142 void (*tf_outb)(u8 addr, unsigned long port);
143 u8 (*tf_inb)(unsigned long port);
60f85019 144 u8 valid = cmd->valid.in.tf;
1574cf6c
BZ
145 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
146
147 if (mmio) {
148 tf_outb = ide_mm_outb;
149 tf_inb = ide_mm_inb;
150 } else {
151 tf_outb = ide_outb;
152 tf_inb = ide_inb;
153 }
154
1574cf6c 155 /* be sure we're looking at the low order bits */
4d74c3fc 156 tf_outb(ATA_DEVCTL_OBS, io_ports->ctl_addr);
1574cf6c 157
60f85019 158 if (valid & IDE_VALID_ERROR)
67625119 159 tf->error = tf_inb(io_ports->feature_addr);
60f85019 160 if (valid & IDE_VALID_NSECT)
1574cf6c 161 tf->nsect = tf_inb(io_ports->nsect_addr);
60f85019 162 if (valid & IDE_VALID_LBAL)
1574cf6c 163 tf->lbal = tf_inb(io_ports->lbal_addr);
60f85019 164 if (valid & IDE_VALID_LBAM)
1574cf6c 165 tf->lbam = tf_inb(io_ports->lbam_addr);
60f85019 166 if (valid & IDE_VALID_LBAH)
1574cf6c 167 tf->lbah = tf_inb(io_ports->lbah_addr);
60f85019 168 if (valid & IDE_VALID_DEVICE)
1574cf6c
BZ
169 tf->device = tf_inb(io_ports->device_addr);
170
22aa4b32 171 if (cmd->tf_flags & IDE_TFLAG_LBA48) {
4d74c3fc 172 tf_outb(ATA_HOB | ATA_DEVCTL_OBS, io_ports->ctl_addr);
1574cf6c 173
745483f1 174 tf = &cmd->hob;
60f85019
SS
175 valid = cmd->valid.in.hob;
176
177 if (valid & IDE_VALID_ERROR)
745483f1 178 tf->error = tf_inb(io_ports->feature_addr);
60f85019 179 if (valid & IDE_VALID_NSECT)
745483f1 180 tf->nsect = tf_inb(io_ports->nsect_addr);
60f85019 181 if (valid & IDE_VALID_LBAL)
745483f1 182 tf->lbal = tf_inb(io_ports->lbal_addr);
60f85019 183 if (valid & IDE_VALID_LBAM)
745483f1 184 tf->lbam = tf_inb(io_ports->lbam_addr);
60f85019 185 if (valid & IDE_VALID_LBAH)
745483f1 186 tf->lbah = tf_inb(io_ports->lbah_addr);
1574cf6c
BZ
187 }
188}
189EXPORT_SYMBOL_GPL(ide_tf_read);
190
191/*
192 * Some localbus EIDE interfaces require a special access sequence
193 * when using 32-bit I/O instructions to transfer data. We call this
194 * the "vlb_sync" sequence, which consists of three successive reads
195 * of the sector count register location, with interrupts disabled
196 * to ensure that the reads all happen together.
197 */
198static void ata_vlb_sync(unsigned long port)
199{
200 (void)inb(port);
201 (void)inb(port);
202 (void)inb(port);
203}
204
205/*
206 * This is used for most PIO data transfers *from* the IDE interface
207 *
208 * These routines will round up any request for an odd number of bytes,
209 * so if an odd len is specified, be sure that there's at least one
210 * extra byte allocated for the buffer.
211 */
adb1af98 212void ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
1574cf6c
BZ
213 unsigned int len)
214{
215 ide_hwif_t *hwif = drive->hwif;
216 struct ide_io_ports *io_ports = &hwif->io_ports;
217 unsigned long data_addr = io_ports->data_addr;
deae17fd 218 unsigned int words = (len + 1) >> 1;
1574cf6c
BZ
219 u8 io_32bit = drive->io_32bit;
220 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
221
1574cf6c
BZ
222 if (io_32bit) {
223 unsigned long uninitialized_var(flags);
224
225 if ((io_32bit & 2) && !mmio) {
226 local_irq_save(flags);
227 ata_vlb_sync(io_ports->nsect_addr);
228 }
229
deae17fd 230 words >>= 1;
1574cf6c 231 if (mmio)
deae17fd 232 __ide_mm_insl((void __iomem *)data_addr, buf, words);
1574cf6c 233 else
deae17fd 234 insl(data_addr, buf, words);
1574cf6c
BZ
235
236 if ((io_32bit & 2) && !mmio)
237 local_irq_restore(flags);
238
deae17fd
SS
239 if (((len + 1) & 3) < 2)
240 return;
241
242 buf += len & ~3;
243 words = 1;
1574cf6c 244 }
deae17fd
SS
245
246 if (mmio)
247 __ide_mm_insw((void __iomem *)data_addr, buf, words);
248 else
249 insw(data_addr, buf, words);
1574cf6c
BZ
250}
251EXPORT_SYMBOL_GPL(ide_input_data);
252
253/*
254 * This is used for most PIO data transfers *to* the IDE interface
255 */
adb1af98 256void ide_output_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
1574cf6c
BZ
257 unsigned int len)
258{
259 ide_hwif_t *hwif = drive->hwif;
260 struct ide_io_ports *io_ports = &hwif->io_ports;
261 unsigned long data_addr = io_ports->data_addr;
deae17fd 262 unsigned int words = (len + 1) >> 1;
1574cf6c
BZ
263 u8 io_32bit = drive->io_32bit;
264 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
265
1574cf6c
BZ
266 if (io_32bit) {
267 unsigned long uninitialized_var(flags);
268
269 if ((io_32bit & 2) && !mmio) {
270 local_irq_save(flags);
271 ata_vlb_sync(io_ports->nsect_addr);
272 }
273
deae17fd 274 words >>= 1;
1574cf6c 275 if (mmio)
deae17fd 276 __ide_mm_outsl((void __iomem *)data_addr, buf, words);
1574cf6c 277 else
deae17fd 278 outsl(data_addr, buf, words);
1574cf6c
BZ
279
280 if ((io_32bit & 2) && !mmio)
281 local_irq_restore(flags);
282
deae17fd
SS
283 if (((len + 1) & 3) < 2)
284 return;
285
286 buf += len & ~3;
287 words = 1;
1574cf6c 288 }
deae17fd
SS
289
290 if (mmio)
291 __ide_mm_outsw((void __iomem *)data_addr, buf, words);
292 else
293 outsw(data_addr, buf, words);
1574cf6c
BZ
294}
295EXPORT_SYMBOL_GPL(ide_output_data);
296
297const struct ide_tp_ops default_tp_ops = {
298 .exec_command = ide_exec_command,
299 .read_status = ide_read_status,
300 .read_altstatus = ide_read_altstatus,
ecf3a31d 301 .write_devctl = ide_write_devctl,
1574cf6c 302
abb596b2 303 .dev_select = ide_dev_select,
1574cf6c
BZ
304 .tf_load = ide_tf_load,
305 .tf_read = ide_tf_read,
306
307 .input_data = ide_input_data,
308 .output_data = ide_output_data,
309};