2 #include <linux/kernel.h>
5 #if defined(CONFIG_ARM) || defined(CONFIG_M68K) || defined(CONFIG_MIPS) || \
6 defined(CONFIG_PARISC) || defined(CONFIG_PPC) || defined(CONFIG_SPARC)
9 #include <asm-generic/ide_iops.h>
13 * Conventional PIO operations for ATA devices
16 static u8
ide_inb(unsigned long port
)
18 return (u8
) inb(port
);
21 static void ide_outb(u8 val
, unsigned long port
)
27 * MMIO operations, typically used for SATA controllers
30 static u8
ide_mm_inb(unsigned long port
)
32 return (u8
) readb((void __iomem
*) port
);
35 static void ide_mm_outb(u8 value
, unsigned long port
)
37 writeb(value
, (void __iomem
*) port
);
40 void ide_exec_command(ide_hwif_t
*hwif
, u8 cmd
)
42 if (hwif
->host_flags
& IDE_HFLAG_MMIO
)
43 writeb(cmd
, (void __iomem
*)hwif
->io_ports
.command_addr
);
45 outb(cmd
, hwif
->io_ports
.command_addr
);
47 EXPORT_SYMBOL_GPL(ide_exec_command
);
49 u8
ide_read_status(ide_hwif_t
*hwif
)
51 if (hwif
->host_flags
& IDE_HFLAG_MMIO
)
52 return readb((void __iomem
*)hwif
->io_ports
.status_addr
);
54 return inb(hwif
->io_ports
.status_addr
);
56 EXPORT_SYMBOL_GPL(ide_read_status
);
58 u8
ide_read_altstatus(ide_hwif_t
*hwif
)
60 if (hwif
->host_flags
& IDE_HFLAG_MMIO
)
61 return readb((void __iomem
*)hwif
->io_ports
.ctl_addr
);
63 return inb(hwif
->io_ports
.ctl_addr
);
65 EXPORT_SYMBOL_GPL(ide_read_altstatus
);
67 void ide_write_devctl(ide_hwif_t
*hwif
, u8 ctl
)
69 if (hwif
->host_flags
& IDE_HFLAG_MMIO
)
70 writeb(ctl
, (void __iomem
*)hwif
->io_ports
.ctl_addr
);
72 outb(ctl
, hwif
->io_ports
.ctl_addr
);
74 EXPORT_SYMBOL_GPL(ide_write_devctl
);
76 void ide_dev_select(ide_drive_t
*drive
)
78 ide_hwif_t
*hwif
= drive
->hwif
;
79 u8 select
= drive
->select
| ATA_DEVICE_OBS
;
81 if (hwif
->host_flags
& IDE_HFLAG_MMIO
)
82 writeb(select
, (void __iomem
*)hwif
->io_ports
.device_addr
);
84 outb(select
, hwif
->io_ports
.device_addr
);
86 EXPORT_SYMBOL_GPL(ide_dev_select
);
88 void ide_tf_load(ide_drive_t
*drive
, struct ide_cmd
*cmd
)
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;
98 tf_outb
= ide_mm_outb
;
102 if (cmd
->ftf_flags
& IDE_FTFLAG_FLAGGED
)
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
);
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
);
127 if (cmd
->tf_flags
& IDE_TFLAG_OUT_DEVICE
)
128 tf_outb((tf
->device
& HIHI
) | drive
->select
,
129 io_ports
->device_addr
);
131 EXPORT_SYMBOL_GPL(ide_tf_load
);
133 void ide_tf_read(ide_drive_t
*drive
, struct ide_cmd
*cmd
)
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;
143 tf_outb
= ide_mm_outb
;
150 /* be sure we're looking at the low order bits */
151 tf_outb(ATA_DEVCTL_OBS
, io_ports
->ctl_addr
);
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
);
166 if (cmd
->tf_flags
& IDE_TFLAG_LBA48
) {
167 tf_outb(ATA_HOB
| ATA_DEVCTL_OBS
, io_ports
->ctl_addr
);
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
);
181 EXPORT_SYMBOL_GPL(ide_tf_read
);
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.
190 static void ata_vlb_sync(unsigned long port
)
198 * This is used for most PIO data transfers *from* the IDE interface
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.
204 void ide_input_data(ide_drive_t
*drive
, struct ide_cmd
*cmd
, void *buf
,
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;
215 unsigned long uninitialized_var(flags
);
217 if ((io_32bit
& 2) && !mmio
) {
218 local_irq_save(flags
);
219 ata_vlb_sync(io_ports
->nsect_addr
);
224 __ide_mm_insl((void __iomem
*)data_addr
, buf
, words
);
226 insl(data_addr
, buf
, words
);
228 if ((io_32bit
& 2) && !mmio
)
229 local_irq_restore(flags
);
231 if (((len
+ 1) & 3) < 2)
239 __ide_mm_insw((void __iomem
*)data_addr
, buf
, words
);
241 insw(data_addr
, buf
, words
);
243 EXPORT_SYMBOL_GPL(ide_input_data
);
246 * This is used for most PIO data transfers *to* the IDE interface
248 void ide_output_data(ide_drive_t
*drive
, struct ide_cmd
*cmd
, void *buf
,
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;
259 unsigned long uninitialized_var(flags
);
261 if ((io_32bit
& 2) && !mmio
) {
262 local_irq_save(flags
);
263 ata_vlb_sync(io_ports
->nsect_addr
);
268 __ide_mm_outsl((void __iomem
*)data_addr
, buf
, words
);
270 outsl(data_addr
, buf
, words
);
272 if ((io_32bit
& 2) && !mmio
)
273 local_irq_restore(flags
);
275 if (((len
+ 1) & 3) < 2)
283 __ide_mm_outsw((void __iomem
*)data_addr
, buf
, words
);
285 outsw(data_addr
, buf
, words
);
287 EXPORT_SYMBOL_GPL(ide_output_data
);
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
,
295 .dev_select
= ide_dev_select
,
296 .tf_load
= ide_tf_load
,
297 .tf_read
= ide_tf_read
,
299 .input_data
= ide_input_data
,
300 .output_data
= ide_output_data
,