caa4a6a32711a2ea352960c741f3ce7d7207b9d9
[safe/jmp/linux-2.6] / drivers / ide / setup-pci.c
1 /*
2  *  linux/drivers/ide/setup-pci.c               Version 1.10    2002/08/19
3  *
4  *  Copyright (c) 1998-2000  Andre Hedrick <andre@linux-ide.org>
5  *
6  *  Copyright (c) 1995-1998  Mark Lord
7  *  May be copied or modified under the terms of the GNU General Public License
8  */
9
10 #include <linux/module.h>
11 #include <linux/types.h>
12 #include <linux/kernel.h>
13 #include <linux/pci.h>
14 #include <linux/init.h>
15 #include <linux/timer.h>
16 #include <linux/mm.h>
17 #include <linux/interrupt.h>
18 #include <linux/ide.h>
19 #include <linux/dma-mapping.h>
20
21 #include <asm/io.h>
22 #include <asm/irq.h>
23
24
25 /**
26  *      ide_match_hwif  -       match a PCI IDE against an ide_hwif
27  *      @io_base: I/O base of device
28  *      @bootable: set if its bootable
29  *      @name: name of device
30  *
31  *      Match a PCI IDE port against an entry in ide_hwifs[],
32  *      based on io_base port if possible. Return the matching hwif,
33  *      or a new hwif. If we find an error (clashing, out of devices, etc)
34  *      return NULL
35  *
36  *      FIXME: we need to handle mmio matches here too
37  */
38
39 static ide_hwif_t *ide_match_hwif(unsigned long io_base, u8 bootable, const char *name)
40 {
41         int h;
42         ide_hwif_t *hwif;
43
44         /*
45          * Look for a hwif with matching io_base specified using
46          * parameters to ide_setup().
47          */
48         for (h = 0; h < MAX_HWIFS; ++h) {
49                 hwif = &ide_hwifs[h];
50                 if (hwif->io_ports[IDE_DATA_OFFSET] == io_base) {
51                         if (hwif->chipset == ide_forced)
52                                 return hwif; /* a perfect match */
53                 }
54         }
55         /*
56          * Look for a hwif with matching io_base default value.
57          * If chipset is "ide_unknown", then claim that hwif slot.
58          * Otherwise, some other chipset has already claimed it..  :(
59          */
60         for (h = 0; h < MAX_HWIFS; ++h) {
61                 hwif = &ide_hwifs[h];
62                 if (hwif->io_ports[IDE_DATA_OFFSET] == io_base) {
63                         if (hwif->chipset == ide_unknown)
64                                 return hwif; /* match */
65                         printk(KERN_ERR "%s: port 0x%04lx already claimed by %s\n",
66                                 name, io_base, hwif->name);
67                         return NULL;    /* already claimed */
68                 }
69         }
70         /*
71          * Okay, there is no hwif matching our io_base,
72          * so we'll just claim an unassigned slot.
73          * Give preference to claiming other slots before claiming ide0/ide1,
74          * just in case there's another interface yet-to-be-scanned
75          * which uses ports 1f0/170 (the ide0/ide1 defaults).
76          *
77          * Unless there is a bootable card that does not use the standard
78          * ports 1f0/170 (the ide0/ide1 defaults). The (bootable) flag.
79          */
80         if (bootable) {
81                 for (h = 0; h < MAX_HWIFS; ++h) {
82                         hwif = &ide_hwifs[h];
83                         if (hwif->chipset == ide_unknown)
84                                 return hwif;    /* pick an unused entry */
85                 }
86         } else {
87                 for (h = 2; h < MAX_HWIFS; ++h) {
88                         hwif = ide_hwifs + h;
89                         if (hwif->chipset == ide_unknown)
90                                 return hwif;    /* pick an unused entry */
91                 }
92         }
93         for (h = 0; h < 2 && h < MAX_HWIFS; ++h) {
94                 hwif = ide_hwifs + h;
95                 if (hwif->chipset == ide_unknown)
96                         return hwif;    /* pick an unused entry */
97         }
98         printk(KERN_ERR "%s: too many IDE interfaces, no room in table\n", name);
99         return NULL;
100 }
101
102 /**
103  *      ide_setup_pci_baseregs  -       place a PCI IDE controller native
104  *      @dev: PCI device of interface to switch native
105  *      @name: Name of interface
106  *
107  *      We attempt to place the PCI interface into PCI native mode. If
108  *      we succeed the BARs are ok and the controller is in PCI mode.
109  *      Returns 0 on success or an errno code. 
110  *
111  *      FIXME: if we program the interface and then fail to set the BARS
112  *      we don't switch it back to legacy mode. Do we actually care ??
113  */
114  
115 static int ide_setup_pci_baseregs (struct pci_dev *dev, const char *name)
116 {
117         u8 progif = 0;
118
119         /*
120          * Place both IDE interfaces into PCI "native" mode:
121          */
122         if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
123                          (progif & 5) != 5) {
124                 if ((progif & 0xa) != 0xa) {
125                         printk(KERN_INFO "%s: device not capable of full "
126                                 "native PCI mode\n", name);
127                         return -EOPNOTSUPP;
128                 }
129                 printk("%s: placing both ports into native PCI mode\n", name);
130                 (void) pci_write_config_byte(dev, PCI_CLASS_PROG, progif|5);
131                 if (pci_read_config_byte(dev, PCI_CLASS_PROG, &progif) ||
132                     (progif & 5) != 5) {
133                         printk(KERN_ERR "%s: rewrite of PROGIF failed, wanted "
134                                 "0x%04x, got 0x%04x\n",
135                                 name, progif|5, progif);
136                         return -EOPNOTSUPP;
137                 }
138         }
139         return 0;
140 }
141
142 #ifdef CONFIG_BLK_DEV_IDEDMA_PCI
143 /**
144  *      ide_get_or_set_dma_base         -       setup BMIBA
145  *      @d: IDE port info
146  *      @hwif: IDE interface
147  *
148  *      Fetch the DMA Bus-Master-I/O-Base-Address (BMIBA) from PCI space.
149  *      Where a device has a partner that is already in DMA mode we check
150  *      and enforce IDE simplex rules.
151  */
152
153 static unsigned long ide_get_or_set_dma_base(const struct ide_port_info *d, ide_hwif_t *hwif)
154 {
155         unsigned long   dma_base = 0;
156         struct pci_dev  *dev = hwif->pci_dev;
157
158         if (hwif->mmio)
159                 return hwif->dma_base;
160
161         if (hwif->mate && hwif->mate->dma_base) {
162                 dma_base = hwif->mate->dma_base - (hwif->channel ? 0 : 8);
163         } else {
164                 u8 baridx = (d->host_flags & IDE_HFLAG_CS5520) ? 2 : 4;
165
166                 dma_base = pci_resource_start(dev, baridx);
167
168                 if (dma_base == 0) {
169                         printk(KERN_ERR "%s: DMA base is invalid\n", d->name);
170                         return 0;
171                 }
172         }
173
174         if (hwif->channel)
175                 dma_base += 8;
176
177         if ((d->host_flags & IDE_HFLAG_CS5520) == 0) {
178                 u8 simplex_stat = 0;
179
180                 switch(dev->device) {
181                         case PCI_DEVICE_ID_AL_M5219:
182                         case PCI_DEVICE_ID_AL_M5229:
183                         case PCI_DEVICE_ID_AMD_VIPER_7409:
184                         case PCI_DEVICE_ID_CMD_643:
185                         case PCI_DEVICE_ID_SERVERWORKS_CSB5IDE:
186                         case PCI_DEVICE_ID_REVOLUTION:
187                                 simplex_stat = inb(dma_base + 2);
188                                 outb(simplex_stat & 0x60, dma_base + 2);
189                                 simplex_stat = inb(dma_base + 2);
190                                 if (simplex_stat & 0x80) {
191                                         printk(KERN_INFO "%s: simplex device: "
192                                                          "DMA forced\n",
193                                                          d->name);
194                                 }
195                                 break;
196                         default:
197                                 /*
198                                  * If the device claims "simplex" DMA,
199                                  * this means only one of the two interfaces
200                                  * can be trusted with DMA at any point in time.
201                                  * So we should enable DMA only on one of the
202                                  * two interfaces.
203                                  */
204                                 simplex_stat = hwif->INB(dma_base + 2);
205                                 if (simplex_stat & 0x80) {
206                                         /* simplex device? */
207 /*
208  *      At this point we haven't probed the drives so we can't make the
209  *      appropriate decision. Really we should defer this problem
210  *      until we tune the drive then try to grab DMA ownership if we want
211  *      to be the DMA end. This has to be become dynamic to handle hot
212  *      plug.
213  */
214                                         if (hwif->mate && hwif->mate->dma_base) {
215                                                 printk(KERN_INFO "%s: simplex device: "
216                                                                  "DMA disabled\n",
217                                                                  d->name);
218                                                 dma_base = 0;
219                                         }
220                                 }
221                 }
222         }
223         return dma_base;
224 }
225 #endif /* CONFIG_BLK_DEV_IDEDMA_PCI */
226
227 void ide_setup_pci_noise(struct pci_dev *dev, const struct ide_port_info *d)
228 {
229         printk(KERN_INFO "%s: IDE controller (0x%04x:0x%04x rev 0x%02x) at "
230                          " PCI slot %s\n", d->name, dev->vendor, dev->device,
231                          dev->revision, pci_name(dev));
232 }
233
234 EXPORT_SYMBOL_GPL(ide_setup_pci_noise);
235
236
237 /**
238  *      ide_pci_enable  -       do PCI enables
239  *      @dev: PCI device
240  *      @d: IDE port info
241  *
242  *      Enable the IDE PCI device. We attempt to enable the device in full
243  *      but if that fails then we only need BAR4 so we will enable that.
244  *      
245  *      Returns zero on success or an error code
246  */
247
248 static int ide_pci_enable(struct pci_dev *dev, const struct ide_port_info *d)
249 {
250         int ret;
251
252         if (pci_enable_device(dev)) {
253                 ret = pci_enable_device_bars(dev, 1 << 4);
254                 if (ret < 0) {
255                         printk(KERN_WARNING "%s: (ide_setup_pci_device:) "
256                                 "Could not enable device.\n", d->name);
257                         goto out;
258                 }
259                 printk(KERN_WARNING "%s: BIOS configuration fixed.\n", d->name);
260         }
261
262         /*
263          * assume all devices can do 32-bit DMA for now, we can add
264          * a DMA mask field to the struct ide_port_info if we need it
265          * (or let lower level driver set the DMA mask)
266          */
267         ret = pci_set_dma_mask(dev, DMA_32BIT_MASK);
268         if (ret < 0) {
269                 printk(KERN_ERR "%s: can't set dma mask\n", d->name);
270                 goto out;
271         }
272
273         /* FIXME: Temporary - until we put in the hotplug interface logic
274            Check that the bits we want are not in use by someone else. */
275         ret = pci_request_region(dev, 4, "ide_tmp");
276         if (ret < 0)
277                 goto out;
278
279         pci_release_region(dev, 4);
280 out:
281         return ret;
282 }
283
284 /**
285  *      ide_pci_configure       -       configure an unconfigured device
286  *      @dev: PCI device
287  *      @d: IDE port info
288  *
289  *      Enable and configure the PCI device we have been passed.
290  *      Returns zero on success or an error code.
291  */
292
293 static int ide_pci_configure(struct pci_dev *dev, const struct ide_port_info *d)
294 {
295         u16 pcicmd = 0;
296         /*
297          * PnP BIOS was *supposed* to have setup this device, but we
298          * can do it ourselves, so long as the BIOS has assigned an IRQ
299          * (or possibly the device is using a "legacy header" for IRQs).
300          * Maybe the user deliberately *disabled* the device,
301          * but we'll eventually ignore it again if no drives respond.
302          */
303         if (ide_setup_pci_baseregs(dev, d->name) || pci_write_config_word(dev, PCI_COMMAND, pcicmd|PCI_COMMAND_IO)) 
304         {
305                 printk(KERN_INFO "%s: device disabled (BIOS)\n", d->name);
306                 return -ENODEV;
307         }
308         if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd)) {
309                 printk(KERN_ERR "%s: error accessing PCI regs\n", d->name);
310                 return -EIO;
311         }
312         if (!(pcicmd & PCI_COMMAND_IO)) {
313                 printk(KERN_ERR "%s: unable to enable IDE controller\n", d->name);
314                 return -ENXIO;
315         }
316         return 0;
317 }
318
319 /**
320  *      ide_pci_check_iomem     -       check a register is I/O
321  *      @dev: PCI device
322  *      @d: IDE port info
323  *      @bar: BAR number
324  *
325  *      Checks if a BAR is configured and points to MMIO space. If so
326  *      print an error and return an error code. Otherwise return 0
327  */
328
329 static int ide_pci_check_iomem(struct pci_dev *dev, const struct ide_port_info *d, int bar)
330 {
331         ulong flags = pci_resource_flags(dev, bar);
332         
333         /* Unconfigured ? */
334         if (!flags || pci_resource_len(dev, bar) == 0)
335                 return 0;
336
337         /* I/O space */         
338         if(flags & PCI_BASE_ADDRESS_IO_MASK)
339                 return 0;
340                 
341         /* Bad */
342         printk(KERN_ERR "%s: IO baseregs (BIOS) are reported "
343                         "as MEM, report to "
344                         "<andre@linux-ide.org>.\n", d->name);
345         return -EINVAL;
346 }
347
348 /**
349  *      ide_hwif_configure      -       configure an IDE interface
350  *      @dev: PCI device holding interface
351  *      @d: IDE port info
352  *      @mate: Paired interface if any
353  *
354  *      Perform the initial set up for the hardware interface structure. This
355  *      is done per interface port rather than per PCI device. There may be
356  *      more than one port per device.
357  *
358  *      Returns the new hardware interface structure, or NULL on a failure
359  */
360
361 static ide_hwif_t *ide_hwif_configure(struct pci_dev *dev, const struct ide_port_info *d, ide_hwif_t *mate, int port, int irq)
362 {
363         unsigned long ctl = 0, base = 0;
364         ide_hwif_t *hwif;
365         u8 bootable = (d->host_flags & IDE_HFLAG_BOOTABLE) ? 1 : 0;
366
367         if ((d->host_flags & IDE_HFLAG_ISA_PORTS) == 0) {
368                 /*  Possibly we should fail if these checks report true */
369                 ide_pci_check_iomem(dev, d, 2*port);
370                 ide_pci_check_iomem(dev, d, 2*port+1);
371  
372                 ctl  = pci_resource_start(dev, 2*port+1);
373                 base = pci_resource_start(dev, 2*port);
374                 if ((ctl && !base) || (base && !ctl)) {
375                         printk(KERN_ERR "%s: inconsistent baseregs (BIOS) "
376                                 "for port %d, skipping\n", d->name, port);
377                         return NULL;
378                 }
379         }
380         if (!ctl)
381         {
382                 /* Use default values */
383                 ctl = port ? 0x374 : 0x3f4;
384                 base = port ? 0x170 : 0x1f0;
385         }
386         if ((hwif = ide_match_hwif(base, bootable, d->name)) == NULL)
387                 return NULL;    /* no room in ide_hwifs[] */
388         if (hwif->io_ports[IDE_DATA_OFFSET] != base ||
389             hwif->io_ports[IDE_CONTROL_OFFSET] != (ctl | 2)) {
390                 hw_regs_t hw;
391
392                 memset(&hw, 0, sizeof(hw));
393                 ide_std_init_ports(&hw, base, ctl | 2);
394                 memcpy(hwif->io_ports, hw.io_ports, sizeof(hwif->io_ports));
395                 hwif->noprobe = 0;
396         }
397         hwif->chipset = d->chipset ? d->chipset : ide_pci;
398         hwif->pci_dev = dev;
399         hwif->cds = d;
400         hwif->channel = port;
401
402         if (!hwif->irq)
403                 hwif->irq = irq;
404         if (mate) {
405                 hwif->mate = mate;
406                 mate->mate = hwif;
407         }
408         return hwif;
409 }
410
411 /**
412  *      ide_hwif_setup_dma      -       configure DMA interface
413  *      @dev: PCI device
414  *      @d: IDE port info
415  *      @hwif: IDE interface
416  *
417  *      Set up the DMA base for the interface. Enable the master bits as
418  *      necessary and attempt to bring the device DMA into a ready to use
419  *      state
420  */
421
422 static void ide_hwif_setup_dma(struct pci_dev *dev, const struct ide_port_info *d, ide_hwif_t *hwif)
423 {
424 #ifdef CONFIG_BLK_DEV_IDEDMA_PCI
425         u16 pcicmd;
426
427         pci_read_config_word(dev, PCI_COMMAND, &pcicmd);
428
429         if ((d->host_flags & IDE_HFLAG_NO_AUTODMA) == 0 ||
430             ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE &&
431              (dev->class & 0x80))) {
432                 unsigned long dma_base = ide_get_or_set_dma_base(d, hwif);
433                 if (dma_base && !(pcicmd & PCI_COMMAND_MASTER)) {
434                         /*
435                          * Set up BM-DMA capability
436                          * (PnP BIOS should have done this)
437                          */
438                         pci_set_master(dev);
439                         if (pci_read_config_word(dev, PCI_COMMAND, &pcicmd) || !(pcicmd & PCI_COMMAND_MASTER)) {
440                                 printk(KERN_ERR "%s: %s error updating PCICMD\n",
441                                         hwif->name, d->name);
442                                 dma_base = 0;
443                         }
444                 }
445                 if (dma_base) {
446                         if (d->init_dma) {
447                                 d->init_dma(hwif, dma_base);
448                         } else {
449                                 ide_setup_dma(hwif, dma_base, 8);
450                         }
451                 } else {
452                         printk(KERN_INFO "%s: %s Bus-Master DMA disabled "
453                                 "(BIOS)\n", hwif->name, d->name);
454                 }
455         }
456 #endif /* CONFIG_BLK_DEV_IDEDMA_PCI*/
457 }
458
459 /**
460  *      ide_setup_pci_controller        -       set up IDE PCI
461  *      @dev: PCI device
462  *      @d: IDE port info
463  *      @noisy: verbose flag
464  *      @config: returned as 1 if we configured the hardware
465  *
466  *      Set up the PCI and controller side of the IDE interface. This brings
467  *      up the PCI side of the device, checks that the device is enabled
468  *      and enables it if need be
469  */
470
471 static int ide_setup_pci_controller(struct pci_dev *dev, const struct ide_port_info *d, int noisy, int *config)
472 {
473         int ret;
474         u16 pcicmd;
475
476         if (noisy)
477                 ide_setup_pci_noise(dev, d);
478
479         ret = ide_pci_enable(dev, d);
480         if (ret < 0)
481                 goto out;
482
483         ret = pci_read_config_word(dev, PCI_COMMAND, &pcicmd);
484         if (ret < 0) {
485                 printk(KERN_ERR "%s: error accessing PCI regs\n", d->name);
486                 goto out;
487         }
488         if (!(pcicmd & PCI_COMMAND_IO)) {       /* is device disabled? */
489                 ret = ide_pci_configure(dev, d);
490                 if (ret < 0)
491                         goto out;
492                 *config = 1;
493                 printk(KERN_INFO "%s: device enabled (Linux)\n", d->name);
494         }
495
496 out:
497         return ret;
498 }
499
500 /**
501  *      ide_pci_setup_ports     -       configure ports/devices on PCI IDE
502  *      @dev: PCI device
503  *      @d: IDE port info
504  *      @pciirq: IRQ line
505  *      @idx: ATA index table to update
506  *
507  *      Scan the interfaces attached to this device and do any
508  *      necessary per port setup. Attach the devices and ask the
509  *      generic DMA layer to do its work for us.
510  *
511  *      Normally called automaticall from do_ide_pci_setup_device,
512  *      but is also used directly as a helper function by some controllers
513  *      where the chipset setup is not the default PCI IDE one.
514  */
515
516 void ide_pci_setup_ports(struct pci_dev *dev, const struct ide_port_info *d, int pciirq, u8 *idx)
517 {
518         int channels = (d->host_flags & IDE_HFLAG_SINGLE) ? 1 : 2, port;
519         ide_hwif_t *hwif, *mate = NULL;
520         u8 tmp;
521
522         /*
523          * Set up the IDE ports
524          */
525
526         for (port = 0; port < channels; ++port) {
527                 const ide_pci_enablebit_t *e = &(d->enablebits[port]);
528
529                 if (e->reg && (pci_read_config_byte(dev, e->reg, &tmp) ||
530                     (tmp & e->mask) != e->val)) {
531                         printk(KERN_INFO "%s: IDE port disabled\n", d->name);
532                         continue;       /* port not enabled */
533                 }
534
535                 if ((hwif = ide_hwif_configure(dev, d, mate, port, pciirq)) == NULL)
536                         continue;
537
538                 /* setup proper ancestral information */
539                 hwif->gendev.parent = &dev->dev;
540
541                 *(idx + port) = hwif->index;
542
543                 
544                 if (d->init_iops)
545                         d->init_iops(hwif);
546
547                 if ((d->host_flags & IDE_HFLAG_NO_DMA) == 0)
548                         ide_hwif_setup_dma(dev, d, hwif);
549
550                 if ((!hwif->irq && (d->host_flags & IDE_HFLAG_LEGACY_IRQS)) ||
551                     (d->host_flags & IDE_HFLAG_FORCE_LEGACY_IRQS))
552                         hwif->irq = port ? 15 : 14;
553
554                 hwif->host_flags = d->host_flags;
555                 hwif->pio_mask = d->pio_mask;
556
557                 if ((d->host_flags & IDE_HFLAG_SERIALIZE) && hwif->mate)
558                         hwif->mate->serialized = hwif->serialized = 1;
559
560                 if (d->host_flags & IDE_HFLAG_IO_32BIT) {
561                         hwif->drives[0].io_32bit = 1;
562                         hwif->drives[1].io_32bit = 1;
563                 }
564
565                 if (d->host_flags & IDE_HFLAG_UNMASK_IRQS) {
566                         hwif->drives[0].unmask = 1;
567                         hwif->drives[1].unmask = 1;
568                 }
569
570                 if (hwif->dma_base) {
571                         hwif->swdma_mask = d->swdma_mask;
572                         hwif->mwdma_mask = d->mwdma_mask;
573                         hwif->ultra_mask = d->udma_mask;
574                 }
575
576                 hwif->drives[0].autotune = 1;
577                 hwif->drives[1].autotune = 1;
578
579                 if (d->host_flags & IDE_HFLAG_RQSIZE_256)
580                         hwif->rqsize = 256;
581
582                 if (d->init_hwif)
583                         /* Call chipset-specific routine
584                          * for each enabled hwif
585                          */
586                         d->init_hwif(hwif);
587
588                 mate = hwif;
589         }
590 }
591
592 EXPORT_SYMBOL_GPL(ide_pci_setup_ports);
593
594 /*
595  * ide_setup_pci_device() looks at the primary/secondary interfaces
596  * on a PCI IDE device and, if they are enabled, prepares the IDE driver
597  * for use with them.  This generic code works for most PCI chipsets.
598  *
599  * One thing that is not standardized is the location of the
600  * primary/secondary interface "enable/disable" bits.  For chipsets that
601  * we "know" about, this information is in the struct ide_port_info;
602  * for all other chipsets, we just assume both interfaces are enabled.
603  */
604 static int do_ide_setup_pci_device(struct pci_dev *dev,
605                                    const struct ide_port_info *d,
606                                    u8 *idx, u8 noisy)
607 {
608         int tried_config = 0;
609         int pciirq, ret;
610
611         ret = ide_setup_pci_controller(dev, d, noisy, &tried_config);
612         if (ret < 0)
613                 goto out;
614
615         /*
616          * Can we trust the reported IRQ?
617          */
618         pciirq = dev->irq;
619
620         /* Is it an "IDE storage" device in non-PCI mode? */
621         if ((dev->class >> 8) == PCI_CLASS_STORAGE_IDE && (dev->class & 5) != 5) {
622                 if (noisy)
623                         printk(KERN_INFO "%s: not 100%% native mode: "
624                                 "will probe irqs later\n", d->name);
625                 /*
626                  * This allows offboard ide-pci cards the enable a BIOS,
627                  * verify interrupt settings of split-mirror pci-config
628                  * space, place chipset into init-mode, and/or preserve
629                  * an interrupt if the card is not native ide support.
630                  */
631                 ret = d->init_chipset ? d->init_chipset(dev, d->name) : 0;
632                 if (ret < 0)
633                         goto out;
634                 pciirq = ret;
635         } else if (tried_config) {
636                 if (noisy)
637                         printk(KERN_INFO "%s: will probe irqs later\n", d->name);
638                 pciirq = 0;
639         } else if (!pciirq) {
640                 if (noisy)
641                         printk(KERN_WARNING "%s: bad irq (%d): will probe later\n",
642                                 d->name, pciirq);
643                 pciirq = 0;
644         } else {
645                 if (d->init_chipset) {
646                         ret = d->init_chipset(dev, d->name);
647                         if (ret < 0)
648                                 goto out;
649                 }
650                 if (noisy)
651                         printk(KERN_INFO "%s: 100%% native mode on irq %d\n",
652                                 d->name, pciirq);
653         }
654
655         /* FIXME: silent failure can happen */
656
657         ide_pci_setup_ports(dev, d, pciirq, idx);
658 out:
659         return ret;
660 }
661
662 int ide_setup_pci_device(struct pci_dev *dev, const struct ide_port_info *d)
663 {
664         u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
665         int ret;
666
667         ret = do_ide_setup_pci_device(dev, d, &idx[0], 1);
668
669         if (ret >= 0)
670                 ide_device_add(idx);
671
672         return ret;
673 }
674
675 EXPORT_SYMBOL_GPL(ide_setup_pci_device);
676
677 int ide_setup_pci_devices(struct pci_dev *dev1, struct pci_dev *dev2,
678                           const struct ide_port_info *d)
679 {
680         struct pci_dev *pdev[] = { dev1, dev2 };
681         int ret, i;
682         u8 idx[4] = { 0xff, 0xff, 0xff, 0xff };
683
684         for (i = 0; i < 2; i++) {
685                 ret = do_ide_setup_pci_device(pdev[i], d, &idx[i*2], !i);
686                 /*
687                  * FIXME: Mom, mom, they stole me the helper function to undo
688                  * do_ide_setup_pci_device() on the first device!
689                  */
690                 if (ret < 0)
691                         goto out;
692         }
693
694         ide_device_add(idx);
695 out:
696         return ret;
697 }
698
699 EXPORT_SYMBOL_GPL(ide_setup_pci_devices);
700
701 #ifdef CONFIG_IDEPCI_PCIBUS_ORDER
702 /*
703  *      Module interfaces
704  */
705
706 static int pre_init = 1;                /* Before first ordered IDE scan */
707 static LIST_HEAD(ide_pci_drivers);
708
709 /*
710  *      __ide_pci_register_driver       -       attach IDE driver
711  *      @driver: pci driver
712  *      @module: owner module of the driver
713  *
714  *      Registers a driver with the IDE layer. The IDE layer arranges that
715  *      boot time setup is done in the expected device order and then
716  *      hands the controllers off to the core PCI code to do the rest of
717  *      the work.
718  *
719  *      Returns are the same as for pci_register_driver
720  */
721
722 int __ide_pci_register_driver(struct pci_driver *driver, struct module *module,
723                               const char *mod_name)
724 {
725         if (!pre_init)
726                 return __pci_register_driver(driver, module, mod_name);
727         driver->driver.owner = module;
728         list_add_tail(&driver->node, &ide_pci_drivers);
729         return 0;
730 }
731 EXPORT_SYMBOL_GPL(__ide_pci_register_driver);
732
733 /**
734  *      ide_scan_pcidev         -       find an IDE driver for a device
735  *      @dev: PCI device to check
736  *
737  *      Look for an IDE driver to handle the device we are considering.
738  *      This is only used during boot up to get the ordering correct. After
739  *      boot up the pci layer takes over the job.
740  */
741
742 static int __init ide_scan_pcidev(struct pci_dev *dev)
743 {
744         struct list_head *l;
745         struct pci_driver *d;
746
747         list_for_each(l, &ide_pci_drivers) {
748                 d = list_entry(l, struct pci_driver, node);
749                 if (d->id_table) {
750                         const struct pci_device_id *id =
751                                 pci_match_id(d->id_table, dev);
752
753                         if (id != NULL && d->probe(dev, id) >= 0) {
754                                 dev->driver = d;
755                                 pci_dev_get(dev);
756                                 return 1;
757                         }
758                 }
759         }
760         return 0;
761 }
762
763 /**
764  *      ide_scan_pcibus         -       perform the initial IDE driver scan
765  *
766  *      Perform the initial bus rather than driver ordered scan of the
767  *      PCI drivers. After this all IDE pci handling becomes standard
768  *      module ordering not traditionally ordered.
769  */
770
771 int __init ide_scan_pcibus(void)
772 {
773         struct pci_dev *dev = NULL;
774         struct pci_driver *d;
775         struct list_head *l, *n;
776
777         pre_init = 0;
778         if (!ide_scan_direction)
779                 while ((dev = pci_get_device(PCI_ANY_ID, PCI_ANY_ID, dev)))
780                         ide_scan_pcidev(dev);
781         else
782                 while ((dev = pci_get_device_reverse(PCI_ANY_ID, PCI_ANY_ID,
783                                                      dev)))
784                         ide_scan_pcidev(dev);
785
786         /*
787          *      Hand the drivers over to the PCI layer now we
788          *      are post init.
789          */
790
791         list_for_each_safe(l, n, &ide_pci_drivers) {
792                 list_del(l);
793                 d = list_entry(l, struct pci_driver, node);
794                 if (__pci_register_driver(d, d->driver.owner,
795                                           d->driver.mod_name))
796                         printk(KERN_ERR "%s: failed to register %s driver\n",
797                                         __FUNCTION__, d->driver.mod_name);
798         }
799
800         return 0;
801 }
802 #endif