5 files changed, 196 insertions, 28 deletions

diff --git a/arch/mips/pci/ops-tx3927.c b/arch/mips/pci/ops-tx3927.c
index 8a17a39e5bf2..31c150196595 100644
--- a/arch/mips/pci/ops-tx3927.c
+++ b/arch/mips/pci/ops-tx3927.c
@@ -37,45 +37,48 @@
 #include <linux/pci.h>
 #include <linux/kernel.h>
 #include <linux/init.h>
+#include <linux/interrupt.h>
 
 #include <asm/addrspace.h>
+#include <asm/txx9irq.h>
+#include <asm/txx9/pci.h>
 #include <asm/txx9/tx3927.h>
 
-static inline int mkaddr(unsigned char bus, unsigned char dev_fn,
-        unsigned char where)
+static int mkaddr(struct pci_bus *bus, unsigned char devfn, unsigned char where)
 {
-        if (bus == 0 && dev_fn >= PCI_DEVFN(TX3927_PCIC_MAX_DEVNU, 0))
-                return PCIBIOS_DEVICE_NOT_FOUND;
-
-        tx3927_pcicptr->ica = ((bus & 0xff) << 0x10) |
-                              ((dev_fn & 0xff) << 0x08) |
-                              (where & 0xfc);
+        if (bus->parent == NULL &&
+            devfn >= PCI_DEVFN(TX3927_PCIC_MAX_DEVNU, 0))
+                return -1;
+        tx3927_pcicptr->ica =
+                ((bus->number & 0xff) << 0x10) |
+                ((devfn & 0xff) << 0x08) |
+                (where & 0xfc) | (bus->parent ? 1 : 0);
 
         /* clear M_ABORT and Disable M_ABORT Int. */
         tx3927_pcicptr->pcistat |= PCI_STATUS_REC_MASTER_ABORT;
         tx3927_pcicptr->pcistatim &= ~PCI_STATUS_REC_MASTER_ABORT;
-
-        return PCIBIOS_SUCCESSFUL;
+        return 0;
 }
 
 static inline int check_abort(void)
 {
-        if (tx3927_pcicptr->pcistat & PCI_STATUS_REC_MASTER_ABORT)
+        if (tx3927_pcicptr->pcistat & PCI_STATUS_REC_MASTER_ABORT) {
                 tx3927_pcicptr->pcistat |= PCI_STATUS_REC_MASTER_ABORT;
                 tx3927_pcicptr->pcistatim |= PCI_STATUS_REC_MASTER_ABORT;
+                /* flush write buffer */
+                iob();
                 return PCIBIOS_DEVICE_NOT_FOUND;
-
+        }
         return PCIBIOS_SUCCESSFUL;
 }
 
 static int tx3927_pci_read_config(struct pci_bus *bus, unsigned int devfn,
         int where, int size, u32 * val)
 {
-        int ret;
-
-        ret = mkaddr(bus->number, devfn, where);
-        if (ret)
-                return ret;
+        if (mkaddr(bus, devfn, where)) {
+                *val = 0xffffffff;
+                return PCIBIOS_DEVICE_NOT_FOUND;
+        }
 
         switch (size) {
         case 1:
@@ -97,11 +100,8 @@ static int tx3927_pci_read_config(struct pci_bus *bus, unsigned int devfn,
 static int tx3927_pci_write_config(struct pci_bus *bus, unsigned int devfn,
         int where, int size, u32 val)
 {
-        int ret;
-
-        ret = mkaddr(bus->number, devfn, where);
-        if (ret)
-                return ret;
+        if (mkaddr(bus, devfn, where))
+                return PCIBIOS_DEVICE_NOT_FOUND;
 
         switch (size) {
         case 1:
@@ -117,11 +117,6 @@ static int tx3927_pci_write_config(struct pci_bus *bus, unsigned int devfn,
                 tx3927_pcicptr->icd = cpu_to_le32(val);
         }
 
-        if (tx3927_pcicptr->pcistat & PCI_STATUS_REC_MASTER_ABORT)
-                tx3927_pcicptr->pcistat |= PCI_STATUS_REC_MASTER_ABORT;
-                tx3927_pcicptr->pcistatim |= PCI_STATUS_REC_MASTER_ABORT;
-                return PCIBIOS_DEVICE_NOT_FOUND;
-
         return check_abort();
 }
 
@@ -202,3 +197,34 @@ void __init tx3927_pcic_setup(struct pci_controller *channel,
                 PCI_COMMAND_PARITY | PCI_COMMAND_SERR;
         local_irq_restore(flags);
 }
+
+static irqreturn_t tx3927_pcierr_interrupt(int irq, void *dev_id)
+{
+        struct pt_regs *regs = get_irq_regs();
+
+        if (txx9_pci_err_action != TXX9_PCI_ERR_IGNORE) {
+                printk(KERN_WARNING "PCI error interrupt at 0x%08lx.\n",
+                       regs->cp0_epc);
+                printk(KERN_WARNING "pcistat:%02x, lbstat:%04lx\n",
+                       tx3927_pcicptr->pcistat, tx3927_pcicptr->lbstat);
+        }
+        if (txx9_pci_err_action != TXX9_PCI_ERR_PANIC) {
+                /* clear all pci errors */
+                tx3927_pcicptr->pcistat |= TX3927_PCIC_PCISTATIM_ALL;
+                tx3927_pcicptr->istat = TX3927_PCIC_IIM_ALL;
+                tx3927_pcicptr->tstat = TX3927_PCIC_TIM_ALL;
+                tx3927_pcicptr->lbstat = TX3927_PCIC_LBIM_ALL;
+                return IRQ_HANDLED;
+        }
+        console_verbose();
+        panic("PCI error.");
+}
+
+void __init tx3927_setup_pcierr_irq(void)
+{
+        if (request_irq(TXX9_IRQ_BASE + TX3927_IR_PCI,
+                        tx3927_pcierr_interrupt,
+                        IRQF_DISABLED, "PCI error",
+                        (void *)TX3927_PCIC_REG))
+                printk(KERN_WARNING "Failed to request irq for PCIERR\n");
+}
diff --git a/arch/mips/pci/ops-tx4927.c b/arch/mips/pci/ops-tx4927.c
index c6b49bccd274..5989e747527f 100644
--- a/arch/mips/pci/ops-tx4927.c
+++ b/arch/mips/pci/ops-tx4927.c
@@ -16,6 +16,8 @@
  * option) any later version.
  */
 #include <linux/kernel.h>
+#include <linux/interrupt.h>
+#include <asm/txx9/pci.h>
 #include <asm/txx9/tx4927pcic.h>
 
 static struct {
@@ -85,6 +87,8 @@ static int check_abort(struct tx4927_pcic_reg __iomem *pcicptr)
                 __raw_writel((__raw_readl(&pcicptr->pcistatus) & 0x0000ffff)
                              | (PCI_STATUS_REC_MASTER_ABORT << 16),
                              &pcicptr->pcistatus);
+                /* flush write buffer */
+                iob();
                 code = PCIBIOS_DEVICE_NOT_FOUND;
         }
         return code;
@@ -192,6 +196,28 @@ static struct {
         .gbwc = 0xfe0,  /* 4064 GBUSCLK for CCFG.GTOT=0b11 */
 };
 
+char *__devinit tx4927_pcibios_setup(char *str)
+{
+        unsigned long val;
+
+        if (!strncmp(str, "trdyto=", 7)) {
+                if (strict_strtoul(str + 7, 0, &val) == 0)
+                        tx4927_pci_opts.trdyto = val;
+                return NULL;
+        }
+        if (!strncmp(str, "retryto=", 8)) {
+                if (strict_strtoul(str + 8, 0, &val) == 0)
+                        tx4927_pci_opts.retryto = val;
+                return NULL;
+        }
+        if (!strncmp(str, "gbwc=", 5)) {
+                if (strict_strtoul(str + 5, 0, &val) == 0)
+                        tx4927_pci_opts.gbwc = val;
+                return NULL;
+        }
+        return str;
+}
+
 void __init tx4927_pcic_setup(struct tx4927_pcic_reg __iomem *pcicptr,
                               struct pci_controller *channel, int extarb)
 {
@@ -406,3 +432,95 @@ void tx4927_report_pcic_status(void)
                         tx4927_report_pcic_status1(pcicptrs[i].pcicptr);
         }
 }
+
+static void tx4927_dump_pcic_settings1(struct tx4927_pcic_reg __iomem *pcicptr)
+{
+        int i;
+        __u32 __iomem *preg = (__u32 __iomem *)pcicptr;
+
+        printk(KERN_INFO "tx4927 pcic (0x%p) settings:", pcicptr);
+        for (i = 0; i < sizeof(struct tx4927_pcic_reg); i += 4, preg++) {
+                if (i % 32 == 0) {
+                        printk(KERN_CONT "\n");
+                        printk(KERN_INFO "%04x:", i);
+                }
+                /* skip registers with side-effects */
+                if (i == offsetof(struct tx4927_pcic_reg, g2pintack)
+                    || i == offsetof(struct tx4927_pcic_reg, g2pspc)
+                    || i == offsetof(struct tx4927_pcic_reg, g2pcfgadrs)
+                    || i == offsetof(struct tx4927_pcic_reg, g2pcfgdata)) {
+                        printk(KERN_CONT " XXXXXXXX");
+                        continue;
+                }
+                printk(KERN_CONT " %08x", __raw_readl(preg));
+        }
+        printk(KERN_CONT "\n");
+}
+
+void tx4927_dump_pcic_settings(void)
+{
+        int i;
+
+        for (i = 0; i < ARRAY_SIZE(pcicptrs); i++) {
+                if (pcicptrs[i].pcicptr)
+                        tx4927_dump_pcic_settings1(pcicptrs[i].pcicptr);
+        }
+}
+
+irqreturn_t tx4927_pcierr_interrupt(int irq, void *dev_id)
+{
+        struct pt_regs *regs = get_irq_regs();
+        struct tx4927_pcic_reg __iomem *pcicptr =
+                (struct tx4927_pcic_reg __iomem *)(unsigned long)dev_id;
+
+        if (txx9_pci_err_action != TXX9_PCI_ERR_IGNORE) {
+                printk(KERN_WARNING "PCIERR interrupt at 0x%0*lx\n",
+                       (int)(2 * sizeof(unsigned long)), regs->cp0_epc);
+                tx4927_report_pcic_status1(pcicptr);
+        }
+        if (txx9_pci_err_action != TXX9_PCI_ERR_PANIC) {
+                /* clear all pci errors */
+                __raw_writel((__raw_readl(&pcicptr->pcistatus) & 0x0000ffff)
+                             | (TX4927_PCIC_PCISTATUS_ALL << 16),
+                             &pcicptr->pcistatus);
+                __raw_writel(TX4927_PCIC_G2PSTATUS_ALL, &pcicptr->g2pstatus);
+                __raw_writel(TX4927_PCIC_PBASTATUS_ALL, &pcicptr->pbastatus);
+                __raw_writel(TX4927_PCIC_PCICSTATUS_ALL, &pcicptr->pcicstatus);
+                return IRQ_HANDLED;
+        }
+        console_verbose();
+        tx4927_dump_pcic_settings1(pcicptr);
+        panic("PCI error.");
+}
+
+#ifdef CONFIG_TOSHIBA_FPCIB0
+static void __init tx4927_quirk_slc90e66_bridge(struct pci_dev *dev)
+{
+        struct tx4927_pcic_reg __iomem *pcicptr = pci_bus_to_pcicptr(dev->bus);
+
+        if (!pcicptr)
+                return;
+        if (__raw_readl(&pcicptr->pbacfg) & TX4927_PCIC_PBACFG_PBAEN) {
+                /* Reset Bus Arbiter */
+                __raw_writel(TX4927_PCIC_PBACFG_RPBA, &pcicptr->pbacfg);
+                /*
+                 * swap reqBP and reqXP (raise priority of SLC90E66).
+                 * SLC90E66(PCI-ISA bridge) is connected to REQ2 on
+                 * PCI Backplane board.
+                 */
+                __raw_writel(0x72543610, &pcicptr->pbareqport);
+                __raw_writel(0, &pcicptr->pbabm);
+                /* Use Fixed ParkMaster (required by SLC90E66) */
+                __raw_writel(TX4927_PCIC_PBACFG_FIXPA, &pcicptr->pbacfg);
+                /* Enable Bus Arbiter */
+                __raw_writel(TX4927_PCIC_PBACFG_FIXPA |
+                             TX4927_PCIC_PBACFG_PBAEN,
+                             &pcicptr->pbacfg);
+                printk(KERN_INFO "PCI: Use Fixed Park Master (REQPORT %08x)\n",
+                       __raw_readl(&pcicptr->pbareqport));
+        }
+}
+#define PCI_DEVICE_ID_EFAR_SLC90E66_0 0x9460
+DECLARE_PCI_FIXUP_FINAL(PCI_VENDOR_ID_EFAR, PCI_DEVICE_ID_EFAR_SLC90E66_0,
+        tx4927_quirk_slc90e66_bridge);
+#endif
diff --git a/arch/mips/pci/pci-tx4927.c b/arch/mips/pci/pci-tx4927.c
index 27e86a09dd41..aaa900596792 100644
--- a/arch/mips/pci/pci-tx4927.c
+++ b/arch/mips/pci/pci-tx4927.c
@@ -15,6 +15,7 @@
 #include <linux/init.h>
 #include <linux/pci.h>
 #include <linux/kernel.h>
+#include <linux/interrupt.h>
 #include <asm/txx9/generic.h>
 #include <asm/txx9/tx4927.h>
 
@@ -81,3 +82,12 @@ int __init tx4927_pciclk66_setup(void)
                 pciclk = -1;
         return pciclk;
 }
+
+void __init tx4927_setup_pcierr_irq(void)
+{
+        if (request_irq(TXX9_IRQ_BASE + TX4927_IR_PCIERR,
+                        tx4927_pcierr_interrupt,
+                        IRQF_DISABLED, "PCI error",
+                        (void *)TX4927_PCIC_REG))
+                printk(KERN_WARNING "Failed to request irq for PCIERR\n");
+}
diff --git a/arch/mips/pci/pci-tx4938.c b/arch/mips/pci/pci-tx4938.c
index e5375511c2b7..60e2c52c2c5e 100644
--- a/arch/mips/pci/pci-tx4938.c
+++ b/arch/mips/pci/pci-tx4938.c
@@ -15,6 +15,7 @@
 #include <linux/init.h>
 #include <linux/pci.h>
 #include <linux/kernel.h>
+#include <linux/interrupt.h>
 #include <asm/txx9/generic.h>
 #include <asm/txx9/tx4938.h>
 
@@ -132,3 +133,12 @@ int tx4938_pcic1_map_irq(const struct pci_dev *dev, u8 slot)
         }
         return -1;
 }
+
+void __init tx4938_setup_pcierr_irq(void)
+{
+        if (request_irq(TXX9_IRQ_BASE + TX4938_IR_PCIERR,
+                        tx4927_pcierr_interrupt,
+                        IRQF_DISABLED, "PCI error",
+                        (void *)TX4927_PCIC_REG))
+                printk(KERN_WARNING "Failed to request irq for PCIERR\n");
+}
diff --git a/arch/mips/pci/pci.c b/arch/mips/pci/pci.c
index 77bd5b68dc43..c7fe6ec621e6 100644
--- a/arch/mips/pci/pci.c
+++ b/arch/mips/pci/pci.c
@@ -328,7 +328,11 @@ EXPORT_SYMBOL(PCIBIOS_MIN_IO);
 EXPORT_SYMBOL(PCIBIOS_MIN_MEM);
 #endif
 
-char *pcibios_setup(char *str)
+char * (*pcibios_plat_setup)(char *str) __devinitdata;
+
+char *__devinit pcibios_setup(char *str)
 {
+        if (pcibios_plat_setup)
+                return pcibios_plat_setup(str);
         return str;
 }