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 17static u8 ide_inb(unsigned long port) 18{ 19 return (u8) inb(port); 20} 21 22static 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 31static u8 ide_mm_inb(unsigned long port) 32{ 33 return (u8) readb((void __iomem *) port); 34} 35 36static void ide_mm_outb(u8 value, unsigned long port) 37{ 38 writeb(value, (void __iomem *) port); 39} 40 41void 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} 48EXPORT_SYMBOL_GPL(ide_exec_command); 49 50u8 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} 57EXPORT_SYMBOL_GPL(ide_read_status); 58 59u8 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} 66EXPORT_SYMBOL_GPL(ide_read_altstatus); 67 68void 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} 75EXPORT_SYMBOL_GPL(ide_write_devctl); 76 77void 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} 87EXPORT_SYMBOL_GPL(ide_dev_select); 88 89void 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} 114EXPORT_SYMBOL_GPL(ide_tf_load); 115 116void 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} 141EXPORT_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 */ 150static 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 */ 164void 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} 203EXPORT_SYMBOL_GPL(ide_input_data); 204 205/* 206 * This is used for most PIO data transfers *to* the IDE interface 207 */ 208void 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} 247EXPORT_SYMBOL_GPL(ide_output_data); 248 249const 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