| // SPDX-License-Identifier: GPL-2.0 | |
| /* | |
| * Copyright (C) 2020 - Google LLC | |
| * Author: Quentin Perret <qperret@google.com> | |
| */ | |
| #include <linux/kvm_host.h> | |
| #include <linux/memblock.h> | |
| #include <linux/mm.h> | |
| #include <linux/mutex.h> | |
| #include <linux/sort.h> | |
| #include <asm/kvm_pkvm.h> | |
| #include "hyp_constants.h" | |
| static struct memblock_region *hyp_memory = kvm_nvhe_sym(hyp_memory); | |
| static unsigned int *hyp_memblock_nr_ptr = &kvm_nvhe_sym(hyp_memblock_nr); | |
| phys_addr_t hyp_mem_base; | |
| phys_addr_t hyp_mem_size; | |
| static int cmp_hyp_memblock(const void *p1, const void *p2) | |
| { | |
| const struct memblock_region *r1 = p1; | |
| const struct memblock_region *r2 = p2; | |
| return r1->base < r2->base ? -1 : (r1->base > r2->base); | |
| } | |
| static void __init sort_memblock_regions(void) | |
| { | |
| sort(hyp_memory, | |
| *hyp_memblock_nr_ptr, | |
| sizeof(struct memblock_region), | |
| cmp_hyp_memblock, | |
| NULL); | |
| } | |
| static int __init register_memblock_regions(void) | |
| { | |
| struct memblock_region *reg; | |
| for_each_mem_region(reg) { | |
| if (*hyp_memblock_nr_ptr >= HYP_MEMBLOCK_REGIONS) | |
| return -ENOMEM; | |
| hyp_memory[*hyp_memblock_nr_ptr] = *reg; | |
| (*hyp_memblock_nr_ptr)++; | |
| } | |
| sort_memblock_regions(); | |
| return 0; | |
| } | |
| void __init kvm_hyp_reserve(void) | |
| { | |
| u64 hyp_mem_pages = 0; | |
| int ret; | |
| if (!is_hyp_mode_available() || is_kernel_in_hyp_mode()) | |
| return; | |
| if (kvm_get_mode() != KVM_MODE_PROTECTED) | |
| return; | |
| ret = register_memblock_regions(); | |
| if (ret) { | |
| *hyp_memblock_nr_ptr = 0; | |
| kvm_err("Failed to register hyp memblocks: %d\n", ret); | |
| return; | |
| } | |
| hyp_mem_pages += hyp_s1_pgtable_pages(); | |
| hyp_mem_pages += host_s2_pgtable_pages(); | |
| hyp_mem_pages += hyp_shadow_table_pages(KVM_SHADOW_VM_SIZE); | |
| hyp_mem_pages += hyp_vmemmap_pages(STRUCT_HYP_PAGE_SIZE); | |
| /* | |
| * Try to allocate a PMD-aligned region to reduce TLB pressure once | |
| * this is unmapped from the host stage-2, and fallback to PAGE_SIZE. | |
| */ | |
| hyp_mem_size = hyp_mem_pages << PAGE_SHIFT; | |
| hyp_mem_base = memblock_phys_alloc(ALIGN(hyp_mem_size, PMD_SIZE), | |
| PMD_SIZE); | |
| if (!hyp_mem_base) | |
| hyp_mem_base = memblock_phys_alloc(hyp_mem_size, PAGE_SIZE); | |
| else | |
| hyp_mem_size = ALIGN(hyp_mem_size, PMD_SIZE); | |
| if (!hyp_mem_base) { | |
| kvm_err("Failed to reserve hyp memory\n"); | |
| return; | |
| } | |
| kvm_info("Reserved %lld MiB at 0x%llx\n", hyp_mem_size >> 20, | |
| hyp_mem_base); | |
| } | |
| /* | |
| * Updates the state of the host's version of the vcpu state. | |
| */ | |
| static void update_vcpu_state(struct kvm_vcpu *vcpu, int shadow_handle) | |
| { | |
| vcpu->arch.pkvm.shadow_handle = shadow_handle; | |
| } | |
| /* | |
| * Allocates and donates memory for EL2 shadow structs. | |
| * | |
| * Allocates space for the shadow state, which includes the shadow vm as well as | |
| * the shadow vcpu states. | |
| * | |
| * Stores an opaque handler in the kvm struct for future reference. | |
| * | |
| * Return 0 on success, negative error code on failure. | |
| */ | |
| static int create_el2_shadow(struct kvm *kvm) | |
| { | |
| int shadow_handle; | |
| void *shadow_addr; | |
| size_t shadow_sz; | |
| int ret, i; | |
| if (kvm->arch.pkvm.shadow_handle) | |
| return -EEXIST; | |
| if (kvm->created_vcpus < 1) | |
| return -EINVAL; | |
| /* Allocate memory to donate to hyp for the kvm and vcpu state. */ | |
| shadow_sz = PAGE_ALIGN(KVM_SHADOW_VM_SIZE + | |
| SHADOW_VCPU_STATE_SIZE * kvm->created_vcpus); | |
| shadow_addr = alloc_pages_exact(shadow_sz, GFP_KERNEL_ACCOUNT); | |
| if (!shadow_addr) | |
| return -ENOMEM; | |
| /* Donate the shadow memory to hyp and let hyp initialize it. */ | |
| ret = kvm_call_hyp_nvhe(__pkvm_init_shadow, kvm, shadow_addr, shadow_sz); | |
| if (ret < 0) | |
| goto err; | |
| shadow_handle = ret; | |
| /* Store the shadow handle given by hyp for future call reference. */ | |
| kvm->arch.pkvm.shadow_handle = shadow_handle; | |
| /* Adjust host's vcpu state as it doesn't control it anymore. */ | |
| for (i = 0; i < kvm->created_vcpus; i++) | |
| update_vcpu_state(kvm->vcpus[i], shadow_handle); | |
| return 0; | |
| err: | |
| free_pages_exact(shadow_addr, shadow_sz); | |
| return ret; | |
| } | |
| int pkvm_init_el2_context(struct kvm *kvm) | |
| { | |
| int ret = 0; | |
| mutex_lock(&kvm->lock); | |
| ret = create_el2_shadow(kvm); | |
| mutex_unlock(&kvm->lock); | |
| if (ret < 0) { | |
| kvm_err("Creating shadow structures for protected VM failed: %d\n", | |
| ret); | |
| return ret; | |
| } | |
| kvm_pr_unimpl("Stage-2 protection is a work-in-progress: civilization phase III\n"); | |
| return 0; | |
| } |