mirror of https://github.com/Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
102 lines
2.7 KiB
102 lines
2.7 KiB
// SPDX-License-Identifier: GPL-2.0 |
|
/* |
|
* Author: Yun Liu <[email protected]> |
|
* Huacai Chen <[email protected]> |
|
* Copyright (C) 2020-2022 Loongson Technology Corporation Limited |
|
*/ |
|
|
|
#include <asm/efi.h> |
|
#include <asm/addrspace.h> |
|
#include "efistub.h" |
|
|
|
typedef void __noreturn (*kernel_entry_t)(bool efi, unsigned long cmdline, |
|
unsigned long systab); |
|
|
|
extern int kernel_asize; |
|
extern int kernel_fsize; |
|
extern int kernel_offset; |
|
extern kernel_entry_t kernel_entry; |
|
|
|
efi_status_t check_platform_features(void) |
|
{ |
|
return EFI_SUCCESS; |
|
} |
|
|
|
efi_status_t handle_kernel_image(unsigned long *image_addr, |
|
unsigned long *image_size, |
|
unsigned long *reserve_addr, |
|
unsigned long *reserve_size, |
|
efi_loaded_image_t *image, |
|
efi_handle_t image_handle) |
|
{ |
|
efi_status_t status; |
|
unsigned long kernel_addr = 0; |
|
|
|
kernel_addr = (unsigned long)&kernel_offset - kernel_offset; |
|
|
|
status = efi_relocate_kernel(&kernel_addr, kernel_fsize, kernel_asize, |
|
PHYSADDR(VMLINUX_LOAD_ADDRESS), SZ_2M, 0x0); |
|
|
|
*image_addr = kernel_addr; |
|
*image_size = kernel_asize; |
|
|
|
return status; |
|
} |
|
|
|
struct exit_boot_struct { |
|
efi_memory_desc_t *runtime_map; |
|
int runtime_entry_count; |
|
}; |
|
|
|
static efi_status_t exit_boot_func(struct efi_boot_memmap *map, void *priv) |
|
{ |
|
struct exit_boot_struct *p = priv; |
|
|
|
/* |
|
* Update the memory map with virtual addresses. The function will also |
|
* populate @runtime_map with copies of just the EFI_MEMORY_RUNTIME |
|
* entries so that we can pass it straight to SetVirtualAddressMap() |
|
*/ |
|
efi_get_virtmap(map->map, map->map_size, map->desc_size, |
|
p->runtime_map, &p->runtime_entry_count); |
|
|
|
return EFI_SUCCESS; |
|
} |
|
|
|
efi_status_t efi_boot_kernel(void *handle, efi_loaded_image_t *image, |
|
unsigned long kernel_addr, char *cmdline_ptr) |
|
{ |
|
kernel_entry_t real_kernel_entry; |
|
struct exit_boot_struct priv; |
|
unsigned long desc_size; |
|
efi_status_t status; |
|
u32 desc_ver; |
|
|
|
status = efi_alloc_virtmap(&priv.runtime_map, &desc_size, &desc_ver); |
|
if (status != EFI_SUCCESS) { |
|
efi_err("Unable to retrieve UEFI memory map.\n"); |
|
return status; |
|
} |
|
|
|
efi_info("Exiting boot services\n"); |
|
|
|
efi_novamap = false; |
|
status = efi_exit_boot_services(handle, &priv, exit_boot_func); |
|
if (status != EFI_SUCCESS) |
|
return status; |
|
|
|
/* Install the new virtual address map */ |
|
efi_rt_call(set_virtual_address_map, |
|
priv.runtime_entry_count * desc_size, desc_size, |
|
desc_ver, priv.runtime_map); |
|
|
|
/* Config Direct Mapping */ |
|
csr_write64(CSR_DMW0_INIT, LOONGARCH_CSR_DMWIN0); |
|
csr_write64(CSR_DMW1_INIT, LOONGARCH_CSR_DMWIN1); |
|
|
|
real_kernel_entry = (kernel_entry_t) |
|
((unsigned long)&kernel_entry - kernel_addr + VMLINUX_LOAD_ADDRESS); |
|
|
|
real_kernel_entry(true, (unsigned long)cmdline_ptr, |
|
(unsigned long)efi_system_table); |
|
}
|
|
|