blob: f06940df255e9ce9cbb1b0cdef1388f63b9eae87 [file] [log] [blame]
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +01001
2#include <linux/kernel.h>
3#include <linux/ide.h>
4
Bartlomiej Zolnierkiewicz15a453a2009-03-27 12:46:26 +01005#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
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010012/*
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
Sergei Shtylyovecf3a312009-03-31 20:15:30 +020067void ide_write_devctl(ide_hwif_t *hwif, u8 ctl)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010068{
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010069 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}
Sergei Shtylyovecf3a312009-03-31 20:15:30 +020074EXPORT_SYMBOL_GPL(ide_write_devctl);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010075
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010076void ide_tf_load(ide_drive_t *drive, struct ide_cmd *cmd)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010077{
78 ide_hwif_t *hwif = drive->hwif;
79 struct ide_io_ports *io_ports = &hwif->io_ports;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010080 struct ide_taskfile *tf = &cmd->tf;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010081 void (*tf_outb)(u8 addr, unsigned long port);
82 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010083 u8 HIHI = (cmd->tf_flags & IDE_TFLAG_LBA48) ? 0xE0 : 0xEF;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010084
85 if (mmio)
86 tf_outb = ide_mm_outb;
87 else
88 tf_outb = ide_outb;
89
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010090 if (cmd->ftf_flags & IDE_FTFLAG_FLAGGED)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010091 HIHI = 0xFF;
92
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010093 if (cmd->ftf_flags & IDE_FTFLAG_OUT_DATA) {
Sergei Shtylyovbac08ce2009-03-31 20:15:31 +020094 u8 data[2] = { tf->data, tf->hob_data };
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010095
Sergei Shtylyovbac08ce2009-03-31 20:15:31 +020096 ide_output_data(drive, cmd, data, 2);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010097 }
98
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +010099 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_FEATURE)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100100 tf_outb(tf->hob_feature, io_ports->feature_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100101 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_NSECT)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100102 tf_outb(tf->hob_nsect, io_ports->nsect_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100103 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAL)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100104 tf_outb(tf->hob_lbal, io_ports->lbal_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100105 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAM)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100106 tf_outb(tf->hob_lbam, io_ports->lbam_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100107 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAH)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100108 tf_outb(tf->hob_lbah, io_ports->lbah_addr);
109
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100110 if (cmd->tf_flags & IDE_TFLAG_OUT_FEATURE)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100111 tf_outb(tf->feature, io_ports->feature_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100112 if (cmd->tf_flags & IDE_TFLAG_OUT_NSECT)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100113 tf_outb(tf->nsect, io_ports->nsect_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100114 if (cmd->tf_flags & IDE_TFLAG_OUT_LBAL)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100115 tf_outb(tf->lbal, io_ports->lbal_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100116 if (cmd->tf_flags & IDE_TFLAG_OUT_LBAM)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100117 tf_outb(tf->lbam, io_ports->lbam_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100118 if (cmd->tf_flags & IDE_TFLAG_OUT_LBAH)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100119 tf_outb(tf->lbah, io_ports->lbah_addr);
120
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100121 if (cmd->tf_flags & IDE_TFLAG_OUT_DEVICE)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100122 tf_outb((tf->device & HIHI) | drive->select,
123 io_ports->device_addr);
124}
125EXPORT_SYMBOL_GPL(ide_tf_load);
126
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100127void ide_tf_read(ide_drive_t *drive, struct ide_cmd *cmd)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100128{
129 ide_hwif_t *hwif = drive->hwif;
130 struct ide_io_ports *io_ports = &hwif->io_ports;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100131 struct ide_taskfile *tf = &cmd->tf;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100132 void (*tf_outb)(u8 addr, unsigned long port);
133 u8 (*tf_inb)(unsigned long port);
134 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
135
136 if (mmio) {
137 tf_outb = ide_mm_outb;
138 tf_inb = ide_mm_inb;
139 } else {
140 tf_outb = ide_outb;
141 tf_inb = ide_inb;
142 }
143
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100144 if (cmd->ftf_flags & IDE_FTFLAG_IN_DATA) {
Sergei Shtylyovbac08ce2009-03-31 20:15:31 +0200145 u8 data[2];
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100146
Sergei Shtylyovbac08ce2009-03-31 20:15:31 +0200147 ide_input_data(drive, cmd, data, 2);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100148
Sergei Shtylyovbac08ce2009-03-31 20:15:31 +0200149 tf->data = data[0];
150 tf->hob_data = data[1];
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100151 }
152
153 /* be sure we're looking at the low order bits */
Sergei Shtylyov4d74c3f2009-03-31 20:15:29 +0200154 tf_outb(ATA_DEVCTL_OBS, io_ports->ctl_addr);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100155
Sergei Shtylyov67625112009-03-31 20:15:30 +0200156 if (cmd->tf_flags & IDE_TFLAG_IN_ERROR)
157 tf->error = tf_inb(io_ports->feature_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100158 if (cmd->tf_flags & IDE_TFLAG_IN_NSECT)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100159 tf->nsect = tf_inb(io_ports->nsect_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100160 if (cmd->tf_flags & IDE_TFLAG_IN_LBAL)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100161 tf->lbal = tf_inb(io_ports->lbal_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100162 if (cmd->tf_flags & IDE_TFLAG_IN_LBAM)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100163 tf->lbam = tf_inb(io_ports->lbam_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100164 if (cmd->tf_flags & IDE_TFLAG_IN_LBAH)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100165 tf->lbah = tf_inb(io_ports->lbah_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100166 if (cmd->tf_flags & IDE_TFLAG_IN_DEVICE)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100167 tf->device = tf_inb(io_ports->device_addr);
168
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100169 if (cmd->tf_flags & IDE_TFLAG_LBA48) {
Sergei Shtylyov4d74c3f2009-03-31 20:15:29 +0200170 tf_outb(ATA_HOB | ATA_DEVCTL_OBS, io_ports->ctl_addr);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100171
Sergei Shtylyov67625112009-03-31 20:15:30 +0200172 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_ERROR)
173 tf->hob_error = tf_inb(io_ports->feature_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100174 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_NSECT)
Sergei Shtylyov67625112009-03-31 20:15:30 +0200175 tf->hob_nsect = tf_inb(io_ports->nsect_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100176 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAL)
Sergei Shtylyov67625112009-03-31 20:15:30 +0200177 tf->hob_lbal = tf_inb(io_ports->lbal_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100178 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAM)
Sergei Shtylyov67625112009-03-31 20:15:30 +0200179 tf->hob_lbam = tf_inb(io_ports->lbam_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100180 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAH)
Sergei Shtylyov67625112009-03-31 20:15:30 +0200181 tf->hob_lbah = tf_inb(io_ports->lbah_addr);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100182 }
183}
184EXPORT_SYMBOL_GPL(ide_tf_read);
185
186/*
187 * Some localbus EIDE interfaces require a special access sequence
188 * when using 32-bit I/O instructions to transfer data. We call this
189 * the "vlb_sync" sequence, which consists of three successive reads
190 * of the sector count register location, with interrupts disabled
191 * to ensure that the reads all happen together.
192 */
193static void ata_vlb_sync(unsigned long port)
194{
195 (void)inb(port);
196 (void)inb(port);
197 (void)inb(port);
198}
199
200/*
201 * This is used for most PIO data transfers *from* the IDE interface
202 *
203 * These routines will round up any request for an odd number of bytes,
204 * so if an odd len is specified, be sure that there's at least one
205 * extra byte allocated for the buffer.
206 */
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100207void ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100208 unsigned int len)
209{
210 ide_hwif_t *hwif = drive->hwif;
211 struct ide_io_ports *io_ports = &hwif->io_ports;
212 unsigned long data_addr = io_ports->data_addr;
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200213 unsigned int words = (len + 1) >> 1;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100214 u8 io_32bit = drive->io_32bit;
215 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
216
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100217 if (io_32bit) {
218 unsigned long uninitialized_var(flags);
219
220 if ((io_32bit & 2) && !mmio) {
221 local_irq_save(flags);
222 ata_vlb_sync(io_ports->nsect_addr);
223 }
224
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200225 words >>= 1;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100226 if (mmio)
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200227 __ide_mm_insl((void __iomem *)data_addr, buf, words);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100228 else
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200229 insl(data_addr, buf, words);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100230
231 if ((io_32bit & 2) && !mmio)
232 local_irq_restore(flags);
233
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200234 if (((len + 1) & 3) < 2)
235 return;
236
237 buf += len & ~3;
238 words = 1;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100239 }
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200240
241 if (mmio)
242 __ide_mm_insw((void __iomem *)data_addr, buf, words);
243 else
244 insw(data_addr, buf, words);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100245}
246EXPORT_SYMBOL_GPL(ide_input_data);
247
248/*
249 * This is used for most PIO data transfers *to* the IDE interface
250 */
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100251void ide_output_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100252 unsigned int len)
253{
254 ide_hwif_t *hwif = drive->hwif;
255 struct ide_io_ports *io_ports = &hwif->io_ports;
256 unsigned long data_addr = io_ports->data_addr;
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200257 unsigned int words = (len + 1) >> 1;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100258 u8 io_32bit = drive->io_32bit;
259 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
260
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100261 if (io_32bit) {
262 unsigned long uninitialized_var(flags);
263
264 if ((io_32bit & 2) && !mmio) {
265 local_irq_save(flags);
266 ata_vlb_sync(io_ports->nsect_addr);
267 }
268
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200269 words >>= 1;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100270 if (mmio)
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200271 __ide_mm_outsl((void __iomem *)data_addr, buf, words);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100272 else
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200273 outsl(data_addr, buf, words);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100274
275 if ((io_32bit & 2) && !mmio)
276 local_irq_restore(flags);
277
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200278 if (((len + 1) & 3) < 2)
279 return;
280
281 buf += len & ~3;
282 words = 1;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100283 }
Sergei Shtylyovdeae17f2009-03-31 20:15:31 +0200284
285 if (mmio)
286 __ide_mm_outsw((void __iomem *)data_addr, buf, words);
287 else
288 outsw(data_addr, buf, words);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100289}
290EXPORT_SYMBOL_GPL(ide_output_data);
291
292const struct ide_tp_ops default_tp_ops = {
293 .exec_command = ide_exec_command,
294 .read_status = ide_read_status,
295 .read_altstatus = ide_read_altstatus,
Sergei Shtylyovecf3a312009-03-31 20:15:30 +0200296 .write_devctl = ide_write_devctl,
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100297
298 .tf_load = ide_tf_load,
299 .tf_read = ide_tf_read,
300
301 .input_data = ide_input_data,
302 .output_data = ide_output_data,
303};