deepin: LoongArch: legacyboot: BPI: workaround old firmware with ISA

deepin inclusion
category: other

Restore BPI logic to workaround with some buggy DSDT table with ISA IO.

Signed-off-by: Wentao Guan <guanwentao@uniontech.com>

Author: opsiff

arch/loongarch/kernel/legacy_boot.c

@@ -1,6 +1,7 @@
 #include <linux/efi.h>
 #include <linux/memblock.h>
 #include <linux/acpi.h>
+#include <linux/of_address.h>
 #include <linux/kmemleak.h>
 #include <linux/kernel.h>
 
@@ -718,3 +719,69 @@ void __init acpi_arch_init (void){
 int loongarch_have_legacy_bpi (void){
 	return have_bpi;
 }
+
+static int __init add_legacy_isa_io(struct fwnode_handle *fwnode, unsigned long isa_base)
+{
+	int ret = 0;
+	unsigned long vaddr;
+	struct logic_pio_hwaddr *range;
+	range = kzalloc(sizeof(*range), GFP_ATOMIC);
+	if (!range)
+			return -ENOMEM;
+	range->fwnode = fwnode;
+	range->size = ISA_IOSIZE;
+	range->hw_start = isa_base;
+	range->flags = LOGIC_PIO_CPU_MMIO;
+	ret = logic_pio_register_range(range);
+	if (ret) {
+			kfree(range);
+			return ret;
+	}
+	if (range->io_start != 0) {
+			logic_pio_unregister_range(range);
+			kfree(range);
+			return -EINVAL;
+	}
+	vaddr = (unsigned long)(PCI_IOBASE + range->io_start);
+	ret = ioremap_page_range(vaddr, vaddr + range->size, range->hw_start,
+									pgprot_device(PAGE_KERNEL));
+	return ret;
+}
+static struct fwnode_handle * __init parse_isa_base(u64 *cpu_addr)
+{
+	struct device_node *np;
+	const __be32 *ranges = NULL;
+	int len;
+	struct device_node *node;
+	for_each_node_by_name(np, "isa") {
+			node = of_node_get(np);
+			if (!node)
+					break;
+			ranges = of_get_property(node, "ranges", &len);
+			if (!ranges || (ranges && len > 0))
+					break;
+	}
+	if (ranges) {
+			ranges += 2;
+			*cpu_addr = of_translate_address(np, ranges);
+			return &np->fwnode;
+	}
+	return NULL;
+}
+
+#define ISA_PHY_IOBASE  LOONGSON_LIO_BASE
+static int __init register_legacy_isa_io(void)
+{
+	struct fwnode_handle *fwnode;
+	u64 cpu_addr;
+	if (!acpi_disabled) {
+			cpu_addr = ISA_PHY_IOBASE;
+			fwnode = kzalloc(sizeof(*fwnode), GFP_ATOMIC);
+	} else {
+			fwnode = parse_isa_base(&cpu_addr);
+	}
+	if (fwnode)
+			add_legacy_isa_io(fwnode, cpu_addr);
+	return 0;
+}
+arch_initcall(register_legacy_isa_io);