enable start-stop-daemon by default, i want to use this to clean up a few init script...

[openwrt/staging/florian.git] / target / linux / adm5120-2.6 / files / arch / mips / pci / fixup-adm5120.c

diff --git a/target/linux/adm5120-2.6/files/arch/mips/pci/fixup-adm5120.c b/target/linux/adm5120-2.6/files/arch/mips/pci/fixup-adm5120.c
index 07119ef3adae0cc877ec7d2ab684578e1e191b03..59acf75c18c4a7a877a0da2ec9917001ddf35d73 100644 (file)
--- a/target/linux/adm5120-2.6/files/arch/mips/pci/fixup-adm5120.c
+++ b/target/linux/adm5120-2.6/files/arch/mips/pci/fixup-adm5120.c
@@ -5,7 +5,7 @@
  *
  *  Copyright (C) ADMtek Incorporated.
  *  Copyright (C) 2005 Jeroen Vreeken (pe1rxq@amsat.org)
- *  Copyright (C) 2007 Gabor Juhos <juhosg@freemail.hu>
+ *  Copyright (C) 2007 Gabor Juhos <juhosg at openwrt.org>
  *  Copyright (C) 2007 OpenWrt.org
  *
  *  This program is free software; you can redistribute it and/or
@@ -25,7 +25,6 @@
  *
  */
 
-#include <linux/autoconf.h>
 #include <linux/types.h>
 #include <linux/kernel.h>
 #include <linux/init.h>
@@ -40,32 +39,63 @@
 #include <asm/mach-adm5120/adm5120_defs.h>
 #include <asm/mach-adm5120/adm5120_irq.h>
 
-static void adm5120_pci_fixup(struct pci_dev *dev)
-{
-       if (dev->devfn !=0)
-               return;
+struct adm5120_pci_irq {
+       u8      slot;
+       u8      func;
+       u8      pin;
+       unsigned irq;
+};
 
-       /* setup COMMAND register */
-       pci_write_config_word(dev, PCI_COMMAND, 
-               (PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER));
+#define PCIIRQ(s,f,p,i) {      \
+       .slot = (s),            \
+       .func = (f),            \
+       .pin  = (p),            \
+       .irq  = (i)             \
+       }
 
-       /* setup CACHE_LINE_SIZE register */
-       pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, 4);
+static struct adm5120_pci_irq default_pci_irqs[] __initdata = {
+       PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
+};
 
-       /* setting up BARS */
-       pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, 0);
-       pci_write_config_dword(dev, PCI_BASE_ADDRESS_1, 0);
-}
+static struct adm5120_pci_irq rb1xx_pci_irqs[] __initdata = {
+       PCIIRQ(1, 0, 1, ADM5120_IRQ_PCI0),
+       PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI1),
+       PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI2)
+};
 
-DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_ADMTEK, PCI_DEVICE_ID_ADMTEK_ADM5120, 
-       adm5120_pci_fixup);
+static struct adm5120_pci_irq cas771_pci_irqs[] __initdata = {
+       PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
+       PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI1),
+       PCIIRQ(3, 2, 3, ADM5120_IRQ_PCI2)
+};
+
+static struct adm5120_pci_irq np28g_pci_irqs[] __initdata = {
+       PCIIRQ(2, 0, 1, ADM5120_IRQ_PCI0),
+       PCIIRQ(3, 0, 1, ADM5120_IRQ_PCI0),
+       PCIIRQ(3, 1, 2, ADM5120_IRQ_PCI1),
+       PCIIRQ(3, 2, 3, ADM5120_IRQ_PCI2)
+};
 
+#define GETMAP(n) do {                                 \
+               nr_irqs = ARRAY_SIZE(n ## _pci_irqs);   \
+               p = n ## _pci_irqs;                     \
+       } while (0)
 
 int __init pcibios_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
 {
+       struct adm5120_pci_irq  *p;
+       int nr_irqs;
+       int i;
        int irq;
-       
+
        irq = -1;
+       if (slot < 1 || slot > 3) {
+               printk(KERN_ALERT "PCI: slot number %u is not supported\n",
+                       slot);
+               goto out;
+       }
+
+       GETMAP(default);
 
        switch (mips_machtype) {
        case MACH_ADM5120_RB_111:
@@ -73,21 +103,71 @@ int __init pcibios_map_irq(struct pci_dev *dev, u8 slot, u8 pin)
        case MACH_ADM5120_RB_133:
        case MACH_ADM5120_RB_133C:
        case MACH_ADM5120_RB_153:
-               if (slot > 0 && slot < 4)
-                       irq = slot + 5;
+               GETMAP(rb1xx);
                break;
+       case MACH_ADM5120_NP28G:
+               GETMAP(np28g);
+               break;
+       case MACH_ADM5120_P335:
+       case MACH_ADM5120_P334WT:
+               /* using default mapping */
+               break;
+       case MACH_ADM5120_CAS771:
+               GETMAP(cas771);
+               break;
+
+       case MACH_ADM5120_NP27G:
+       case MACH_ADM5120_NP28GHS:
+       case MACH_ADM5120_WP54AG:
+       case MACH_ADM5120_WP54G:
+       case MACH_ADM5120_WP54G_WRT:
+       case MACH_ADM5120_WPP54AG:
+       case MACH_ADM5120_WPP54G:
        default:
-               if (slot > 1 && slot < 5)
-                       irq = ADM5120_IRQ_PCI0+slot-1;
+               printk(KERN_ALERT "PCI: irq map is unknown, using defaults.\n");
                break;
        }
-       
-       printk(KERN_INFO "PCI: mapping irq for device %s, slot:%u, pin:%u, "
-               "irq:%d\n", pci_name(dev), slot, pin, irq);
-               
+
+       for (i=0; i<nr_irqs; i++, p++) {
+               if ((p->slot == slot) && (PCI_FUNC(dev->devfn) == p->func) &&
+                   (p->pin == pin)) {
+                       irq = p->irq;
+                       break;
+               }
+       }
+
+       if (irq < 0) {
+               printk(KERN_ALERT "PCI: no irq found for %s pin:%u\n",
+                       pci_name(dev), pin);
+       } else {
+               printk(KERN_INFO "PCI: mapping irq for %s pin:%u, irq:%d\n",
+                       pci_name(dev), pin, irq);
+       }
+
+out:
        return irq;
 }
 
+static void adm5120_pci_fixup(struct pci_dev *dev)
+{
+       if (dev->devfn != 0)
+               return;
+
+       /* setup COMMAND register */
+       pci_write_config_word(dev, PCI_COMMAND,
+               (PCI_COMMAND_IO | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER));
+
+       /* setup CACHE_LINE_SIZE register */
+       pci_write_config_byte(dev, PCI_CACHE_LINE_SIZE, 4);
+
+       /* setting up BARS */
+       pci_write_config_dword(dev, PCI_BASE_ADDRESS_0, 0);
+       pci_write_config_dword(dev, PCI_BASE_ADDRESS_1, 0);
+}
+
+DECLARE_PCI_FIXUP_HEADER(PCI_VENDOR_ID_ADMTEK, PCI_DEVICE_ID_ADMTEK_ADM5120,
+       adm5120_pci_fixup);
+
 int pcibios_plat_dev_init(struct pci_dev *dev)
 {
        return 0;