1
2 #include <linux/kernel.h>
3 #include <linux/export.h>
4 #include <linux/ide.h>
5
6 #if defined(CONFIG_ARM) || defined(CONFIG_M68K) || defined(CONFIG_MIPS) || \
7 defined(CONFIG_PARISC) || defined(CONFIG_PPC) || defined(CONFIG_SPARC)
8 #include <asm/ide.h>
9 #else
10 #include <asm-generic/ide_iops.h>
11 #endif
12
13 /*
14 * Conventional PIO operations for ATA devices
15 */
16
ide_inb(unsigned long port)17 static u8 ide_inb(unsigned long port)
18 {
19 return (u8) inb(port);
20 }
21
ide_outb(u8 val,unsigned long port)22 static void ide_outb(u8 val, unsigned long port)
23 {
24 outb(val, port);
25 }
26
27 /*
28 * MMIO operations, typically used for SATA controllers
29 */
30
ide_mm_inb(unsigned long port)31 static u8 ide_mm_inb(unsigned long port)
32 {
33 return (u8) readb((void __iomem *) port);
34 }
35
ide_mm_outb(u8 value,unsigned long port)36 static void ide_mm_outb(u8 value, unsigned long port)
37 {
38 writeb(value, (void __iomem *) port);
39 }
40
ide_exec_command(ide_hwif_t * hwif,u8 cmd)41 void ide_exec_command(ide_hwif_t *hwif, u8 cmd)
42 {
43 if (hwif->host_flags & IDE_HFLAG_MMIO)
44 writeb(cmd, (void __iomem *)hwif->io_ports.command_addr);
45 else
46 outb(cmd, hwif->io_ports.command_addr);
47 }
48 EXPORT_SYMBOL_GPL(ide_exec_command);
49
ide_read_status(ide_hwif_t * hwif)50 u8 ide_read_status(ide_hwif_t *hwif)
51 {
52 if (hwif->host_flags & IDE_HFLAG_MMIO)
53 return readb((void __iomem *)hwif->io_ports.status_addr);
54 else
55 return inb(hwif->io_ports.status_addr);
56 }
57 EXPORT_SYMBOL_GPL(ide_read_status);
58
ide_read_altstatus(ide_hwif_t * hwif)59 u8 ide_read_altstatus(ide_hwif_t *hwif)
60 {
61 if (hwif->host_flags & IDE_HFLAG_MMIO)
62 return readb((void __iomem *)hwif->io_ports.ctl_addr);
63 else
64 return inb(hwif->io_ports.ctl_addr);
65 }
66 EXPORT_SYMBOL_GPL(ide_read_altstatus);
67
ide_write_devctl(ide_hwif_t * hwif,u8 ctl)68 void ide_write_devctl(ide_hwif_t *hwif, u8 ctl)
69 {
70 if (hwif->host_flags & IDE_HFLAG_MMIO)
71 writeb(ctl, (void __iomem *)hwif->io_ports.ctl_addr);
72 else
73 outb(ctl, hwif->io_ports.ctl_addr);
74 }
75 EXPORT_SYMBOL_GPL(ide_write_devctl);
76
ide_dev_select(ide_drive_t * drive)77 void ide_dev_select(ide_drive_t *drive)
78 {
79 ide_hwif_t *hwif = drive->hwif;
80 u8 select = drive->select | ATA_DEVICE_OBS;
81
82 if (hwif->host_flags & IDE_HFLAG_MMIO)
83 writeb(select, (void __iomem *)hwif->io_ports.device_addr);
84 else
85 outb(select, hwif->io_ports.device_addr);
86 }
87 EXPORT_SYMBOL_GPL(ide_dev_select);
88
ide_tf_load(ide_drive_t * drive,struct ide_taskfile * tf,u8 valid)89 void ide_tf_load(ide_drive_t *drive, struct ide_taskfile *tf, u8 valid)
90 {
91 ide_hwif_t *hwif = drive->hwif;
92 struct ide_io_ports *io_ports = &hwif->io_ports;
93 void (*tf_outb)(u8 addr, unsigned long port);
94 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
95
96 if (mmio)
97 tf_outb = ide_mm_outb;
98 else
99 tf_outb = ide_outb;
100
101 if (valid & IDE_VALID_FEATURE)
102 tf_outb(tf->feature, io_ports->feature_addr);
103 if (valid & IDE_VALID_NSECT)
104 tf_outb(tf->nsect, io_ports->nsect_addr);
105 if (valid & IDE_VALID_LBAL)
106 tf_outb(tf->lbal, io_ports->lbal_addr);
107 if (valid & IDE_VALID_LBAM)
108 tf_outb(tf->lbam, io_ports->lbam_addr);
109 if (valid & IDE_VALID_LBAH)
110 tf_outb(tf->lbah, io_ports->lbah_addr);
111 if (valid & IDE_VALID_DEVICE)
112 tf_outb(tf->device, io_ports->device_addr);
113 }
114 EXPORT_SYMBOL_GPL(ide_tf_load);
115
ide_tf_read(ide_drive_t * drive,struct ide_taskfile * tf,u8 valid)116 void ide_tf_read(ide_drive_t *drive, struct ide_taskfile *tf, u8 valid)
117 {
118 ide_hwif_t *hwif = drive->hwif;
119 struct ide_io_ports *io_ports = &hwif->io_ports;
120 u8 (*tf_inb)(unsigned long port);
121 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
122
123 if (mmio)
124 tf_inb = ide_mm_inb;
125 else
126 tf_inb = ide_inb;
127
128 if (valid & IDE_VALID_ERROR)
129 tf->error = tf_inb(io_ports->feature_addr);
130 if (valid & IDE_VALID_NSECT)
131 tf->nsect = tf_inb(io_ports->nsect_addr);
132 if (valid & IDE_VALID_LBAL)
133 tf->lbal = tf_inb(io_ports->lbal_addr);
134 if (valid & IDE_VALID_LBAM)
135 tf->lbam = tf_inb(io_ports->lbam_addr);
136 if (valid & IDE_VALID_LBAH)
137 tf->lbah = tf_inb(io_ports->lbah_addr);
138 if (valid & IDE_VALID_DEVICE)
139 tf->device = tf_inb(io_ports->device_addr);
140 }
141 EXPORT_SYMBOL_GPL(ide_tf_read);
142
143 /*
144 * Some localbus EIDE interfaces require a special access sequence
145 * when using 32-bit I/O instructions to transfer data. We call this
146 * the "vlb_sync" sequence, which consists of three successive reads
147 * of the sector count register location, with interrupts disabled
148 * to ensure that the reads all happen together.
149 */
ata_vlb_sync(unsigned long port)150 static void ata_vlb_sync(unsigned long port)
151 {
152 (void)inb(port);
153 (void)inb(port);
154 (void)inb(port);
155 }
156
157 /*
158 * This is used for most PIO data transfers *from* the IDE interface
159 *
160 * These routines will round up any request for an odd number of bytes,
161 * so if an odd len is specified, be sure that there's at least one
162 * extra byte allocated for the buffer.
163 */
ide_input_data(ide_drive_t * drive,struct ide_cmd * cmd,void * buf,unsigned int len)164 void ide_input_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
165 unsigned int len)
166 {
167 ide_hwif_t *hwif = drive->hwif;
168 struct ide_io_ports *io_ports = &hwif->io_ports;
169 unsigned long data_addr = io_ports->data_addr;
170 unsigned int words = (len + 1) >> 1;
171 u8 io_32bit = drive->io_32bit;
172 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
173
174 if (io_32bit) {
175 unsigned long uninitialized_var(flags);
176
177 if ((io_32bit & 2) && !mmio) {
178 local_irq_save(flags);
179 ata_vlb_sync(io_ports->nsect_addr);
180 }
181
182 words >>= 1;
183 if (mmio)
184 __ide_mm_insl((void __iomem *)data_addr, buf, words);
185 else
186 insl(data_addr, buf, words);
187
188 if ((io_32bit & 2) && !mmio)
189 local_irq_restore(flags);
190
191 if (((len + 1) & 3) < 2)
192 return;
193
194 buf += len & ~3;
195 words = 1;
196 }
197
198 if (mmio)
199 __ide_mm_insw((void __iomem *)data_addr, buf, words);
200 else
201 insw(data_addr, buf, words);
202 }
203 EXPORT_SYMBOL_GPL(ide_input_data);
204
205 /*
206 * This is used for most PIO data transfers *to* the IDE interface
207 */
ide_output_data(ide_drive_t * drive,struct ide_cmd * cmd,void * buf,unsigned int len)208 void ide_output_data(ide_drive_t *drive, struct ide_cmd *cmd, void *buf,
209 unsigned int len)
210 {
211 ide_hwif_t *hwif = drive->hwif;
212 struct ide_io_ports *io_ports = &hwif->io_ports;
213 unsigned long data_addr = io_ports->data_addr;
214 unsigned int words = (len + 1) >> 1;
215 u8 io_32bit = drive->io_32bit;
216 u8 mmio = (hwif->host_flags & IDE_HFLAG_MMIO) ? 1 : 0;
217
218 if (io_32bit) {
219 unsigned long uninitialized_var(flags);
220
221 if ((io_32bit & 2) && !mmio) {
222 local_irq_save(flags);
223 ata_vlb_sync(io_ports->nsect_addr);
224 }
225
226 words >>= 1;
227 if (mmio)
228 __ide_mm_outsl((void __iomem *)data_addr, buf, words);
229 else
230 outsl(data_addr, buf, words);
231
232 if ((io_32bit & 2) && !mmio)
233 local_irq_restore(flags);
234
235 if (((len + 1) & 3) < 2)
236 return;
237
238 buf += len & ~3;
239 words = 1;
240 }
241
242 if (mmio)
243 __ide_mm_outsw((void __iomem *)data_addr, buf, words);
244 else
245 outsw(data_addr, buf, words);
246 }
247 EXPORT_SYMBOL_GPL(ide_output_data);
248
249 const struct ide_tp_ops default_tp_ops = {
250 .exec_command = ide_exec_command,
251 .read_status = ide_read_status,
252 .read_altstatus = ide_read_altstatus,
253 .write_devctl = ide_write_devctl,
254
255 .dev_select = ide_dev_select,
256 .tf_load = ide_tf_load,
257 .tf_read = ide_tf_read,
258
259 .input_data = ide_input_data,
260 .output_data = ide_output_data,
261 };
262