[adm5120] disable VLANs for RB1xx boards (#2132)

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

diff --git a/target/linux/adm5120-2.6/files/arch/mips/pci/ops-adm5120.c b/target/linux/adm5120-2.6/files/arch/mips/pci/ops-adm5120.c
index f7e4e66..0bd0baa 100644 (file)
--- a/target/linux/adm5120-2.6/files/arch/mips/pci/ops-adm5120.c
+++ b/target/linux/adm5120-2.6/files/arch/mips/pci/ops-adm5120.c
@@ -28,6 +28,7 @@
 #include <linux/types.h>
 #include <linux/kernel.h>
 #include <linux/pci.h>
 #include <linux/types.h>
 #include <linux/kernel.h>
 #include <linux/pci.h>

+#include <linux/spinlock.h>

 
 #include <asm/mach-adm5120/adm5120_defs.h>
 
 
 #include <asm/mach-adm5120/adm5120_defs.h>
 


@@ -40,6 +41,8 @@
 
 #define PCI_ENABLE 0x80000000
 
 
 #define PCI_ENABLE 0x80000000
 

+static spinlock_t pci_lock = SPIN_LOCK_UNLOCKED;
+

 static inline void write_cfgaddr(u32 addr)
 {
        *(volatile u32*)KSEG1ADDR(ADM5120_PCICFG_ADDR) = (addr | PCI_ENABLE);
 static inline void write_cfgaddr(u32 addr)
 {
        *(volatile u32*)KSEG1ADDR(ADM5120_PCICFG_ADDR) = (addr | PCI_ENABLE);


@@ -65,8 +68,10 @@ static inline u32 mkaddr(struct pci_bus *bus, unsigned int devfn, int where)
 static int pci_config_read(struct pci_bus *bus, unsigned int devfn, int where,
                            int size, u32 *val)
 {
 static int pci_config_read(struct pci_bus *bus, unsigned int devfn, int where,
                            int size, u32 *val)
 {

+       unsigned long flags;

        u32 data;
 
        u32 data;
 

+       spin_lock_irqsave(&pci_lock, flags);

        write_cfgaddr(mkaddr(bus,devfn,where));
        data = read_cfgdata();  
 
        write_cfgaddr(mkaddr(bus,devfn,where));
        data = read_cfgdata();  
 


@@ -90,6 +95,7 @@ static int pci_config_read(struct pci_bus *bus, unsigned int devfn, int where,
 
        *val = data;
        DBG(", 0x%08X returned\n", data);
 
        *val = data;
        DBG(", 0x%08X returned\n", data);

+       spin_unlock_irqrestore(&pci_lock, flags);

        
        return PCIBIOS_SUCCESSFUL;
 }
        
        return PCIBIOS_SUCCESSFUL;
 }


@@ -97,9 +103,11 @@ static int pci_config_read(struct pci_bus *bus, unsigned int devfn, int where,
 static int pci_config_write(struct pci_bus *bus, unsigned int devfn, int where,
                             int size, u32 val)
 {
 static int pci_config_write(struct pci_bus *bus, unsigned int devfn, int where,
                             int size, u32 val)
 {

+       unsigned long flags;

        u32 data;
        int s;
 
        u32 data;
        int s;
 

+       spin_lock_irqsave(&pci_lock, flags);

        write_cfgaddr(mkaddr(bus,devfn,where));
        data = read_cfgdata();
 
        write_cfgaddr(mkaddr(bus,devfn,where));
        data = read_cfgdata();
 


@@ -124,6 +132,7 @@ static int pci_config_write(struct pci_bus *bus, unsigned int devfn, int where,
 
        write_cfgdata(data);
        DBG(", 0x%08X written\n", data);
 
        write_cfgdata(data);
        DBG(", 0x%08X written\n", data);

+       spin_unlock_irqrestore(&pci_lock, flags);

 
        return PCIBIOS_SUCCESSFUL;
 }
 
        return PCIBIOS_SUCCESSFUL;
 }