blob: 7ae6ae45331f48f09bce6c62d18700c0c167b5a5 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Bartlomiej Zolnierkiewicz59bca8c2008-02-01 23:09:33 +01002 * Copyright (C) 1998-2000 Andre Hedrick <andre@linux-ide.org>
3 * Copyright (C) 1995-1998 Mark Lord
4 * Copyright (C) 2007 Bartlomiej Zolnierkiewicz
Bartlomiej Zolnierkiewicz58f189f2008-02-01 23:09:33 +01005 *
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 * May be copied or modified under the terms of the GNU General Public License
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 */
8
Linus Torvalds1da177e2005-04-16 15:20:36 -07009#include <linux/types.h>
10#include <linux/kernel.h>
11#include <linux/pci.h>
12#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070013#include <linux/interrupt.h>
14#include <linux/ide.h>
15#include <linux/dma-mapping.h>
16
17#include <asm/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070018
Linus Torvalds1da177e2005-04-16 15:20:36 -070019/**
20 * ide_setup_pci_baseregs - place a PCI IDE controller native
21 * @dev: PCI device of interface to switch native
22 * @name: Name of interface
23 *
24 * We attempt to place the PCI interface into PCI native mode. If
25 * we succeed the BARs are ok and the controller is in PCI mode.
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +020026 * Returns 0 on success or an errno code.
Linus Torvalds1da177e2005-04-16 15:20:36 -070027 *
28 * FIXME: if we program the interface and then fail to set the BARS
29 * we don't switch it back to legacy mode. Do we actually care ??
30 */
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +020031
32static int ide_setup_pci_baseregs(struct pci_dev *dev, const char *name)
Linus Torvalds1da177e2005-04-16 15:20:36 -070033{
34 u8 progif = 0;
35
36 /*
37 * Place both IDE interfaces into PCI "native" mode:
38 */
39 if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
40 (progif & 5) != 5) {
41 if ((progif & 0xa) != 0xa) {
42 printk(KERN_INFO "%s: device not capable of full "
43 "native PCI mode\n", name);
44 return -EOPNOTSUPP;
45 }
46 printk("%s: placing both ports into native PCI mode\n", name);
47 (void) pci_write_config_byte(dev, PCI_CLASS_PROG, progif|5);
48 if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
49 (progif & 5) != 5) {
50 printk(KERN_ERR "%s: rewrite of PROGIF failed, wanted "
51 "0x%04x, got 0x%04x\n",
52 name, progif|5, progif);
53 return -EOPNOTSUPP;
54 }
55 }
56 return 0;
57}
58
59#ifdef CONFIG_BLK_DEV_IDEDMA_PCI
Bartlomiej Zolnierkiewicz8ac2b422008-02-01 23:09:30 +010060static void ide_pci_clear_simplex(unsigned long dma_base, const char *name)
61{
62 u8 dma_stat = inb(dma_base + 2);
63
64 outb(dma_stat & 0x60, dma_base + 2);
65 dma_stat = inb(dma_base + 2);
66 if (dma_stat & 0x80)
67 printk(KERN_INFO "%s: simplex device: DMA forced\n", name);
68}
69
Linus Torvalds1da177e2005-04-16 15:20:36 -070070/**
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +020071 * ide_pci_dma_base - setup BMIBA
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +020072 * @hwif: IDE interface
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +020073 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -070074 *
Bartlomiej Zolnierkiewiczc58e79d2007-10-16 22:29:56 +020075 * Fetch the DMA Bus-Master-I/O-Base-Address (BMIBA) from PCI space.
76 * Where a device has a partner that is already in DMA mode we check
77 * and enforce IDE simplex rules.
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 */
79
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +020080unsigned long ide_pci_dma_base(ide_hwif_t *hwif, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -070081{
Bartlomiej Zolnierkiewicz36501652008-02-01 23:09:31 +010082 struct pci_dev *dev = to_pci_dev(hwif->dev);
83 unsigned long dma_base = 0;
Bartlomiej Zolnierkiewicz8ac2b422008-02-01 23:09:30 +010084 u8 dma_stat = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070085
Bartlomiej Zolnierkiewicz13572142008-07-15 21:21:49 +020086 if (hwif->host_flags & IDE_HFLAG_MMIO)
Linus Torvalds1da177e2005-04-16 15:20:36 -070087 return hwif->dma_base;
88
89 if (hwif->mate && hwif->mate->dma_base) {
90 dma_base = hwif->mate->dma_base - (hwif->channel ? 0 : 8);
91 } else {
Bartlomiej Zolnierkiewicz9ffcf362007-10-19 00:30:07 +020092 u8 baridx = (d->host_flags & IDE_HFLAG_CS5520) ? 2 : 4;
93
94 dma_base = pci_resource_start(dev, baridx);
95
Bartlomiej Zolnierkiewiczaea5d372008-01-26 20:12:59 +010096 if (dma_base == 0) {
Bartlomiej Zolnierkiewicz9ffcf362007-10-19 00:30:07 +020097 printk(KERN_ERR "%s: DMA base is invalid\n", d->name);
Bartlomiej Zolnierkiewiczaea5d372008-01-26 20:12:59 +010098 return 0;
99 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700100 }
101
Bartlomiej Zolnierkiewiczaea5d372008-01-26 20:12:59 +0100102 if (hwif->channel)
103 dma_base += 8;
104
Bartlomiej Zolnierkiewicz8ac2b422008-02-01 23:09:30 +0100105 if (d->host_flags & IDE_HFLAG_CS5520)
106 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107
Bartlomiej Zolnierkiewicz8ac2b422008-02-01 23:09:30 +0100108 if (d->host_flags & IDE_HFLAG_CLEAR_SIMPLEX) {
109 ide_pci_clear_simplex(dma_base, d->name);
110 goto out;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 }
Bartlomiej Zolnierkiewicz8ac2b422008-02-01 23:09:30 +0100112
113 /*
114 * If the device claims "simplex" DMA, this means that only one of
115 * the two interfaces can be trusted with DMA at any point in time
116 * (so we should enable DMA only on one of the two interfaces).
117 *
118 * FIXME: At this point we haven't probed the drives so we can't make
119 * the appropriate decision. Really we should defer this problem until
120 * we tune the drive then try to grab DMA ownership if we want to be
121 * the DMA end. This has to be become dynamic to handle hot-plug.
122 */
123 dma_stat = hwif->INB(dma_base + 2);
124 if ((dma_stat & 0x80) && hwif->mate && hwif->mate->dma_base) {
125 printk(KERN_INFO "%s: simplex device: DMA disabled\n", d->name);
126 dma_base = 0;
127 }
128out:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 return dma_base;
130}
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200131EXPORT_SYMBOL_GPL(ide_pci_dma_base);
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200132
133/*
134 * Set up BM-DMA capability (PnP BIOS should have done this)
135 */
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200136int ide_pci_set_master(struct pci_dev *dev, const char *name)
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200137{
138 u16 pcicmd;
139
140 pci_read_config_word(dev, PCI_COMMAND, &pcicmd);
141
142 if ((pcicmd & PCI_COMMAND_MASTER) == 0) {
143 pci_set_master(dev);
144
145 if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd) ||
146 (pcicmd & PCI_COMMAND_MASTER) == 0) {
147 printk(KERN_ERR "%s: error updating PCICMD on %s\n",
148 name, pci_name(dev));
149 return -EIO;
150 }
151 }
152
153 return 0;
154}
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200155EXPORT_SYMBOL_GPL(ide_pci_set_master);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700156#endif /* CONFIG_BLK_DEV_IDEDMA_PCI */
157
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200158void ide_setup_pci_noise(struct pci_dev *dev, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700159{
Bartlomiej Zolnierkiewiczbde07e52007-10-20 00:32:36 +0200160 printk(KERN_INFO "%s: IDE controller (0x%04x:0x%04x rev 0x%02x) at "
161 " PCI slot %s\n", d->name, dev->vendor, dev->device,
162 dev->revision, pci_name(dev));
Linus Torvalds1da177e2005-04-16 15:20:36 -0700163}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700164EXPORT_SYMBOL_GPL(ide_setup_pci_noise);
165
166
167/**
168 * ide_pci_enable - do PCI enables
169 * @dev: PCI device
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200170 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 *
172 * Enable the IDE PCI device. We attempt to enable the device in full
Benjamin Herrenschmidt09483912007-12-20 15:28:09 +1100173 * but if that fails then we only need IO space. The PCI code should
174 * have setup the proper resources for us already for controllers in
175 * legacy mode.
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200176 *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177 * Returns zero on success or an error code
178 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200179
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200180static int ide_pci_enable(struct pci_dev *dev, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700181{
Bartlomiej Zolnierkiewicz0d1bad22008-04-26 22:25:19 +0200182 int ret, bars;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183
184 if (pci_enable_device(dev)) {
Benjamin Herrenschmidt09483912007-12-20 15:28:09 +1100185 ret = pci_enable_device_io(dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186 if (ret < 0) {
187 printk(KERN_WARNING "%s: (ide_setup_pci_device:) "
188 "Could not enable device.\n", d->name);
189 goto out;
190 }
191 printk(KERN_WARNING "%s: BIOS configuration fixed.\n", d->name);
192 }
193
194 /*
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200195 * assume all devices can do 32-bit DMA for now, we can add
196 * a DMA mask field to the struct ide_port_info if we need it
197 * (or let lower level driver set the DMA mask)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700198 */
199 ret = pci_set_dma_mask(dev, DMA_32BIT_MASK);
200 if (ret < 0) {
201 printk(KERN_ERR "%s: can't set dma mask\n", d->name);
202 goto out;
203 }
204
Bartlomiej Zolnierkiewicz0d1bad22008-04-26 22:25:19 +0200205 if (d->host_flags & IDE_HFLAG_SINGLE)
206 bars = (1 << 2) - 1;
207 else
208 bars = (1 << 4) - 1;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700209
Bartlomiej Zolnierkiewicz0d1bad22008-04-26 22:25:19 +0200210 if ((d->host_flags & IDE_HFLAG_NO_DMA) == 0) {
211 if (d->host_flags & IDE_HFLAG_CS5520)
212 bars |= (1 << 2);
213 else
214 bars |= (1 << 4);
215 }
216
217 ret = pci_request_selected_regions(dev, bars, d->name);
218 if (ret < 0)
219 printk(KERN_ERR "%s: can't reserve resources\n", d->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700220out:
221 return ret;
222}
223
224/**
225 * ide_pci_configure - configure an unconfigured device
226 * @dev: PCI device
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200227 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228 *
229 * Enable and configure the PCI device we have been passed.
230 * Returns zero on success or an error code.
231 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200232
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200233static int ide_pci_configure(struct pci_dev *dev, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234{
235 u16 pcicmd = 0;
236 /*
237 * PnP BIOS was *supposed* to have setup this device, but we
238 * can do it ourselves, so long as the BIOS has assigned an IRQ
239 * (or possibly the device is using a "legacy header" for IRQs).
240 * Maybe the user deliberately *disabled* the device,
241 * but we'll eventually ignore it again if no drives respond.
242 */
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200243 if (ide_setup_pci_baseregs(dev, d->name) ||
244 pci_write_config_word(dev, PCI_COMMAND, pcicmd | PCI_COMMAND_IO)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700245 printk(KERN_INFO "%s: device disabled (BIOS)\n", d->name);
246 return -ENODEV;
247 }
248 if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd)) {
249 printk(KERN_ERR "%s: error accessing PCI regs\n", d->name);
250 return -EIO;
251 }
252 if (!(pcicmd & PCI_COMMAND_IO)) {
253 printk(KERN_ERR "%s: unable to enable IDE controller\n", d->name);
254 return -ENXIO;
255 }
256 return 0;
257}
258
259/**
260 * ide_pci_check_iomem - check a register is I/O
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200261 * @dev: PCI device
262 * @d: IDE port info
263 * @bar: BAR number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700264 *
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200265 * Checks if a BAR is configured and points to MMIO space. If so,
266 * return an error code. Otherwise return 0
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200268
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200269static int ide_pci_check_iomem(struct pci_dev *dev, const struct ide_port_info *d,
270 int bar)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700271{
272 ulong flags = pci_resource_flags(dev, bar);
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200273
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 /* Unconfigured ? */
275 if (!flags || pci_resource_len(dev, bar) == 0)
276 return 0;
277
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200278 /* I/O space */
279 if (flags & IORESOURCE_IO)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280 return 0;
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200281
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282 /* Bad */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283 return -EINVAL;
284}
285
286/**
287 * ide_hwif_configure - configure an IDE interface
288 * @dev: PCI device holding interface
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200289 * @d: IDE port info
Bartlomiej Zolnierkiewicz1ebf7492008-02-02 19:56:30 +0100290 * @port: port number
291 * @irq: PCI IRQ
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292 *
293 * Perform the initial set up for the hardware interface structure. This
294 * is done per interface port rather than per PCI device. There may be
295 * more than one port per device.
296 *
297 * Returns the new hardware interface structure, or NULL on a failure
298 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200299
Bartlomiej Zolnierkiewicz1ebf7492008-02-02 19:56:30 +0100300static ide_hwif_t *ide_hwif_configure(struct pci_dev *dev,
301 const struct ide_port_info *d,
302 unsigned int port, int irq)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303{
304 unsigned long ctl = 0, base = 0;
305 ide_hwif_t *hwif;
Bartlomiej Zolnierkiewicz79127c32008-01-26 20:13:08 +0100306 struct hw_regs_s hw;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307
Bartlomiej Zolnierkiewicza5d8c5c2007-07-20 01:11:55 +0200308 if ((d->host_flags & IDE_HFLAG_ISA_PORTS) == 0) {
Sergei Shtylyov1baccff2008-04-26 17:36:31 +0200309 if (ide_pci_check_iomem(dev, d, 2 * port) ||
310 ide_pci_check_iomem(dev, d, 2 * port + 1)) {
311 printk(KERN_ERR "%s: I/O baseregs (BIOS) are reported "
312 "as MEM for port %d!\n", d->name, port);
313 return NULL;
314 }
Paolo Ciarrocchi846bb882008-04-26 17:36:39 +0200315
Linus Torvalds1da177e2005-04-16 15:20:36 -0700316 ctl = pci_resource_start(dev, 2*port+1);
317 base = pci_resource_start(dev, 2*port);
Bartlomiej Zolnierkiewiczc1da6782008-07-16 20:33:41 +0200318 } else {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319 /* Use default values */
320 ctl = port ? 0x374 : 0x3f4;
321 base = port ? 0x170 : 0x1f0;
322 }
Bartlomiej Zolnierkiewiczbad7c822008-04-26 17:36:31 +0200323
Bartlomiej Zolnierkiewiczc1da6782008-07-16 20:33:41 +0200324 if (!base || !ctl) {
325 printk(KERN_ERR "%s: bad PCI BARs for port %d, skipping\n",
326 d->name, port);
327 return NULL;
328 }
329
Bartlomiej Zolnierkiewiczfe80b932008-04-26 17:36:36 +0200330 hwif = ide_find_port_slot(d);
Bartlomiej Zolnierkiewiczeb3aff52008-07-16 20:33:42 +0200331 if (hwif == NULL)
Bartlomiej Zolnierkiewiczbad7c822008-04-26 17:36:31 +0200332 return NULL;
Bartlomiej Zolnierkiewicz9239b332007-10-20 00:32:33 +0200333
Bartlomiej Zolnierkiewicz79127c32008-01-26 20:13:08 +0100334 memset(&hw, 0, sizeof(hw));
Bartlomiej Zolnierkiewiczaab8ad92008-04-18 00:46:35 +0200335 hw.irq = irq;
Bartlomiej Zolnierkiewicz79127c32008-01-26 20:13:08 +0100336 hw.dev = &dev->dev;
337 hw.chipset = d->chipset ? d->chipset : ide_pci;
338 ide_std_init_ports(&hw, base, ctl | 2);
339
Bartlomiej Zolnierkiewicz79127c32008-01-26 20:13:08 +0100340 ide_init_port_hw(hwif, &hw);
341
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 return hwif;
343}
344
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100345#ifdef CONFIG_BLK_DEV_IDEDMA_PCI
Linus Torvalds1da177e2005-04-16 15:20:36 -0700346/**
347 * ide_hwif_setup_dma - configure DMA interface
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200348 * @hwif: IDE interface
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100349 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700350 *
351 * Set up the DMA base for the interface. Enable the master bits as
352 * necessary and attempt to bring the device DMA into a ready to use
353 * state
354 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200355
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200356int ide_hwif_setup_dma(ide_hwif_t *hwif, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357{
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100358 struct pci_dev *dev = to_pci_dev(hwif->dev);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359
Bartlomiej Zolnierkiewicz47b68782007-10-19 00:30:06 +0200360 if ((d->host_flags & IDE_HFLAG_NO_AUTODMA) == 0 ||
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361 ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE &&
362 (dev->class & 0x80))) {
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200363 unsigned long base = ide_pci_dma_base(hwif, d);
Bartlomiej Zolnierkiewicz23658f82008-04-26 22:25:21 +0200364
Bartlomiej Zolnierkiewicz63158d52008-04-26 22:25:21 +0200365 if (base == 0 || ide_pci_set_master(dev, d->name) < 0)
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200366 return -1;
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200367
Bartlomiej Zolnierkiewicz13572142008-07-15 21:21:49 +0200368 if (hwif->host_flags & IDE_HFLAG_MMIO)
Bartlomiej Zolnierkiewicz63158d52008-04-26 22:25:21 +0200369 printk(KERN_INFO " %s: MMIO-DMA\n", hwif->name);
370 else
371 printk(KERN_INFO " %s: BM-DMA at 0x%04lx-0x%04lx\n",
372 hwif->name, base, base + 7);
373
374 hwif->extra_base = base + (hwif->channel ? 8 : 16);
375
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200376 if (ide_allocate_dma_engine(hwif))
377 return -1;
378
Bartlomiej Zolnierkiewiczf37afda2008-04-26 22:25:24 +0200379 ide_setup_dma(hwif, base);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380 }
Bartlomiej Zolnierkiewiczd54452f2008-04-26 22:25:21 +0200381
Bartlomiej Zolnierkiewiczb123f562008-04-26 22:25:22 +0200382 return 0;
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200383}
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100384#endif /* CONFIG_BLK_DEV_IDEDMA_PCI */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700385
386/**
387 * ide_setup_pci_controller - set up IDE PCI
388 * @dev: PCI device
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200389 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 * @noisy: verbose flag
391 * @config: returned as 1 if we configured the hardware
392 *
393 * Set up the PCI and controller side of the IDE interface. This brings
394 * up the PCI side of the device, checks that the device is enabled
395 * and enables it if need be
396 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200397
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200398static int ide_setup_pci_controller(struct pci_dev *dev, const struct ide_port_info *d, int noisy, int *config)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399{
400 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 u16 pcicmd;
402
403 if (noisy)
404 ide_setup_pci_noise(dev, d);
405
406 ret = ide_pci_enable(dev, d);
407 if (ret < 0)
408 goto out;
409
410 ret = pci_read_config_word(dev, PCI_COMMAND, &pcicmd);
411 if (ret < 0) {
412 printk(KERN_ERR "%s: error accessing PCI regs\n", d->name);
413 goto out;
414 }
415 if (!(pcicmd & PCI_COMMAND_IO)) { /* is device disabled? */
416 ret = ide_pci_configure(dev, d);
417 if (ret < 0)
418 goto out;
419 *config = 1;
420 printk(KERN_INFO "%s: device enabled (Linux)\n", d->name);
421 }
422
Linus Torvalds1da177e2005-04-16 15:20:36 -0700423out:
424 return ret;
425}
426
427/**
428 * ide_pci_setup_ports - configure ports/devices on PCI IDE
429 * @dev: PCI device
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200430 * @d: IDE port info
Linus Torvalds1da177e2005-04-16 15:20:36 -0700431 * @pciirq: IRQ line
Bartlomiej Zolnierkiewicz8447d9d2007-10-20 00:32:31 +0200432 * @idx: ATA index table to update
Linus Torvalds1da177e2005-04-16 15:20:36 -0700433 *
434 * Scan the interfaces attached to this device and do any
435 * necessary per port setup. Attach the devices and ask the
436 * generic DMA layer to do its work for us.
437 *
438 * Normally called automaticall from do_ide_pci_setup_device,
439 * but is also used directly as a helper function by some controllers
440 * where the chipset setup is not the default PCI IDE one.
441 */
Bartlomiej Zolnierkiewicz8447d9d2007-10-20 00:32:31 +0200442
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200443void ide_pci_setup_ports(struct pci_dev *dev, const struct ide_port_info *d, int pciirq, u8 *idx)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700444{
Bartlomiej Zolnierkiewicza5d8c5c2007-07-20 01:11:55 +0200445 int channels = (d->host_flags & IDE_HFLAG_SINGLE) ? 1 : 2, port;
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100446 ide_hwif_t *hwif;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447 u8 tmp;
448
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 /*
450 * Set up the IDE ports
451 */
Bartlomiej Zolnierkiewiczcf6e8542007-10-20 00:32:29 +0200452
Bartlomiej Zolnierkiewicza5d8c5c2007-07-20 01:11:55 +0200453 for (port = 0; port < channels; ++port) {
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200454 const ide_pci_enablebit_t *e = &(d->enablebits[port]);
455
Linus Torvalds1da177e2005-04-16 15:20:36 -0700456 if (e->reg && (pci_read_config_byte(dev, e->reg, &tmp) ||
Bartlomiej Zolnierkiewiczcf6e8542007-10-20 00:32:29 +0200457 (tmp & e->mask) != e->val)) {
458 printk(KERN_INFO "%s: IDE port disabled\n", d->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700459 continue; /* port not enabled */
Bartlomiej Zolnierkiewiczcf6e8542007-10-20 00:32:29 +0200460 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461
Bartlomiej Zolnierkiewicz1ebf7492008-02-02 19:56:30 +0100462 hwif = ide_hwif_configure(dev, d, port, pciirq);
463 if (hwif == NULL)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700464 continue;
465
Bartlomiej Zolnierkiewicz8447d9d2007-10-20 00:32:31 +0200466 *(idx + port) = hwif->index;
Bartlomiej Zolnierkiewicz1ebf7492008-02-02 19:56:30 +0100467 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700468}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700469EXPORT_SYMBOL_GPL(ide_pci_setup_ports);
470
471/*
472 * ide_setup_pci_device() looks at the primary/secondary interfaces
473 * on a PCI IDE device and, if they are enabled, prepares the IDE driver
474 * for use with them. This generic code works for most PCI chipsets.
475 *
476 * One thing that is not standardized is the location of the
477 * primary/secondary interface "enable/disable" bits. For chipsets that
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200478 * we "know" about, this information is in the struct ide_port_info;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700479 * for all other chipsets, we just assume both interfaces are enabled.
480 */
Bartlomiej Zolnierkiewicz039788e2007-10-20 00:32:34 +0200481static int do_ide_setup_pci_device(struct pci_dev *dev,
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200482 const struct ide_port_info *d,
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200483 u8 noisy)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700484{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 int tried_config = 0;
486 int pciirq, ret;
487
488 ret = ide_setup_pci_controller(dev, d, noisy, &tried_config);
489 if (ret < 0)
490 goto out;
491
492 /*
493 * Can we trust the reported IRQ?
494 */
495 pciirq = dev->irq;
496
497 /* Is it an "IDE storage" device in non-PCI mode? */
498 if ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE && (dev->class & 5) != 5) {
499 if (noisy)
500 printk(KERN_INFO "%s: not 100%% native mode: "
501 "will probe irqs later\n", d->name);
502 /*
503 * This allows offboard ide-pci cards the enable a BIOS,
504 * verify interrupt settings of split-mirror pci-config
505 * space, place chipset into init-mode, and/or preserve
506 * an interrupt if the card is not native ide support.
507 */
508 ret = d->init_chipset ? d->init_chipset(dev, d->name) : 0;
509 if (ret < 0)
510 goto out;
511 pciirq = ret;
512 } else if (tried_config) {
513 if (noisy)
514 printk(KERN_INFO "%s: will probe irqs later\n", d->name);
515 pciirq = 0;
516 } else if (!pciirq) {
517 if (noisy)
518 printk(KERN_WARNING "%s: bad irq (%d): will probe later\n",
519 d->name, pciirq);
520 pciirq = 0;
521 } else {
522 if (d->init_chipset) {
523 ret = d->init_chipset(dev, d->name);
524 if (ret < 0)
525 goto out;
526 }
527 if (noisy)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700528 printk(KERN_INFO "%s: 100%% native mode on irq %d\n",
529 d->name, pciirq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700530 }
531
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200532 ret = pciirq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700533out:
534 return ret;
535}
536
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200537int ide_setup_pci_device(struct pci_dev *dev, const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538{
Bartlomiej Zolnierkiewicz8447d9d2007-10-20 00:32:31 +0200539 u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700540 int ret;
541
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200542 ret = do_ide_setup_pci_device(dev, d, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700543
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200544 if (ret >= 0) {
545 /* FIXME: silent failure can happen */
546 ide_pci_setup_ports(dev, d, ret, &idx[0]);
547
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100548 ide_device_add(idx, d);
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200549 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550
Linus Torvalds1da177e2005-04-16 15:20:36 -0700551 return ret;
552}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700553EXPORT_SYMBOL_GPL(ide_setup_pci_device);
554
555int ide_setup_pci_devices(struct pci_dev *dev1, struct pci_dev *dev2,
Bartlomiej Zolnierkiewicz85620432007-10-20 00:32:34 +0200556 const struct ide_port_info *d)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700557{
558 struct pci_dev *pdev[] = { dev1, dev2 };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700559 int ret, i;
Bartlomiej Zolnierkiewicz8447d9d2007-10-20 00:32:31 +0200560 u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700561
562 for (i = 0; i < 2; i++) {
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200563 ret = do_ide_setup_pci_device(pdev[i], d, !i);
564
Linus Torvalds1da177e2005-04-16 15:20:36 -0700565 /*
566 * FIXME: Mom, mom, they stole me the helper function to undo
567 * do_ide_setup_pci_device() on the first device!
568 */
569 if (ret < 0)
570 goto out;
Bartlomiej Zolnierkiewicz51d87ed2008-07-23 19:55:49 +0200571
572 /* FIXME: silent failure can happen */
573 ide_pci_setup_ports(pdev[i], d, ret, &idx[i*2]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700574 }
575
Bartlomiej Zolnierkiewiczc413b9b2008-02-02 19:56:31 +0100576 ide_device_add(idx, d);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700577out:
578 return ret;
579}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700580EXPORT_SYMBOL_GPL(ide_setup_pci_devices);