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