Merge branch 'reloc'

[u-boot] / board / mpl / common / pci.c

diff --git a/board/mpl/common/pci.c b/board/mpl/common/pci.c
index d1965f95f640090934c4166a32fa16da5534e7d4..f9bb6ab2bc63238b7989e026b1a08139d80abae4 100644 (file)
--- a/board/mpl/common/pci.c
+++ b/board/mpl/common/pci.c
@@ -1,4 +1,6 @@
 /*-----------------------------------------------------------------------------+
+|       This source code is dual-licensed.  You may use it under the terms of
+|       the GNU General Public License version 2, or under the license below.
 |
 |       This source code has been made available to you by IBM on an AS-IS
 |       basis.  Anyone receiving this source is licensed under IBM
@@ -32,7 +34,7 @@
 #ifdef CONFIG_405GP
 #ifdef CONFIG_PCI
 
-#undef DEBUG
+DECLARE_GLOBAL_DATA_PTR;
 
 #include "piix4_pci.h"
 #include "pci_parts.h"
@@ -65,21 +67,22 @@ void pci_pip405_write_regs(struct pci_controller *hose, pci_dev_t dev,
 static void pci_pip405_fixup_irq(struct pci_controller *hose, pci_dev_t dev)
 {
        unsigned char int_line = 0xff;
+       unsigned char pin;
        /*
         * Write pci interrupt line register
         */
        if(PCI_DEV(dev)==0) /* Device0 = PPC405 -> skip */
                return;
-       if(PCI_FUNC(dev)==0)
-       {
-               /* assuming all function 0 are using their INTA# Pin*/
-               int_line=PCI_IRQ_VECTOR(dev);
-               pci_hose_write_config_byte(hose, dev, PCI_INTERRUPT_LINE, int_line);
+       pci_hose_read_config_byte(hose, dev, PCI_INTERRUPT_PIN, &pin);
+       if ((pin == 0) || (pin > 4))
+           return;
+
+       int_line = ((PCI_DEV(dev) + (pin-1) + 10) % 4) + 28;
+       pci_hose_write_config_byte(hose, dev, PCI_INTERRUPT_LINE, int_line);
 #ifdef DEBUG
-               printf("Fixup IRQ: dev %d (%x) int line %d 0x%x\n",
-                      PCI_DEV(dev),dev,int_line,int_line);
+       printf("Fixup IRQ: dev %d (%x) int line %d 0x%x\n",
+              PCI_DEV(dev),dev,int_line,int_line);
 #endif
-       }
 }
 
 extern void pci_405gp_init(struct pci_controller *hose);
@@ -90,11 +93,15 @@ static struct pci_controller hose = {
   fixup_irq: pci_pip405_fixup_irq,
 };
 
-void pci_init(void)
+
+void pci_init_board(void)
 {
        /*we want the ptrs to RAM not flash (ie don't use init list)*/
        hose.fixup_irq    = pci_pip405_fixup_irq;
        hose.config_table = pci_pip405_config_table;
+#ifdef DEBUG
+       printf("Init PCI: fixup_irq=%p config_table=%p hose=%p\n",pci_pip405_fixup_irq,pci_pip405_config_table,hose);
+#endif
        pci_405gp_init(&hose);
 }