blob: 31f5c5f4c0932804df3ef363938493554ecd69ae [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) {
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +010094 u16 data = (tf->hob_data << 8) | tf->data;
95
96 if (mmio)
97 writew(data, (void __iomem *)io_ports->data_addr);
98 else
99 outw(data, io_ports->data_addr);
100 }
101
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100102 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_FEATURE)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100103 tf_outb(tf->hob_feature, io_ports->feature_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100104 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_NSECT)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100105 tf_outb(tf->hob_nsect, io_ports->nsect_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100106 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAL)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100107 tf_outb(tf->hob_lbal, io_ports->lbal_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100108 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAM)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100109 tf_outb(tf->hob_lbam, io_ports->lbam_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100110 if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAH)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100111 tf_outb(tf->hob_lbah, io_ports->lbah_addr);
112
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100113 if (cmd->tf_flags & IDE_TFLAG_OUT_FEATURE)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100114 tf_outb(tf->feature, io_ports->feature_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100115 if (cmd->tf_flags & IDE_TFLAG_OUT_NSECT)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100116 tf_outb(tf->nsect, io_ports->nsect_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100117 if (cmd->tf_flags & IDE_TFLAG_OUT_LBAL)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100118 tf_outb(tf->lbal, io_ports->lbal_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100119 if (cmd->tf_flags & IDE_TFLAG_OUT_LBAM)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100120 tf_outb(tf->lbam, io_ports->lbam_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100121 if (cmd->tf_flags & IDE_TFLAG_OUT_LBAH)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100122 tf_outb(tf->lbah, io_ports->lbah_addr);
123
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100124 if (cmd->tf_flags & IDE_TFLAG_OUT_DEVICE)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100125 tf_outb((tf->device & HIHI) | drive->select,
126 io_ports->device_addr);
127}
128EXPORT_SYMBOL_GPL(ide_tf_load);
129
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100130void ide_tf_read(ide_drive_t *drive, struct ide_cmd *cmd)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100131{
132 ide_hwif_t *hwif = drive->hwif;
133 struct ide_io_ports *io_ports = &hwif->io_ports;
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100134 struct ide_taskfile *tf = &cmd->tf;
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100135 void (*tf_outb)(u8 addr, unsigned long port);
136 u8 (*tf_inb)(unsigned long port);
137 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
138
139 if (mmio) {
140 tf_outb = ide_mm_outb;
141 tf_inb = ide_mm_inb;
142 } else {
143 tf_outb = ide_outb;
144 tf_inb = ide_inb;
145 }
146
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100147 if (cmd->ftf_flags & IDE_FTFLAG_IN_DATA) {
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100148 u16 data;
149
150 if (mmio)
151 data = readw((void __iomem *)io_ports->data_addr);
152 else
153 data = inw(io_ports->data_addr);
154
155 tf->data = data & 0xff;
156 tf->hob_data = (data >> 8) & 0xff;
157 }
158
159 /* be sure we're looking at the low order bits */
Sergei Shtylyov4d74c3f2009-03-31 20:15:29 +0200160 tf_outb(ATA_DEVCTL_OBS, io_ports->ctl_addr);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100161
Sergei Shtylyov67625112009-03-31 20:15:30 +0200162 if (cmd->tf_flags & IDE_TFLAG_IN_ERROR)
163 tf->error = tf_inb(io_ports->feature_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100164 if (cmd->tf_flags & IDE_TFLAG_IN_NSECT)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100165 tf->nsect = tf_inb(io_ports->nsect_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100166 if (cmd->tf_flags & IDE_TFLAG_IN_LBAL)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100167 tf->lbal = tf_inb(io_ports->lbal_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100168 if (cmd->tf_flags & IDE_TFLAG_IN_LBAM)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100169 tf->lbam = tf_inb(io_ports->lbam_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100170 if (cmd->tf_flags & IDE_TFLAG_IN_LBAH)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100171 tf->lbah = tf_inb(io_ports->lbah_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100172 if (cmd->tf_flags & IDE_TFLAG_IN_DEVICE)
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100173 tf->device = tf_inb(io_ports->device_addr);
174
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100175 if (cmd->tf_flags & IDE_TFLAG_LBA48) {
Sergei Shtylyov4d74c3f2009-03-31 20:15:29 +0200176 tf_outb(ATA_HOB | ATA_DEVCTL_OBS, io_ports->ctl_addr);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100177
Sergei Shtylyov67625112009-03-31 20:15:30 +0200178 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_ERROR)
179 tf->hob_error = tf_inb(io_ports->feature_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100180 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_NSECT)
Sergei Shtylyov67625112009-03-31 20:15:30 +0200181 tf->hob_nsect = tf_inb(io_ports->nsect_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100182 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAL)
Sergei Shtylyov67625112009-03-31 20:15:30 +0200183 tf->hob_lbal = tf_inb(io_ports->lbal_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100184 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAM)
Sergei Shtylyov67625112009-03-31 20:15:30 +0200185 tf->hob_lbam = tf_inb(io_ports->lbam_addr);
Bartlomiej Zolnierkiewicz22aa4b32009-03-27 12:46:37 +0100186 if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAH)
Sergei Shtylyov67625112009-03-31 20:15:30 +0200187 tf->hob_lbah = tf_inb(io_ports->lbah_addr);
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100188 }
189}
190EXPORT_SYMBOL_GPL(ide_tf_read);
191
192/*
193 * Some localbus EIDE interfaces require a special access sequence
194 * when using 32-bit I/O instructions to transfer data. We call this
195 * the "vlb_sync" sequence, which consists of three successive reads
196 * of the sector count register location, with interrupts disabled
197 * to ensure that the reads all happen together.
198 */
199static void ata_vlb_sync(unsigned long port)
200{
201 (void)inb(port);
202 (void)inb(port);
203 (void)inb(port);
204}
205
206/*
207 * This is used for most PIO data transfers *from* the IDE interface
208 *
209 * These routines will round up any request for an odd number of bytes,
210 * so if an odd len is specified, be sure that there's at least one
211 * extra byte allocated for the buffer.
212 */
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100213void ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100214 unsigned int len)
215{
216 ide_hwif_t *hwif = drive->hwif;
217 struct ide_io_ports *io_ports = &hwif->io_ports;
218 unsigned long data_addr = io_ports->data_addr;
219 u8 io_32bit = drive->io_32bit;
220 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
221
222 len++;
223
224 if (io_32bit) {
225 unsigned long uninitialized_var(flags);
226
227 if ((io_32bit & 2) && !mmio) {
228 local_irq_save(flags);
229 ata_vlb_sync(io_ports->nsect_addr);
230 }
231
232 if (mmio)
233 __ide_mm_insl((void __iomem *)data_addr, buf, len / 4);
234 else
235 insl(data_addr, buf, len / 4);
236
237 if ((io_32bit & 2) && !mmio)
238 local_irq_restore(flags);
239
240 if ((len & 3) >= 2) {
241 if (mmio)
242 __ide_mm_insw((void __iomem *)data_addr,
243 (u8 *)buf + (len & ~3), 1);
244 else
245 insw(data_addr, (u8 *)buf + (len & ~3), 1);
246 }
247 } else {
248 if (mmio)
249 __ide_mm_insw((void __iomem *)data_addr, buf, len / 2);
250 else
251 insw(data_addr, buf, len / 2);
252 }
253}
254EXPORT_SYMBOL_GPL(ide_input_data);
255
256/*
257 * This is used for most PIO data transfers *to* the IDE interface
258 */
Bartlomiej Zolnierkiewiczadb1af92009-03-27 12:46:38 +0100259void ide_output_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100260 unsigned int len)
261{
262 ide_hwif_t *hwif = drive->hwif;
263 struct ide_io_ports *io_ports = &hwif->io_ports;
264 unsigned long data_addr = io_ports->data_addr;
265 u8 io_32bit = drive->io_32bit;
266 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
267
268 len++;
269
270 if (io_32bit) {
271 unsigned long uninitialized_var(flags);
272
273 if ((io_32bit & 2) && !mmio) {
274 local_irq_save(flags);
275 ata_vlb_sync(io_ports->nsect_addr);
276 }
277
278 if (mmio)
279 __ide_mm_outsl((void __iomem *)data_addr, buf, len / 4);
280 else
281 outsl(data_addr, buf, len / 4);
282
283 if ((io_32bit & 2) && !mmio)
284 local_irq_restore(flags);
285
286 if ((len & 3) >= 2) {
287 if (mmio)
288 __ide_mm_outsw((void __iomem *)data_addr,
289 (u8 *)buf + (len & ~3), 1);
290 else
291 outsw(data_addr, (u8 *)buf + (len & ~3), 1);
292 }
293 } else {
294 if (mmio)
295 __ide_mm_outsw((void __iomem *)data_addr, buf, len / 2);
296 else
297 outsw(data_addr, buf, len / 2);
298 }
299}
300EXPORT_SYMBOL_GPL(ide_output_data);
301
302const struct ide_tp_ops default_tp_ops = {
303 .exec_command = ide_exec_command,
304 .read_status = ide_read_status,
305 .read_altstatus = ide_read_altstatus,
Sergei Shtylyovecf3a312009-03-31 20:15:30 +0200306 .write_devctl = ide_write_devctl,
Bartlomiej Zolnierkiewicz1574cf62009-03-24 23:22:46 +0100307
308 .tf_load = ide_tf_load,
309 .tf_read = ide_tf_read,
310
311 .input_data = ide_input_data,
312 .output_data = ide_output_data,
313};