|
|
@@ -0,0 +1,53 @@
|
|
|
+--- a/arch/arm/mach-cns3xxx/pcie.c
|
|
|
++++ b/arch/arm/mach-cns3xxx/pcie.c
|
|
|
+@@ -71,7 +71,7 @@ static void __iomem *cns3xxx_pci_cfg_bas
|
|
|
+ void __iomem *base;
|
|
|
+
|
|
|
+ /* If there is no link, just show the CNS PCI bridge. */
|
|
|
+- if (!cnspci->linked && (busno > 0 || slot > 0))
|
|
|
++ if (!cnspci->linked && (busno > 0))
|
|
|
+ return NULL;
|
|
|
+
|
|
|
+ /*
|
|
|
+@@ -80,15 +80,19 @@ static void __iomem *cns3xxx_pci_cfg_bas
|
|
|
+ * the first device on the same bus as the CNS PCI bridge.
|
|
|
+ */
|
|
|
+ if (busno == 0) {
|
|
|
+- if (slot > 1)
|
|
|
++ type = CNS3XXX_HOST_TYPE;
|
|
|
++ if (devfn)
|
|
|
++ return NULL;
|
|
|
++ } else if (busno == 1) {
|
|
|
++ type = CNS3XXX_CFG0_TYPE;
|
|
|
++ if (slot)
|
|
|
+ return NULL;
|
|
|
+- type = slot;
|
|
|
+ } else {
|
|
|
+ type = CNS3XXX_CFG1_TYPE;
|
|
|
+ }
|
|
|
+
|
|
|
+ base = (void __iomem *)cnspci->cfg_bases[type].virtual;
|
|
|
+- offset = ((busno & 0xf) << 20) | (devfn << 12) | (where & 0xffc);
|
|
|
++ offset = (devfn << 12) | (where & 0xffc);
|
|
|
+
|
|
|
+ return base + offset;
|
|
|
+ }
|
|
|
+@@ -256,7 +260,7 @@ static struct pci_ops cns3xxx_pcie_ops =
|
|
|
+ static int cns3xxx_pcie_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
|
|
|
+ {
|
|
|
+ struct cns3xxx_pcie *cnspci = pdev_to_cnspci(dev);
|
|
|
+- int irq = cnspci->irqs[slot+pin-1];
|
|
|
++ int irq = cnspci->irqs[!!dev->bus->number+pin-1];
|
|
|
+
|
|
|
+ pr_info("PCIe map irq: %04d:%02x:%02x.%02x slot %d, pin %d, irq: %d\n",
|
|
|
+ pci_domain_nr(dev->bus), dev->bus->number, PCI_SLOT(dev->devfn),
|
|
|
+@@ -434,7 +438,8 @@ static void __init cns3xxx_pcie_hw_init(
|
|
|
+ return;
|
|
|
+
|
|
|
+ /* Set Device Max_Read_Request_Size to 128 byte */
|
|
|
+- devfn = PCI_DEVFN(1, 0);
|
|
|
++ bus.number = 1;
|
|
|
++ devfn = PCI_DEVFN(0, 0);
|
|
|
+ pos = pci_bus_find_capability(&bus, devfn, PCI_CAP_ID_EXP);
|
|
|
+ pci_bus_read_config_word(&bus, devfn, pos + PCI_EXP_DEVCTL, &dc);
|
|
|
+ dc &= ~(0x3 << 12); /* Clear Device Control Register [14:12] */
|