The PCI Controller of 2k1000 could not mask devices by
setting vender id & device id in configuration space header
as invalid values. When there are pins shareble between
the platform device and PCI device, if the platform device
is preferred, we should not scan this PCI device. In the
above scene, add "skip-scan" property in DT node of this
PCI device.
Signed-off-by: Liu Peibao <liupeibao@xxxxxxxxxxx>
---
drivers/pci/controller/pci-loongson.c | 62 +++++++++++++++++++++++++++
1 file changed, 62 insertions(+)
diff --git a/drivers/pci/controller/pci-loongson.c b/drivers/pci/controller/pci-loongson.c
index 05c50408f13b..4b97963977c7 100644
--- a/drivers/pci/controller/pci-loongson.c
+++ b/drivers/pci/controller/pci-loongson.c
@@ -40,11 +40,21 @@ struct loongson_pci_data {
struct pci_ops *ops;
};
+#ifdef CONFIG_OF
+struct mask_entry {
+ struct list_head entry;
+ unsigned int devfn;
+};
+#endif
+
struct loongson_pci {
void __iomem *cfg0_base;
void __iomem *cfg1_base;
struct platform_device *pdev;
const struct loongson_pci_data *data;
+#ifdef CONFIG_OF
+ struct list_head masklist;
+#endif
};
/* Fixup wrong class code in PCIe bridges */
@@ -194,6 +204,20 @@ static void __iomem *pci_loongson_map_bus(struct pci_bus *bus,
return NULL;
}
+#ifdef CONFIG_OF
+ /* Don't access devices in masklist */
+ if (pci_is_root_bus(bus)) {
+ struct list_head *list;
+ struct mask_entry *entry;
+
+ list_for_each(list, &priv->masklist) {
+ entry = list_entry(list, struct mask_entry, entry);
+ if (devfn == entry->devfn)
+ return NULL;
+ }
+ }
+#endif
+
/* CFG0 can only access standard space */
if (where < PCI_CFG_SPACE_SIZE && priv->cfg0_base)
return cfg0_map(priv, bus, devfn, where);
@@ -206,6 +230,41 @@ static void __iomem *pci_loongson_map_bus(struct pci_bus *bus,
}
#ifdef CONFIG_OF
+/*
+ * The PCI Controller of 2k1000 could not mask devices by
+ * setting vender id & device id in configuration space
+ * header as invalid values. When there are pins shareble
+ * between the platform device and PCI device, if the
+ * platform device is preferred, we should not scan this
+ * PCI device. In the above scene, add "skip-scan" property
+ * in the device tree node of this PCI device.
+ */
+static int setup_masklist(struct loongson_pci *priv)
+{
+ struct device *dev = &priv->pdev->dev;
+ struct device_node *dn, *parent = dev->of_node;
+ struct mask_entry *entry;
+ int devfn;
+
+ INIT_LIST_HEAD(&priv->masklist);
+
+ for_each_child_of_node(parent, dn) {
+ if (of_property_read_bool(dn, "skip-scan")) {
+ devfn = of_pci_get_devfn(dn);
+ if (devfn < 0)
+ continue;
+
+ entry = devm_kzalloc(dev, sizeof(entry), GFP_KERNEL);
+ if (!entry)
+ return -ENOMEM;
+
+ entry->devfn = devfn;
+ list_add_tail(&entry->entry, &priv->masklist);
+ }
+ }
+
+ return 0;
+}
static int loongson_map_irq(const struct pci_dev *dev, u8 slot, u8 pin)
{
@@ -305,6 +364,9 @@ static int loongson_pci_probe(struct platform_device *pdev)
}
}
+ if (setup_masklist(priv))
+ return -ENOMEM;
+
bridge->sysdata = priv;
bridge->ops = priv->data->ops;
bridge->map_irq = loongson_map_irq;
--
2.20.1
