@@ -245,3 +245,90 @@ void __init pci_mmcfg_late_init(void)
mcfgsav.cfg, mcfgsav.size);
}
}
+
+/*
+ * First walk thru the root infos of all the known ACPI PCI
+ * controllers to see if there is an existing mapping and
+ * use it if we find one.
+ * Otherwise check the MCFG table and setup a temporary mapping
+ */
+static int raw_pci_op(int domain, unsigned int busn, unsigned int devfn,
+ int reg, int len, u32 *val, bool write)
+{
+ void __iomem *m;
+ struct acpi_pci_generic_root_info *ri;
+ struct acpi_pci_root *root;
+ bool tmpmap = false;
+ int i, ret = PCIBIOS_DEVICE_NOT_FOUND;
+
+ mutex_lock(&gen_acpi_pci_lock);
+ list_for_each_entry(ri, &gen_acpi_pci_roots, node) {
+ root = ri->common.root;
+ if (domain == root->segment &&
+ busn >= (u8)root->secondary.start &&
+ busn <= (u8)root->secondary.end) {
+ m = pci_generic_map_bus(ri->cfg, busn, devfn, reg);
+ if (m)
+ goto found;
+ else
+ goto err_out;
+ }
+ }
+
+ /* not found in existing root buses, check in mcfg */
+ i = mcfg_lookup(domain, busn, busn);
+ if (i < 0)
+ goto err_out;
+
+ /* get a temporary mapping */
+ busn -= mcfgsav.cfg[i].bus_start;
+ m = ioremap(mcfgsav.cfg[i].addr + (busn << 20 | devfn << 12), 1 << 12);
+ if (!m)
+ goto err_out;
+ tmpmap = true;
+ m += reg;
+found:
+ if (write) {
+ switch (len) {
+ case 1:
+ writeb(*val, m);
+ break;
+ case 2:
+ writew(*val, m);
+ break;
+ case 4:
+ writel(*val, m);
+ break;
+ }
+ } else {
+ switch (len) {
+ case 1:
+ *val = readb(m);
+ break;
+ case 2:
+ *val = readw(m);
+ break;
+ case 4:
+ *val = readl(m);
+ break;
+ }
+ }
+ if (tmpmap)
+ iounmap(m);
+ ret = 0;
+err_out:
+ mutex_unlock(&gen_acpi_pci_lock);
+ return ret;
+}
+
+int raw_pci_read(unsigned int domain, unsigned int busn, unsigned int devfn,
+ int reg, int len, u32 *val)
+{
+ return raw_pci_op(domain, busn, devfn, reg, len, val, false);
+}
+
+int raw_pci_write(unsigned int domain, unsigned int busn, unsigned int devfn,
+ int reg, int len, u32 val)
+{
+ return raw_pci_op(domain, busn, devfn, reg, len, &val, true);
+}
Provide implementations of raw_pci_read and raw_pci_write needed by ACPI. We already maintain a gen_acpi_pci_roots list with all the ACPI PCI controllers, so we walk thru this list to see if there is an existing mapping. If there is one, we can use the generic config space access. If there is no existing mapping, create a temporary mapping with information available in the saved MCFG table and use it to do raw config space access. Signed-off-by: Jayachandran C <jchandra@broadcom.com> --- drivers/acpi/pci_gen_host.c | 87 +++++++++++++++++++++++++++++++++++++++++++++ 1 file changed, 87 insertions(+)