Commit | Line | Data |
---|---|---|
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 | ||
16 | static u8 ide_inb(unsigned long port) | |
17 | { | |
18 | return (u8) inb(port); | |
19 | } | |
20 | ||
21 | static 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 | ||
30 | static u8 ide_mm_inb(unsigned long port) | |
31 | { | |
32 | return (u8) readb((void __iomem *) port); | |
33 | } | |
34 | ||
35 | static void ide_mm_outb(u8 value, unsigned long port) | |
36 | { | |
37 | writeb(value, (void __iomem *) port); | |
38 | } | |
39 | ||
40 | void 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 | } | |
47 | EXPORT_SYMBOL_GPL(ide_exec_command); | |
48 | ||
49 | u8 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 | } | |
56 | EXPORT_SYMBOL_GPL(ide_read_status); | |
57 | ||
58 | u8 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 | } | |
65 | EXPORT_SYMBOL_GPL(ide_read_altstatus); | |
66 | ||
ecf3a31d | 67 | void 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 | 74 | EXPORT_SYMBOL_GPL(ide_write_devctl); |
1574cf6c | 75 | |
abb596b2 SS |
76 | void 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 | } | |
86 | EXPORT_SYMBOL_GPL(ide_dev_select); | |
87 | ||
22aa4b32 | 88 | void 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 | } | |
135 | EXPORT_SYMBOL_GPL(ide_tf_load); | |
136 | ||
22aa4b32 | 137 | void 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 | } | |
189 | EXPORT_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 | */ | |
198 | static 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 | 212 | void 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 | } |
251 | EXPORT_SYMBOL_GPL(ide_input_data); | |
252 | ||
253 | /* | |
254 | * This is used for most PIO data transfers *to* the IDE interface | |
255 | */ | |
adb1af98 | 256 | void 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 | } |
295 | EXPORT_SYMBOL_GPL(ide_output_data); | |
296 | ||
297 | const 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 | }; |