85 lines · c
1// SPDX-License-Identifier: GPL-2.02/*3 * Author: Yun Liu <liuyun@loongson.cn>4 * Huacai Chen <chenhuacai@loongson.cn>5 * Copyright (C) 2020-2022 Loongson Technology Corporation Limited6 */7 8#include <asm/efi.h>9#include <asm/addrspace.h>10#include "efistub.h"11#include "loongarch-stub.h"12 13typedef void __noreturn (*kernel_entry_t)(bool efi, unsigned long cmdline,14 unsigned long systab);15 16efi_status_t check_platform_features(void)17{18 return EFI_SUCCESS;19}20 21struct exit_boot_struct {22 efi_memory_desc_t *runtime_map;23 int runtime_entry_count;24};25 26static efi_status_t exit_boot_func(struct efi_boot_memmap *map, void *priv)27{28 struct exit_boot_struct *p = priv;29 30 /*31 * Update the memory map with virtual addresses. The function will also32 * populate @runtime_map with copies of just the EFI_MEMORY_RUNTIME33 * entries so that we can pass it straight to SetVirtualAddressMap()34 */35 efi_get_virtmap(map->map, map->map_size, map->desc_size,36 p->runtime_map, &p->runtime_entry_count);37 38 return EFI_SUCCESS;39}40 41unsigned long __weak kernel_entry_address(unsigned long kernel_addr,42 efi_loaded_image_t *image)43{44 return *(unsigned long *)(kernel_addr + 8) - PHYSADDR(VMLINUX_LOAD_ADDRESS) + kernel_addr;45}46 47efi_status_t efi_boot_kernel(void *handle, efi_loaded_image_t *image,48 unsigned long kernel_addr, char *cmdline_ptr)49{50 kernel_entry_t real_kernel_entry;51 struct exit_boot_struct priv;52 unsigned long desc_size;53 efi_status_t status;54 u32 desc_ver;55 56 status = efi_alloc_virtmap(&priv.runtime_map, &desc_size, &desc_ver);57 if (status != EFI_SUCCESS) {58 efi_err("Unable to retrieve UEFI memory map.\n");59 return status;60 }61 62 efi_info("Exiting boot services\n");63 64 efi_novamap = false;65 status = efi_exit_boot_services(handle, &priv, exit_boot_func);66 if (status != EFI_SUCCESS)67 return status;68 69 /* Install the new virtual address map */70 efi_rt_call(set_virtual_address_map,71 priv.runtime_entry_count * desc_size, desc_size,72 desc_ver, priv.runtime_map);73 74 /* Config Direct Mapping */75 csr_write64(CSR_DMW0_INIT, LOONGARCH_CSR_DMWIN0);76 csr_write64(CSR_DMW1_INIT, LOONGARCH_CSR_DMWIN1);77 csr_write64(CSR_DMW2_INIT, LOONGARCH_CSR_DMWIN2);78 csr_write64(CSR_DMW3_INIT, LOONGARCH_CSR_DMWIN3);79 80 real_kernel_entry = (void *)kernel_entry_address(kernel_addr, image);81 82 real_kernel_entry(true, (unsigned long)cmdline_ptr,83 (unsigned long)efi_system_table);84}85