1e2ffe3005
commit 8f7aa77a463f47c9e00592d02747a9fcf2271543 upstream. vgabios is passed from firmware to kernel on Loongson64 systems. Sane firmware will keep this pointer in reserved memory space passed from the firmware but insane firmware keeps it in low memory before kernel entry that is not reserved. Previously kernel won't try to allocate memory from low memory before kernel entry on boot, but after converting to memblock it will do that. Fix by resversing those memory on early boot. Cc: stable@vger.kernel.org Fixes: a94e4f24ec83 ("MIPS: init: Drop boot_mem_map") Signed-off-by: Jiaxun Yang <jiaxun.yang@flygoat.com> Signed-off-by: Thomas Bogendoerfer <tsbogend@alpha.franken.de> Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
154 lines
3.3 KiB
C
Executable file
154 lines
3.3 KiB
C
Executable file
// SPDX-License-Identifier: GPL-2.0-or-later
|
|
/*
|
|
* Copyright (C) 2009 Lemote Inc.
|
|
* Author: Wu Zhangjin, wuzhangjin@gmail.com
|
|
*/
|
|
|
|
#include <linux/irqchip.h>
|
|
#include <linux/logic_pio.h>
|
|
#include <linux/memblock.h>
|
|
#include <linux/of.h>
|
|
#include <linux/of_address.h>
|
|
#include <asm/bootinfo.h>
|
|
#include <asm/traps.h>
|
|
#include <asm/smp-ops.h>
|
|
#include <asm/cacheflush.h>
|
|
#include <asm/fw/fw.h>
|
|
|
|
#include <loongson.h>
|
|
#include <boot_param.h>
|
|
|
|
#define NODE_ID_OFFSET_ADDR ((void __iomem *)TO_UNCAC(0x1001041c))
|
|
|
|
u32 node_id_offset;
|
|
|
|
static void __init mips_nmi_setup(void)
|
|
{
|
|
void *base;
|
|
extern char except_vec_nmi[];
|
|
|
|
base = (void *)(CAC_BASE + 0x380);
|
|
memcpy(base, except_vec_nmi, 0x80);
|
|
flush_icache_range((unsigned long)base, (unsigned long)base + 0x80);
|
|
}
|
|
|
|
void ls7a_early_config(void)
|
|
{
|
|
node_id_offset = ((readl(NODE_ID_OFFSET_ADDR) >> 8) & 0x1f) + 36;
|
|
}
|
|
|
|
void rs780e_early_config(void)
|
|
{
|
|
node_id_offset = 37;
|
|
}
|
|
|
|
void virtual_early_config(void)
|
|
{
|
|
node_id_offset = 44;
|
|
}
|
|
|
|
void __init prom_init(void)
|
|
{
|
|
fw_init_cmdline();
|
|
prom_init_env();
|
|
|
|
/* init base address of io space */
|
|
set_io_port_base(PCI_IOBASE);
|
|
|
|
loongson_sysconf.early_config();
|
|
|
|
prom_init_numa_memory();
|
|
|
|
/* Hardcode to CPU UART 0 */
|
|
setup_8250_early_printk_port(TO_UNCAC(LOONGSON_REG_BASE + 0x1e0), 0, 1024);
|
|
|
|
register_smp_ops(&loongson3_smp_ops);
|
|
board_nmi_handler_setup = mips_nmi_setup;
|
|
}
|
|
|
|
void __init prom_free_prom_memory(void)
|
|
{
|
|
}
|
|
|
|
static int __init add_legacy_isa_io(struct fwnode_handle *fwnode, resource_size_t hw_start,
|
|
resource_size_t size)
|
|
{
|
|
int ret = 0;
|
|
struct logic_pio_hwaddr *range;
|
|
unsigned long vaddr;
|
|
|
|
range = kzalloc(sizeof(*range), GFP_ATOMIC);
|
|
if (!range)
|
|
return -ENOMEM;
|
|
|
|
range->fwnode = fwnode;
|
|
range->size = size = round_up(size, PAGE_SIZE);
|
|
range->hw_start = hw_start;
|
|
range->flags = LOGIC_PIO_CPU_MMIO;
|
|
|
|
ret = logic_pio_register_range(range);
|
|
if (ret) {
|
|
kfree(range);
|
|
return ret;
|
|
}
|
|
|
|
/* Legacy ISA must placed at the start of PCI_IOBASE */
|
|
if (range->io_start != 0) {
|
|
logic_pio_unregister_range(range);
|
|
kfree(range);
|
|
return -EINVAL;
|
|
}
|
|
|
|
vaddr = PCI_IOBASE + range->io_start;
|
|
|
|
ioremap_page_range(vaddr, vaddr + size, hw_start, pgprot_device(PAGE_KERNEL));
|
|
|
|
return 0;
|
|
}
|
|
|
|
static __init void reserve_pio_range(void)
|
|
{
|
|
struct device_node *np;
|
|
|
|
for_each_node_by_name(np, "isa") {
|
|
struct of_range range;
|
|
struct of_range_parser parser;
|
|
|
|
pr_info("ISA Bridge: %pOF\n", np);
|
|
|
|
if (of_range_parser_init(&parser, np)) {
|
|
pr_info("Failed to parse resources.\n");
|
|
break;
|
|
}
|
|
|
|
for_each_of_range(&parser, &range) {
|
|
switch (range.flags & IORESOURCE_TYPE_BITS) {
|
|
case IORESOURCE_IO:
|
|
pr_info(" IO 0x%016llx..0x%016llx -> 0x%016llx\n",
|
|
range.cpu_addr,
|
|
range.cpu_addr + range.size - 1,
|
|
range.bus_addr);
|
|
if (add_legacy_isa_io(&np->fwnode, range.cpu_addr, range.size))
|
|
pr_warn("Failed to reserve legacy IO in Logic PIO\n");
|
|
break;
|
|
case IORESOURCE_MEM:
|
|
pr_info(" MEM 0x%016llx..0x%016llx -> 0x%016llx\n",
|
|
range.cpu_addr,
|
|
range.cpu_addr + range.size - 1,
|
|
range.bus_addr);
|
|
break;
|
|
}
|
|
}
|
|
}
|
|
|
|
/* Reserve vgabios if it comes from firmware */
|
|
if (loongson_sysconf.vgabios_addr)
|
|
memblock_reserve(virt_to_phys((void *)loongson_sysconf.vgabios_addr),
|
|
SZ_256K);
|
|
}
|
|
|
|
void __init arch_init_irq(void)
|
|
{
|
|
reserve_pio_range();
|
|
irqchip_init();
|
|
}
|