openloongarch-linux-5.10/arch/loongarch/kernel/efi.c

// SPDX-License-Identifier: GPL-2.0
/*
 * EFI partition
 *
 * Just for ACPI here, complete it when implementing EFI runtime.
 *
 * Copyright (C) 2020 Loongson Technology Co., Ltd.
 *
 * Jianmin Lv: <lvjianmin@loongson.cn>
 * Huacai Chen: <chenhuacai@loongson.cn>
 */

#include <linux/acpi.h>
#include <linux/efi.h>
#include <linux/efi-bgrt.h>
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/export.h>
#include <linux/io.h>
#include <linux/kobject.h>
#include <linux/memblock.h>
#include <linux/reboot.h>
#include <linux/uaccess.h>

#include <asm/early_ioremap.h>
#include <asm/efi.h>
#include <asm/tlb.h>
#include <loongson.h>

static unsigned long efi_nr_tables;
static unsigned long efi_config_table;
static efi_system_table_t *efi_systab;
static efi_config_table_type_t arch_tables[] __initdata = {{},};

static void __init create_tlb(u32 index, u64 vppn, u32 ps, u32 mat)
{
	unsigned long tlblo0, tlblo1;

	write_csr_pagesize(ps);

	tlblo0 = vppn | CSR_TLBLO0_V | CSR_TLBLO0_WE |
		CSR_TLBLO0_GLOBAL | (mat << CSR_TLBLO0_CCA_SHIFT);
	tlblo1 = tlblo0 + (1 << ps);

	csr_writeq(vppn, LOONGARCH_CSR_TLBEHI);
	csr_writeq(tlblo0, LOONGARCH_CSR_TLBELO0);
	csr_writeq(tlblo1, LOONGARCH_CSR_TLBELO1);
	csr_xchgl(0, CSR_TLBIDX_EHINV, LOONGARCH_CSR_TLBIDX);
	csr_xchgl(index, CSR_TLBIDX_IDX, LOONGARCH_CSR_TLBIDX);

	tlb_write_indexed();
}

#define MTLB_ENTRY_INDEX	0x800

/* Create VA == PA mapping as UEFI */
static void __init fix_efi_mapping(void)
{
	unsigned int i;
	unsigned int index = MTLB_ENTRY_INDEX;
	unsigned int tlbnr = boot_cpu_data.tlbsizemtlb - 2;
	unsigned long vppn;

	/* Low Memory, Cached */
	create_tlb(index++, 0x00000000, PS_256M, 1);
	/* MMIO Registers, Uncached */
	create_tlb(index++, 0x10000000, PS_256M, 0);

	/* High Memory, Cached */
	for (i = 0; i < tlbnr; i++) {
		vppn = 0x80000000 + (SZ_2G * i);
		create_tlb(index++, vppn, PS_1G, 1);
	}
}

/*
 * set_virtual_map() - create a virtual mapping for the EFI memory map and call
 * efi_set_virtual_address_map enter virtual for runtime service
 *
 * This function populates the virt_addr fields of all memory region descriptors
 * in @memory_map whose EFI_MEMORY_RUNTIME attribute is set. Those descriptors
 * are also copied to @runtime_map, and their total count is returned in @count.
 */
static unsigned int __init set_virtual_map(void)
{
	int i, count = 0;
	unsigned int size;
	unsigned long attr;
	efi_status_t status;
	efi_runtime_services_t *rt;
	efi_set_virtual_address_map_t *svam;
	efi_memory_desc_t *runtime_map, *out;
	struct loongsonlist_mem_map *map = loongson_mem_map;

	if (loongson_sysconf.bpi_ver < BPI_VERSION_V3)
		return EFI_SUCCESS;

	size = sizeof(struct efi_mmap);
	out = runtime_map = (efi_memory_desc_t *)&map->map[EFI_RUNTIME_MAP_START];

	for (i = 0; i < map->map_count; i++) {
		attr = map->map[i].attribute;
		if (!(attr & EFI_MEMORY_RUNTIME))
			continue;

		map->map[i].mem_vaddr = TO_CAC(map->map[i].mem_start);
		map->map[i].mem_size  = map->map[i].mem_size >> EFI_PAGE_SHIFT;

		memcpy(out, &map->map[i], size);
		out = (void *)out + size;
		++count;

	}

	rt = early_memremap_ro((unsigned long)efi_systab->runtime, sizeof(*rt));

	/* Install the new virtual address map */
	svam = rt->set_virtual_address_map;

	fix_efi_mapping();

	status = svam(size * count, size, map->desc_version,
			(efi_memory_desc_t *)TO_PHYS((unsigned long)runtime_map));

	local_flush_tlb_all();

	if (status != EFI_SUCCESS)
		return -1;

	return 0;
}

void __init efi_runtime_init(void)
{
	efi_status_t status;

	if (!efi_enabled(EFI_BOOT))
		return;

	if (!efi_systab->runtime)
		return;

	status = set_virtual_map();
	if (status < 0)
		return;

	if (efi_runtime_disabled()) {
		pr_info("EFI runtime services will be disabled.\n");
		return;
	}

	efi.runtime = (efi_runtime_services_t *)efi_systab->runtime;
	efi.runtime_version = (unsigned int)efi.runtime->hdr.revision;

	efi_native_runtime_setup();
	set_bit(EFI_RUNTIME_SERVICES, &efi.flags);
}

void __init efi_init(void)
{
	int size;
	void *config_tables;

	if (!efi_bp)
		return;

	efi_systab = (efi_system_table_t *)early_memremap_ro
		((unsigned long)efi_bp->systemtable, sizeof(efi_systab));

	if (!efi_systab) {
		pr_err("Can't find EFI system table.\n");
		return;
	}

	set_bit(EFI_64BIT, &efi.flags);
	efi_nr_tables	 = efi_systab->nr_tables;
	efi_config_table = (unsigned long)efi_systab->tables;

	size = sizeof(efi_config_table_t);
	config_tables = early_memremap(efi_config_table, efi_nr_tables * size);
	efi_config_parse_tables(config_tables, efi_systab->nr_tables, arch_tables);
	early_memunmap(config_tables, efi_nr_tables * size);
}

static ssize_t boardinfo_show(struct kobject *kobj,
			      struct kobj_attribute *attr, char *buf)
{
	return sprintf(buf,
		"BIOS Information\n"
		"Vendor\t\t\t: %s\n"
		"Version\t\t\t: %s\n"
		"ROM Size\t\t: %d KB\n"
		"Release Date\t\t: %s\n\n"
		"Board Information\n"
		"Manufacturer\t\t: %s\n"
		"Board Name\t\t: %s\n"
		"Family\t\t\t: LOONGSON64\n\n",
		b_info.bios_vendor, b_info.bios_version,
		b_info.bios_size, b_info.bios_release_date,
		b_info.board_vendor, b_info.board_name);
}

static struct kobj_attribute boardinfo_attr = __ATTR(boardinfo, 0444,
						     boardinfo_show, NULL);

static int __init boardinfo_init(void)
{
	if (!efi_kobj)
		return -EINVAL;

	return sysfs_create_file(efi_kobj, &boardinfo_attr.attr);
}
late_initcall(boardinfo_init);