19ed24f4bSMarc Zyngier // SPDX-License-Identifier: GPL-2.0-only 29ed24f4bSMarc Zyngier /* 39ed24f4bSMarc Zyngier * Copyright (C) 2012 - Virtual Open Systems and Columbia University 49ed24f4bSMarc Zyngier * Author: Christoffer Dall <c.dall@virtualopensystems.com> 59ed24f4bSMarc Zyngier */ 69ed24f4bSMarc Zyngier 79ed24f4bSMarc Zyngier #include <linux/bug.h> 89ed24f4bSMarc Zyngier #include <linux/cpu_pm.h> 96caa5812SOliver Upton #include <linux/entry-kvm.h> 109ed24f4bSMarc Zyngier #include <linux/errno.h> 119ed24f4bSMarc Zyngier #include <linux/err.h> 129ed24f4bSMarc Zyngier #include <linux/kvm_host.h> 139ed24f4bSMarc Zyngier #include <linux/list.h> 149ed24f4bSMarc Zyngier #include <linux/module.h> 159ed24f4bSMarc Zyngier #include <linux/vmalloc.h> 169ed24f4bSMarc Zyngier #include <linux/fs.h> 179ed24f4bSMarc Zyngier #include <linux/mman.h> 189ed24f4bSMarc Zyngier #include <linux/sched.h> 1947e6223cSMarc Zyngier #include <linux/kmemleak.h> 209ed24f4bSMarc Zyngier #include <linux/kvm.h> 219ed24f4bSMarc Zyngier #include <linux/kvm_irqfd.h> 229ed24f4bSMarc Zyngier #include <linux/irqbypass.h> 239ed24f4bSMarc Zyngier #include <linux/sched/stat.h> 24eeeee719SDavid Brazdil #include <linux/psci.h> 259ed24f4bSMarc Zyngier #include <trace/events/kvm.h> 269ed24f4bSMarc Zyngier 279ed24f4bSMarc Zyngier #define CREATE_TRACE_POINTS 289ed24f4bSMarc Zyngier #include "trace_arm.h" 299ed24f4bSMarc Zyngier 309ed24f4bSMarc Zyngier #include <linux/uaccess.h> 319ed24f4bSMarc Zyngier #include <asm/ptrace.h> 329ed24f4bSMarc Zyngier #include <asm/mman.h> 339ed24f4bSMarc Zyngier #include <asm/tlbflush.h> 349ed24f4bSMarc Zyngier #include <asm/cacheflush.h> 359ed24f4bSMarc Zyngier #include <asm/cpufeature.h> 369ed24f4bSMarc Zyngier #include <asm/virt.h> 379ed24f4bSMarc Zyngier #include <asm/kvm_arm.h> 389ed24f4bSMarc Zyngier #include <asm/kvm_asm.h> 399ed24f4bSMarc Zyngier #include <asm/kvm_mmu.h> 409ed24f4bSMarc Zyngier #include <asm/kvm_emulate.h> 419ed24f4bSMarc Zyngier #include <asm/sections.h> 429ed24f4bSMarc Zyngier 439ed24f4bSMarc Zyngier #include <kvm/arm_hypercalls.h> 449ed24f4bSMarc Zyngier #include <kvm/arm_pmu.h> 459ed24f4bSMarc Zyngier #include <kvm/arm_psci.h> 469ed24f4bSMarc Zyngier 47d8b369c4SDavid Brazdil static enum kvm_mode kvm_mode = KVM_MODE_DEFAULT; 48f19f6644SDavid Brazdil DEFINE_STATIC_KEY_FALSE(kvm_protected_mode_initialized); 49d8b369c4SDavid Brazdil 5014ef9d04SMarc Zyngier DECLARE_KVM_HYP_PER_CPU(unsigned long, kvm_hyp_vector); 5114ef9d04SMarc Zyngier 529ed24f4bSMarc Zyngier static DEFINE_PER_CPU(unsigned long, kvm_arm_hyp_stack_page); 5330c95391SDavid Brazdil unsigned long kvm_arm_hyp_percpu_base[NR_CPUS]; 5463fec243SDavid Brazdil DECLARE_KVM_NVHE_PER_CPU(struct kvm_nvhe_init_params, kvm_init_params); 559ed24f4bSMarc Zyngier 569ed24f4bSMarc Zyngier /* The VMID used in the VTTBR */ 579ed24f4bSMarc Zyngier static atomic64_t kvm_vmid_gen = ATOMIC64_INIT(1); 589ed24f4bSMarc Zyngier static u32 kvm_next_vmid; 599ed24f4bSMarc Zyngier static DEFINE_SPINLOCK(kvm_vmid_lock); 609ed24f4bSMarc Zyngier 619ed24f4bSMarc Zyngier static bool vgic_present; 629ed24f4bSMarc Zyngier 639ed24f4bSMarc Zyngier static DEFINE_PER_CPU(unsigned char, kvm_arm_hardware_enabled); 649ed24f4bSMarc Zyngier DEFINE_STATIC_KEY_FALSE(userspace_irqchip_in_use); 659ed24f4bSMarc Zyngier 669ed24f4bSMarc Zyngier int kvm_arch_vcpu_should_kick(struct kvm_vcpu *vcpu) 679ed24f4bSMarc Zyngier { 689ed24f4bSMarc Zyngier return kvm_vcpu_exiting_guest_mode(vcpu) == IN_GUEST_MODE; 699ed24f4bSMarc Zyngier } 709ed24f4bSMarc Zyngier 719ed24f4bSMarc Zyngier int kvm_arch_hardware_setup(void *opaque) 729ed24f4bSMarc Zyngier { 739ed24f4bSMarc Zyngier return 0; 749ed24f4bSMarc Zyngier } 759ed24f4bSMarc Zyngier 769ed24f4bSMarc Zyngier int kvm_arch_check_processor_compat(void *opaque) 779ed24f4bSMarc Zyngier { 789ed24f4bSMarc Zyngier return 0; 799ed24f4bSMarc Zyngier } 809ed24f4bSMarc Zyngier 819ed24f4bSMarc Zyngier int kvm_vm_ioctl_enable_cap(struct kvm *kvm, 829ed24f4bSMarc Zyngier struct kvm_enable_cap *cap) 839ed24f4bSMarc Zyngier { 849ed24f4bSMarc Zyngier int r; 859ed24f4bSMarc Zyngier 869ed24f4bSMarc Zyngier if (cap->flags) 879ed24f4bSMarc Zyngier return -EINVAL; 889ed24f4bSMarc Zyngier 899ed24f4bSMarc Zyngier switch (cap->cap) { 909ed24f4bSMarc Zyngier case KVM_CAP_ARM_NISV_TO_USER: 919ed24f4bSMarc Zyngier r = 0; 929ed24f4bSMarc Zyngier kvm->arch.return_nisv_io_abort_to_user = true; 939ed24f4bSMarc Zyngier break; 94673638f4SSteven Price case KVM_CAP_ARM_MTE: 95c4d7c518SSteven Price mutex_lock(&kvm->lock); 96c4d7c518SSteven Price if (!system_supports_mte() || kvm->created_vcpus) { 97c4d7c518SSteven Price r = -EINVAL; 98c4d7c518SSteven Price } else { 99673638f4SSteven Price r = 0; 100673638f4SSteven Price kvm->arch.mte_enabled = true; 101c4d7c518SSteven Price } 102c4d7c518SSteven Price mutex_unlock(&kvm->lock); 103673638f4SSteven Price break; 1049ed24f4bSMarc Zyngier default: 1059ed24f4bSMarc Zyngier r = -EINVAL; 1069ed24f4bSMarc Zyngier break; 1079ed24f4bSMarc Zyngier } 1089ed24f4bSMarc Zyngier 1099ed24f4bSMarc Zyngier return r; 1109ed24f4bSMarc Zyngier } 1119ed24f4bSMarc Zyngier 1125107000fSMarc Zyngier static int kvm_arm_default_max_vcpus(void) 1135107000fSMarc Zyngier { 1145107000fSMarc Zyngier return vgic_present ? kvm_vgic_get_max_vcpus() : KVM_MAX_VCPUS; 1155107000fSMarc Zyngier } 1165107000fSMarc Zyngier 1174f1df628SMarc Zyngier static void set_default_spectre(struct kvm *kvm) 11823711a5eSMarc Zyngier { 11923711a5eSMarc Zyngier /* 12023711a5eSMarc Zyngier * The default is to expose CSV2 == 1 if the HW isn't affected. 12123711a5eSMarc Zyngier * Although this is a per-CPU feature, we make it global because 12223711a5eSMarc Zyngier * asymmetric systems are just a nuisance. 12323711a5eSMarc Zyngier * 12423711a5eSMarc Zyngier * Userspace can override this as long as it doesn't promise 12523711a5eSMarc Zyngier * the impossible. 12623711a5eSMarc Zyngier */ 12723711a5eSMarc Zyngier if (arm64_get_spectre_v2_state() == SPECTRE_UNAFFECTED) 12823711a5eSMarc Zyngier kvm->arch.pfr0_csv2 = 1; 1294f1df628SMarc Zyngier if (arm64_get_meltdown_state() == SPECTRE_UNAFFECTED) 1304f1df628SMarc Zyngier kvm->arch.pfr0_csv3 = 1; 13123711a5eSMarc Zyngier } 13223711a5eSMarc Zyngier 1339ed24f4bSMarc Zyngier /** 1349ed24f4bSMarc Zyngier * kvm_arch_init_vm - initializes a VM data structure 1359ed24f4bSMarc Zyngier * @kvm: pointer to the KVM struct 1369ed24f4bSMarc Zyngier */ 1379ed24f4bSMarc Zyngier int kvm_arch_init_vm(struct kvm *kvm, unsigned long type) 1389ed24f4bSMarc Zyngier { 139a0e50aa3SChristoffer Dall int ret; 1409ed24f4bSMarc Zyngier 1419ed24f4bSMarc Zyngier ret = kvm_arm_setup_stage2(kvm, type); 1429ed24f4bSMarc Zyngier if (ret) 1439ed24f4bSMarc Zyngier return ret; 1449ed24f4bSMarc Zyngier 145a0e50aa3SChristoffer Dall ret = kvm_init_stage2_mmu(kvm, &kvm->arch.mmu); 1469ed24f4bSMarc Zyngier if (ret) 147a0e50aa3SChristoffer Dall return ret; 1489ed24f4bSMarc Zyngier 1499ed24f4bSMarc Zyngier ret = create_hyp_mappings(kvm, kvm + 1, PAGE_HYP); 1509ed24f4bSMarc Zyngier if (ret) 1519ed24f4bSMarc Zyngier goto out_free_stage2_pgd; 1529ed24f4bSMarc Zyngier 1539ed24f4bSMarc Zyngier kvm_vgic_early_init(kvm); 1549ed24f4bSMarc Zyngier 1559ed24f4bSMarc Zyngier /* The maximum number of VCPUs is limited by the host's GIC model */ 1565107000fSMarc Zyngier kvm->arch.max_vcpus = kvm_arm_default_max_vcpus(); 1579ed24f4bSMarc Zyngier 1584f1df628SMarc Zyngier set_default_spectre(kvm); 15923711a5eSMarc Zyngier 1609ed24f4bSMarc Zyngier return ret; 1619ed24f4bSMarc Zyngier out_free_stage2_pgd: 162a0e50aa3SChristoffer Dall kvm_free_stage2_pgd(&kvm->arch.mmu); 1639ed24f4bSMarc Zyngier return ret; 1649ed24f4bSMarc Zyngier } 1659ed24f4bSMarc Zyngier 1669ed24f4bSMarc Zyngier vm_fault_t kvm_arch_vcpu_fault(struct kvm_vcpu *vcpu, struct vm_fault *vmf) 1679ed24f4bSMarc Zyngier { 1689ed24f4bSMarc Zyngier return VM_FAULT_SIGBUS; 1699ed24f4bSMarc Zyngier } 1709ed24f4bSMarc Zyngier 1719ed24f4bSMarc Zyngier 1729ed24f4bSMarc Zyngier /** 1739ed24f4bSMarc Zyngier * kvm_arch_destroy_vm - destroy the VM data structure 1749ed24f4bSMarc Zyngier * @kvm: pointer to the KVM struct 1759ed24f4bSMarc Zyngier */ 1769ed24f4bSMarc Zyngier void kvm_arch_destroy_vm(struct kvm *kvm) 1779ed24f4bSMarc Zyngier { 1789ed24f4bSMarc Zyngier int i; 1799ed24f4bSMarc Zyngier 180d7eec236SMarc Zyngier bitmap_free(kvm->arch.pmu_filter); 181d7eec236SMarc Zyngier 1829ed24f4bSMarc Zyngier kvm_vgic_destroy(kvm); 1839ed24f4bSMarc Zyngier 1849ed24f4bSMarc Zyngier for (i = 0; i < KVM_MAX_VCPUS; ++i) { 1859ed24f4bSMarc Zyngier if (kvm->vcpus[i]) { 1869ed24f4bSMarc Zyngier kvm_vcpu_destroy(kvm->vcpus[i]); 1879ed24f4bSMarc Zyngier kvm->vcpus[i] = NULL; 1889ed24f4bSMarc Zyngier } 1899ed24f4bSMarc Zyngier } 1909ed24f4bSMarc Zyngier atomic_set(&kvm->online_vcpus, 0); 1919ed24f4bSMarc Zyngier } 1929ed24f4bSMarc Zyngier 1939ed24f4bSMarc Zyngier int kvm_vm_ioctl_check_extension(struct kvm *kvm, long ext) 1949ed24f4bSMarc Zyngier { 1959ed24f4bSMarc Zyngier int r; 1969ed24f4bSMarc Zyngier switch (ext) { 1979ed24f4bSMarc Zyngier case KVM_CAP_IRQCHIP: 1989ed24f4bSMarc Zyngier r = vgic_present; 1999ed24f4bSMarc Zyngier break; 2009ed24f4bSMarc Zyngier case KVM_CAP_IOEVENTFD: 2019ed24f4bSMarc Zyngier case KVM_CAP_DEVICE_CTRL: 2029ed24f4bSMarc Zyngier case KVM_CAP_USER_MEMORY: 2039ed24f4bSMarc Zyngier case KVM_CAP_SYNC_MMU: 2049ed24f4bSMarc Zyngier case KVM_CAP_DESTROY_MEMORY_REGION_WORKS: 2059ed24f4bSMarc Zyngier case KVM_CAP_ONE_REG: 2069ed24f4bSMarc Zyngier case KVM_CAP_ARM_PSCI: 2079ed24f4bSMarc Zyngier case KVM_CAP_ARM_PSCI_0_2: 2089ed24f4bSMarc Zyngier case KVM_CAP_READONLY_MEM: 2099ed24f4bSMarc Zyngier case KVM_CAP_MP_STATE: 2109ed24f4bSMarc Zyngier case KVM_CAP_IMMEDIATE_EXIT: 2119ed24f4bSMarc Zyngier case KVM_CAP_VCPU_EVENTS: 2129ed24f4bSMarc Zyngier case KVM_CAP_ARM_IRQ_LINE_LAYOUT_2: 2139ed24f4bSMarc Zyngier case KVM_CAP_ARM_NISV_TO_USER: 2149ed24f4bSMarc Zyngier case KVM_CAP_ARM_INJECT_EXT_DABT: 21536fb4cd5SWill Deacon case KVM_CAP_SET_GUEST_DEBUG: 21636fb4cd5SWill Deacon case KVM_CAP_VCPU_ATTRIBUTES: 2173bf72569SJianyong Wu case KVM_CAP_PTP_KVM: 2189ed24f4bSMarc Zyngier r = 1; 2199ed24f4bSMarc Zyngier break; 220fa18aca9SMaxim Levitsky case KVM_CAP_SET_GUEST_DEBUG2: 221fa18aca9SMaxim Levitsky return KVM_GUESTDBG_VALID_MASK; 2229ed24f4bSMarc Zyngier case KVM_CAP_ARM_SET_DEVICE_ADDR: 2239ed24f4bSMarc Zyngier r = 1; 2249ed24f4bSMarc Zyngier break; 2259ed24f4bSMarc Zyngier case KVM_CAP_NR_VCPUS: 2269ed24f4bSMarc Zyngier r = num_online_cpus(); 2279ed24f4bSMarc Zyngier break; 2289ed24f4bSMarc Zyngier case KVM_CAP_MAX_VCPUS: 2299ed24f4bSMarc Zyngier case KVM_CAP_MAX_VCPU_ID: 2305107000fSMarc Zyngier if (kvm) 2315107000fSMarc Zyngier r = kvm->arch.max_vcpus; 2325107000fSMarc Zyngier else 2335107000fSMarc Zyngier r = kvm_arm_default_max_vcpus(); 2349ed24f4bSMarc Zyngier break; 2359ed24f4bSMarc Zyngier case KVM_CAP_MSI_DEVID: 2369ed24f4bSMarc Zyngier if (!kvm) 2379ed24f4bSMarc Zyngier r = -EINVAL; 2389ed24f4bSMarc Zyngier else 2399ed24f4bSMarc Zyngier r = kvm->arch.vgic.msis_require_devid; 2409ed24f4bSMarc Zyngier break; 2419ed24f4bSMarc Zyngier case KVM_CAP_ARM_USER_IRQ: 2429ed24f4bSMarc Zyngier /* 2439ed24f4bSMarc Zyngier * 1: EL1_VTIMER, EL1_PTIMER, and PMU. 2449ed24f4bSMarc Zyngier * (bump this number if adding more devices) 2459ed24f4bSMarc Zyngier */ 2469ed24f4bSMarc Zyngier r = 1; 2479ed24f4bSMarc Zyngier break; 248673638f4SSteven Price case KVM_CAP_ARM_MTE: 249673638f4SSteven Price r = system_supports_mte(); 250673638f4SSteven Price break; 251004a0124SAndrew Jones case KVM_CAP_STEAL_TIME: 252004a0124SAndrew Jones r = kvm_arm_pvtime_supported(); 253004a0124SAndrew Jones break; 25436fb4cd5SWill Deacon case KVM_CAP_ARM_EL1_32BIT: 25536fb4cd5SWill Deacon r = cpus_have_const_cap(ARM64_HAS_32BIT_EL1); 2569ed24f4bSMarc Zyngier break; 25736fb4cd5SWill Deacon case KVM_CAP_GUEST_DEBUG_HW_BPS: 25836fb4cd5SWill Deacon r = get_num_brps(); 25936fb4cd5SWill Deacon break; 26036fb4cd5SWill Deacon case KVM_CAP_GUEST_DEBUG_HW_WPS: 26136fb4cd5SWill Deacon r = get_num_wrps(); 26236fb4cd5SWill Deacon break; 26336fb4cd5SWill Deacon case KVM_CAP_ARM_PMU_V3: 26436fb4cd5SWill Deacon r = kvm_arm_support_pmu_v3(); 26536fb4cd5SWill Deacon break; 26636fb4cd5SWill Deacon case KVM_CAP_ARM_INJECT_SERROR_ESR: 26736fb4cd5SWill Deacon r = cpus_have_const_cap(ARM64_HAS_RAS_EXTN); 26836fb4cd5SWill Deacon break; 26936fb4cd5SWill Deacon case KVM_CAP_ARM_VM_IPA_SIZE: 27036fb4cd5SWill Deacon r = get_kvm_ipa_limit(); 27136fb4cd5SWill Deacon break; 27236fb4cd5SWill Deacon case KVM_CAP_ARM_SVE: 27336fb4cd5SWill Deacon r = system_supports_sve(); 27436fb4cd5SWill Deacon break; 27536fb4cd5SWill Deacon case KVM_CAP_ARM_PTRAUTH_ADDRESS: 27636fb4cd5SWill Deacon case KVM_CAP_ARM_PTRAUTH_GENERIC: 27736fb4cd5SWill Deacon r = system_has_full_ptr_auth(); 27836fb4cd5SWill Deacon break; 27936fb4cd5SWill Deacon default: 28036fb4cd5SWill Deacon r = 0; 2819ed24f4bSMarc Zyngier } 28236fb4cd5SWill Deacon 2839ed24f4bSMarc Zyngier return r; 2849ed24f4bSMarc Zyngier } 2859ed24f4bSMarc Zyngier 2869ed24f4bSMarc Zyngier long kvm_arch_dev_ioctl(struct file *filp, 2879ed24f4bSMarc Zyngier unsigned int ioctl, unsigned long arg) 2889ed24f4bSMarc Zyngier { 2899ed24f4bSMarc Zyngier return -EINVAL; 2909ed24f4bSMarc Zyngier } 2919ed24f4bSMarc Zyngier 2929ed24f4bSMarc Zyngier struct kvm *kvm_arch_alloc_vm(void) 2939ed24f4bSMarc Zyngier { 2949ed24f4bSMarc Zyngier if (!has_vhe()) 2959ed24f4bSMarc Zyngier return kzalloc(sizeof(struct kvm), GFP_KERNEL); 2969ed24f4bSMarc Zyngier 2979ed24f4bSMarc Zyngier return vzalloc(sizeof(struct kvm)); 2989ed24f4bSMarc Zyngier } 2999ed24f4bSMarc Zyngier 3009ed24f4bSMarc Zyngier void kvm_arch_free_vm(struct kvm *kvm) 3019ed24f4bSMarc Zyngier { 3029ed24f4bSMarc Zyngier if (!has_vhe()) 3039ed24f4bSMarc Zyngier kfree(kvm); 3049ed24f4bSMarc Zyngier else 3059ed24f4bSMarc Zyngier vfree(kvm); 3069ed24f4bSMarc Zyngier } 3079ed24f4bSMarc Zyngier 3089ed24f4bSMarc Zyngier int kvm_arch_vcpu_precreate(struct kvm *kvm, unsigned int id) 3099ed24f4bSMarc Zyngier { 3109ed24f4bSMarc Zyngier if (irqchip_in_kernel(kvm) && vgic_initialized(kvm)) 3119ed24f4bSMarc Zyngier return -EBUSY; 3129ed24f4bSMarc Zyngier 3139ed24f4bSMarc Zyngier if (id >= kvm->arch.max_vcpus) 3149ed24f4bSMarc Zyngier return -EINVAL; 3159ed24f4bSMarc Zyngier 3169ed24f4bSMarc Zyngier return 0; 3179ed24f4bSMarc Zyngier } 3189ed24f4bSMarc Zyngier 3199ed24f4bSMarc Zyngier int kvm_arch_vcpu_create(struct kvm_vcpu *vcpu) 3209ed24f4bSMarc Zyngier { 3219ed24f4bSMarc Zyngier int err; 3229ed24f4bSMarc Zyngier 3239ed24f4bSMarc Zyngier /* Force users to call KVM_ARM_VCPU_INIT */ 3249ed24f4bSMarc Zyngier vcpu->arch.target = -1; 3259ed24f4bSMarc Zyngier bitmap_zero(vcpu->arch.features, KVM_VCPU_MAX_FEATURES); 3269ed24f4bSMarc Zyngier 327e539451bSSean Christopherson vcpu->arch.mmu_page_cache.gfp_zero = __GFP_ZERO; 328e539451bSSean Christopherson 3299ed24f4bSMarc Zyngier /* Set up the timer */ 3309ed24f4bSMarc Zyngier kvm_timer_vcpu_init(vcpu); 3319ed24f4bSMarc Zyngier 3329ed24f4bSMarc Zyngier kvm_pmu_vcpu_init(vcpu); 3339ed24f4bSMarc Zyngier 3349ed24f4bSMarc Zyngier kvm_arm_reset_debug_ptr(vcpu); 3359ed24f4bSMarc Zyngier 3369ed24f4bSMarc Zyngier kvm_arm_pvtime_vcpu_init(&vcpu->arch); 3379ed24f4bSMarc Zyngier 338a0e50aa3SChristoffer Dall vcpu->arch.hw_mmu = &vcpu->kvm->arch.mmu; 339a0e50aa3SChristoffer Dall 3409ed24f4bSMarc Zyngier err = kvm_vgic_vcpu_init(vcpu); 3419ed24f4bSMarc Zyngier if (err) 3429ed24f4bSMarc Zyngier return err; 3439ed24f4bSMarc Zyngier 3449ed24f4bSMarc Zyngier return create_hyp_mappings(vcpu, vcpu + 1, PAGE_HYP); 3459ed24f4bSMarc Zyngier } 3469ed24f4bSMarc Zyngier 3479ed24f4bSMarc Zyngier void kvm_arch_vcpu_postcreate(struct kvm_vcpu *vcpu) 3489ed24f4bSMarc Zyngier { 3499ed24f4bSMarc Zyngier } 3509ed24f4bSMarc Zyngier 3519ed24f4bSMarc Zyngier void kvm_arch_vcpu_destroy(struct kvm_vcpu *vcpu) 3529ed24f4bSMarc Zyngier { 3539ed24f4bSMarc Zyngier if (vcpu->arch.has_run_once && unlikely(!irqchip_in_kernel(vcpu->kvm))) 3549ed24f4bSMarc Zyngier static_branch_dec(&userspace_irqchip_in_use); 3559ed24f4bSMarc Zyngier 3569af3e08bSWill Deacon kvm_mmu_free_memory_cache(&vcpu->arch.mmu_page_cache); 3579ed24f4bSMarc Zyngier kvm_timer_vcpu_terminate(vcpu); 3589ed24f4bSMarc Zyngier kvm_pmu_vcpu_destroy(vcpu); 3599ed24f4bSMarc Zyngier 3609ed24f4bSMarc Zyngier kvm_arm_vcpu_destroy(vcpu); 3619ed24f4bSMarc Zyngier } 3629ed24f4bSMarc Zyngier 3639ed24f4bSMarc Zyngier int kvm_cpu_has_pending_timer(struct kvm_vcpu *vcpu) 3649ed24f4bSMarc Zyngier { 3659ed24f4bSMarc Zyngier return kvm_timer_is_pending(vcpu); 3669ed24f4bSMarc Zyngier } 3679ed24f4bSMarc Zyngier 3689ed24f4bSMarc Zyngier void kvm_arch_vcpu_blocking(struct kvm_vcpu *vcpu) 3699ed24f4bSMarc Zyngier { 3709ed24f4bSMarc Zyngier /* 3719ed24f4bSMarc Zyngier * If we're about to block (most likely because we've just hit a 3729ed24f4bSMarc Zyngier * WFI), we need to sync back the state of the GIC CPU interface 3739ed24f4bSMarc Zyngier * so that we have the latest PMR and group enables. This ensures 3749ed24f4bSMarc Zyngier * that kvm_arch_vcpu_runnable has up-to-date data to decide 3759ed24f4bSMarc Zyngier * whether we have pending interrupts. 3769ed24f4bSMarc Zyngier * 3779ed24f4bSMarc Zyngier * For the same reason, we want to tell GICv4 that we need 3789ed24f4bSMarc Zyngier * doorbells to be signalled, should an interrupt become pending. 3799ed24f4bSMarc Zyngier */ 3809ed24f4bSMarc Zyngier preempt_disable(); 3819ed24f4bSMarc Zyngier kvm_vgic_vmcr_sync(vcpu); 3829ed24f4bSMarc Zyngier vgic_v4_put(vcpu, true); 3839ed24f4bSMarc Zyngier preempt_enable(); 3849ed24f4bSMarc Zyngier } 3859ed24f4bSMarc Zyngier 3869ed24f4bSMarc Zyngier void kvm_arch_vcpu_unblocking(struct kvm_vcpu *vcpu) 3879ed24f4bSMarc Zyngier { 3889ed24f4bSMarc Zyngier preempt_disable(); 3899ed24f4bSMarc Zyngier vgic_v4_load(vcpu); 3909ed24f4bSMarc Zyngier preempt_enable(); 3919ed24f4bSMarc Zyngier } 3929ed24f4bSMarc Zyngier 3939ed24f4bSMarc Zyngier void kvm_arch_vcpu_load(struct kvm_vcpu *vcpu, int cpu) 3949ed24f4bSMarc Zyngier { 395a0e50aa3SChristoffer Dall struct kvm_s2_mmu *mmu; 3969ed24f4bSMarc Zyngier int *last_ran; 3979ed24f4bSMarc Zyngier 398a0e50aa3SChristoffer Dall mmu = vcpu->arch.hw_mmu; 399a0e50aa3SChristoffer Dall last_ran = this_cpu_ptr(mmu->last_vcpu_ran); 4009ed24f4bSMarc Zyngier 4019ed24f4bSMarc Zyngier /* 40201dc9262SMarc Zyngier * We guarantee that both TLBs and I-cache are private to each 40301dc9262SMarc Zyngier * vcpu. If detecting that a vcpu from the same VM has 40401dc9262SMarc Zyngier * previously run on the same physical CPU, call into the 40501dc9262SMarc Zyngier * hypervisor code to nuke the relevant contexts. 40601dc9262SMarc Zyngier * 4079ed24f4bSMarc Zyngier * We might get preempted before the vCPU actually runs, but 4089ed24f4bSMarc Zyngier * over-invalidation doesn't affect correctness. 4099ed24f4bSMarc Zyngier */ 4109ed24f4bSMarc Zyngier if (*last_ran != vcpu->vcpu_id) { 41101dc9262SMarc Zyngier kvm_call_hyp(__kvm_flush_cpu_context, mmu); 4129ed24f4bSMarc Zyngier *last_ran = vcpu->vcpu_id; 4139ed24f4bSMarc Zyngier } 4149ed24f4bSMarc Zyngier 4159ed24f4bSMarc Zyngier vcpu->cpu = cpu; 4169ed24f4bSMarc Zyngier 4179ed24f4bSMarc Zyngier kvm_vgic_load(vcpu); 4189ed24f4bSMarc Zyngier kvm_timer_vcpu_load(vcpu); 41913aeb9b4SDavid Brazdil if (has_vhe()) 42013aeb9b4SDavid Brazdil kvm_vcpu_load_sysregs_vhe(vcpu); 4219ed24f4bSMarc Zyngier kvm_arch_vcpu_load_fp(vcpu); 4229ed24f4bSMarc Zyngier kvm_vcpu_pmu_restore_guest(vcpu); 4239ed24f4bSMarc Zyngier if (kvm_arm_is_pvtime_enabled(&vcpu->arch)) 4249ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_RECORD_STEAL, vcpu); 4259ed24f4bSMarc Zyngier 4269ed24f4bSMarc Zyngier if (single_task_running()) 4279ed24f4bSMarc Zyngier vcpu_clear_wfx_traps(vcpu); 4289ed24f4bSMarc Zyngier else 4299ed24f4bSMarc Zyngier vcpu_set_wfx_traps(vcpu); 4309ed24f4bSMarc Zyngier 43129eb5a3cSMarc Zyngier if (vcpu_has_ptrauth(vcpu)) 432ef3e40a7SMarc Zyngier vcpu_ptrauth_disable(vcpu); 433d2602bb4SSuzuki K Poulose kvm_arch_vcpu_load_debug_state_flags(vcpu); 4349ed24f4bSMarc Zyngier } 4359ed24f4bSMarc Zyngier 4369ed24f4bSMarc Zyngier void kvm_arch_vcpu_put(struct kvm_vcpu *vcpu) 4379ed24f4bSMarc Zyngier { 438d2602bb4SSuzuki K Poulose kvm_arch_vcpu_put_debug_state_flags(vcpu); 4399ed24f4bSMarc Zyngier kvm_arch_vcpu_put_fp(vcpu); 44013aeb9b4SDavid Brazdil if (has_vhe()) 44113aeb9b4SDavid Brazdil kvm_vcpu_put_sysregs_vhe(vcpu); 4429ed24f4bSMarc Zyngier kvm_timer_vcpu_put(vcpu); 4439ed24f4bSMarc Zyngier kvm_vgic_put(vcpu); 4449ed24f4bSMarc Zyngier kvm_vcpu_pmu_restore_host(vcpu); 4459ed24f4bSMarc Zyngier 4469ed24f4bSMarc Zyngier vcpu->cpu = -1; 4479ed24f4bSMarc Zyngier } 4489ed24f4bSMarc Zyngier 4499ed24f4bSMarc Zyngier static void vcpu_power_off(struct kvm_vcpu *vcpu) 4509ed24f4bSMarc Zyngier { 4519ed24f4bSMarc Zyngier vcpu->arch.power_off = true; 4529ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_SLEEP, vcpu); 4539ed24f4bSMarc Zyngier kvm_vcpu_kick(vcpu); 4549ed24f4bSMarc Zyngier } 4559ed24f4bSMarc Zyngier 4569ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_get_mpstate(struct kvm_vcpu *vcpu, 4579ed24f4bSMarc Zyngier struct kvm_mp_state *mp_state) 4589ed24f4bSMarc Zyngier { 4599ed24f4bSMarc Zyngier if (vcpu->arch.power_off) 4609ed24f4bSMarc Zyngier mp_state->mp_state = KVM_MP_STATE_STOPPED; 4619ed24f4bSMarc Zyngier else 4629ed24f4bSMarc Zyngier mp_state->mp_state = KVM_MP_STATE_RUNNABLE; 4639ed24f4bSMarc Zyngier 4649ed24f4bSMarc Zyngier return 0; 4659ed24f4bSMarc Zyngier } 4669ed24f4bSMarc Zyngier 4679ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_set_mpstate(struct kvm_vcpu *vcpu, 4689ed24f4bSMarc Zyngier struct kvm_mp_state *mp_state) 4699ed24f4bSMarc Zyngier { 4709ed24f4bSMarc Zyngier int ret = 0; 4719ed24f4bSMarc Zyngier 4729ed24f4bSMarc Zyngier switch (mp_state->mp_state) { 4739ed24f4bSMarc Zyngier case KVM_MP_STATE_RUNNABLE: 4749ed24f4bSMarc Zyngier vcpu->arch.power_off = false; 4759ed24f4bSMarc Zyngier break; 4769ed24f4bSMarc Zyngier case KVM_MP_STATE_STOPPED: 4779ed24f4bSMarc Zyngier vcpu_power_off(vcpu); 4789ed24f4bSMarc Zyngier break; 4799ed24f4bSMarc Zyngier default: 4809ed24f4bSMarc Zyngier ret = -EINVAL; 4819ed24f4bSMarc Zyngier } 4829ed24f4bSMarc Zyngier 4839ed24f4bSMarc Zyngier return ret; 4849ed24f4bSMarc Zyngier } 4859ed24f4bSMarc Zyngier 4869ed24f4bSMarc Zyngier /** 4879ed24f4bSMarc Zyngier * kvm_arch_vcpu_runnable - determine if the vcpu can be scheduled 4889ed24f4bSMarc Zyngier * @v: The VCPU pointer 4899ed24f4bSMarc Zyngier * 4909ed24f4bSMarc Zyngier * If the guest CPU is not waiting for interrupts or an interrupt line is 4919ed24f4bSMarc Zyngier * asserted, the CPU is by definition runnable. 4929ed24f4bSMarc Zyngier */ 4939ed24f4bSMarc Zyngier int kvm_arch_vcpu_runnable(struct kvm_vcpu *v) 4949ed24f4bSMarc Zyngier { 4959ed24f4bSMarc Zyngier bool irq_lines = *vcpu_hcr(v) & (HCR_VI | HCR_VF); 4969ed24f4bSMarc Zyngier return ((irq_lines || kvm_vgic_vcpu_pending_irq(v)) 4979ed24f4bSMarc Zyngier && !v->arch.power_off && !v->arch.pause); 4989ed24f4bSMarc Zyngier } 4999ed24f4bSMarc Zyngier 5009ed24f4bSMarc Zyngier bool kvm_arch_vcpu_in_kernel(struct kvm_vcpu *vcpu) 5019ed24f4bSMarc Zyngier { 5029ed24f4bSMarc Zyngier return vcpu_mode_priv(vcpu); 5039ed24f4bSMarc Zyngier } 5049ed24f4bSMarc Zyngier 5059ed24f4bSMarc Zyngier /* Just ensure a guest exit from a particular CPU */ 5069ed24f4bSMarc Zyngier static void exit_vm_noop(void *info) 5079ed24f4bSMarc Zyngier { 5089ed24f4bSMarc Zyngier } 5099ed24f4bSMarc Zyngier 5109ed24f4bSMarc Zyngier void force_vm_exit(const cpumask_t *mask) 5119ed24f4bSMarc Zyngier { 5129ed24f4bSMarc Zyngier preempt_disable(); 5139ed24f4bSMarc Zyngier smp_call_function_many(mask, exit_vm_noop, NULL, true); 5149ed24f4bSMarc Zyngier preempt_enable(); 5159ed24f4bSMarc Zyngier } 5169ed24f4bSMarc Zyngier 5179ed24f4bSMarc Zyngier /** 5189ed24f4bSMarc Zyngier * need_new_vmid_gen - check that the VMID is still valid 5199ed24f4bSMarc Zyngier * @vmid: The VMID to check 5209ed24f4bSMarc Zyngier * 5219ed24f4bSMarc Zyngier * return true if there is a new generation of VMIDs being used 5229ed24f4bSMarc Zyngier * 5239ed24f4bSMarc Zyngier * The hardware supports a limited set of values with the value zero reserved 5249ed24f4bSMarc Zyngier * for the host, so we check if an assigned value belongs to a previous 525656012c7SFuad Tabba * generation, which requires us to assign a new value. If we're the first to 526656012c7SFuad Tabba * use a VMID for the new generation, we must flush necessary caches and TLBs 527656012c7SFuad Tabba * on all CPUs. 5289ed24f4bSMarc Zyngier */ 5299ed24f4bSMarc Zyngier static bool need_new_vmid_gen(struct kvm_vmid *vmid) 5309ed24f4bSMarc Zyngier { 5319ed24f4bSMarc Zyngier u64 current_vmid_gen = atomic64_read(&kvm_vmid_gen); 5329ed24f4bSMarc Zyngier smp_rmb(); /* Orders read of kvm_vmid_gen and kvm->arch.vmid */ 5339ed24f4bSMarc Zyngier return unlikely(READ_ONCE(vmid->vmid_gen) != current_vmid_gen); 5349ed24f4bSMarc Zyngier } 5359ed24f4bSMarc Zyngier 5369ed24f4bSMarc Zyngier /** 5379ed24f4bSMarc Zyngier * update_vmid - Update the vmid with a valid VMID for the current generation 5389ed24f4bSMarc Zyngier * @vmid: The stage-2 VMID information struct 5399ed24f4bSMarc Zyngier */ 5409ed24f4bSMarc Zyngier static void update_vmid(struct kvm_vmid *vmid) 5419ed24f4bSMarc Zyngier { 5429ed24f4bSMarc Zyngier if (!need_new_vmid_gen(vmid)) 5439ed24f4bSMarc Zyngier return; 5449ed24f4bSMarc Zyngier 5459ed24f4bSMarc Zyngier spin_lock(&kvm_vmid_lock); 5469ed24f4bSMarc Zyngier 5479ed24f4bSMarc Zyngier /* 5489ed24f4bSMarc Zyngier * We need to re-check the vmid_gen here to ensure that if another vcpu 5499ed24f4bSMarc Zyngier * already allocated a valid vmid for this vm, then this vcpu should 5509ed24f4bSMarc Zyngier * use the same vmid. 5519ed24f4bSMarc Zyngier */ 5529ed24f4bSMarc Zyngier if (!need_new_vmid_gen(vmid)) { 5539ed24f4bSMarc Zyngier spin_unlock(&kvm_vmid_lock); 5549ed24f4bSMarc Zyngier return; 5559ed24f4bSMarc Zyngier } 5569ed24f4bSMarc Zyngier 5579ed24f4bSMarc Zyngier /* First user of a new VMID generation? */ 5589ed24f4bSMarc Zyngier if (unlikely(kvm_next_vmid == 0)) { 5599ed24f4bSMarc Zyngier atomic64_inc(&kvm_vmid_gen); 5609ed24f4bSMarc Zyngier kvm_next_vmid = 1; 5619ed24f4bSMarc Zyngier 5629ed24f4bSMarc Zyngier /* 5639ed24f4bSMarc Zyngier * On SMP we know no other CPUs can use this CPU's or each 5649ed24f4bSMarc Zyngier * other's VMID after force_vm_exit returns since the 5659ed24f4bSMarc Zyngier * kvm_vmid_lock blocks them from reentry to the guest. 5669ed24f4bSMarc Zyngier */ 5679ed24f4bSMarc Zyngier force_vm_exit(cpu_all_mask); 5689ed24f4bSMarc Zyngier /* 5699ed24f4bSMarc Zyngier * Now broadcast TLB + ICACHE invalidation over the inner 5709ed24f4bSMarc Zyngier * shareable domain to make sure all data structures are 5719ed24f4bSMarc Zyngier * clean. 5729ed24f4bSMarc Zyngier */ 5739ed24f4bSMarc Zyngier kvm_call_hyp(__kvm_flush_vm_context); 5749ed24f4bSMarc Zyngier } 5759ed24f4bSMarc Zyngier 576cf364e08SMarc Zyngier WRITE_ONCE(vmid->vmid, kvm_next_vmid); 5779ed24f4bSMarc Zyngier kvm_next_vmid++; 5789ed24f4bSMarc Zyngier kvm_next_vmid &= (1 << kvm_get_vmid_bits()) - 1; 5799ed24f4bSMarc Zyngier 5809ed24f4bSMarc Zyngier smp_wmb(); 5819ed24f4bSMarc Zyngier WRITE_ONCE(vmid->vmid_gen, atomic64_read(&kvm_vmid_gen)); 5829ed24f4bSMarc Zyngier 5839ed24f4bSMarc Zyngier spin_unlock(&kvm_vmid_lock); 5849ed24f4bSMarc Zyngier } 5859ed24f4bSMarc Zyngier 5869ed24f4bSMarc Zyngier static int kvm_vcpu_first_run_init(struct kvm_vcpu *vcpu) 5879ed24f4bSMarc Zyngier { 5889ed24f4bSMarc Zyngier struct kvm *kvm = vcpu->kvm; 5899ed24f4bSMarc Zyngier int ret = 0; 5909ed24f4bSMarc Zyngier 5919ed24f4bSMarc Zyngier if (likely(vcpu->arch.has_run_once)) 5929ed24f4bSMarc Zyngier return 0; 5939ed24f4bSMarc Zyngier 5949ed24f4bSMarc Zyngier if (!kvm_arm_vcpu_is_finalized(vcpu)) 5959ed24f4bSMarc Zyngier return -EPERM; 5969ed24f4bSMarc Zyngier 5979ed24f4bSMarc Zyngier vcpu->arch.has_run_once = true; 5989ed24f4bSMarc Zyngier 599263d6287SAlexandru Elisei kvm_arm_vcpu_init_debug(vcpu); 600263d6287SAlexandru Elisei 6019ed24f4bSMarc Zyngier if (likely(irqchip_in_kernel(kvm))) { 6029ed24f4bSMarc Zyngier /* 6039ed24f4bSMarc Zyngier * Map the VGIC hardware resources before running a vcpu the 6049ed24f4bSMarc Zyngier * first time on this VM. 6059ed24f4bSMarc Zyngier */ 6069ed24f4bSMarc Zyngier ret = kvm_vgic_map_resources(kvm); 6079ed24f4bSMarc Zyngier if (ret) 6089ed24f4bSMarc Zyngier return ret; 6099ed24f4bSMarc Zyngier } else { 6109ed24f4bSMarc Zyngier /* 6119ed24f4bSMarc Zyngier * Tell the rest of the code that there are userspace irqchip 6129ed24f4bSMarc Zyngier * VMs in the wild. 6139ed24f4bSMarc Zyngier */ 6149ed24f4bSMarc Zyngier static_branch_inc(&userspace_irqchip_in_use); 6159ed24f4bSMarc Zyngier } 6169ed24f4bSMarc Zyngier 6179ed24f4bSMarc Zyngier ret = kvm_timer_enable(vcpu); 6189ed24f4bSMarc Zyngier if (ret) 6199ed24f4bSMarc Zyngier return ret; 6209ed24f4bSMarc Zyngier 6219ed24f4bSMarc Zyngier ret = kvm_arm_pmu_v3_enable(vcpu); 6229ed24f4bSMarc Zyngier 623*2a0c3433SFuad Tabba /* 624*2a0c3433SFuad Tabba * Initialize traps for protected VMs. 625*2a0c3433SFuad Tabba * NOTE: Move to run in EL2 directly, rather than via a hypercall, once 626*2a0c3433SFuad Tabba * the code is in place for first run initialization at EL2. 627*2a0c3433SFuad Tabba */ 628*2a0c3433SFuad Tabba if (kvm_vm_is_protected(kvm)) 629*2a0c3433SFuad Tabba kvm_call_hyp_nvhe(__pkvm_vcpu_init_traps, vcpu); 630*2a0c3433SFuad Tabba 6319ed24f4bSMarc Zyngier return ret; 6329ed24f4bSMarc Zyngier } 6339ed24f4bSMarc Zyngier 6349ed24f4bSMarc Zyngier bool kvm_arch_intc_initialized(struct kvm *kvm) 6359ed24f4bSMarc Zyngier { 6369ed24f4bSMarc Zyngier return vgic_initialized(kvm); 6379ed24f4bSMarc Zyngier } 6389ed24f4bSMarc Zyngier 6399ed24f4bSMarc Zyngier void kvm_arm_halt_guest(struct kvm *kvm) 6409ed24f4bSMarc Zyngier { 6419ed24f4bSMarc Zyngier int i; 6429ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 6439ed24f4bSMarc Zyngier 6449ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) 6459ed24f4bSMarc Zyngier vcpu->arch.pause = true; 6469ed24f4bSMarc Zyngier kvm_make_all_cpus_request(kvm, KVM_REQ_SLEEP); 6479ed24f4bSMarc Zyngier } 6489ed24f4bSMarc Zyngier 6499ed24f4bSMarc Zyngier void kvm_arm_resume_guest(struct kvm *kvm) 6509ed24f4bSMarc Zyngier { 6519ed24f4bSMarc Zyngier int i; 6529ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 6539ed24f4bSMarc Zyngier 6549ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) { 6559ed24f4bSMarc Zyngier vcpu->arch.pause = false; 65638060944SPaolo Bonzini rcuwait_wake_up(kvm_arch_vcpu_get_wait(vcpu)); 6579ed24f4bSMarc Zyngier } 6589ed24f4bSMarc Zyngier } 6599ed24f4bSMarc Zyngier 6609ed24f4bSMarc Zyngier static void vcpu_req_sleep(struct kvm_vcpu *vcpu) 6619ed24f4bSMarc Zyngier { 66238060944SPaolo Bonzini struct rcuwait *wait = kvm_arch_vcpu_get_wait(vcpu); 6639ed24f4bSMarc Zyngier 66438060944SPaolo Bonzini rcuwait_wait_event(wait, 66538060944SPaolo Bonzini (!vcpu->arch.power_off) &&(!vcpu->arch.pause), 66638060944SPaolo Bonzini TASK_INTERRUPTIBLE); 6679ed24f4bSMarc Zyngier 6689ed24f4bSMarc Zyngier if (vcpu->arch.power_off || vcpu->arch.pause) { 6699ed24f4bSMarc Zyngier /* Awaken to handle a signal, request we sleep again later. */ 6709ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_SLEEP, vcpu); 6719ed24f4bSMarc Zyngier } 6729ed24f4bSMarc Zyngier 6739ed24f4bSMarc Zyngier /* 6749ed24f4bSMarc Zyngier * Make sure we will observe a potential reset request if we've 6759ed24f4bSMarc Zyngier * observed a change to the power state. Pairs with the smp_wmb() in 6769ed24f4bSMarc Zyngier * kvm_psci_vcpu_on(). 6779ed24f4bSMarc Zyngier */ 6789ed24f4bSMarc Zyngier smp_rmb(); 6799ed24f4bSMarc Zyngier } 6809ed24f4bSMarc Zyngier 6819ed24f4bSMarc Zyngier static int kvm_vcpu_initialized(struct kvm_vcpu *vcpu) 6829ed24f4bSMarc Zyngier { 6839ed24f4bSMarc Zyngier return vcpu->arch.target >= 0; 6849ed24f4bSMarc Zyngier } 6859ed24f4bSMarc Zyngier 6869ed24f4bSMarc Zyngier static void check_vcpu_requests(struct kvm_vcpu *vcpu) 6879ed24f4bSMarc Zyngier { 6889ed24f4bSMarc Zyngier if (kvm_request_pending(vcpu)) { 6899ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_SLEEP, vcpu)) 6909ed24f4bSMarc Zyngier vcpu_req_sleep(vcpu); 6919ed24f4bSMarc Zyngier 6929ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu)) 6939ed24f4bSMarc Zyngier kvm_reset_vcpu(vcpu); 6949ed24f4bSMarc Zyngier 6959ed24f4bSMarc Zyngier /* 6969ed24f4bSMarc Zyngier * Clear IRQ_PENDING requests that were made to guarantee 6979ed24f4bSMarc Zyngier * that a VCPU sees new virtual interrupts. 6989ed24f4bSMarc Zyngier */ 6999ed24f4bSMarc Zyngier kvm_check_request(KVM_REQ_IRQ_PENDING, vcpu); 7009ed24f4bSMarc Zyngier 7019ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_RECORD_STEAL, vcpu)) 7029ed24f4bSMarc Zyngier kvm_update_stolen_time(vcpu); 7039ed24f4bSMarc Zyngier 7049ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_RELOAD_GICv4, vcpu)) { 7059ed24f4bSMarc Zyngier /* The distributor enable bits were changed */ 7069ed24f4bSMarc Zyngier preempt_disable(); 7079ed24f4bSMarc Zyngier vgic_v4_put(vcpu, false); 7089ed24f4bSMarc Zyngier vgic_v4_load(vcpu); 7099ed24f4bSMarc Zyngier preempt_enable(); 7109ed24f4bSMarc Zyngier } 711d0c94c49SMarc Zyngier 712d0c94c49SMarc Zyngier if (kvm_check_request(KVM_REQ_RELOAD_PMU, vcpu)) 713d0c94c49SMarc Zyngier kvm_pmu_handle_pmcr(vcpu, 714d0c94c49SMarc Zyngier __vcpu_sys_reg(vcpu, PMCR_EL0)); 7159ed24f4bSMarc Zyngier } 7169ed24f4bSMarc Zyngier } 7179ed24f4bSMarc Zyngier 7182f6a49bbSWill Deacon static bool vcpu_mode_is_bad_32bit(struct kvm_vcpu *vcpu) 7192f6a49bbSWill Deacon { 7202f6a49bbSWill Deacon if (likely(!vcpu_mode_is_32bit(vcpu))) 7212f6a49bbSWill Deacon return false; 7222f6a49bbSWill Deacon 7232f6a49bbSWill Deacon return !system_supports_32bit_el0() || 7242f6a49bbSWill Deacon static_branch_unlikely(&arm64_mismatched_32bit_el0); 7252f6a49bbSWill Deacon } 7262f6a49bbSWill Deacon 7279ed24f4bSMarc Zyngier /** 7286caa5812SOliver Upton * kvm_vcpu_exit_request - returns true if the VCPU should *not* enter the guest 7296caa5812SOliver Upton * @vcpu: The VCPU pointer 7306caa5812SOliver Upton * @ret: Pointer to write optional return code 7316caa5812SOliver Upton * 7326caa5812SOliver Upton * Returns: true if the VCPU needs to return to a preemptible + interruptible 7336caa5812SOliver Upton * and skip guest entry. 7346caa5812SOliver Upton * 7356caa5812SOliver Upton * This function disambiguates between two different types of exits: exits to a 7366caa5812SOliver Upton * preemptible + interruptible kernel context and exits to userspace. For an 7376caa5812SOliver Upton * exit to userspace, this function will write the return code to ret and return 7386caa5812SOliver Upton * true. For an exit to preemptible + interruptible kernel context (i.e. check 7396caa5812SOliver Upton * for pending work and re-enter), return true without writing to ret. 7406caa5812SOliver Upton */ 7416caa5812SOliver Upton static bool kvm_vcpu_exit_request(struct kvm_vcpu *vcpu, int *ret) 7426caa5812SOliver Upton { 7436caa5812SOliver Upton struct kvm_run *run = vcpu->run; 7446caa5812SOliver Upton 7456caa5812SOliver Upton /* 7466caa5812SOliver Upton * If we're using a userspace irqchip, then check if we need 7476caa5812SOliver Upton * to tell a userspace irqchip about timer or PMU level 7486caa5812SOliver Upton * changes and if so, exit to userspace (the actual level 7496caa5812SOliver Upton * state gets updated in kvm_timer_update_run and 7506caa5812SOliver Upton * kvm_pmu_update_run below). 7516caa5812SOliver Upton */ 7526caa5812SOliver Upton if (static_branch_unlikely(&userspace_irqchip_in_use)) { 7536caa5812SOliver Upton if (kvm_timer_should_notify_user(vcpu) || 7546caa5812SOliver Upton kvm_pmu_should_notify_user(vcpu)) { 7556caa5812SOliver Upton *ret = -EINTR; 7566caa5812SOliver Upton run->exit_reason = KVM_EXIT_INTR; 7576caa5812SOliver Upton return true; 7586caa5812SOliver Upton } 7596caa5812SOliver Upton } 7606caa5812SOliver Upton 7616caa5812SOliver Upton return kvm_request_pending(vcpu) || 7626caa5812SOliver Upton need_new_vmid_gen(&vcpu->arch.hw_mmu->vmid) || 7636caa5812SOliver Upton xfer_to_guest_mode_work_pending(); 7646caa5812SOliver Upton } 7656caa5812SOliver Upton 7666caa5812SOliver Upton /** 7679ed24f4bSMarc Zyngier * kvm_arch_vcpu_ioctl_run - the main VCPU run function to execute guest code 7689ed24f4bSMarc Zyngier * @vcpu: The VCPU pointer 7699ed24f4bSMarc Zyngier * 7709ed24f4bSMarc Zyngier * This function is called through the VCPU_RUN ioctl called from user space. It 7719ed24f4bSMarc Zyngier * will execute VM code in a loop until the time slice for the process is used 7729ed24f4bSMarc Zyngier * or some emulation is needed from user space in which case the function will 7739ed24f4bSMarc Zyngier * return with return value 0 and with the kvm_run structure filled in with the 7749ed24f4bSMarc Zyngier * required data for the requested emulation. 7759ed24f4bSMarc Zyngier */ 77638060944SPaolo Bonzini int kvm_arch_vcpu_ioctl_run(struct kvm_vcpu *vcpu) 7779ed24f4bSMarc Zyngier { 77838060944SPaolo Bonzini struct kvm_run *run = vcpu->run; 7799ed24f4bSMarc Zyngier int ret; 7809ed24f4bSMarc Zyngier 7819ed24f4bSMarc Zyngier if (unlikely(!kvm_vcpu_initialized(vcpu))) 7829ed24f4bSMarc Zyngier return -ENOEXEC; 7839ed24f4bSMarc Zyngier 7849ed24f4bSMarc Zyngier ret = kvm_vcpu_first_run_init(vcpu); 7859ed24f4bSMarc Zyngier if (ret) 7869ed24f4bSMarc Zyngier return ret; 7879ed24f4bSMarc Zyngier 7889ed24f4bSMarc Zyngier if (run->exit_reason == KVM_EXIT_MMIO) { 78974cc7e0cSTianjia Zhang ret = kvm_handle_mmio_return(vcpu); 7909ed24f4bSMarc Zyngier if (ret) 7919ed24f4bSMarc Zyngier return ret; 7929ed24f4bSMarc Zyngier } 7939ed24f4bSMarc Zyngier 7949ed24f4bSMarc Zyngier vcpu_load(vcpu); 7959ed24f4bSMarc Zyngier 796e3e880bbSZenghui Yu if (run->immediate_exit) { 797e3e880bbSZenghui Yu ret = -EINTR; 798e3e880bbSZenghui Yu goto out; 799e3e880bbSZenghui Yu } 800e3e880bbSZenghui Yu 8019ed24f4bSMarc Zyngier kvm_sigset_activate(vcpu); 8029ed24f4bSMarc Zyngier 8039ed24f4bSMarc Zyngier ret = 1; 8049ed24f4bSMarc Zyngier run->exit_reason = KVM_EXIT_UNKNOWN; 8059ed24f4bSMarc Zyngier while (ret > 0) { 8069ed24f4bSMarc Zyngier /* 8079ed24f4bSMarc Zyngier * Check conditions before entering the guest 8089ed24f4bSMarc Zyngier */ 8096caa5812SOliver Upton ret = xfer_to_guest_mode_handle_work(vcpu); 8106caa5812SOliver Upton if (!ret) 8116caa5812SOliver Upton ret = 1; 8129ed24f4bSMarc Zyngier 813a0e50aa3SChristoffer Dall update_vmid(&vcpu->arch.hw_mmu->vmid); 8149ed24f4bSMarc Zyngier 8159ed24f4bSMarc Zyngier check_vcpu_requests(vcpu); 8169ed24f4bSMarc Zyngier 8179ed24f4bSMarc Zyngier /* 8189ed24f4bSMarc Zyngier * Preparing the interrupts to be injected also 8199ed24f4bSMarc Zyngier * involves poking the GIC, which must be done in a 8209ed24f4bSMarc Zyngier * non-preemptible context. 8219ed24f4bSMarc Zyngier */ 8229ed24f4bSMarc Zyngier preempt_disable(); 8239ed24f4bSMarc Zyngier 8249ed24f4bSMarc Zyngier kvm_pmu_flush_hwstate(vcpu); 8259ed24f4bSMarc Zyngier 8269ed24f4bSMarc Zyngier local_irq_disable(); 8279ed24f4bSMarc Zyngier 8289ed24f4bSMarc Zyngier kvm_vgic_flush_hwstate(vcpu); 8299ed24f4bSMarc Zyngier 8309ed24f4bSMarc Zyngier /* 8319ed24f4bSMarc Zyngier * Ensure we set mode to IN_GUEST_MODE after we disable 8329ed24f4bSMarc Zyngier * interrupts and before the final VCPU requests check. 8339ed24f4bSMarc Zyngier * See the comment in kvm_vcpu_exiting_guest_mode() and 8349ed24f4bSMarc Zyngier * Documentation/virt/kvm/vcpu-requests.rst 8359ed24f4bSMarc Zyngier */ 8369ed24f4bSMarc Zyngier smp_store_mb(vcpu->mode, IN_GUEST_MODE); 8379ed24f4bSMarc Zyngier 8386caa5812SOliver Upton if (ret <= 0 || kvm_vcpu_exit_request(vcpu, &ret)) { 8399ed24f4bSMarc Zyngier vcpu->mode = OUTSIDE_GUEST_MODE; 8409ed24f4bSMarc Zyngier isb(); /* Ensure work in x_flush_hwstate is committed */ 8419ed24f4bSMarc Zyngier kvm_pmu_sync_hwstate(vcpu); 8429ed24f4bSMarc Zyngier if (static_branch_unlikely(&userspace_irqchip_in_use)) 8433c5ff0c6SMarc Zyngier kvm_timer_sync_user(vcpu); 8449ed24f4bSMarc Zyngier kvm_vgic_sync_hwstate(vcpu); 8459ed24f4bSMarc Zyngier local_irq_enable(); 8469ed24f4bSMarc Zyngier preempt_enable(); 8479ed24f4bSMarc Zyngier continue; 8489ed24f4bSMarc Zyngier } 8499ed24f4bSMarc Zyngier 8509ed24f4bSMarc Zyngier kvm_arm_setup_debug(vcpu); 8519ed24f4bSMarc Zyngier 8529ed24f4bSMarc Zyngier /************************************************************** 8539ed24f4bSMarc Zyngier * Enter the guest 8549ed24f4bSMarc Zyngier */ 8559ed24f4bSMarc Zyngier trace_kvm_entry(*vcpu_pc(vcpu)); 8569ed24f4bSMarc Zyngier guest_enter_irqoff(); 8579ed24f4bSMarc Zyngier 85809cf57ebSDavid Brazdil ret = kvm_call_hyp_ret(__kvm_vcpu_run, vcpu); 8599ed24f4bSMarc Zyngier 8609ed24f4bSMarc Zyngier vcpu->mode = OUTSIDE_GUEST_MODE; 8619ed24f4bSMarc Zyngier vcpu->stat.exits++; 8629ed24f4bSMarc Zyngier /* 8639ed24f4bSMarc Zyngier * Back from guest 8649ed24f4bSMarc Zyngier *************************************************************/ 8659ed24f4bSMarc Zyngier 8669ed24f4bSMarc Zyngier kvm_arm_clear_debug(vcpu); 8679ed24f4bSMarc Zyngier 8689ed24f4bSMarc Zyngier /* 8699ed24f4bSMarc Zyngier * We must sync the PMU state before the vgic state so 8709ed24f4bSMarc Zyngier * that the vgic can properly sample the updated state of the 8719ed24f4bSMarc Zyngier * interrupt line. 8729ed24f4bSMarc Zyngier */ 8739ed24f4bSMarc Zyngier kvm_pmu_sync_hwstate(vcpu); 8749ed24f4bSMarc Zyngier 8759ed24f4bSMarc Zyngier /* 8769ed24f4bSMarc Zyngier * Sync the vgic state before syncing the timer state because 8779ed24f4bSMarc Zyngier * the timer code needs to know if the virtual timer 8789ed24f4bSMarc Zyngier * interrupts are active. 8799ed24f4bSMarc Zyngier */ 8809ed24f4bSMarc Zyngier kvm_vgic_sync_hwstate(vcpu); 8819ed24f4bSMarc Zyngier 8829ed24f4bSMarc Zyngier /* 8839ed24f4bSMarc Zyngier * Sync the timer hardware state before enabling interrupts as 8849ed24f4bSMarc Zyngier * we don't want vtimer interrupts to race with syncing the 8859ed24f4bSMarc Zyngier * timer virtual interrupt state. 8869ed24f4bSMarc Zyngier */ 8879ed24f4bSMarc Zyngier if (static_branch_unlikely(&userspace_irqchip_in_use)) 8883c5ff0c6SMarc Zyngier kvm_timer_sync_user(vcpu); 8899ed24f4bSMarc Zyngier 8909ed24f4bSMarc Zyngier kvm_arch_vcpu_ctxsync_fp(vcpu); 8919ed24f4bSMarc Zyngier 8929ed24f4bSMarc Zyngier /* 8939ed24f4bSMarc Zyngier * We may have taken a host interrupt in HYP mode (ie 8949ed24f4bSMarc Zyngier * while executing the guest). This interrupt is still 8959ed24f4bSMarc Zyngier * pending, as we haven't serviced it yet! 8969ed24f4bSMarc Zyngier * 8979ed24f4bSMarc Zyngier * We're now back in SVC mode, with interrupts 8989ed24f4bSMarc Zyngier * disabled. Enabling the interrupts now will have 8999ed24f4bSMarc Zyngier * the effect of taking the interrupt again, in SVC 9009ed24f4bSMarc Zyngier * mode this time. 9019ed24f4bSMarc Zyngier */ 9029ed24f4bSMarc Zyngier local_irq_enable(); 9039ed24f4bSMarc Zyngier 9049ed24f4bSMarc Zyngier /* 9059ed24f4bSMarc Zyngier * We do local_irq_enable() before calling guest_exit() so 9069ed24f4bSMarc Zyngier * that if a timer interrupt hits while running the guest we 9079ed24f4bSMarc Zyngier * account that tick as being spent in the guest. We enable 9089ed24f4bSMarc Zyngier * preemption after calling guest_exit() so that if we get 9099ed24f4bSMarc Zyngier * preempted we make sure ticks after that is not counted as 9109ed24f4bSMarc Zyngier * guest time. 9119ed24f4bSMarc Zyngier */ 9129ed24f4bSMarc Zyngier guest_exit(); 9139ed24f4bSMarc Zyngier trace_kvm_exit(ret, kvm_vcpu_trap_get_class(vcpu), *vcpu_pc(vcpu)); 9149ed24f4bSMarc Zyngier 9159ed24f4bSMarc Zyngier /* Exit types that need handling before we can be preempted */ 91674cc7e0cSTianjia Zhang handle_exit_early(vcpu, ret); 9179ed24f4bSMarc Zyngier 9189ed24f4bSMarc Zyngier preempt_enable(); 9199ed24f4bSMarc Zyngier 92022f55384SQais Yousef /* 92122f55384SQais Yousef * The ARMv8 architecture doesn't give the hypervisor 92222f55384SQais Yousef * a mechanism to prevent a guest from dropping to AArch32 EL0 92322f55384SQais Yousef * if implemented by the CPU. If we spot the guest in such 92422f55384SQais Yousef * state and that we decided it wasn't supposed to do so (like 92522f55384SQais Yousef * with the asymmetric AArch32 case), return to userspace with 92622f55384SQais Yousef * a fatal error. 92722f55384SQais Yousef */ 9282f6a49bbSWill Deacon if (vcpu_mode_is_bad_32bit(vcpu)) { 92922f55384SQais Yousef /* 93022f55384SQais Yousef * As we have caught the guest red-handed, decide that 93122f55384SQais Yousef * it isn't fit for purpose anymore by making the vcpu 93222f55384SQais Yousef * invalid. The VMM can try and fix it by issuing a 93322f55384SQais Yousef * KVM_ARM_VCPU_INIT if it really wants to. 93422f55384SQais Yousef */ 93522f55384SQais Yousef vcpu->arch.target = -1; 93622f55384SQais Yousef ret = ARM_EXCEPTION_IL; 93722f55384SQais Yousef } 93822f55384SQais Yousef 93974cc7e0cSTianjia Zhang ret = handle_exit(vcpu, ret); 9409ed24f4bSMarc Zyngier } 9419ed24f4bSMarc Zyngier 9429ed24f4bSMarc Zyngier /* Tell userspace about in-kernel device output levels */ 9439ed24f4bSMarc Zyngier if (unlikely(!irqchip_in_kernel(vcpu->kvm))) { 9449ed24f4bSMarc Zyngier kvm_timer_update_run(vcpu); 9459ed24f4bSMarc Zyngier kvm_pmu_update_run(vcpu); 9469ed24f4bSMarc Zyngier } 9479ed24f4bSMarc Zyngier 9489ed24f4bSMarc Zyngier kvm_sigset_deactivate(vcpu); 9499ed24f4bSMarc Zyngier 950e3e880bbSZenghui Yu out: 95126778aaaSMarc Zyngier /* 95226778aaaSMarc Zyngier * In the unlikely event that we are returning to userspace 95326778aaaSMarc Zyngier * with pending exceptions or PC adjustment, commit these 95426778aaaSMarc Zyngier * adjustments in order to give userspace a consistent view of 95526778aaaSMarc Zyngier * the vcpu state. Note that this relies on __kvm_adjust_pc() 95626778aaaSMarc Zyngier * being preempt-safe on VHE. 95726778aaaSMarc Zyngier */ 95826778aaaSMarc Zyngier if (unlikely(vcpu->arch.flags & (KVM_ARM64_PENDING_EXCEPTION | 95926778aaaSMarc Zyngier KVM_ARM64_INCREMENT_PC))) 96026778aaaSMarc Zyngier kvm_call_hyp(__kvm_adjust_pc, vcpu); 96126778aaaSMarc Zyngier 9629ed24f4bSMarc Zyngier vcpu_put(vcpu); 9639ed24f4bSMarc Zyngier return ret; 9649ed24f4bSMarc Zyngier } 9659ed24f4bSMarc Zyngier 9669ed24f4bSMarc Zyngier static int vcpu_interrupt_line(struct kvm_vcpu *vcpu, int number, bool level) 9679ed24f4bSMarc Zyngier { 9689ed24f4bSMarc Zyngier int bit_index; 9699ed24f4bSMarc Zyngier bool set; 9709ed24f4bSMarc Zyngier unsigned long *hcr; 9719ed24f4bSMarc Zyngier 9729ed24f4bSMarc Zyngier if (number == KVM_ARM_IRQ_CPU_IRQ) 9739ed24f4bSMarc Zyngier bit_index = __ffs(HCR_VI); 9749ed24f4bSMarc Zyngier else /* KVM_ARM_IRQ_CPU_FIQ */ 9759ed24f4bSMarc Zyngier bit_index = __ffs(HCR_VF); 9769ed24f4bSMarc Zyngier 9779ed24f4bSMarc Zyngier hcr = vcpu_hcr(vcpu); 9789ed24f4bSMarc Zyngier if (level) 9799ed24f4bSMarc Zyngier set = test_and_set_bit(bit_index, hcr); 9809ed24f4bSMarc Zyngier else 9819ed24f4bSMarc Zyngier set = test_and_clear_bit(bit_index, hcr); 9829ed24f4bSMarc Zyngier 9839ed24f4bSMarc Zyngier /* 9849ed24f4bSMarc Zyngier * If we didn't change anything, no need to wake up or kick other CPUs 9859ed24f4bSMarc Zyngier */ 9869ed24f4bSMarc Zyngier if (set == level) 9879ed24f4bSMarc Zyngier return 0; 9889ed24f4bSMarc Zyngier 9899ed24f4bSMarc Zyngier /* 9909ed24f4bSMarc Zyngier * The vcpu irq_lines field was updated, wake up sleeping VCPUs and 9919ed24f4bSMarc Zyngier * trigger a world-switch round on the running physical CPU to set the 9929ed24f4bSMarc Zyngier * virtual IRQ/FIQ fields in the HCR appropriately. 9939ed24f4bSMarc Zyngier */ 9949ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_IRQ_PENDING, vcpu); 9959ed24f4bSMarc Zyngier kvm_vcpu_kick(vcpu); 9969ed24f4bSMarc Zyngier 9979ed24f4bSMarc Zyngier return 0; 9989ed24f4bSMarc Zyngier } 9999ed24f4bSMarc Zyngier 10009ed24f4bSMarc Zyngier int kvm_vm_ioctl_irq_line(struct kvm *kvm, struct kvm_irq_level *irq_level, 10019ed24f4bSMarc Zyngier bool line_status) 10029ed24f4bSMarc Zyngier { 10039ed24f4bSMarc Zyngier u32 irq = irq_level->irq; 10049ed24f4bSMarc Zyngier unsigned int irq_type, vcpu_idx, irq_num; 10059ed24f4bSMarc Zyngier int nrcpus = atomic_read(&kvm->online_vcpus); 10069ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu = NULL; 10079ed24f4bSMarc Zyngier bool level = irq_level->level; 10089ed24f4bSMarc Zyngier 10099ed24f4bSMarc Zyngier irq_type = (irq >> KVM_ARM_IRQ_TYPE_SHIFT) & KVM_ARM_IRQ_TYPE_MASK; 10109ed24f4bSMarc Zyngier vcpu_idx = (irq >> KVM_ARM_IRQ_VCPU_SHIFT) & KVM_ARM_IRQ_VCPU_MASK; 10119ed24f4bSMarc Zyngier vcpu_idx += ((irq >> KVM_ARM_IRQ_VCPU2_SHIFT) & KVM_ARM_IRQ_VCPU2_MASK) * (KVM_ARM_IRQ_VCPU_MASK + 1); 10129ed24f4bSMarc Zyngier irq_num = (irq >> KVM_ARM_IRQ_NUM_SHIFT) & KVM_ARM_IRQ_NUM_MASK; 10139ed24f4bSMarc Zyngier 10149ed24f4bSMarc Zyngier trace_kvm_irq_line(irq_type, vcpu_idx, irq_num, irq_level->level); 10159ed24f4bSMarc Zyngier 10169ed24f4bSMarc Zyngier switch (irq_type) { 10179ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_CPU: 10189ed24f4bSMarc Zyngier if (irqchip_in_kernel(kvm)) 10199ed24f4bSMarc Zyngier return -ENXIO; 10209ed24f4bSMarc Zyngier 10219ed24f4bSMarc Zyngier if (vcpu_idx >= nrcpus) 10229ed24f4bSMarc Zyngier return -EINVAL; 10239ed24f4bSMarc Zyngier 10249ed24f4bSMarc Zyngier vcpu = kvm_get_vcpu(kvm, vcpu_idx); 10259ed24f4bSMarc Zyngier if (!vcpu) 10269ed24f4bSMarc Zyngier return -EINVAL; 10279ed24f4bSMarc Zyngier 10289ed24f4bSMarc Zyngier if (irq_num > KVM_ARM_IRQ_CPU_FIQ) 10299ed24f4bSMarc Zyngier return -EINVAL; 10309ed24f4bSMarc Zyngier 10319ed24f4bSMarc Zyngier return vcpu_interrupt_line(vcpu, irq_num, level); 10329ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_PPI: 10339ed24f4bSMarc Zyngier if (!irqchip_in_kernel(kvm)) 10349ed24f4bSMarc Zyngier return -ENXIO; 10359ed24f4bSMarc Zyngier 10369ed24f4bSMarc Zyngier if (vcpu_idx >= nrcpus) 10379ed24f4bSMarc Zyngier return -EINVAL; 10389ed24f4bSMarc Zyngier 10399ed24f4bSMarc Zyngier vcpu = kvm_get_vcpu(kvm, vcpu_idx); 10409ed24f4bSMarc Zyngier if (!vcpu) 10419ed24f4bSMarc Zyngier return -EINVAL; 10429ed24f4bSMarc Zyngier 10439ed24f4bSMarc Zyngier if (irq_num < VGIC_NR_SGIS || irq_num >= VGIC_NR_PRIVATE_IRQS) 10449ed24f4bSMarc Zyngier return -EINVAL; 10459ed24f4bSMarc Zyngier 10469ed24f4bSMarc Zyngier return kvm_vgic_inject_irq(kvm, vcpu->vcpu_id, irq_num, level, NULL); 10479ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_SPI: 10489ed24f4bSMarc Zyngier if (!irqchip_in_kernel(kvm)) 10499ed24f4bSMarc Zyngier return -ENXIO; 10509ed24f4bSMarc Zyngier 10519ed24f4bSMarc Zyngier if (irq_num < VGIC_NR_PRIVATE_IRQS) 10529ed24f4bSMarc Zyngier return -EINVAL; 10539ed24f4bSMarc Zyngier 10549ed24f4bSMarc Zyngier return kvm_vgic_inject_irq(kvm, 0, irq_num, level, NULL); 10559ed24f4bSMarc Zyngier } 10569ed24f4bSMarc Zyngier 10579ed24f4bSMarc Zyngier return -EINVAL; 10589ed24f4bSMarc Zyngier } 10599ed24f4bSMarc Zyngier 10609ed24f4bSMarc Zyngier static int kvm_vcpu_set_target(struct kvm_vcpu *vcpu, 10619ed24f4bSMarc Zyngier const struct kvm_vcpu_init *init) 10629ed24f4bSMarc Zyngier { 10639ed24f4bSMarc Zyngier unsigned int i, ret; 10646b7982feSAnshuman Khandual u32 phys_target = kvm_target_cpu(); 10659ed24f4bSMarc Zyngier 10669ed24f4bSMarc Zyngier if (init->target != phys_target) 10679ed24f4bSMarc Zyngier return -EINVAL; 10689ed24f4bSMarc Zyngier 10699ed24f4bSMarc Zyngier /* 10709ed24f4bSMarc Zyngier * Secondary and subsequent calls to KVM_ARM_VCPU_INIT must 10719ed24f4bSMarc Zyngier * use the same target. 10729ed24f4bSMarc Zyngier */ 10739ed24f4bSMarc Zyngier if (vcpu->arch.target != -1 && vcpu->arch.target != init->target) 10749ed24f4bSMarc Zyngier return -EINVAL; 10759ed24f4bSMarc Zyngier 10769ed24f4bSMarc Zyngier /* -ENOENT for unknown features, -EINVAL for invalid combinations. */ 10779ed24f4bSMarc Zyngier for (i = 0; i < sizeof(init->features) * 8; i++) { 10789ed24f4bSMarc Zyngier bool set = (init->features[i / 32] & (1 << (i % 32))); 10799ed24f4bSMarc Zyngier 10809ed24f4bSMarc Zyngier if (set && i >= KVM_VCPU_MAX_FEATURES) 10819ed24f4bSMarc Zyngier return -ENOENT; 10829ed24f4bSMarc Zyngier 10839ed24f4bSMarc Zyngier /* 10849ed24f4bSMarc Zyngier * Secondary and subsequent calls to KVM_ARM_VCPU_INIT must 10859ed24f4bSMarc Zyngier * use the same feature set. 10869ed24f4bSMarc Zyngier */ 10879ed24f4bSMarc Zyngier if (vcpu->arch.target != -1 && i < KVM_VCPU_MAX_FEATURES && 10889ed24f4bSMarc Zyngier test_bit(i, vcpu->arch.features) != set) 10899ed24f4bSMarc Zyngier return -EINVAL; 10909ed24f4bSMarc Zyngier 10919ed24f4bSMarc Zyngier if (set) 10929ed24f4bSMarc Zyngier set_bit(i, vcpu->arch.features); 10939ed24f4bSMarc Zyngier } 10949ed24f4bSMarc Zyngier 10959ed24f4bSMarc Zyngier vcpu->arch.target = phys_target; 10969ed24f4bSMarc Zyngier 10979ed24f4bSMarc Zyngier /* Now we know what it is, we can reset it. */ 10989ed24f4bSMarc Zyngier ret = kvm_reset_vcpu(vcpu); 10999ed24f4bSMarc Zyngier if (ret) { 11009ed24f4bSMarc Zyngier vcpu->arch.target = -1; 11019ed24f4bSMarc Zyngier bitmap_zero(vcpu->arch.features, KVM_VCPU_MAX_FEATURES); 11029ed24f4bSMarc Zyngier } 11039ed24f4bSMarc Zyngier 11049ed24f4bSMarc Zyngier return ret; 11059ed24f4bSMarc Zyngier } 11069ed24f4bSMarc Zyngier 11079ed24f4bSMarc Zyngier static int kvm_arch_vcpu_ioctl_vcpu_init(struct kvm_vcpu *vcpu, 11089ed24f4bSMarc Zyngier struct kvm_vcpu_init *init) 11099ed24f4bSMarc Zyngier { 11109ed24f4bSMarc Zyngier int ret; 11119ed24f4bSMarc Zyngier 11129ed24f4bSMarc Zyngier ret = kvm_vcpu_set_target(vcpu, init); 11139ed24f4bSMarc Zyngier if (ret) 11149ed24f4bSMarc Zyngier return ret; 11159ed24f4bSMarc Zyngier 11169ed24f4bSMarc Zyngier /* 11179ed24f4bSMarc Zyngier * Ensure a rebooted VM will fault in RAM pages and detect if the 11189ed24f4bSMarc Zyngier * guest MMU is turned off and flush the caches as needed. 1119892713e9SZenghui Yu * 11207ae2f3dbSMarc Zyngier * S2FWB enforces all memory accesses to RAM being cacheable, 11217ae2f3dbSMarc Zyngier * ensuring that the data side is always coherent. We still 11227ae2f3dbSMarc Zyngier * need to invalidate the I-cache though, as FWB does *not* 11237ae2f3dbSMarc Zyngier * imply CTR_EL0.DIC. 11249ed24f4bSMarc Zyngier */ 11257ae2f3dbSMarc Zyngier if (vcpu->arch.has_run_once) { 11267ae2f3dbSMarc Zyngier if (!cpus_have_final_cap(ARM64_HAS_STAGE2_FWB)) 11279ed24f4bSMarc Zyngier stage2_unmap_vm(vcpu->kvm); 11287ae2f3dbSMarc Zyngier else 1129fade9c2cSFuad Tabba icache_inval_all_pou(); 11307ae2f3dbSMarc Zyngier } 11319ed24f4bSMarc Zyngier 11329ed24f4bSMarc Zyngier vcpu_reset_hcr(vcpu); 1133cd496228SFuad Tabba vcpu->arch.cptr_el2 = CPTR_EL2_DEFAULT; 11349ed24f4bSMarc Zyngier 11359ed24f4bSMarc Zyngier /* 11369ed24f4bSMarc Zyngier * Handle the "start in power-off" case. 11379ed24f4bSMarc Zyngier */ 11389ed24f4bSMarc Zyngier if (test_bit(KVM_ARM_VCPU_POWER_OFF, vcpu->arch.features)) 11399ed24f4bSMarc Zyngier vcpu_power_off(vcpu); 11409ed24f4bSMarc Zyngier else 11419ed24f4bSMarc Zyngier vcpu->arch.power_off = false; 11429ed24f4bSMarc Zyngier 11439ed24f4bSMarc Zyngier return 0; 11449ed24f4bSMarc Zyngier } 11459ed24f4bSMarc Zyngier 11469ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_attr(struct kvm_vcpu *vcpu, 11479ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 11489ed24f4bSMarc Zyngier { 11499ed24f4bSMarc Zyngier int ret = -ENXIO; 11509ed24f4bSMarc Zyngier 11519ed24f4bSMarc Zyngier switch (attr->group) { 11529ed24f4bSMarc Zyngier default: 11539ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_set_attr(vcpu, attr); 11549ed24f4bSMarc Zyngier break; 11559ed24f4bSMarc Zyngier } 11569ed24f4bSMarc Zyngier 11579ed24f4bSMarc Zyngier return ret; 11589ed24f4bSMarc Zyngier } 11599ed24f4bSMarc Zyngier 11609ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_attr(struct kvm_vcpu *vcpu, 11619ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 11629ed24f4bSMarc Zyngier { 11639ed24f4bSMarc Zyngier int ret = -ENXIO; 11649ed24f4bSMarc Zyngier 11659ed24f4bSMarc Zyngier switch (attr->group) { 11669ed24f4bSMarc Zyngier default: 11679ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_get_attr(vcpu, attr); 11689ed24f4bSMarc Zyngier break; 11699ed24f4bSMarc Zyngier } 11709ed24f4bSMarc Zyngier 11719ed24f4bSMarc Zyngier return ret; 11729ed24f4bSMarc Zyngier } 11739ed24f4bSMarc Zyngier 11749ed24f4bSMarc Zyngier static int kvm_arm_vcpu_has_attr(struct kvm_vcpu *vcpu, 11759ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 11769ed24f4bSMarc Zyngier { 11779ed24f4bSMarc Zyngier int ret = -ENXIO; 11789ed24f4bSMarc Zyngier 11799ed24f4bSMarc Zyngier switch (attr->group) { 11809ed24f4bSMarc Zyngier default: 11819ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_has_attr(vcpu, attr); 11829ed24f4bSMarc Zyngier break; 11839ed24f4bSMarc Zyngier } 11849ed24f4bSMarc Zyngier 11859ed24f4bSMarc Zyngier return ret; 11869ed24f4bSMarc Zyngier } 11879ed24f4bSMarc Zyngier 11889ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_events(struct kvm_vcpu *vcpu, 11899ed24f4bSMarc Zyngier struct kvm_vcpu_events *events) 11909ed24f4bSMarc Zyngier { 11919ed24f4bSMarc Zyngier memset(events, 0, sizeof(*events)); 11929ed24f4bSMarc Zyngier 11939ed24f4bSMarc Zyngier return __kvm_arm_vcpu_get_events(vcpu, events); 11949ed24f4bSMarc Zyngier } 11959ed24f4bSMarc Zyngier 11969ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_events(struct kvm_vcpu *vcpu, 11979ed24f4bSMarc Zyngier struct kvm_vcpu_events *events) 11989ed24f4bSMarc Zyngier { 11999ed24f4bSMarc Zyngier int i; 12009ed24f4bSMarc Zyngier 12019ed24f4bSMarc Zyngier /* check whether the reserved field is zero */ 12029ed24f4bSMarc Zyngier for (i = 0; i < ARRAY_SIZE(events->reserved); i++) 12039ed24f4bSMarc Zyngier if (events->reserved[i]) 12049ed24f4bSMarc Zyngier return -EINVAL; 12059ed24f4bSMarc Zyngier 12069ed24f4bSMarc Zyngier /* check whether the pad field is zero */ 12079ed24f4bSMarc Zyngier for (i = 0; i < ARRAY_SIZE(events->exception.pad); i++) 12089ed24f4bSMarc Zyngier if (events->exception.pad[i]) 12099ed24f4bSMarc Zyngier return -EINVAL; 12109ed24f4bSMarc Zyngier 12119ed24f4bSMarc Zyngier return __kvm_arm_vcpu_set_events(vcpu, events); 12129ed24f4bSMarc Zyngier } 12139ed24f4bSMarc Zyngier 12149ed24f4bSMarc Zyngier long kvm_arch_vcpu_ioctl(struct file *filp, 12159ed24f4bSMarc Zyngier unsigned int ioctl, unsigned long arg) 12169ed24f4bSMarc Zyngier { 12179ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu = filp->private_data; 12189ed24f4bSMarc Zyngier void __user *argp = (void __user *)arg; 12199ed24f4bSMarc Zyngier struct kvm_device_attr attr; 12209ed24f4bSMarc Zyngier long r; 12219ed24f4bSMarc Zyngier 12229ed24f4bSMarc Zyngier switch (ioctl) { 12239ed24f4bSMarc Zyngier case KVM_ARM_VCPU_INIT: { 12249ed24f4bSMarc Zyngier struct kvm_vcpu_init init; 12259ed24f4bSMarc Zyngier 12269ed24f4bSMarc Zyngier r = -EFAULT; 12279ed24f4bSMarc Zyngier if (copy_from_user(&init, argp, sizeof(init))) 12289ed24f4bSMarc Zyngier break; 12299ed24f4bSMarc Zyngier 12309ed24f4bSMarc Zyngier r = kvm_arch_vcpu_ioctl_vcpu_init(vcpu, &init); 12319ed24f4bSMarc Zyngier break; 12329ed24f4bSMarc Zyngier } 12339ed24f4bSMarc Zyngier case KVM_SET_ONE_REG: 12349ed24f4bSMarc Zyngier case KVM_GET_ONE_REG: { 12359ed24f4bSMarc Zyngier struct kvm_one_reg reg; 12369ed24f4bSMarc Zyngier 12379ed24f4bSMarc Zyngier r = -ENOEXEC; 12389ed24f4bSMarc Zyngier if (unlikely(!kvm_vcpu_initialized(vcpu))) 12399ed24f4bSMarc Zyngier break; 12409ed24f4bSMarc Zyngier 12419ed24f4bSMarc Zyngier r = -EFAULT; 12429ed24f4bSMarc Zyngier if (copy_from_user(®, argp, sizeof(reg))) 12439ed24f4bSMarc Zyngier break; 12449ed24f4bSMarc Zyngier 12456826c684SOliver Upton /* 12466826c684SOliver Upton * We could owe a reset due to PSCI. Handle the pending reset 12476826c684SOliver Upton * here to ensure userspace register accesses are ordered after 12486826c684SOliver Upton * the reset. 12496826c684SOliver Upton */ 12506826c684SOliver Upton if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu)) 12516826c684SOliver Upton kvm_reset_vcpu(vcpu); 12526826c684SOliver Upton 12539ed24f4bSMarc Zyngier if (ioctl == KVM_SET_ONE_REG) 12549ed24f4bSMarc Zyngier r = kvm_arm_set_reg(vcpu, ®); 12559ed24f4bSMarc Zyngier else 12569ed24f4bSMarc Zyngier r = kvm_arm_get_reg(vcpu, ®); 12579ed24f4bSMarc Zyngier break; 12589ed24f4bSMarc Zyngier } 12599ed24f4bSMarc Zyngier case KVM_GET_REG_LIST: { 12609ed24f4bSMarc Zyngier struct kvm_reg_list __user *user_list = argp; 12619ed24f4bSMarc Zyngier struct kvm_reg_list reg_list; 12629ed24f4bSMarc Zyngier unsigned n; 12639ed24f4bSMarc Zyngier 12649ed24f4bSMarc Zyngier r = -ENOEXEC; 12659ed24f4bSMarc Zyngier if (unlikely(!kvm_vcpu_initialized(vcpu))) 12669ed24f4bSMarc Zyngier break; 12679ed24f4bSMarc Zyngier 12689ed24f4bSMarc Zyngier r = -EPERM; 12699ed24f4bSMarc Zyngier if (!kvm_arm_vcpu_is_finalized(vcpu)) 12709ed24f4bSMarc Zyngier break; 12719ed24f4bSMarc Zyngier 12729ed24f4bSMarc Zyngier r = -EFAULT; 12739ed24f4bSMarc Zyngier if (copy_from_user(®_list, user_list, sizeof(reg_list))) 12749ed24f4bSMarc Zyngier break; 12759ed24f4bSMarc Zyngier n = reg_list.n; 12769ed24f4bSMarc Zyngier reg_list.n = kvm_arm_num_regs(vcpu); 12779ed24f4bSMarc Zyngier if (copy_to_user(user_list, ®_list, sizeof(reg_list))) 12789ed24f4bSMarc Zyngier break; 12799ed24f4bSMarc Zyngier r = -E2BIG; 12809ed24f4bSMarc Zyngier if (n < reg_list.n) 12819ed24f4bSMarc Zyngier break; 12829ed24f4bSMarc Zyngier r = kvm_arm_copy_reg_indices(vcpu, user_list->reg); 12839ed24f4bSMarc Zyngier break; 12849ed24f4bSMarc Zyngier } 12859ed24f4bSMarc Zyngier case KVM_SET_DEVICE_ATTR: { 12869ed24f4bSMarc Zyngier r = -EFAULT; 12879ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 12889ed24f4bSMarc Zyngier break; 12899ed24f4bSMarc Zyngier r = kvm_arm_vcpu_set_attr(vcpu, &attr); 12909ed24f4bSMarc Zyngier break; 12919ed24f4bSMarc Zyngier } 12929ed24f4bSMarc Zyngier case KVM_GET_DEVICE_ATTR: { 12939ed24f4bSMarc Zyngier r = -EFAULT; 12949ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 12959ed24f4bSMarc Zyngier break; 12969ed24f4bSMarc Zyngier r = kvm_arm_vcpu_get_attr(vcpu, &attr); 12979ed24f4bSMarc Zyngier break; 12989ed24f4bSMarc Zyngier } 12999ed24f4bSMarc Zyngier case KVM_HAS_DEVICE_ATTR: { 13009ed24f4bSMarc Zyngier r = -EFAULT; 13019ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 13029ed24f4bSMarc Zyngier break; 13039ed24f4bSMarc Zyngier r = kvm_arm_vcpu_has_attr(vcpu, &attr); 13049ed24f4bSMarc Zyngier break; 13059ed24f4bSMarc Zyngier } 13069ed24f4bSMarc Zyngier case KVM_GET_VCPU_EVENTS: { 13079ed24f4bSMarc Zyngier struct kvm_vcpu_events events; 13089ed24f4bSMarc Zyngier 13099ed24f4bSMarc Zyngier if (kvm_arm_vcpu_get_events(vcpu, &events)) 13109ed24f4bSMarc Zyngier return -EINVAL; 13119ed24f4bSMarc Zyngier 13129ed24f4bSMarc Zyngier if (copy_to_user(argp, &events, sizeof(events))) 13139ed24f4bSMarc Zyngier return -EFAULT; 13149ed24f4bSMarc Zyngier 13159ed24f4bSMarc Zyngier return 0; 13169ed24f4bSMarc Zyngier } 13179ed24f4bSMarc Zyngier case KVM_SET_VCPU_EVENTS: { 13189ed24f4bSMarc Zyngier struct kvm_vcpu_events events; 13199ed24f4bSMarc Zyngier 13209ed24f4bSMarc Zyngier if (copy_from_user(&events, argp, sizeof(events))) 13219ed24f4bSMarc Zyngier return -EFAULT; 13229ed24f4bSMarc Zyngier 13239ed24f4bSMarc Zyngier return kvm_arm_vcpu_set_events(vcpu, &events); 13249ed24f4bSMarc Zyngier } 13259ed24f4bSMarc Zyngier case KVM_ARM_VCPU_FINALIZE: { 13269ed24f4bSMarc Zyngier int what; 13279ed24f4bSMarc Zyngier 13289ed24f4bSMarc Zyngier if (!kvm_vcpu_initialized(vcpu)) 13299ed24f4bSMarc Zyngier return -ENOEXEC; 13309ed24f4bSMarc Zyngier 13319ed24f4bSMarc Zyngier if (get_user(what, (const int __user *)argp)) 13329ed24f4bSMarc Zyngier return -EFAULT; 13339ed24f4bSMarc Zyngier 13349ed24f4bSMarc Zyngier return kvm_arm_vcpu_finalize(vcpu, what); 13359ed24f4bSMarc Zyngier } 13369ed24f4bSMarc Zyngier default: 13379ed24f4bSMarc Zyngier r = -EINVAL; 13389ed24f4bSMarc Zyngier } 13399ed24f4bSMarc Zyngier 13409ed24f4bSMarc Zyngier return r; 13419ed24f4bSMarc Zyngier } 13429ed24f4bSMarc Zyngier 13439ed24f4bSMarc Zyngier void kvm_arch_sync_dirty_log(struct kvm *kvm, struct kvm_memory_slot *memslot) 13449ed24f4bSMarc Zyngier { 13459ed24f4bSMarc Zyngier 13469ed24f4bSMarc Zyngier } 13479ed24f4bSMarc Zyngier 13489ed24f4bSMarc Zyngier void kvm_arch_flush_remote_tlbs_memslot(struct kvm *kvm, 13496c9dd6d2SPaolo Bonzini const struct kvm_memory_slot *memslot) 13509ed24f4bSMarc Zyngier { 13519ed24f4bSMarc Zyngier kvm_flush_remote_tlbs(kvm); 13529ed24f4bSMarc Zyngier } 13539ed24f4bSMarc Zyngier 13549ed24f4bSMarc Zyngier static int kvm_vm_ioctl_set_device_addr(struct kvm *kvm, 13559ed24f4bSMarc Zyngier struct kvm_arm_device_addr *dev_addr) 13569ed24f4bSMarc Zyngier { 13579ed24f4bSMarc Zyngier unsigned long dev_id, type; 13589ed24f4bSMarc Zyngier 13599ed24f4bSMarc Zyngier dev_id = (dev_addr->id & KVM_ARM_DEVICE_ID_MASK) >> 13609ed24f4bSMarc Zyngier KVM_ARM_DEVICE_ID_SHIFT; 13619ed24f4bSMarc Zyngier type = (dev_addr->id & KVM_ARM_DEVICE_TYPE_MASK) >> 13629ed24f4bSMarc Zyngier KVM_ARM_DEVICE_TYPE_SHIFT; 13639ed24f4bSMarc Zyngier 13649ed24f4bSMarc Zyngier switch (dev_id) { 13659ed24f4bSMarc Zyngier case KVM_ARM_DEVICE_VGIC_V2: 13669ed24f4bSMarc Zyngier if (!vgic_present) 13679ed24f4bSMarc Zyngier return -ENXIO; 13689ed24f4bSMarc Zyngier return kvm_vgic_addr(kvm, type, &dev_addr->addr, true); 13699ed24f4bSMarc Zyngier default: 13709ed24f4bSMarc Zyngier return -ENODEV; 13719ed24f4bSMarc Zyngier } 13729ed24f4bSMarc Zyngier } 13739ed24f4bSMarc Zyngier 13749ed24f4bSMarc Zyngier long kvm_arch_vm_ioctl(struct file *filp, 13759ed24f4bSMarc Zyngier unsigned int ioctl, unsigned long arg) 13769ed24f4bSMarc Zyngier { 13779ed24f4bSMarc Zyngier struct kvm *kvm = filp->private_data; 13789ed24f4bSMarc Zyngier void __user *argp = (void __user *)arg; 13799ed24f4bSMarc Zyngier 13809ed24f4bSMarc Zyngier switch (ioctl) { 13819ed24f4bSMarc Zyngier case KVM_CREATE_IRQCHIP: { 13829ed24f4bSMarc Zyngier int ret; 13839ed24f4bSMarc Zyngier if (!vgic_present) 13849ed24f4bSMarc Zyngier return -ENXIO; 13859ed24f4bSMarc Zyngier mutex_lock(&kvm->lock); 13869ed24f4bSMarc Zyngier ret = kvm_vgic_create(kvm, KVM_DEV_TYPE_ARM_VGIC_V2); 13879ed24f4bSMarc Zyngier mutex_unlock(&kvm->lock); 13889ed24f4bSMarc Zyngier return ret; 13899ed24f4bSMarc Zyngier } 13909ed24f4bSMarc Zyngier case KVM_ARM_SET_DEVICE_ADDR: { 13919ed24f4bSMarc Zyngier struct kvm_arm_device_addr dev_addr; 13929ed24f4bSMarc Zyngier 13939ed24f4bSMarc Zyngier if (copy_from_user(&dev_addr, argp, sizeof(dev_addr))) 13949ed24f4bSMarc Zyngier return -EFAULT; 13959ed24f4bSMarc Zyngier return kvm_vm_ioctl_set_device_addr(kvm, &dev_addr); 13969ed24f4bSMarc Zyngier } 13979ed24f4bSMarc Zyngier case KVM_ARM_PREFERRED_TARGET: { 13989ed24f4bSMarc Zyngier int err; 13999ed24f4bSMarc Zyngier struct kvm_vcpu_init init; 14009ed24f4bSMarc Zyngier 14019ed24f4bSMarc Zyngier err = kvm_vcpu_preferred_target(&init); 14029ed24f4bSMarc Zyngier if (err) 14039ed24f4bSMarc Zyngier return err; 14049ed24f4bSMarc Zyngier 14059ed24f4bSMarc Zyngier if (copy_to_user(argp, &init, sizeof(init))) 14069ed24f4bSMarc Zyngier return -EFAULT; 14079ed24f4bSMarc Zyngier 14089ed24f4bSMarc Zyngier return 0; 14099ed24f4bSMarc Zyngier } 1410f0376edbSSteven Price case KVM_ARM_MTE_COPY_TAGS: { 1411f0376edbSSteven Price struct kvm_arm_copy_mte_tags copy_tags; 1412f0376edbSSteven Price 1413f0376edbSSteven Price if (copy_from_user(©_tags, argp, sizeof(copy_tags))) 1414f0376edbSSteven Price return -EFAULT; 1415f0376edbSSteven Price return kvm_vm_ioctl_mte_copy_tags(kvm, ©_tags); 1416f0376edbSSteven Price } 14179ed24f4bSMarc Zyngier default: 14189ed24f4bSMarc Zyngier return -EINVAL; 14199ed24f4bSMarc Zyngier } 14209ed24f4bSMarc Zyngier } 14219ed24f4bSMarc Zyngier 142230c95391SDavid Brazdil static unsigned long nvhe_percpu_size(void) 142330c95391SDavid Brazdil { 142430c95391SDavid Brazdil return (unsigned long)CHOOSE_NVHE_SYM(__per_cpu_end) - 142530c95391SDavid Brazdil (unsigned long)CHOOSE_NVHE_SYM(__per_cpu_start); 142630c95391SDavid Brazdil } 142730c95391SDavid Brazdil 142830c95391SDavid Brazdil static unsigned long nvhe_percpu_order(void) 142930c95391SDavid Brazdil { 143030c95391SDavid Brazdil unsigned long size = nvhe_percpu_size(); 143130c95391SDavid Brazdil 143230c95391SDavid Brazdil return size ? get_order(size) : 0; 143330c95391SDavid Brazdil } 143430c95391SDavid Brazdil 1435b881cdceSWill Deacon /* A lookup table holding the hypervisor VA for each vector slot */ 1436b881cdceSWill Deacon static void *hyp_spectre_vector_selector[BP_HARDEN_EL2_SLOTS]; 1437de5bcdb4SWill Deacon 1438b881cdceSWill Deacon static void kvm_init_vector_slot(void *base, enum arm64_hyp_spectre_vector slot) 1439b881cdceSWill Deacon { 1440bc1d2892SQuentin Perret hyp_spectre_vector_selector[slot] = __kvm_vector_slot2addr(base, slot); 14419ef2b48bSWill Deacon } 14429ef2b48bSWill Deacon 1443b881cdceSWill Deacon static int kvm_init_vector_slots(void) 1444b881cdceSWill Deacon { 1445b881cdceSWill Deacon int err; 1446b881cdceSWill Deacon void *base; 1447b881cdceSWill Deacon 1448b881cdceSWill Deacon base = kern_hyp_va(kvm_ksym_ref(__kvm_hyp_vector)); 1449b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_DIRECT); 1450b881cdceSWill Deacon 1451b881cdceSWill Deacon base = kern_hyp_va(kvm_ksym_ref(__bp_harden_hyp_vecs)); 1452b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_SPECTRE_DIRECT); 1453b881cdceSWill Deacon 1454c4792b6dSWill Deacon if (!cpus_have_const_cap(ARM64_SPECTRE_V3A)) 1455de5bcdb4SWill Deacon return 0; 14569ef2b48bSWill Deacon 1457b881cdceSWill Deacon if (!has_vhe()) { 1458b881cdceSWill Deacon err = create_hyp_exec_mappings(__pa_symbol(__bp_harden_hyp_vecs), 1459b881cdceSWill Deacon __BP_HARDEN_HYP_VECS_SZ, &base); 1460b881cdceSWill Deacon if (err) 1461b881cdceSWill Deacon return err; 1462b881cdceSWill Deacon } 14639ef2b48bSWill Deacon 1464b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_INDIRECT); 1465b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_SPECTRE_INDIRECT); 14669ef2b48bSWill Deacon return 0; 14679ef2b48bSWill Deacon } 14689ef2b48bSWill Deacon 14699cc77581SQuentin Perret static void cpu_prepare_hyp_mode(int cpu) 14709ed24f4bSMarc Zyngier { 14719cc77581SQuentin Perret struct kvm_nvhe_init_params *params = per_cpu_ptr_nvhe_sym(kvm_init_params, cpu); 1472d3e1086cSDavid Brazdil unsigned long tcr; 14739ed24f4bSMarc Zyngier 147471b3ec5fSDavid Brazdil /* 147571b3ec5fSDavid Brazdil * Calculate the raw per-cpu offset without a translation from the 147671b3ec5fSDavid Brazdil * kernel's mapping to the linear mapping, and store it in tpidr_el2 147771b3ec5fSDavid Brazdil * so that we can use adr_l to access per-cpu variables in EL2. 1478e1663372SSteven Price * Also drop the KASAN tag which gets in the way... 147971b3ec5fSDavid Brazdil */ 14809cc77581SQuentin Perret params->tpidr_el2 = (unsigned long)kasan_reset_tag(per_cpu_ptr_nvhe_sym(__per_cpu_start, cpu)) - 148130c95391SDavid Brazdil (unsigned long)kvm_ksym_ref(CHOOSE_NVHE_SYM(__per_cpu_start)); 148271b3ec5fSDavid Brazdil 1483d3e1086cSDavid Brazdil params->mair_el2 = read_sysreg(mair_el1); 1484d3e1086cSDavid Brazdil 1485d3e1086cSDavid Brazdil /* 1486d3e1086cSDavid Brazdil * The ID map may be configured to use an extended virtual address 1487d3e1086cSDavid Brazdil * range. This is only the case if system RAM is out of range for the 1488d3e1086cSDavid Brazdil * currently configured page size and VA_BITS, in which case we will 1489d3e1086cSDavid Brazdil * also need the extended virtual range for the HYP ID map, or we won't 1490d3e1086cSDavid Brazdil * be able to enable the EL2 MMU. 1491d3e1086cSDavid Brazdil * 1492d3e1086cSDavid Brazdil * However, at EL2, there is only one TTBR register, and we can't switch 1493d3e1086cSDavid Brazdil * between translation tables *and* update TCR_EL2.T0SZ at the same 1494d3e1086cSDavid Brazdil * time. Bottom line: we need to use the extended range with *both* our 1495d3e1086cSDavid Brazdil * translation tables. 1496d3e1086cSDavid Brazdil * 1497d3e1086cSDavid Brazdil * So use the same T0SZ value we use for the ID map. 1498d3e1086cSDavid Brazdil */ 1499d3e1086cSDavid Brazdil tcr = (read_sysreg(tcr_el1) & TCR_EL2_MASK) | TCR_EL2_RES1; 1500d3e1086cSDavid Brazdil tcr &= ~TCR_T0SZ_MASK; 1501d3e1086cSDavid Brazdil tcr |= (idmap_t0sz & GENMASK(TCR_TxSZ_WIDTH - 1, 0)) << TCR_T0SZ_OFFSET; 1502d3e1086cSDavid Brazdil params->tcr_el2 = tcr; 1503d3e1086cSDavid Brazdil 15049cc77581SQuentin Perret params->stack_hyp_va = kern_hyp_va(per_cpu(kvm_arm_hyp_stack_page, cpu) + PAGE_SIZE); 150563fec243SDavid Brazdil params->pgd_pa = kvm_mmu_get_httbr(); 1506734864c1SQuentin Perret if (is_protected_kvm_enabled()) 1507734864c1SQuentin Perret params->hcr_el2 = HCR_HOST_NVHE_PROTECTED_FLAGS; 1508734864c1SQuentin Perret else 1509734864c1SQuentin Perret params->hcr_el2 = HCR_HOST_NVHE_FLAGS; 1510734864c1SQuentin Perret params->vttbr = params->vtcr = 0; 151163fec243SDavid Brazdil 151263fec243SDavid Brazdil /* 151363fec243SDavid Brazdil * Flush the init params from the data cache because the struct will 151463fec243SDavid Brazdil * be read while the MMU is off. 151563fec243SDavid Brazdil */ 151663fec243SDavid Brazdil kvm_flush_dcache_to_poc(params, sizeof(*params)); 15179cc77581SQuentin Perret } 15189cc77581SQuentin Perret 1519bfa79a80SQuentin Perret static void hyp_install_host_vector(void) 15209cc77581SQuentin Perret { 15219cc77581SQuentin Perret struct kvm_nvhe_init_params *params; 15229cc77581SQuentin Perret struct arm_smccc_res res; 15239cc77581SQuentin Perret 15249cc77581SQuentin Perret /* Switch from the HYP stub to our own HYP init vector */ 15259cc77581SQuentin Perret __hyp_set_vectors(kvm_get_idmap_vector()); 15269ed24f4bSMarc Zyngier 152771b3ec5fSDavid Brazdil /* 152871b3ec5fSDavid Brazdil * Call initialization code, and switch to the full blown HYP code. 152971b3ec5fSDavid Brazdil * If the cpucaps haven't been finalized yet, something has gone very 153071b3ec5fSDavid Brazdil * wrong, and hyp will crash and burn when it uses any 153171b3ec5fSDavid Brazdil * cpus_have_const_cap() wrapper. 153271b3ec5fSDavid Brazdil */ 153371b3ec5fSDavid Brazdil BUG_ON(!system_capabilities_finalized()); 15349cc77581SQuentin Perret params = this_cpu_ptr_nvhe_sym(kvm_init_params); 153563fec243SDavid Brazdil arm_smccc_1_1_hvc(KVM_HOST_SMCCC_FUNC(__kvm_hyp_init), virt_to_phys(params), &res); 153604e4caa8SAndrew Scull WARN_ON(res.a0 != SMCCC_RET_SUCCESS); 1537bfa79a80SQuentin Perret } 1538bfa79a80SQuentin Perret 1539bfa79a80SQuentin Perret static void cpu_init_hyp_mode(void) 1540bfa79a80SQuentin Perret { 1541bfa79a80SQuentin Perret hyp_install_host_vector(); 154271b3ec5fSDavid Brazdil 154371b3ec5fSDavid Brazdil /* 154471b3ec5fSDavid Brazdil * Disabling SSBD on a non-VHE system requires us to enable SSBS 154571b3ec5fSDavid Brazdil * at EL2. 154671b3ec5fSDavid Brazdil */ 154771b3ec5fSDavid Brazdil if (this_cpu_has_cap(ARM64_SSBS) && 1548d63d975aSMarc Zyngier arm64_get_spectre_v4_state() == SPECTRE_VULNERABLE) { 154913aeb9b4SDavid Brazdil kvm_call_hyp_nvhe(__kvm_enable_ssbs); 155071b3ec5fSDavid Brazdil } 15519ed24f4bSMarc Zyngier } 15529ed24f4bSMarc Zyngier 15539ed24f4bSMarc Zyngier static void cpu_hyp_reset(void) 15549ed24f4bSMarc Zyngier { 15559ed24f4bSMarc Zyngier if (!is_kernel_in_hyp_mode()) 15569ed24f4bSMarc Zyngier __hyp_reset_vectors(); 15579ed24f4bSMarc Zyngier } 15589ed24f4bSMarc Zyngier 1559042c76a9SWill Deacon /* 1560042c76a9SWill Deacon * EL2 vectors can be mapped and rerouted in a number of ways, 1561042c76a9SWill Deacon * depending on the kernel configuration and CPU present: 1562042c76a9SWill Deacon * 1563042c76a9SWill Deacon * - If the CPU is affected by Spectre-v2, the hardening sequence is 1564042c76a9SWill Deacon * placed in one of the vector slots, which is executed before jumping 1565042c76a9SWill Deacon * to the real vectors. 1566042c76a9SWill Deacon * 1567c4792b6dSWill Deacon * - If the CPU also has the ARM64_SPECTRE_V3A cap, the slot 1568042c76a9SWill Deacon * containing the hardening sequence is mapped next to the idmap page, 1569042c76a9SWill Deacon * and executed before jumping to the real vectors. 1570042c76a9SWill Deacon * 1571c4792b6dSWill Deacon * - If the CPU only has the ARM64_SPECTRE_V3A cap, then an 1572042c76a9SWill Deacon * empty slot is selected, mapped next to the idmap page, and 1573042c76a9SWill Deacon * executed before jumping to the real vectors. 1574042c76a9SWill Deacon * 1575c4792b6dSWill Deacon * Note that ARM64_SPECTRE_V3A is somewhat incompatible with 1576042c76a9SWill Deacon * VHE, as we don't have hypervisor-specific mappings. If the system 1577042c76a9SWill Deacon * is VHE and yet selects this capability, it will be ignored. 1578042c76a9SWill Deacon */ 1579042c76a9SWill Deacon static void cpu_set_hyp_vector(void) 1580042c76a9SWill Deacon { 15816279017eSWill Deacon struct bp_hardening_data *data = this_cpu_ptr(&bp_hardening_data); 1582b881cdceSWill Deacon void *vector = hyp_spectre_vector_selector[data->slot]; 1583042c76a9SWill Deacon 1584bfa79a80SQuentin Perret if (!is_protected_kvm_enabled()) 1585b881cdceSWill Deacon *this_cpu_ptr_hyp_sym(kvm_hyp_vector) = (unsigned long)vector; 1586bfa79a80SQuentin Perret else 1587bfa79a80SQuentin Perret kvm_call_hyp_nvhe(__pkvm_cpu_set_vector, data->slot); 1588042c76a9SWill Deacon } 1589042c76a9SWill Deacon 15909ed24f4bSMarc Zyngier static void cpu_hyp_reinit(void) 15919ed24f4bSMarc Zyngier { 15922a1198c9SDavid Brazdil kvm_init_host_cpu_context(&this_cpu_ptr_hyp_sym(kvm_host_data)->host_ctxt); 15939ed24f4bSMarc Zyngier 15949ed24f4bSMarc Zyngier cpu_hyp_reset(); 1595a0e47952SAndrew Scull 15969ed24f4bSMarc Zyngier if (is_kernel_in_hyp_mode()) 15979ed24f4bSMarc Zyngier kvm_timer_init_vhe(); 15989ed24f4bSMarc Zyngier else 15999ed24f4bSMarc Zyngier cpu_init_hyp_mode(); 16009ed24f4bSMarc Zyngier 1601bfa79a80SQuentin Perret cpu_set_hyp_vector(); 1602bfa79a80SQuentin Perret 16039ed24f4bSMarc Zyngier kvm_arm_init_debug(); 16049ed24f4bSMarc Zyngier 16059ed24f4bSMarc Zyngier if (vgic_present) 16069ed24f4bSMarc Zyngier kvm_vgic_init_cpu_hardware(); 16079ed24f4bSMarc Zyngier } 16089ed24f4bSMarc Zyngier 16099ed24f4bSMarc Zyngier static void _kvm_arch_hardware_enable(void *discard) 16109ed24f4bSMarc Zyngier { 16119ed24f4bSMarc Zyngier if (!__this_cpu_read(kvm_arm_hardware_enabled)) { 16129ed24f4bSMarc Zyngier cpu_hyp_reinit(); 16139ed24f4bSMarc Zyngier __this_cpu_write(kvm_arm_hardware_enabled, 1); 16149ed24f4bSMarc Zyngier } 16159ed24f4bSMarc Zyngier } 16169ed24f4bSMarc Zyngier 16179ed24f4bSMarc Zyngier int kvm_arch_hardware_enable(void) 16189ed24f4bSMarc Zyngier { 16199ed24f4bSMarc Zyngier _kvm_arch_hardware_enable(NULL); 16209ed24f4bSMarc Zyngier return 0; 16219ed24f4bSMarc Zyngier } 16229ed24f4bSMarc Zyngier 16239ed24f4bSMarc Zyngier static void _kvm_arch_hardware_disable(void *discard) 16249ed24f4bSMarc Zyngier { 16259ed24f4bSMarc Zyngier if (__this_cpu_read(kvm_arm_hardware_enabled)) { 16269ed24f4bSMarc Zyngier cpu_hyp_reset(); 16279ed24f4bSMarc Zyngier __this_cpu_write(kvm_arm_hardware_enabled, 0); 16289ed24f4bSMarc Zyngier } 16299ed24f4bSMarc Zyngier } 16309ed24f4bSMarc Zyngier 16319ed24f4bSMarc Zyngier void kvm_arch_hardware_disable(void) 16329ed24f4bSMarc Zyngier { 1633fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 16349ed24f4bSMarc Zyngier _kvm_arch_hardware_disable(NULL); 16359ed24f4bSMarc Zyngier } 16369ed24f4bSMarc Zyngier 16379ed24f4bSMarc Zyngier #ifdef CONFIG_CPU_PM 16389ed24f4bSMarc Zyngier static int hyp_init_cpu_pm_notifier(struct notifier_block *self, 16399ed24f4bSMarc Zyngier unsigned long cmd, 16409ed24f4bSMarc Zyngier void *v) 16419ed24f4bSMarc Zyngier { 16429ed24f4bSMarc Zyngier /* 16439ed24f4bSMarc Zyngier * kvm_arm_hardware_enabled is left with its old value over 16449ed24f4bSMarc Zyngier * PM_ENTER->PM_EXIT. It is used to indicate PM_EXIT should 16459ed24f4bSMarc Zyngier * re-enable hyp. 16469ed24f4bSMarc Zyngier */ 16479ed24f4bSMarc Zyngier switch (cmd) { 16489ed24f4bSMarc Zyngier case CPU_PM_ENTER: 16499ed24f4bSMarc Zyngier if (__this_cpu_read(kvm_arm_hardware_enabled)) 16509ed24f4bSMarc Zyngier /* 16519ed24f4bSMarc Zyngier * don't update kvm_arm_hardware_enabled here 16529ed24f4bSMarc Zyngier * so that the hardware will be re-enabled 16539ed24f4bSMarc Zyngier * when we resume. See below. 16549ed24f4bSMarc Zyngier */ 16559ed24f4bSMarc Zyngier cpu_hyp_reset(); 16569ed24f4bSMarc Zyngier 16579ed24f4bSMarc Zyngier return NOTIFY_OK; 16589ed24f4bSMarc Zyngier case CPU_PM_ENTER_FAILED: 16599ed24f4bSMarc Zyngier case CPU_PM_EXIT: 16609ed24f4bSMarc Zyngier if (__this_cpu_read(kvm_arm_hardware_enabled)) 16619ed24f4bSMarc Zyngier /* The hardware was enabled before suspend. */ 16629ed24f4bSMarc Zyngier cpu_hyp_reinit(); 16639ed24f4bSMarc Zyngier 16649ed24f4bSMarc Zyngier return NOTIFY_OK; 16659ed24f4bSMarc Zyngier 16669ed24f4bSMarc Zyngier default: 16679ed24f4bSMarc Zyngier return NOTIFY_DONE; 16689ed24f4bSMarc Zyngier } 16699ed24f4bSMarc Zyngier } 16709ed24f4bSMarc Zyngier 16719ed24f4bSMarc Zyngier static struct notifier_block hyp_init_cpu_pm_nb = { 16729ed24f4bSMarc Zyngier .notifier_call = hyp_init_cpu_pm_notifier, 16739ed24f4bSMarc Zyngier }; 16749ed24f4bSMarc Zyngier 167544362a3cSMarc Zyngier static void hyp_cpu_pm_init(void) 16769ed24f4bSMarc Zyngier { 1677fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 16789ed24f4bSMarc Zyngier cpu_pm_register_notifier(&hyp_init_cpu_pm_nb); 16799ed24f4bSMarc Zyngier } 168044362a3cSMarc Zyngier static void hyp_cpu_pm_exit(void) 16819ed24f4bSMarc Zyngier { 1682fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 16839ed24f4bSMarc Zyngier cpu_pm_unregister_notifier(&hyp_init_cpu_pm_nb); 16849ed24f4bSMarc Zyngier } 16859ed24f4bSMarc Zyngier #else 16869ed24f4bSMarc Zyngier static inline void hyp_cpu_pm_init(void) 16879ed24f4bSMarc Zyngier { 16889ed24f4bSMarc Zyngier } 16899ed24f4bSMarc Zyngier static inline void hyp_cpu_pm_exit(void) 16909ed24f4bSMarc Zyngier { 16919ed24f4bSMarc Zyngier } 16929ed24f4bSMarc Zyngier #endif 16939ed24f4bSMarc Zyngier 169494f5e8a4SDavid Brazdil static void init_cpu_logical_map(void) 169594f5e8a4SDavid Brazdil { 169694f5e8a4SDavid Brazdil unsigned int cpu; 169794f5e8a4SDavid Brazdil 169894f5e8a4SDavid Brazdil /* 169994f5e8a4SDavid Brazdil * Copy the MPIDR <-> logical CPU ID mapping to hyp. 170094f5e8a4SDavid Brazdil * Only copy the set of online CPUs whose features have been chacked 170194f5e8a4SDavid Brazdil * against the finalized system capabilities. The hypervisor will not 170294f5e8a4SDavid Brazdil * allow any other CPUs from the `possible` set to boot. 170394f5e8a4SDavid Brazdil */ 170494f5e8a4SDavid Brazdil for_each_online_cpu(cpu) 170561fe0c37SDavid Brazdil hyp_cpu_logical_map[cpu] = cpu_logical_map(cpu); 170694f5e8a4SDavid Brazdil } 170794f5e8a4SDavid Brazdil 1708767c973fSMarc Zyngier #define init_psci_0_1_impl_state(config, what) \ 1709767c973fSMarc Zyngier config.psci_0_1_ ## what ## _implemented = psci_ops.what 1710767c973fSMarc Zyngier 1711eeeee719SDavid Brazdil static bool init_psci_relay(void) 1712eeeee719SDavid Brazdil { 1713eeeee719SDavid Brazdil /* 1714eeeee719SDavid Brazdil * If PSCI has not been initialized, protected KVM cannot install 1715eeeee719SDavid Brazdil * itself on newly booted CPUs. 1716eeeee719SDavid Brazdil */ 1717eeeee719SDavid Brazdil if (!psci_ops.get_version) { 1718eeeee719SDavid Brazdil kvm_err("Cannot initialize protected mode without PSCI\n"); 1719eeeee719SDavid Brazdil return false; 1720eeeee719SDavid Brazdil } 1721eeeee719SDavid Brazdil 1722ff367fe4SDavid Brazdil kvm_host_psci_config.version = psci_ops.get_version(); 1723ff367fe4SDavid Brazdil 1724ff367fe4SDavid Brazdil if (kvm_host_psci_config.version == PSCI_VERSION(0, 1)) { 1725ff367fe4SDavid Brazdil kvm_host_psci_config.function_ids_0_1 = get_psci_0_1_function_ids(); 1726767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_suspend); 1727767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_on); 1728767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_off); 1729767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, migrate); 1730ff367fe4SDavid Brazdil } 1731eeeee719SDavid Brazdil return true; 1732eeeee719SDavid Brazdil } 1733eeeee719SDavid Brazdil 17349ed24f4bSMarc Zyngier static int init_subsystems(void) 17359ed24f4bSMarc Zyngier { 17369ed24f4bSMarc Zyngier int err = 0; 17379ed24f4bSMarc Zyngier 17389ed24f4bSMarc Zyngier /* 17399ed24f4bSMarc Zyngier * Enable hardware so that subsystem initialisation can access EL2. 17409ed24f4bSMarc Zyngier */ 17419ed24f4bSMarc Zyngier on_each_cpu(_kvm_arch_hardware_enable, NULL, 1); 17429ed24f4bSMarc Zyngier 17439ed24f4bSMarc Zyngier /* 17449ed24f4bSMarc Zyngier * Register CPU lower-power notifier 17459ed24f4bSMarc Zyngier */ 17469ed24f4bSMarc Zyngier hyp_cpu_pm_init(); 17479ed24f4bSMarc Zyngier 17489ed24f4bSMarc Zyngier /* 17499ed24f4bSMarc Zyngier * Init HYP view of VGIC 17509ed24f4bSMarc Zyngier */ 17519ed24f4bSMarc Zyngier err = kvm_vgic_hyp_init(); 17529ed24f4bSMarc Zyngier switch (err) { 17539ed24f4bSMarc Zyngier case 0: 17549ed24f4bSMarc Zyngier vgic_present = true; 17559ed24f4bSMarc Zyngier break; 17569ed24f4bSMarc Zyngier case -ENODEV: 17579ed24f4bSMarc Zyngier case -ENXIO: 17589ed24f4bSMarc Zyngier vgic_present = false; 17599ed24f4bSMarc Zyngier err = 0; 17609ed24f4bSMarc Zyngier break; 17619ed24f4bSMarc Zyngier default: 17629ed24f4bSMarc Zyngier goto out; 17639ed24f4bSMarc Zyngier } 17649ed24f4bSMarc Zyngier 17659ed24f4bSMarc Zyngier /* 17669ed24f4bSMarc Zyngier * Init HYP architected timer support 17679ed24f4bSMarc Zyngier */ 17689ed24f4bSMarc Zyngier err = kvm_timer_hyp_init(vgic_present); 17699ed24f4bSMarc Zyngier if (err) 17709ed24f4bSMarc Zyngier goto out; 17719ed24f4bSMarc Zyngier 17729ed24f4bSMarc Zyngier kvm_perf_init(); 17736ac4a5acSMarc Zyngier kvm_sys_reg_table_init(); 17749ed24f4bSMarc Zyngier 17759ed24f4bSMarc Zyngier out: 1776fa8c3d65SDavid Brazdil if (err || !is_protected_kvm_enabled()) 17779ed24f4bSMarc Zyngier on_each_cpu(_kvm_arch_hardware_disable, NULL, 1); 17789ed24f4bSMarc Zyngier 17799ed24f4bSMarc Zyngier return err; 17809ed24f4bSMarc Zyngier } 17819ed24f4bSMarc Zyngier 17829ed24f4bSMarc Zyngier static void teardown_hyp_mode(void) 17839ed24f4bSMarc Zyngier { 17849ed24f4bSMarc Zyngier int cpu; 17859ed24f4bSMarc Zyngier 17869ed24f4bSMarc Zyngier free_hyp_pgds(); 178730c95391SDavid Brazdil for_each_possible_cpu(cpu) { 17889ed24f4bSMarc Zyngier free_page(per_cpu(kvm_arm_hyp_stack_page, cpu)); 178930c95391SDavid Brazdil free_pages(kvm_arm_hyp_percpu_base[cpu], nvhe_percpu_order()); 179030c95391SDavid Brazdil } 17919ed24f4bSMarc Zyngier } 17929ed24f4bSMarc Zyngier 1793bfa79a80SQuentin Perret static int do_pkvm_init(u32 hyp_va_bits) 1794bfa79a80SQuentin Perret { 1795bfa79a80SQuentin Perret void *per_cpu_base = kvm_ksym_ref(kvm_arm_hyp_percpu_base); 1796bfa79a80SQuentin Perret int ret; 1797bfa79a80SQuentin Perret 1798bfa79a80SQuentin Perret preempt_disable(); 1799bfa79a80SQuentin Perret hyp_install_host_vector(); 1800bfa79a80SQuentin Perret ret = kvm_call_hyp_nvhe(__pkvm_init, hyp_mem_base, hyp_mem_size, 1801bfa79a80SQuentin Perret num_possible_cpus(), kern_hyp_va(per_cpu_base), 1802bfa79a80SQuentin Perret hyp_va_bits); 1803bfa79a80SQuentin Perret preempt_enable(); 1804bfa79a80SQuentin Perret 1805bfa79a80SQuentin Perret return ret; 1806bfa79a80SQuentin Perret } 1807bfa79a80SQuentin Perret 1808bfa79a80SQuentin Perret static int kvm_hyp_init_protection(u32 hyp_va_bits) 1809bfa79a80SQuentin Perret { 1810bfa79a80SQuentin Perret void *addr = phys_to_virt(hyp_mem_base); 1811bfa79a80SQuentin Perret int ret; 1812bfa79a80SQuentin Perret 18136c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64pfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64PFR0_EL1); 18146c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64pfr1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64PFR1_EL1); 18156c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64isar0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR0_EL1); 18166c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64isar1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR1_EL1); 18177c419937SMarc Zyngier kvm_nvhe_sym(id_aa64mmfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR0_EL1); 18187c419937SMarc Zyngier kvm_nvhe_sym(id_aa64mmfr1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR1_EL1); 18196c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64mmfr2_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR2_EL1); 18207c419937SMarc Zyngier 1821bfa79a80SQuentin Perret ret = create_hyp_mappings(addr, addr + hyp_mem_size, PAGE_HYP); 1822bfa79a80SQuentin Perret if (ret) 1823bfa79a80SQuentin Perret return ret; 1824bfa79a80SQuentin Perret 1825bfa79a80SQuentin Perret ret = do_pkvm_init(hyp_va_bits); 1826bfa79a80SQuentin Perret if (ret) 1827bfa79a80SQuentin Perret return ret; 1828bfa79a80SQuentin Perret 1829bfa79a80SQuentin Perret free_hyp_pgds(); 1830bfa79a80SQuentin Perret 1831bfa79a80SQuentin Perret return 0; 1832bfa79a80SQuentin Perret } 1833bfa79a80SQuentin Perret 18349ed24f4bSMarc Zyngier /** 18359ed24f4bSMarc Zyngier * Inits Hyp-mode on all online CPUs 18369ed24f4bSMarc Zyngier */ 18379ed24f4bSMarc Zyngier static int init_hyp_mode(void) 18389ed24f4bSMarc Zyngier { 1839bfa79a80SQuentin Perret u32 hyp_va_bits; 18409ed24f4bSMarc Zyngier int cpu; 1841bfa79a80SQuentin Perret int err = -ENOMEM; 1842bfa79a80SQuentin Perret 1843bfa79a80SQuentin Perret /* 1844bfa79a80SQuentin Perret * The protected Hyp-mode cannot be initialized if the memory pool 1845bfa79a80SQuentin Perret * allocation has failed. 1846bfa79a80SQuentin Perret */ 1847bfa79a80SQuentin Perret if (is_protected_kvm_enabled() && !hyp_mem_base) 1848bfa79a80SQuentin Perret goto out_err; 18499ed24f4bSMarc Zyngier 18509ed24f4bSMarc Zyngier /* 18519ed24f4bSMarc Zyngier * Allocate Hyp PGD and setup Hyp identity mapping 18529ed24f4bSMarc Zyngier */ 1853bfa79a80SQuentin Perret err = kvm_mmu_init(&hyp_va_bits); 18549ed24f4bSMarc Zyngier if (err) 18559ed24f4bSMarc Zyngier goto out_err; 18569ed24f4bSMarc Zyngier 18579ed24f4bSMarc Zyngier /* 18589ed24f4bSMarc Zyngier * Allocate stack pages for Hypervisor-mode 18599ed24f4bSMarc Zyngier */ 18609ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 18619ed24f4bSMarc Zyngier unsigned long stack_page; 18629ed24f4bSMarc Zyngier 18639ed24f4bSMarc Zyngier stack_page = __get_free_page(GFP_KERNEL); 18649ed24f4bSMarc Zyngier if (!stack_page) { 18659ed24f4bSMarc Zyngier err = -ENOMEM; 18669ed24f4bSMarc Zyngier goto out_err; 18679ed24f4bSMarc Zyngier } 18689ed24f4bSMarc Zyngier 18699ed24f4bSMarc Zyngier per_cpu(kvm_arm_hyp_stack_page, cpu) = stack_page; 18709ed24f4bSMarc Zyngier } 18719ed24f4bSMarc Zyngier 18729ed24f4bSMarc Zyngier /* 187330c95391SDavid Brazdil * Allocate and initialize pages for Hypervisor-mode percpu regions. 187430c95391SDavid Brazdil */ 187530c95391SDavid Brazdil for_each_possible_cpu(cpu) { 187630c95391SDavid Brazdil struct page *page; 187730c95391SDavid Brazdil void *page_addr; 187830c95391SDavid Brazdil 187930c95391SDavid Brazdil page = alloc_pages(GFP_KERNEL, nvhe_percpu_order()); 188030c95391SDavid Brazdil if (!page) { 188130c95391SDavid Brazdil err = -ENOMEM; 188230c95391SDavid Brazdil goto out_err; 188330c95391SDavid Brazdil } 188430c95391SDavid Brazdil 188530c95391SDavid Brazdil page_addr = page_address(page); 188630c95391SDavid Brazdil memcpy(page_addr, CHOOSE_NVHE_SYM(__per_cpu_start), nvhe_percpu_size()); 188730c95391SDavid Brazdil kvm_arm_hyp_percpu_base[cpu] = (unsigned long)page_addr; 188830c95391SDavid Brazdil } 188930c95391SDavid Brazdil 189030c95391SDavid Brazdil /* 18919ed24f4bSMarc Zyngier * Map the Hyp-code called directly from the host 18929ed24f4bSMarc Zyngier */ 18939ed24f4bSMarc Zyngier err = create_hyp_mappings(kvm_ksym_ref(__hyp_text_start), 18949ed24f4bSMarc Zyngier kvm_ksym_ref(__hyp_text_end), PAGE_HYP_EXEC); 18959ed24f4bSMarc Zyngier if (err) { 18969ed24f4bSMarc Zyngier kvm_err("Cannot map world-switch code\n"); 18979ed24f4bSMarc Zyngier goto out_err; 18989ed24f4bSMarc Zyngier } 18999ed24f4bSMarc Zyngier 190016174eeaSDavid Brazdil err = create_hyp_mappings(kvm_ksym_ref(__hyp_rodata_start), 190116174eeaSDavid Brazdil kvm_ksym_ref(__hyp_rodata_end), PAGE_HYP_RO); 19022d7bf218SDavid Brazdil if (err) { 190316174eeaSDavid Brazdil kvm_err("Cannot map .hyp.rodata section\n"); 19042d7bf218SDavid Brazdil goto out_err; 19052d7bf218SDavid Brazdil } 19062d7bf218SDavid Brazdil 19079ed24f4bSMarc Zyngier err = create_hyp_mappings(kvm_ksym_ref(__start_rodata), 19089ed24f4bSMarc Zyngier kvm_ksym_ref(__end_rodata), PAGE_HYP_RO); 19099ed24f4bSMarc Zyngier if (err) { 19109ed24f4bSMarc Zyngier kvm_err("Cannot map rodata section\n"); 19119ed24f4bSMarc Zyngier goto out_err; 19129ed24f4bSMarc Zyngier } 19139ed24f4bSMarc Zyngier 1914380e18adSQuentin Perret /* 1915380e18adSQuentin Perret * .hyp.bss is guaranteed to be placed at the beginning of the .bss 1916380e18adSQuentin Perret * section thanks to an assertion in the linker script. Map it RW and 1917380e18adSQuentin Perret * the rest of .bss RO. 1918380e18adSQuentin Perret */ 1919380e18adSQuentin Perret err = create_hyp_mappings(kvm_ksym_ref(__hyp_bss_start), 1920380e18adSQuentin Perret kvm_ksym_ref(__hyp_bss_end), PAGE_HYP); 1921380e18adSQuentin Perret if (err) { 1922380e18adSQuentin Perret kvm_err("Cannot map hyp bss section: %d\n", err); 1923380e18adSQuentin Perret goto out_err; 1924380e18adSQuentin Perret } 1925380e18adSQuentin Perret 1926380e18adSQuentin Perret err = create_hyp_mappings(kvm_ksym_ref(__hyp_bss_end), 19279ed24f4bSMarc Zyngier kvm_ksym_ref(__bss_stop), PAGE_HYP_RO); 19289ed24f4bSMarc Zyngier if (err) { 19299ed24f4bSMarc Zyngier kvm_err("Cannot map bss section\n"); 19309ed24f4bSMarc Zyngier goto out_err; 19319ed24f4bSMarc Zyngier } 19329ed24f4bSMarc Zyngier 19339ed24f4bSMarc Zyngier /* 19349ed24f4bSMarc Zyngier * Map the Hyp stack pages 19359ed24f4bSMarc Zyngier */ 19369ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 19379ed24f4bSMarc Zyngier char *stack_page = (char *)per_cpu(kvm_arm_hyp_stack_page, cpu); 19389ed24f4bSMarc Zyngier err = create_hyp_mappings(stack_page, stack_page + PAGE_SIZE, 19399ed24f4bSMarc Zyngier PAGE_HYP); 19409ed24f4bSMarc Zyngier 19419ed24f4bSMarc Zyngier if (err) { 19429ed24f4bSMarc Zyngier kvm_err("Cannot map hyp stack\n"); 19439ed24f4bSMarc Zyngier goto out_err; 19449ed24f4bSMarc Zyngier } 19459ed24f4bSMarc Zyngier } 19469ed24f4bSMarc Zyngier 19479ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 194830c95391SDavid Brazdil char *percpu_begin = (char *)kvm_arm_hyp_percpu_base[cpu]; 194930c95391SDavid Brazdil char *percpu_end = percpu_begin + nvhe_percpu_size(); 19509ed24f4bSMarc Zyngier 19519cc77581SQuentin Perret /* Map Hyp percpu pages */ 195230c95391SDavid Brazdil err = create_hyp_mappings(percpu_begin, percpu_end, PAGE_HYP); 19539ed24f4bSMarc Zyngier if (err) { 195430c95391SDavid Brazdil kvm_err("Cannot map hyp percpu region\n"); 19556e3bfbb2SAndrew Scull goto out_err; 19566e3bfbb2SAndrew Scull } 19579cc77581SQuentin Perret 19589cc77581SQuentin Perret /* Prepare the CPU initialization parameters */ 19599cc77581SQuentin Perret cpu_prepare_hyp_mode(cpu); 19609ed24f4bSMarc Zyngier } 19619ed24f4bSMarc Zyngier 1962eeeee719SDavid Brazdil if (is_protected_kvm_enabled()) { 196394f5e8a4SDavid Brazdil init_cpu_logical_map(); 196494f5e8a4SDavid Brazdil 196552b9e265SWang Wensheng if (!init_psci_relay()) { 196652b9e265SWang Wensheng err = -ENODEV; 1967eeeee719SDavid Brazdil goto out_err; 1968eeeee719SDavid Brazdil } 196952b9e265SWang Wensheng } 1970eeeee719SDavid Brazdil 1971bfa79a80SQuentin Perret if (is_protected_kvm_enabled()) { 1972bfa79a80SQuentin Perret err = kvm_hyp_init_protection(hyp_va_bits); 1973bfa79a80SQuentin Perret if (err) { 1974bfa79a80SQuentin Perret kvm_err("Failed to init hyp memory protection\n"); 1975bfa79a80SQuentin Perret goto out_err; 1976bfa79a80SQuentin Perret } 1977bfa79a80SQuentin Perret } 19789ed24f4bSMarc Zyngier 19799ed24f4bSMarc Zyngier return 0; 19809ed24f4bSMarc Zyngier 19819ed24f4bSMarc Zyngier out_err: 19829ed24f4bSMarc Zyngier teardown_hyp_mode(); 19839ed24f4bSMarc Zyngier kvm_err("error initializing Hyp mode: %d\n", err); 19849ed24f4bSMarc Zyngier return err; 19859ed24f4bSMarc Zyngier } 19869ed24f4bSMarc Zyngier 1987b1306fefSXu Jia static void _kvm_host_prot_finalize(void *discard) 19881025c8c0SQuentin Perret { 19891025c8c0SQuentin Perret WARN_ON(kvm_call_hyp_nvhe(__pkvm_prot_finalize)); 19901025c8c0SQuentin Perret } 19911025c8c0SQuentin Perret 1992bfa79a80SQuentin Perret static int finalize_hyp_mode(void) 1993bfa79a80SQuentin Perret { 1994bfa79a80SQuentin Perret if (!is_protected_kvm_enabled()) 1995bfa79a80SQuentin Perret return 0; 1996bfa79a80SQuentin Perret 199747e6223cSMarc Zyngier /* 199847e6223cSMarc Zyngier * Exclude HYP BSS from kmemleak so that it doesn't get peeked 199947e6223cSMarc Zyngier * at, which would end badly once the section is inaccessible. 200047e6223cSMarc Zyngier * None of other sections should ever be introspected. 200147e6223cSMarc Zyngier */ 200247e6223cSMarc Zyngier kmemleak_free_part(__hyp_bss_start, __hyp_bss_end - __hyp_bss_start); 200390134ac9SQuentin Perret 20041025c8c0SQuentin Perret /* 20051025c8c0SQuentin Perret * Flip the static key upfront as that may no longer be possible 20061025c8c0SQuentin Perret * once the host stage 2 is installed. 20071025c8c0SQuentin Perret */ 2008bfa79a80SQuentin Perret static_branch_enable(&kvm_protected_mode_initialized); 20091025c8c0SQuentin Perret on_each_cpu(_kvm_host_prot_finalize, NULL, 1); 2010bfa79a80SQuentin Perret 2011bfa79a80SQuentin Perret return 0; 2012bfa79a80SQuentin Perret } 2013bfa79a80SQuentin Perret 20149ed24f4bSMarc Zyngier struct kvm_vcpu *kvm_mpidr_to_vcpu(struct kvm *kvm, unsigned long mpidr) 20159ed24f4bSMarc Zyngier { 20169ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 20179ed24f4bSMarc Zyngier int i; 20189ed24f4bSMarc Zyngier 20199ed24f4bSMarc Zyngier mpidr &= MPIDR_HWID_BITMASK; 20209ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) { 20219ed24f4bSMarc Zyngier if (mpidr == kvm_vcpu_get_mpidr_aff(vcpu)) 20229ed24f4bSMarc Zyngier return vcpu; 20239ed24f4bSMarc Zyngier } 20249ed24f4bSMarc Zyngier return NULL; 20259ed24f4bSMarc Zyngier } 20269ed24f4bSMarc Zyngier 20279ed24f4bSMarc Zyngier bool kvm_arch_has_irq_bypass(void) 20289ed24f4bSMarc Zyngier { 20299ed24f4bSMarc Zyngier return true; 20309ed24f4bSMarc Zyngier } 20319ed24f4bSMarc Zyngier 20329ed24f4bSMarc Zyngier int kvm_arch_irq_bypass_add_producer(struct irq_bypass_consumer *cons, 20339ed24f4bSMarc Zyngier struct irq_bypass_producer *prod) 20349ed24f4bSMarc Zyngier { 20359ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 20369ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 20379ed24f4bSMarc Zyngier 20389ed24f4bSMarc Zyngier return kvm_vgic_v4_set_forwarding(irqfd->kvm, prod->irq, 20399ed24f4bSMarc Zyngier &irqfd->irq_entry); 20409ed24f4bSMarc Zyngier } 20419ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_del_producer(struct irq_bypass_consumer *cons, 20429ed24f4bSMarc Zyngier struct irq_bypass_producer *prod) 20439ed24f4bSMarc Zyngier { 20449ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 20459ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 20469ed24f4bSMarc Zyngier 20479ed24f4bSMarc Zyngier kvm_vgic_v4_unset_forwarding(irqfd->kvm, prod->irq, 20489ed24f4bSMarc Zyngier &irqfd->irq_entry); 20499ed24f4bSMarc Zyngier } 20509ed24f4bSMarc Zyngier 20519ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_stop(struct irq_bypass_consumer *cons) 20529ed24f4bSMarc Zyngier { 20539ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 20549ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 20559ed24f4bSMarc Zyngier 20569ed24f4bSMarc Zyngier kvm_arm_halt_guest(irqfd->kvm); 20579ed24f4bSMarc Zyngier } 20589ed24f4bSMarc Zyngier 20599ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_start(struct irq_bypass_consumer *cons) 20609ed24f4bSMarc Zyngier { 20619ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 20629ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 20639ed24f4bSMarc Zyngier 20649ed24f4bSMarc Zyngier kvm_arm_resume_guest(irqfd->kvm); 20659ed24f4bSMarc Zyngier } 20669ed24f4bSMarc Zyngier 20679ed24f4bSMarc Zyngier /** 20689ed24f4bSMarc Zyngier * Initialize Hyp-mode and memory mappings on all CPUs. 20699ed24f4bSMarc Zyngier */ 20709ed24f4bSMarc Zyngier int kvm_arch_init(void *opaque) 20719ed24f4bSMarc Zyngier { 20729ed24f4bSMarc Zyngier int err; 20739ed24f4bSMarc Zyngier bool in_hyp_mode; 20749ed24f4bSMarc Zyngier 20759ed24f4bSMarc Zyngier if (!is_hyp_mode_available()) { 20769ed24f4bSMarc Zyngier kvm_info("HYP mode not available\n"); 20779ed24f4bSMarc Zyngier return -ENODEV; 20789ed24f4bSMarc Zyngier } 20799ed24f4bSMarc Zyngier 20809ed24f4bSMarc Zyngier in_hyp_mode = is_kernel_in_hyp_mode(); 20819ed24f4bSMarc Zyngier 208296d389caSRob Herring if (cpus_have_final_cap(ARM64_WORKAROUND_DEVICE_LOAD_ACQUIRE) || 208396d389caSRob Herring cpus_have_final_cap(ARM64_WORKAROUND_1508412)) 2084abf532ccSRob Herring kvm_info("Guests without required CPU erratum workarounds can deadlock system!\n" \ 2085abf532ccSRob Herring "Only trusted guests should be used on this system.\n"); 2086abf532ccSRob Herring 2087bf249d9eSAnshuman Khandual err = kvm_set_ipa_limit(); 20889ed24f4bSMarc Zyngier if (err) 20899ed24f4bSMarc Zyngier return err; 20909ed24f4bSMarc Zyngier 20919ed24f4bSMarc Zyngier err = kvm_arm_init_sve(); 20929ed24f4bSMarc Zyngier if (err) 20939ed24f4bSMarc Zyngier return err; 20949ed24f4bSMarc Zyngier 20959ed24f4bSMarc Zyngier if (!in_hyp_mode) { 20969ed24f4bSMarc Zyngier err = init_hyp_mode(); 20979ed24f4bSMarc Zyngier if (err) 20989ed24f4bSMarc Zyngier goto out_err; 20999ed24f4bSMarc Zyngier } 21009ed24f4bSMarc Zyngier 2101b881cdceSWill Deacon err = kvm_init_vector_slots(); 2102b881cdceSWill Deacon if (err) { 2103b881cdceSWill Deacon kvm_err("Cannot initialise vector slots\n"); 2104b881cdceSWill Deacon goto out_err; 2105b881cdceSWill Deacon } 2106b881cdceSWill Deacon 21079ed24f4bSMarc Zyngier err = init_subsystems(); 21089ed24f4bSMarc Zyngier if (err) 21099ed24f4bSMarc Zyngier goto out_hyp; 21109ed24f4bSMarc Zyngier 2111bfa79a80SQuentin Perret if (!in_hyp_mode) { 2112bfa79a80SQuentin Perret err = finalize_hyp_mode(); 2113bfa79a80SQuentin Perret if (err) { 2114bfa79a80SQuentin Perret kvm_err("Failed to finalize Hyp protection\n"); 2115bfa79a80SQuentin Perret goto out_hyp; 2116bfa79a80SQuentin Perret } 2117bfa79a80SQuentin Perret } 2118bfa79a80SQuentin Perret 2119f19f6644SDavid Brazdil if (is_protected_kvm_enabled()) { 21203eb681fbSDavid Brazdil kvm_info("Protected nVHE mode initialized successfully\n"); 2121f19f6644SDavid Brazdil } else if (in_hyp_mode) { 21229ed24f4bSMarc Zyngier kvm_info("VHE mode initialized successfully\n"); 2123f19f6644SDavid Brazdil } else { 21249ed24f4bSMarc Zyngier kvm_info("Hyp mode initialized successfully\n"); 2125f19f6644SDavid Brazdil } 21269ed24f4bSMarc Zyngier 21279ed24f4bSMarc Zyngier return 0; 21289ed24f4bSMarc Zyngier 21299ed24f4bSMarc Zyngier out_hyp: 21309ed24f4bSMarc Zyngier hyp_cpu_pm_exit(); 21319ed24f4bSMarc Zyngier if (!in_hyp_mode) 21329ed24f4bSMarc Zyngier teardown_hyp_mode(); 21339ed24f4bSMarc Zyngier out_err: 21349ed24f4bSMarc Zyngier return err; 21359ed24f4bSMarc Zyngier } 21369ed24f4bSMarc Zyngier 21379ed24f4bSMarc Zyngier /* NOP: Compiling as a module not supported */ 21389ed24f4bSMarc Zyngier void kvm_arch_exit(void) 21399ed24f4bSMarc Zyngier { 21409ed24f4bSMarc Zyngier kvm_perf_teardown(); 21419ed24f4bSMarc Zyngier } 21429ed24f4bSMarc Zyngier 2143d8b369c4SDavid Brazdil static int __init early_kvm_mode_cfg(char *arg) 2144d8b369c4SDavid Brazdil { 2145d8b369c4SDavid Brazdil if (!arg) 2146d8b369c4SDavid Brazdil return -EINVAL; 2147d8b369c4SDavid Brazdil 2148d8b369c4SDavid Brazdil if (strcmp(arg, "protected") == 0) { 2149d8b369c4SDavid Brazdil kvm_mode = KVM_MODE_PROTECTED; 2150d8b369c4SDavid Brazdil return 0; 2151d8b369c4SDavid Brazdil } 2152d8b369c4SDavid Brazdil 21531945a067SMarc Zyngier if (strcmp(arg, "nvhe") == 0 && !WARN_ON(is_kernel_in_hyp_mode())) 21541945a067SMarc Zyngier return 0; 21551945a067SMarc Zyngier 2156d8b369c4SDavid Brazdil return -EINVAL; 2157d8b369c4SDavid Brazdil } 2158d8b369c4SDavid Brazdil early_param("kvm-arm.mode", early_kvm_mode_cfg); 2159d8b369c4SDavid Brazdil 21603eb681fbSDavid Brazdil enum kvm_mode kvm_get_mode(void) 21613eb681fbSDavid Brazdil { 21623eb681fbSDavid Brazdil return kvm_mode; 21633eb681fbSDavid Brazdil } 21643eb681fbSDavid Brazdil 21659ed24f4bSMarc Zyngier static int arm_init(void) 21669ed24f4bSMarc Zyngier { 21679ed24f4bSMarc Zyngier int rc = kvm_init(NULL, sizeof(struct kvm_vcpu), 0, THIS_MODULE); 21689ed24f4bSMarc Zyngier return rc; 21699ed24f4bSMarc Zyngier } 21709ed24f4bSMarc Zyngier 21719ed24f4bSMarc Zyngier module_init(arm_init); 2172