8 files changed, 236 insertions, 34 deletions

diff --git a/arch/powerpc/sysdev/cpm2.c b/arch/powerpc/sysdev/cpm2.c
index f1c3395633b9..fd969f0e3121 100644
--- a/arch/powerpc/sysdev/cpm2.c
+++ b/arch/powerpc/sysdev/cpm2.c
@@ -52,6 +52,7 @@ cpm_cpm2_t __iomem *cpmp; /* Pointer to comm processor space */
  * the communication processor devices.
  */
 cpm2_map_t __iomem *cpm2_immr;
+EXPORT_SYMBOL(cpm2_immr);
 
 #define CPM_MAP_SIZE    (0x40000)       /* 256k - the PQ3 reserve this amount
                                            of space for CPM as it is larger
@@ -129,7 +130,8 @@ void __cpm2_setbrg(uint brg, uint rate, uint clk, int div16, int src)
                 brg -= 4;
         }
         bp += brg;
-        val = (((clk / rate) - 1) << 1) | CPM_BRG_EN | src;
+        /* Round the clock divider to the nearest integer. */
+        val = (((clk * 2 / rate) - 1) & ~1) | CPM_BRG_EN | src;
         if (div16)
                 val |= CPM_BRG_DIV16;
 
diff --git a/arch/powerpc/sysdev/cpm_common.c b/arch/powerpc/sysdev/cpm_common.c
index 00d3d17c84a3..e4b6d66d93de 100644
--- a/arch/powerpc/sysdev/cpm_common.c
+++ b/arch/powerpc/sysdev/cpm_common.c
@@ -56,7 +56,7 @@ void __init udbg_init_cpm(void)
 {
         if (cpm_udbg_txdesc) {
 #ifdef CONFIG_CPM2
-                setbat(1, 0xf0000000, 0xf0000000, 1024*1024, _PAGE_IO);
+                setbat(1, 0xf0000000, 0xf0000000, 1024*1024, PAGE_KERNEL_NCG);
 #endif
                 udbg_putc = udbg_putc_cpm;
         }
diff --git a/arch/powerpc/sysdev/fsl_pci.c b/arch/powerpc/sysdev/fsl_pci.c
index 9817f63723dd..78021d8afc53 100644
--- a/arch/powerpc/sysdev/fsl_pci.c
+++ b/arch/powerpc/sysdev/fsl_pci.c
@@ -1,12 +1,16 @@
 /*
  * MPC83xx/85xx/86xx PCI/PCIE support routing.
  *
- * Copyright 2007,2008 Freescale Semiconductor, Inc
+ * Copyright 2007-2009 Freescale Semiconductor, Inc.
+ * Copyright 2008-2009 MontaVista Software, Inc.
  *
  * Initial author: Xianghua Xiao <x.xiao@freescale.com>
  * Recode: ZHANG WEI <wei.zhang@freescale.com>
  * Rewrite the routing for Frescale PCI and PCI Express
  *      Roy Zang <tie-fei.zang@freescale.com>
+ * MPC83xx PCI-Express support:
+ *      Tony Li <tony.li@freescale.com>
+ *      Anton Vorontsov <avorontsov@ru.mvista.com>
  *
  * This program is free software; you can redistribute  it and/or modify it
  * under  the terms of  the GNU General  Public License as published by the
@@ -27,6 +31,29 @@
 #include <sysdev/fsl_soc.h>
 #include <sysdev/fsl_pci.h>
 
+static int fsl_pcie_bus_fixup;
+
+static void __init quirk_fsl_pcie_header(struct pci_dev *dev)
+{
+        /* if we aren't a PCIe don't bother */
+        if (!pci_find_capability(dev, PCI_CAP_ID_EXP))
+                return;
+
+        dev->class = PCI_CLASS_BRIDGE_PCI << 8;
+        fsl_pcie_bus_fixup = 1;
+        return;
+}
+
+static int __init fsl_pcie_check_link(struct pci_controller *hose)
+{
+        u32 val;
+
+        early_read_config_dword(hose, 0, 0, PCIE_LTSSM, &val);
+        if (val < PCIE_LTSSM_L0)
+                return 1;
+        return 0;
+}
+
 #if defined(CONFIG_PPC_85xx) || defined(CONFIG_PPC_86xx)
 static int __init setup_one_atmu(struct ccsr_pci __iomem *pci,
         unsigned int index, const struct resource *res,
@@ -159,28 +186,6 @@ static void __init setup_pci_pcsrbar(struct pci_controller *hose)
 #endif
 }
 
-static int fsl_pcie_bus_fixup;
-
-static void __init quirk_fsl_pcie_header(struct pci_dev *dev)
-{
-        /* if we aren't a PCIe don't bother */
-        if (!pci_find_capability(dev, PCI_CAP_ID_EXP))
-                return ;
-
-        dev->class = PCI_CLASS_BRIDGE_PCI << 8;
-        fsl_pcie_bus_fixup = 1;
-        return ;
-}
-
-static int __init fsl_pcie_check_link(struct pci_controller *hose)
-{
-        u32 val;
-        early_read_config_dword(hose, 0, 0, PCIE_LTSSM, &val);
-        if (val < PCIE_LTSSM_L0)
-                return 1;
-        return 0;
-}
-
 void fsl_pcibios_fixup_bus(struct pci_bus *bus)
 {
         struct pci_controller *hose = (struct pci_controller *) bus->sysdata;
@@ -294,8 +299,184 @@ DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8610, quirk_fsl_pcie_header);
 #endif /* CONFIG_PPC_85xx || CONFIG_PPC_86xx */
 
 #if defined(CONFIG_PPC_83xx) || defined(CONFIG_PPC_MPC512x)
+DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8314E, quirk_fsl_pcie_header);
+DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8314, quirk_fsl_pcie_header);
+DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8315E, quirk_fsl_pcie_header);
+DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8315, quirk_fsl_pcie_header);
+DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8377E, quirk_fsl_pcie_header);
+DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8377, quirk_fsl_pcie_header);
+DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8378E, quirk_fsl_pcie_header);
+DECLARE_PCI_FIXUP_HEADER(0x1957, PCI_DEVICE_ID_MPC8378, quirk_fsl_pcie_header);
+
+struct mpc83xx_pcie_priv {
+        void __iomem *cfg_type0;
+        void __iomem *cfg_type1;
+        u32 dev_base;
+};
+
+/*
+ * With the convention of u-boot, the PCIE outbound window 0 serves
+ * as configuration transactions outbound.
+ */
+#define PEX_OUTWIN0_BAR         0xCA4
+#define PEX_OUTWIN0_TAL         0xCA8
+#define PEX_OUTWIN0_TAH         0xCAC
+
+static int mpc83xx_pcie_exclude_device(struct pci_bus *bus, unsigned int devfn)
+{
+        struct pci_controller *hose = bus->sysdata;
+
+        if (hose->indirect_type & PPC_INDIRECT_TYPE_NO_PCIE_LINK)
+                return PCIBIOS_DEVICE_NOT_FOUND;
+        /*
+         * Workaround for the HW bug: for Type 0 configure transactions the
+         * PCI-E controller does not check the device number bits and just
+         * assumes that the device number bits are 0.
+         */
+        if (bus->number == hose->first_busno ||
+                        bus->primary == hose->first_busno) {
+                if (devfn & 0xf8)
+                        return PCIBIOS_DEVICE_NOT_FOUND;
+        }
+
+        if (ppc_md.pci_exclude_device) {
+                if (ppc_md.pci_exclude_device(hose, bus->number, devfn))
+                        return PCIBIOS_DEVICE_NOT_FOUND;
+        }
+
+        return PCIBIOS_SUCCESSFUL;
+}
+
+static void __iomem *mpc83xx_pcie_remap_cfg(struct pci_bus *bus,
+                                            unsigned int devfn, int offset)
+{
+        struct pci_controller *hose = bus->sysdata;
+        struct mpc83xx_pcie_priv *pcie = hose->dn->data;
+        u8 bus_no = bus->number - hose->first_busno;
+        u32 dev_base = bus_no << 24 | devfn << 16;
+        int ret;
+
+        ret = mpc83xx_pcie_exclude_device(bus, devfn);
+        if (ret)
+                return NULL;
+
+        offset &= 0xfff;
+
+        /* Type 0 */
+        if (bus->number == hose->first_busno)
+                return pcie->cfg_type0 + offset;
+
+        if (pcie->dev_base == dev_base)
+                goto mapped;
+
+        out_le32(pcie->cfg_type0 + PEX_OUTWIN0_TAL, dev_base);
+
+        pcie->dev_base = dev_base;
+mapped:
+        return pcie->cfg_type1 + offset;
+}
+
+static int mpc83xx_pcie_read_config(struct pci_bus *bus, unsigned int devfn,
+                                    int offset, int len, u32 *val)
+{
+        void __iomem *cfg_addr;
+
+        cfg_addr = mpc83xx_pcie_remap_cfg(bus, devfn, offset);
+        if (!cfg_addr)
+                return PCIBIOS_DEVICE_NOT_FOUND;
+
+        switch (len) {
+        case 1:
+                *val = in_8(cfg_addr);
+                break;
+        case 2:
+                *val = in_le16(cfg_addr);
+                break;
+        default:
+                *val = in_le32(cfg_addr);
+                break;
+        }
+
+        return PCIBIOS_SUCCESSFUL;
+}
+
+static int mpc83xx_pcie_write_config(struct pci_bus *bus, unsigned int devfn,
+                                     int offset, int len, u32 val)
+{
+        void __iomem *cfg_addr;
+
+        cfg_addr = mpc83xx_pcie_remap_cfg(bus, devfn, offset);
+        if (!cfg_addr)
+                return PCIBIOS_DEVICE_NOT_FOUND;
+
+        switch (len) {
+        case 1:
+                out_8(cfg_addr, val);
+                break;
+        case 2:
+                out_le16(cfg_addr, val);
+                break;
+        default:
+                out_le32(cfg_addr, val);
+                break;
+        }
+
+        return PCIBIOS_SUCCESSFUL;
+}
+
+static struct pci_ops mpc83xx_pcie_ops = {
+        .read = mpc83xx_pcie_read_config,
+        .write = mpc83xx_pcie_write_config,
+};
+
+static int __init mpc83xx_pcie_setup(struct pci_controller *hose,
+                                     struct resource *reg)
+{
+        struct mpc83xx_pcie_priv *pcie;
+        u32 cfg_bar;
+        int ret = -ENOMEM;
+
+        pcie = zalloc_maybe_bootmem(sizeof(*pcie), GFP_KERNEL);
+        if (!pcie)
+                return ret;
+
+        pcie->cfg_type0 = ioremap(reg->start, resource_size(reg));
+        if (!pcie->cfg_type0)
+                goto err0;
+
+        cfg_bar = in_le32(pcie->cfg_type0 + PEX_OUTWIN0_BAR);
+        if (!cfg_bar) {
+                /* PCI-E isn't configured. */
+                ret = -ENODEV;
+                goto err1;
+        }
+
+        pcie->cfg_type1 = ioremap(cfg_bar, 0x1000);
+        if (!pcie->cfg_type1)
+                goto err1;
+
+        WARN_ON(hose->dn->data);
+        hose->dn->data = pcie;
+        hose->ops = &mpc83xx_pcie_ops;
+
+        out_le32(pcie->cfg_type0 + PEX_OUTWIN0_TAH, 0);
+        out_le32(pcie->cfg_type0 + PEX_OUTWIN0_TAL, 0);
+
+        if (fsl_pcie_check_link(hose))
+                hose->indirect_type |= PPC_INDIRECT_TYPE_NO_PCIE_LINK;
+
+        return 0;
+err1:
+        iounmap(pcie->cfg_type0);
+err0:
+        kfree(pcie);
+        return ret;
+
+}
+
 int __init mpc83xx_add_bridge(struct device_node *dev)
 {
+        int ret;
         int len;
         struct pci_controller *hose;
         struct resource rsrc_reg;
@@ -303,6 +484,11 @@ int __init mpc83xx_add_bridge(struct device_node *dev)
         const int *bus_range;
         int primary;
 
+        if (!of_device_is_available(dev)) {
+                pr_warning("%s: disabled by the firmware.\n",
+                           dev->full_name);
+                return -ENODEV;
+        }
         pr_debug("Adding PCI host bridge %s\n", dev->full_name);
 
         /* Fetch host bridge registers address */
@@ -350,7 +536,14 @@ int __init mpc83xx_add_bridge(struct device_node *dev)
         hose->first_busno = bus_range ? bus_range[0] : 0;
         hose->last_busno = bus_range ? bus_range[1] : 0xff;
 
-        setup_indirect_pci(hose, rsrc_cfg.start, rsrc_cfg.start + 4, 0);
+        if (of_device_is_compatible(dev, "fsl,mpc8314-pcie")) {
+                ret = mpc83xx_pcie_setup(hose, &rsrc_reg);
+                if (ret)
+                        goto err0;
+        } else {
+                setup_indirect_pci(hose, rsrc_cfg.start,
+                                   rsrc_cfg.start + 4, 0);
+        }
 
         printk(KERN_INFO "Found FSL PCI host bridge at 0x%016llx. "
                "Firmware bus number: %d->%d\n",
@@ -365,5 +558,8 @@ int __init mpc83xx_add_bridge(struct device_node *dev)
         pci_process_bridge_OF_ranges(hose, dev, primary);
 
         return 0;
+err0:
+        pcibios_free_controller(hose);
+        return ret;
 }
 #endif /* CONFIG_PPC_83xx */
diff --git a/arch/powerpc/sysdev/fsl_soc.c b/arch/powerpc/sysdev/fsl_soc.c
index 115cb16351fd..a01c89d3f9bd 100644
--- a/arch/powerpc/sysdev/fsl_soc.c
+++ b/arch/powerpc/sysdev/fsl_soc.c
@@ -22,6 +22,7 @@
 #include <linux/module.h>
 #include <linux/device.h>
 #include <linux/platform_device.h>
+#include <linux/of.h>
 #include <linux/of_platform.h>
 #include <linux/phy.h>
 #include <linux/phy_fixed.h>
@@ -328,6 +329,9 @@ static int __init fsl_usb_of_init(void)
                 struct fsl_usb2_platform_data usb_data;
                 const unsigned char *prop = NULL;
 
+                if (!of_device_is_available(np))
+                        continue;
+
                 memset(&r, 0, sizeof(r));
                 memset(&usb_data, 0, sizeof(usb_data));
 
diff --git a/arch/powerpc/sysdev/ipic.c b/arch/powerpc/sysdev/ipic.c
index 9a89cd3e80a2..a86d3ce01ead 100644
--- a/arch/powerpc/sysdev/ipic.c
+++ b/arch/powerpc/sysdev/ipic.c
@@ -568,8 +568,7 @@ static void ipic_ack_irq(unsigned int virq)
 
         spin_lock_irqsave(&ipic_lock, flags);
 
-        temp = ipic_read(ipic->regs, ipic_info[src].ack);
-        temp |= (1 << (31 - ipic_info[src].bit));
+        temp = 1 << (31 - ipic_info[src].bit);
         ipic_write(ipic->regs, ipic_info[src].ack, temp);
 
         /* mb() can't guarantee that ack is finished.  But it does finish
@@ -592,8 +591,7 @@ static void ipic_mask_irq_and_ack(unsigned int virq)
         temp &= ~(1 << (31 - ipic_info[src].bit));
         ipic_write(ipic->regs, ipic_info[src].mask, temp);
 
-        temp = ipic_read(ipic->regs, ipic_info[src].ack);
-        temp |= (1 << (31 - ipic_info[src].bit));
+        temp = 1 << (31 - ipic_info[src].bit);
         ipic_write(ipic->regs, ipic_info[src].ack, temp);
 
         /* mb() can't guarantee that ack is finished.  But it does finish
diff --git a/arch/powerpc/sysdev/msi_bitmap.c b/arch/powerpc/sysdev/msi_bitmap.c
index f84217b8863a..5a32cbef9b6c 100644
--- a/arch/powerpc/sysdev/msi_bitmap.c
+++ b/arch/powerpc/sysdev/msi_bitmap.c
@@ -141,7 +141,7 @@ void msi_bitmap_free(struct msi_bitmap *bmp)
 #define check(x)        \
         if (!(x)) printk("msi_bitmap: test failed at line %d\n", __LINE__);
 
-void test_basics(void)
+void __init test_basics(void)
 {
         struct msi_bitmap bmp;
         int i, size = 512;
@@ -186,7 +186,7 @@ void test_basics(void)
         kfree(bmp.bitmap);
 }
 
-void test_of_node(void)
+void __init test_of_node(void)
 {
         u32 prop_data[] = { 10, 10, 25, 3, 40, 1, 100, 100, 200, 20 };
         const char *expected_str = "0-9,20-24,28-39,41-99,220-255";
@@ -234,7 +234,7 @@ void test_of_node(void)
         kfree(bmp.bitmap);
 }
 
-int msi_bitmap_selftest(void)
+int __init msi_bitmap_selftest(void)
 {
         printk(KERN_DEBUG "Running MSI bitmap self-tests ...\n");
 
diff --git a/arch/powerpc/sysdev/pmi.c b/arch/powerpc/sysdev/pmi.c
index c858749263e0..aaa915998eb6 100644
--- a/arch/powerpc/sysdev/pmi.c
+++ b/arch/powerpc/sysdev/pmi.c
@@ -50,7 +50,7 @@ struct pmi_data {
 
 static struct pmi_data *data;
 
-static int pmi_irq_handler(int irq, void *dev_id)
+static irqreturn_t pmi_irq_handler(int irq, void *dev_id)
 {
         u8 type;
         int rc;
diff --git a/arch/powerpc/sysdev/ppc4xx_pci.c b/arch/powerpc/sysdev/ppc4xx_pci.c
index 5558d932b4d5..6a2d473c345a 100644
--- a/arch/powerpc/sysdev/ppc4xx_pci.c
+++ b/arch/powerpc/sysdev/ppc4xx_pci.c
@@ -1839,6 +1839,8 @@ static int __init ppc4xx_pci_find_bridges(void)
 {
         struct device_node *np;
 
+        ppc_pci_flags |= PPC_PCI_ENABLE_PROC_DOMAINS | PPC_PCI_COMPAT_DOMAIN_0;
+
 #ifdef CONFIG_PPC4xx_PCI_EXPRESS
         for_each_compatible_node(np, NULL, "ibm,plb-pciex")
                 ppc4xx_probe_pciex_bridge(np);