diff options
author | Len Brown <len.brown@intel.com> | 2009-04-05 02:14:15 -0400 |
---|---|---|
committer | Len Brown <len.brown@intel.com> | 2009-04-05 02:14:15 -0400 |
commit | 478c6a43fcbc6c11609f8cee7c7b57223907754f (patch) | |
tree | a7f7952099da60d33032aed6de9c0c56c9f8779e /drivers/ide/ide-io-std.c | |
parent | 8a3f257c704e02aee9869decd069a806b45be3f1 (diff) | |
parent | 6bb597507f9839b13498781e481f5458aea33620 (diff) |
Merge branch 'linus' into release
Conflicts:
arch/x86/kernel/cpu/cpufreq/longhaul.c
Signed-off-by: Len Brown <len.brown@intel.com>
Diffstat (limited to 'drivers/ide/ide-io-std.c')
-rw-r--r-- | drivers/ide/ide-io-std.c | 301 |
1 files changed, 301 insertions, 0 deletions
diff --git a/drivers/ide/ide-io-std.c b/drivers/ide/ide-io-std.c new file mode 100644 index 000000000000..9cac281d82c4 --- /dev/null +++ b/drivers/ide/ide-io-std.c | |||
@@ -0,0 +1,301 @@ | |||
1 | |||
2 | #include <linux/kernel.h> | ||
3 | #include <linux/ide.h> | ||
4 | |||
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 | |||
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 | |||
67 | void ide_write_devctl(ide_hwif_t *hwif, u8 ctl) | ||
68 | { | ||
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 | } | ||
74 | EXPORT_SYMBOL_GPL(ide_write_devctl); | ||
75 | |||
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 | |||
88 | void ide_tf_load(ide_drive_t *drive, struct ide_cmd *cmd) | ||
89 | { | ||
90 | ide_hwif_t *hwif = drive->hwif; | ||
91 | struct ide_io_ports *io_ports = &hwif->io_ports; | ||
92 | struct ide_taskfile *tf = &cmd->tf; | ||
93 | void (*tf_outb)(u8 addr, unsigned long port); | ||
94 | u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0; | ||
95 | u8 HIHI = (cmd->tf_flags & IDE_TFLAG_LBA48) ? 0xE0 : 0xEF; | ||
96 | |||
97 | if (mmio) | ||
98 | tf_outb = ide_mm_outb; | ||
99 | else | ||
100 | tf_outb = ide_outb; | ||
101 | |||
102 | if (cmd->ftf_flags & IDE_FTFLAG_FLAGGED) | ||
103 | HIHI = 0xFF; | ||
104 | |||
105 | if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_FEATURE) | ||
106 | tf_outb(tf->hob_feature, io_ports->feature_addr); | ||
107 | if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_NSECT) | ||
108 | tf_outb(tf->hob_nsect, io_ports->nsect_addr); | ||
109 | if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAL) | ||
110 | tf_outb(tf->hob_lbal, io_ports->lbal_addr); | ||
111 | if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAM) | ||
112 | tf_outb(tf->hob_lbam, io_ports->lbam_addr); | ||
113 | if (cmd->tf_flags & IDE_TFLAG_OUT_HOB_LBAH) | ||
114 | tf_outb(tf->hob_lbah, io_ports->lbah_addr); | ||
115 | |||
116 | if (cmd->tf_flags & IDE_TFLAG_OUT_FEATURE) | ||
117 | tf_outb(tf->feature, io_ports->feature_addr); | ||
118 | if (cmd->tf_flags & IDE_TFLAG_OUT_NSECT) | ||
119 | tf_outb(tf->nsect, io_ports->nsect_addr); | ||
120 | if (cmd->tf_flags & IDE_TFLAG_OUT_LBAL) | ||
121 | tf_outb(tf->lbal, io_ports->lbal_addr); | ||
122 | if (cmd->tf_flags & IDE_TFLAG_OUT_LBAM) | ||
123 | tf_outb(tf->lbam, io_ports->lbam_addr); | ||
124 | if (cmd->tf_flags & IDE_TFLAG_OUT_LBAH) | ||
125 | tf_outb(tf->lbah, io_ports->lbah_addr); | ||
126 | |||
127 | if (cmd->tf_flags & IDE_TFLAG_OUT_DEVICE) | ||
128 | tf_outb((tf->device & HIHI) | drive->select, | ||
129 | io_ports->device_addr); | ||
130 | } | ||
131 | EXPORT_SYMBOL_GPL(ide_tf_load); | ||
132 | |||
133 | void ide_tf_read(ide_drive_t *drive, struct ide_cmd *cmd) | ||
134 | { | ||
135 | ide_hwif_t *hwif = drive->hwif; | ||
136 | struct ide_io_ports *io_ports = &hwif->io_ports; | ||
137 | struct ide_taskfile *tf = &cmd->tf; | ||
138 | void (*tf_outb)(u8 addr, unsigned long port); | ||
139 | u8 (*tf_inb)(unsigned long port); | ||
140 | u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0; | ||
141 | |||
142 | if (mmio) { | ||
143 | tf_outb = ide_mm_outb; | ||
144 | tf_inb = ide_mm_inb; | ||
145 | } else { | ||
146 | tf_outb = ide_outb; | ||
147 | tf_inb = ide_inb; | ||
148 | } | ||
149 | |||
150 | /* be sure we're looking at the low order bits */ | ||
151 | tf_outb(ATA_DEVCTL_OBS, io_ports->ctl_addr); | ||
152 | |||
153 | if (cmd->tf_flags & IDE_TFLAG_IN_ERROR) | ||
154 | tf->error = tf_inb(io_ports->feature_addr); | ||
155 | if (cmd->tf_flags & IDE_TFLAG_IN_NSECT) | ||
156 | tf->nsect = tf_inb(io_ports->nsect_addr); | ||
157 | if (cmd->tf_flags & IDE_TFLAG_IN_LBAL) | ||
158 | tf->lbal = tf_inb(io_ports->lbal_addr); | ||
159 | if (cmd->tf_flags & IDE_TFLAG_IN_LBAM) | ||
160 | tf->lbam = tf_inb(io_ports->lbam_addr); | ||
161 | if (cmd->tf_flags & IDE_TFLAG_IN_LBAH) | ||
162 | tf->lbah = tf_inb(io_ports->lbah_addr); | ||
163 | if (cmd->tf_flags & IDE_TFLAG_IN_DEVICE) | ||
164 | tf->device = tf_inb(io_ports->device_addr); | ||
165 | |||
166 | if (cmd->tf_flags & IDE_TFLAG_LBA48) { | ||
167 | tf_outb(ATA_HOB | ATA_DEVCTL_OBS, io_ports->ctl_addr); | ||
168 | |||
169 | if (cmd->tf_flags & IDE_TFLAG_IN_HOB_ERROR) | ||
170 | tf->hob_error = tf_inb(io_ports->feature_addr); | ||
171 | if (cmd->tf_flags & IDE_TFLAG_IN_HOB_NSECT) | ||
172 | tf->hob_nsect = tf_inb(io_ports->nsect_addr); | ||
173 | if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAL) | ||
174 | tf->hob_lbal = tf_inb(io_ports->lbal_addr); | ||
175 | if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAM) | ||
176 | tf->hob_lbam = tf_inb(io_ports->lbam_addr); | ||
177 | if (cmd->tf_flags & IDE_TFLAG_IN_HOB_LBAH) | ||
178 | tf->hob_lbah = tf_inb(io_ports->lbah_addr); | ||
179 | } | ||
180 | } | ||
181 | EXPORT_SYMBOL_GPL(ide_tf_read); | ||
182 | |||
183 | /* | ||
184 | * Some localbus EIDE interfaces require a special access sequence | ||
185 | * when using 32-bit I/O instructions to transfer data. We call this | ||
186 | * the "vlb_sync" sequence, which consists of three successive reads | ||
187 | * of the sector count register location, with interrupts disabled | ||
188 | * to ensure that the reads all happen together. | ||
189 | */ | ||
190 | static void ata_vlb_sync(unsigned long port) | ||
191 | { | ||
192 | (void)inb(port); | ||
193 | (void)inb(port); | ||
194 | (void)inb(port); | ||
195 | } | ||
196 | |||
197 | /* | ||
198 | * This is used for most PIO data transfers *from* the IDE interface | ||
199 | * | ||
200 | * These routines will round up any request for an odd number of bytes, | ||
201 | * so if an odd len is specified, be sure that there's at least one | ||
202 | * extra byte allocated for the buffer. | ||
203 | */ | ||
204 | void ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf, | ||
205 | unsigned int len) | ||
206 | { | ||
207 | ide_hwif_t *hwif = drive->hwif; | ||
208 | struct ide_io_ports *io_ports = &hwif->io_ports; | ||
209 | unsigned long data_addr = io_ports->data_addr; | ||
210 | unsigned int words = (len + 1) >> 1; | ||
211 | u8 io_32bit = drive->io_32bit; | ||
212 | u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0; | ||
213 | |||
214 | if (io_32bit) { | ||
215 | unsigned long uninitialized_var(flags); | ||
216 | |||
217 | if ((io_32bit & 2) && !mmio) { | ||
218 | local_irq_save(flags); | ||
219 | ata_vlb_sync(io_ports->nsect_addr); | ||
220 | } | ||
221 | |||
222 | words >>= 1; | ||
223 | if (mmio) | ||
224 | __ide_mm_insl((void __iomem *)data_addr, buf, words); | ||
225 | else | ||
226 | insl(data_addr, buf, words); | ||
227 | |||
228 | if ((io_32bit & 2) && !mmio) | ||
229 | local_irq_restore(flags); | ||
230 | |||
231 | if (((len + 1) & 3) < 2) | ||
232 | return; | ||
233 | |||
234 | buf += len & ~3; | ||
235 | words = 1; | ||
236 | } | ||
237 | |||
238 | if (mmio) | ||
239 | __ide_mm_insw((void __iomem *)data_addr, buf, words); | ||
240 | else | ||
241 | insw(data_addr, buf, words); | ||
242 | } | ||
243 | EXPORT_SYMBOL_GPL(ide_input_data); | ||
244 | |||
245 | /* | ||
246 | * This is used for most PIO data transfers *to* the IDE interface | ||
247 | */ | ||
248 | void ide_output_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf, | ||
249 | unsigned int len) | ||
250 | { | ||
251 | ide_hwif_t *hwif = drive->hwif; | ||
252 | struct ide_io_ports *io_ports = &hwif->io_ports; | ||
253 | unsigned long data_addr = io_ports->data_addr; | ||
254 | unsigned int words = (len + 1) >> 1; | ||
255 | u8 io_32bit = drive->io_32bit; | ||
256 | u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0; | ||
257 | |||
258 | if (io_32bit) { | ||
259 | unsigned long uninitialized_var(flags); | ||
260 | |||
261 | if ((io_32bit & 2) && !mmio) { | ||
262 | local_irq_save(flags); | ||
263 | ata_vlb_sync(io_ports->nsect_addr); | ||
264 | } | ||
265 | |||
266 | words >>= 1; | ||
267 | if (mmio) | ||
268 | __ide_mm_outsl((void __iomem *)data_addr, buf, words); | ||
269 | else | ||
270 | outsl(data_addr, buf, words); | ||
271 | |||
272 | if ((io_32bit & 2) && !mmio) | ||
273 | local_irq_restore(flags); | ||
274 | |||
275 | if (((len + 1) & 3) < 2) | ||
276 | return; | ||
277 | |||
278 | buf += len & ~3; | ||
279 | words = 1; | ||
280 | } | ||
281 | |||
282 | if (mmio) | ||
283 | __ide_mm_outsw((void __iomem *)data_addr, buf, words); | ||
284 | else | ||
285 | outsw(data_addr, buf, words); | ||
286 | } | ||
287 | EXPORT_SYMBOL_GPL(ide_output_data); | ||
288 | |||
289 | const struct ide_tp_ops default_tp_ops = { | ||
290 | .exec_command = ide_exec_command, | ||
291 | .read_status = ide_read_status, | ||
292 | .read_altstatus = ide_read_altstatus, | ||
293 | .write_devctl = ide_write_devctl, | ||
294 | |||
295 | .dev_select = ide_dev_select, | ||
296 | .tf_load = ide_tf_load, | ||
297 | .tf_read = ide_tf_read, | ||
298 | |||
299 | .input_data = ide_input_data, | ||
300 | .output_data = ide_output_data, | ||
301 | }; | ||