ide: use ->tf_read in ide_read_error()
[linux-2.6/linux-acpi-2.6/ibm-acpi-2.6.git] / drivers / ide / pci / ns87415.c
blobb9bb8428b35e71d99210479ad587db8b64980ebe
1 /*
2 * Copyright (C) 1997-1998 Mark Lord <mlord@pobox.com>
3 * Copyright (C) 1998 Eddie C. Dost <ecd@skynet.be>
4 * Copyright (C) 1999-2000 Andre Hedrick <andre@linux-ide.org>
5 * Copyright (C) 2004 Grant Grundler <grundler at parisc-linux.org>
7 * Inspired by an earlier effort from David S. Miller <davem@redhat.com>
8 */
10 #include <linux/module.h>
11 #include <linux/types.h>
12 #include <linux/kernel.h>
13 #include <linux/interrupt.h>
14 #include <linux/hdreg.h>
15 #include <linux/pci.h>
16 #include <linux/delay.h>
17 #include <linux/ide.h>
18 #include <linux/init.h>
20 #include <asm/io.h>
22 #ifdef CONFIG_SUPERIO
23 /* SUPERIO 87560 is a PoS chip that NatSem denies exists.
24 * Unfortunately, it's built-in on all Astro-based PA-RISC workstations
25 * which use the integrated NS87514 cell for CD-ROM support.
26 * i.e we have to support for CD-ROM installs.
27 * See drivers/parisc/superio.c for more gory details.
29 #include <asm/superio.h>
31 static unsigned long superio_ide_status[2];
32 static unsigned long superio_ide_select[2];
33 static unsigned long superio_ide_dma_status[2];
35 #define SUPERIO_IDE_MAX_RETRIES 25
37 /* Because of a defect in Super I/O, all reads of the PCI DMA status
38 * registers, IDE status register and the IDE select register need to be
39 * retried
41 static u8 superio_ide_inb (unsigned long port)
43 if (port == superio_ide_status[0] ||
44 port == superio_ide_status[1] ||
45 port == superio_ide_select[0] ||
46 port == superio_ide_select[1] ||
47 port == superio_ide_dma_status[0] ||
48 port == superio_ide_dma_status[1]) {
49 u8 tmp;
50 int retries = SUPERIO_IDE_MAX_RETRIES;
52 /* printk(" [ reading port 0x%x with retry ] ", port); */
54 do {
55 tmp = inb(port);
56 if (tmp == 0)
57 udelay(50);
58 } while (tmp == 0 && retries-- > 0);
60 return tmp;
63 return inb(port);
66 static u8 superio_read_status(ide_hwif_t *hwif)
68 return superio_ide_inb(hwif->io_ports.status_addr);
71 static u8 superio_read_sff_dma_status(ide_hwif_t *hwif)
73 return superio_ide_inb(hwif->dma_base + ATA_DMA_STATUS);
76 static void superio_tf_read(ide_drive_t *drive, ide_task_t *task)
78 struct ide_io_ports *io_ports = &drive->hwif->io_ports;
79 struct ide_taskfile *tf = &task->tf;
81 if (task->tf_flags & IDE_TFLAG_IN_DATA) {
82 u16 data = inw(io_ports->data_addr);
84 tf->data = data & 0xff;
85 tf->hob_data = (data >> 8) & 0xff;
88 /* be sure we're looking at the low order bits */
89 outb(ATA_DEVCTL_OBS & ~0x80, io_ports->ctl_addr);
91 if (task->tf_flags & IDE_TFLAG_IN_FEATURE)
92 tf->feature = inb(io_ports->feature_addr);
93 if (task->tf_flags & IDE_TFLAG_IN_NSECT)
94 tf->nsect = inb(io_ports->nsect_addr);
95 if (task->tf_flags & IDE_TFLAG_IN_LBAL)
96 tf->lbal = inb(io_ports->lbal_addr);
97 if (task->tf_flags & IDE_TFLAG_IN_LBAM)
98 tf->lbam = inb(io_ports->lbam_addr);
99 if (task->tf_flags & IDE_TFLAG_IN_LBAH)
100 tf->lbah = inb(io_ports->lbah_addr);
101 if (task->tf_flags & IDE_TFLAG_IN_DEVICE)
102 tf->device = superio_ide_inb(io_ports->device_addr);
104 if (task->tf_flags & IDE_TFLAG_LBA48) {
105 outb(ATA_DEVCTL_OBS | 0x80, io_ports->ctl_addr);
107 if (task->tf_flags & IDE_TFLAG_IN_HOB_FEATURE)
108 tf->hob_feature = inb(io_ports->feature_addr);
109 if (task->tf_flags & IDE_TFLAG_IN_HOB_NSECT)
110 tf->hob_nsect = inb(io_ports->nsect_addr);
111 if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAL)
112 tf->hob_lbal = inb(io_ports->lbal_addr);
113 if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAM)
114 tf->hob_lbam = inb(io_ports->lbam_addr);
115 if (task->tf_flags & IDE_TFLAG_IN_HOB_LBAH)
116 tf->hob_lbah = inb(io_ports->lbah_addr);
120 static void __devinit superio_ide_init_iops (struct hwif_s *hwif)
122 struct pci_dev *pdev = to_pci_dev(hwif->dev);
123 u32 base, dmabase;
124 u8 port = hwif->channel, tmp;
126 base = pci_resource_start(pdev, port * 2) & ~3;
127 dmabase = pci_resource_start(pdev, 4) & ~3;
129 superio_ide_status[port] = base + 7;
130 superio_ide_select[port] = base + 6;
131 superio_ide_dma_status[port] = dmabase + (!port ? 2 : 0xa);
133 /* Clear error/interrupt, enable dma */
134 tmp = superio_ide_inb(superio_ide_dma_status[port]);
135 outb(tmp | 0x66, superio_ide_dma_status[port]);
137 hwif->read_status = superio_read_status;
138 hwif->read_sff_dma_status = superio_read_sff_dma_status;
140 hwif->tf_read = superio_tf_read;
142 /* We need to override inb to workaround a SuperIO errata */
143 hwif->INB = superio_ide_inb;
146 static void __devinit init_iops_ns87415(ide_hwif_t *hwif)
148 struct pci_dev *dev = to_pci_dev(hwif->dev);
150 if (PCI_SLOT(dev->devfn) == 0xE)
151 /* Built-in - assume it's under superio. */
152 superio_ide_init_iops(hwif);
154 #endif
156 static unsigned int ns87415_count = 0, ns87415_control[MAX_HWIFS] = { 0 };
159 * This routine either enables/disables (according to drive->present)
160 * the IRQ associated with the port (HWIF(drive)),
161 * and selects either PIO or DMA handshaking for the next I/O operation.
163 static void ns87415_prepare_drive (ide_drive_t *drive, unsigned int use_dma)
165 ide_hwif_t *hwif = HWIF(drive);
166 struct pci_dev *dev = to_pci_dev(hwif->dev);
167 unsigned int bit, other, new, *old = (unsigned int *) hwif->select_data;
168 unsigned long flags;
170 local_irq_save(flags);
171 new = *old;
173 /* Adjust IRQ enable bit */
174 bit = 1 << (8 + hwif->channel);
175 new = drive->present ? (new & ~bit) : (new | bit);
177 /* Select PIO or DMA, DMA may only be selected for one drive/channel. */
178 bit = 1 << (20 + drive->select.b.unit + (hwif->channel << 1));
179 other = 1 << (20 + (1 - drive->select.b.unit) + (hwif->channel << 1));
180 new = use_dma ? ((new & ~other) | bit) : (new & ~bit);
182 if (new != *old) {
183 unsigned char stat;
186 * Don't change DMA engine settings while Write Buffers
187 * are busy.
189 (void) pci_read_config_byte(dev, 0x43, &stat);
190 while (stat & 0x03) {
191 udelay(1);
192 (void) pci_read_config_byte(dev, 0x43, &stat);
195 *old = new;
196 (void) pci_write_config_dword(dev, 0x40, new);
199 * And let things settle...
201 udelay(10);
204 local_irq_restore(flags);
207 static void ns87415_selectproc (ide_drive_t *drive)
209 ns87415_prepare_drive (drive, drive->using_dma);
212 static int ns87415_dma_end(ide_drive_t *drive)
214 ide_hwif_t *hwif = HWIF(drive);
215 u8 dma_stat = 0, dma_cmd = 0;
217 drive->waiting_for_dma = 0;
218 dma_stat = hwif->read_sff_dma_status(hwif);
219 /* get DMA command mode */
220 dma_cmd = inb(hwif->dma_base + ATA_DMA_CMD);
221 /* stop DMA */
222 outb(dma_cmd & ~1, hwif->dma_base + ATA_DMA_CMD);
223 /* from ERRATA: clear the INTR & ERROR bits */
224 dma_cmd = inb(hwif->dma_base + ATA_DMA_CMD);
225 outb(dma_cmd | 6, hwif->dma_base + ATA_DMA_CMD);
226 /* and free any DMA resources */
227 ide_destroy_dmatable(drive);
228 /* verify good DMA status */
229 return (dma_stat & 7) != 4;
232 static int ns87415_dma_setup(ide_drive_t *drive)
234 /* select DMA xfer */
235 ns87415_prepare_drive(drive, 1);
236 if (!ide_dma_setup(drive))
237 return 0;
238 /* DMA failed: select PIO xfer */
239 ns87415_prepare_drive(drive, 0);
240 return 1;
243 static void __devinit init_hwif_ns87415 (ide_hwif_t *hwif)
245 struct pci_dev *dev = to_pci_dev(hwif->dev);
246 unsigned int ctrl, using_inta;
247 u8 progif;
248 #ifdef __sparc_v9__
249 int timeout;
250 u8 stat;
251 #endif
254 * We cannot probe for IRQ: both ports share common IRQ on INTA.
255 * Also, leave IRQ masked during drive probing, to prevent infinite
256 * interrupts from a potentially floating INTA..
258 * IRQs get unmasked in selectproc when drive is first used.
260 (void) pci_read_config_dword(dev, 0x40, &ctrl);
261 (void) pci_read_config_byte(dev, 0x09, &progif);
262 /* is irq in "native" mode? */
263 using_inta = progif & (1 << (hwif->channel << 1));
264 if (!using_inta)
265 using_inta = ctrl & (1 << (4 + hwif->channel));
266 if (hwif->mate) {
267 hwif->select_data = hwif->mate->select_data;
268 } else {
269 hwif->select_data = (unsigned long)
270 &ns87415_control[ns87415_count++];
271 ctrl |= (1 << 8) | (1 << 9); /* mask both IRQs */
272 if (using_inta)
273 ctrl &= ~(1 << 6); /* unmask INTA */
274 *((unsigned int *)hwif->select_data) = ctrl;
275 (void) pci_write_config_dword(dev, 0x40, ctrl);
278 * Set prefetch size to 512 bytes for both ports,
279 * but don't turn on/off prefetching here.
281 pci_write_config_byte(dev, 0x55, 0xee);
283 #ifdef __sparc_v9__
285 * XXX: Reset the device, if we don't it will not respond to
286 * SELECT_DRIVE() properly during first ide_probe_port().
288 timeout = 10000;
289 outb(12, hwif->io_ports.ctl_addr);
290 udelay(10);
291 outb(8, hwif->io_ports.ctl_addr);
292 do {
293 udelay(50);
294 stat = hwif->read_status(hwif);
295 if (stat == 0xff)
296 break;
297 } while ((stat & BUSY_STAT) && --timeout);
298 #endif
301 if (!using_inta)
302 hwif->irq = __ide_default_irq(hwif->io_ports.data_addr);
303 else if (!hwif->irq && hwif->mate && hwif->mate->irq)
304 hwif->irq = hwif->mate->irq; /* share IRQ with mate */
306 if (!hwif->dma_base)
307 return;
309 outb(0x60, hwif->dma_base + ATA_DMA_STATUS);
312 static const struct ide_port_ops ns87415_port_ops = {
313 .selectproc = ns87415_selectproc,
316 static const struct ide_dma_ops ns87415_dma_ops = {
317 .dma_host_set = ide_dma_host_set,
318 .dma_setup = ns87415_dma_setup,
319 .dma_exec_cmd = ide_dma_exec_cmd,
320 .dma_start = ide_dma_start,
321 .dma_end = ns87415_dma_end,
322 .dma_test_irq = ide_dma_test_irq,
323 .dma_lost_irq = ide_dma_lost_irq,
324 .dma_timeout = ide_dma_timeout,
327 static const struct ide_port_info ns87415_chipset __devinitdata = {
328 .name = "NS87415",
329 #ifdef CONFIG_SUPERIO
330 .init_iops = init_iops_ns87415,
331 #endif
332 .init_hwif = init_hwif_ns87415,
333 .port_ops = &ns87415_port_ops,
334 .dma_ops = &ns87415_dma_ops,
335 .host_flags = IDE_HFLAG_TRUST_BIOS_FOR_DMA |
336 IDE_HFLAG_NO_ATAPI_DMA,
339 static int __devinit ns87415_init_one(struct pci_dev *dev, const struct pci_device_id *id)
341 return ide_setup_pci_device(dev, &ns87415_chipset);
344 static const struct pci_device_id ns87415_pci_tbl[] = {
345 { PCI_VDEVICE(NS, PCI_DEVICE_ID_NS_87415), 0 },
346 { 0, },
348 MODULE_DEVICE_TABLE(pci, ns87415_pci_tbl);
350 static struct pci_driver driver = {
351 .name = "NS87415_IDE",
352 .id_table = ns87415_pci_tbl,
353 .probe = ns87415_init_one,
356 static int __init ns87415_ide_init(void)
358 return ide_pci_register_driver(&driver);
361 module_init(ns87415_ide_init);
363 MODULE_AUTHOR("Mark Lord, Eddie Dost, Andre Hedrick");
364 MODULE_DESCRIPTION("PCI driver module for NS87415 IDE");
365 MODULE_LICENSE("GPL");