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> 199ed24f4bSMarc Zyngier #include <linux/kvm.h> 209ed24f4bSMarc Zyngier #include <linux/kvm_irqfd.h> 219ed24f4bSMarc Zyngier #include <linux/irqbypass.h> 229ed24f4bSMarc Zyngier #include <linux/sched/stat.h> 23eeeee719SDavid Brazdil #include <linux/psci.h> 249ed24f4bSMarc Zyngier #include <trace/events/kvm.h> 259ed24f4bSMarc Zyngier 269ed24f4bSMarc Zyngier #define CREATE_TRACE_POINTS 279ed24f4bSMarc Zyngier #include "trace_arm.h" 289ed24f4bSMarc Zyngier 299ed24f4bSMarc Zyngier #include <linux/uaccess.h> 309ed24f4bSMarc Zyngier #include <asm/ptrace.h> 319ed24f4bSMarc Zyngier #include <asm/mman.h> 329ed24f4bSMarc Zyngier #include <asm/tlbflush.h> 339ed24f4bSMarc Zyngier #include <asm/cacheflush.h> 349ed24f4bSMarc Zyngier #include <asm/cpufeature.h> 359ed24f4bSMarc Zyngier #include <asm/virt.h> 369ed24f4bSMarc Zyngier #include <asm/kvm_arm.h> 379ed24f4bSMarc Zyngier #include <asm/kvm_asm.h> 389ed24f4bSMarc Zyngier #include <asm/kvm_mmu.h> 39a77b31dcSMarc Zyngier #include <asm/kvm_nested.h> 409d0c063aSFuad Tabba #include <asm/kvm_pkvm.h> 419ed24f4bSMarc Zyngier #include <asm/kvm_emulate.h> 429ed24f4bSMarc Zyngier #include <asm/sections.h> 439ed24f4bSMarc Zyngier 449ed24f4bSMarc Zyngier #include <kvm/arm_hypercalls.h> 459ed24f4bSMarc Zyngier #include <kvm/arm_pmu.h> 469ed24f4bSMarc Zyngier #include <kvm/arm_psci.h> 479ed24f4bSMarc Zyngier 48d8b369c4SDavid Brazdil static enum kvm_mode kvm_mode = KVM_MODE_DEFAULT; 49d8b369c4SDavid Brazdil 5014ef9d04SMarc Zyngier DECLARE_KVM_HYP_PER_CPU(unsigned long, kvm_hyp_vector); 5114ef9d04SMarc Zyngier 52db129d48SKalesh Singh DEFINE_PER_CPU(unsigned long, kvm_arm_hyp_stack_page); 5363fec243SDavid Brazdil DECLARE_KVM_NVHE_PER_CPU(struct kvm_nvhe_init_params, kvm_init_params); 549ed24f4bSMarc Zyngier 558c15c2a0SMostafa Saleh DECLARE_KVM_NVHE_PER_CPU(struct kvm_cpu_context, kvm_hyp_ctxt); 568c15c2a0SMostafa Saleh 57fa729bc7SSudeep Holla static bool vgic_present, kvm_arm_initialised; 589ed24f4bSMarc Zyngier 59733c758eSOliver Upton static DEFINE_PER_CPU(unsigned char, kvm_hyp_initialized); 609ed24f4bSMarc Zyngier DEFINE_STATIC_KEY_FALSE(userspace_irqchip_in_use); 619ed24f4bSMarc Zyngier 62fa729bc7SSudeep Holla bool is_kvm_arm_initialised(void) 63fa729bc7SSudeep Holla { 64fa729bc7SSudeep Holla return kvm_arm_initialised; 65fa729bc7SSudeep Holla } 66fa729bc7SSudeep Holla 679ed24f4bSMarc Zyngier int kvm_arch_vcpu_should_kick(struct kvm_vcpu *vcpu) 689ed24f4bSMarc Zyngier { 699ed24f4bSMarc Zyngier return kvm_vcpu_exiting_guest_mode(vcpu) == IN_GUEST_MODE; 709ed24f4bSMarc Zyngier } 719ed24f4bSMarc Zyngier 729ed24f4bSMarc Zyngier int kvm_vm_ioctl_enable_cap(struct kvm *kvm, 739ed24f4bSMarc Zyngier struct kvm_enable_cap *cap) 749ed24f4bSMarc Zyngier { 759ed24f4bSMarc Zyngier int r; 762f440b72SRicardo Koller u64 new_cap; 779ed24f4bSMarc Zyngier 789ed24f4bSMarc Zyngier if (cap->flags) 799ed24f4bSMarc Zyngier return -EINVAL; 809ed24f4bSMarc Zyngier 819ed24f4bSMarc Zyngier switch (cap->cap) { 829ed24f4bSMarc Zyngier case KVM_CAP_ARM_NISV_TO_USER: 839ed24f4bSMarc Zyngier r = 0; 8406394531SMarc Zyngier set_bit(KVM_ARCH_FLAG_RETURN_NISV_IO_ABORT_TO_USER, 8506394531SMarc Zyngier &kvm->arch.flags); 869ed24f4bSMarc Zyngier break; 87673638f4SSteven Price case KVM_CAP_ARM_MTE: 88c4d7c518SSteven Price mutex_lock(&kvm->lock); 89c4d7c518SSteven Price if (!system_supports_mte() || kvm->created_vcpus) { 90c4d7c518SSteven Price r = -EINVAL; 91c4d7c518SSteven Price } else { 92673638f4SSteven Price r = 0; 9306394531SMarc Zyngier set_bit(KVM_ARCH_FLAG_MTE_ENABLED, &kvm->arch.flags); 94c4d7c518SSteven Price } 95c4d7c518SSteven Price mutex_unlock(&kvm->lock); 96673638f4SSteven Price break; 97bfbab445SOliver Upton case KVM_CAP_ARM_SYSTEM_SUSPEND: 98bfbab445SOliver Upton r = 0; 99bfbab445SOliver Upton set_bit(KVM_ARCH_FLAG_SYSTEM_SUSPEND_ENABLED, &kvm->arch.flags); 100bfbab445SOliver Upton break; 1012f440b72SRicardo Koller case KVM_CAP_ARM_EAGER_SPLIT_CHUNK_SIZE: 1022f440b72SRicardo Koller new_cap = cap->args[0]; 1032f440b72SRicardo Koller 1042f440b72SRicardo Koller mutex_lock(&kvm->slots_lock); 1052f440b72SRicardo Koller /* 1062f440b72SRicardo Koller * To keep things simple, allow changing the chunk 1072f440b72SRicardo Koller * size only when no memory slots have been created. 1082f440b72SRicardo Koller */ 1092f440b72SRicardo Koller if (!kvm_are_all_memslots_empty(kvm)) { 1102f440b72SRicardo Koller r = -EINVAL; 1112f440b72SRicardo Koller } else if (new_cap && !kvm_is_block_size_supported(new_cap)) { 1122f440b72SRicardo Koller r = -EINVAL; 1132f440b72SRicardo Koller } else { 1142f440b72SRicardo Koller r = 0; 1152f440b72SRicardo Koller kvm->arch.mmu.split_page_chunk_size = new_cap; 1162f440b72SRicardo Koller } 1172f440b72SRicardo Koller mutex_unlock(&kvm->slots_lock); 1182f440b72SRicardo Koller break; 1199ed24f4bSMarc Zyngier default: 1209ed24f4bSMarc Zyngier r = -EINVAL; 1219ed24f4bSMarc Zyngier break; 1229ed24f4bSMarc Zyngier } 1239ed24f4bSMarc Zyngier 1249ed24f4bSMarc Zyngier return r; 1259ed24f4bSMarc Zyngier } 1269ed24f4bSMarc Zyngier 1275107000fSMarc Zyngier static int kvm_arm_default_max_vcpus(void) 1285107000fSMarc Zyngier { 1295107000fSMarc Zyngier return vgic_present ? kvm_vgic_get_max_vcpus() : KVM_MAX_VCPUS; 1305107000fSMarc Zyngier } 1315107000fSMarc Zyngier 1329ed24f4bSMarc Zyngier /** 1339ed24f4bSMarc Zyngier * kvm_arch_init_vm - initializes a VM data structure 1349ed24f4bSMarc Zyngier * @kvm: pointer to the KVM struct 1359ed24f4bSMarc Zyngier */ 1369ed24f4bSMarc Zyngier int kvm_arch_init_vm(struct kvm *kvm, unsigned long type) 1379ed24f4bSMarc Zyngier { 138a0e50aa3SChristoffer Dall int ret; 1399ed24f4bSMarc Zyngier 140c43120afSOliver Upton mutex_init(&kvm->arch.config_lock); 141c43120afSOliver Upton 142c43120afSOliver Upton #ifdef CONFIG_LOCKDEP 143c43120afSOliver Upton /* Clue in lockdep that the config_lock must be taken inside kvm->lock */ 144c43120afSOliver Upton mutex_lock(&kvm->lock); 145c43120afSOliver Upton mutex_lock(&kvm->arch.config_lock); 146c43120afSOliver Upton mutex_unlock(&kvm->arch.config_lock); 147c43120afSOliver Upton mutex_unlock(&kvm->lock); 148c43120afSOliver Upton #endif 149c43120afSOliver Upton 1503f868e14SQuentin Perret ret = kvm_share_hyp(kvm, kvm + 1); 1519ed24f4bSMarc Zyngier if (ret) 152315775ffSQuentin Perret return ret; 1539ed24f4bSMarc Zyngier 1549d0c063aSFuad Tabba ret = pkvm_init_host_vm(kvm); 1559d0c063aSFuad Tabba if (ret) 156315775ffSQuentin Perret goto err_unshare_kvm; 1579ed24f4bSMarc Zyngier 1585f623a59SOliver Upton if (!zalloc_cpumask_var(&kvm->arch.supported_cpus, GFP_KERNEL_ACCOUNT)) { 159ae187fecSWill Deacon ret = -ENOMEM; 160315775ffSQuentin Perret goto err_unshare_kvm; 161ae187fecSWill Deacon } 162583cda1bSAlexandru Elisei cpumask_copy(kvm->arch.supported_cpus, cpu_possible_mask); 163583cda1bSAlexandru Elisei 164315775ffSQuentin Perret ret = kvm_init_stage2_mmu(kvm, &kvm->arch.mmu, type); 165315775ffSQuentin Perret if (ret) 166315775ffSQuentin Perret goto err_free_cpumask; 167315775ffSQuentin Perret 1689ed24f4bSMarc Zyngier kvm_vgic_early_init(kvm); 1699ed24f4bSMarc Zyngier 1708a5eb2d2SMarc Zyngier kvm_timer_init_vm(kvm); 1718a5eb2d2SMarc Zyngier 1729ed24f4bSMarc Zyngier /* The maximum number of VCPUs is limited by the host's GIC model */ 173f502cc56SSean Christopherson kvm->max_vcpus = kvm_arm_default_max_vcpus(); 1749ed24f4bSMarc Zyngier 17505714cabSRaghavendra Rao Ananta kvm_arm_init_hypercalls(kvm); 17623711a5eSMarc Zyngier 1772251e9ffSOliver Upton bitmap_zero(kvm->arch.vcpu_features, KVM_VCPU_MAX_FEATURES); 1783d0dba57SMarc Zyngier 179315775ffSQuentin Perret return 0; 180315775ffSQuentin Perret 181315775ffSQuentin Perret err_free_cpumask: 182315775ffSQuentin Perret free_cpumask_var(kvm->arch.supported_cpus); 183315775ffSQuentin Perret err_unshare_kvm: 184315775ffSQuentin Perret kvm_unshare_hyp(kvm, kvm + 1); 1859ed24f4bSMarc Zyngier return ret; 1869ed24f4bSMarc Zyngier } 1879ed24f4bSMarc Zyngier 1889ed24f4bSMarc Zyngier vm_fault_t kvm_arch_vcpu_fault(struct kvm_vcpu *vcpu, struct vm_fault *vmf) 1899ed24f4bSMarc Zyngier { 1909ed24f4bSMarc Zyngier return VM_FAULT_SIGBUS; 1919ed24f4bSMarc Zyngier } 1929ed24f4bSMarc Zyngier 1939ed24f4bSMarc Zyngier 1949ed24f4bSMarc Zyngier /** 1959ed24f4bSMarc Zyngier * kvm_arch_destroy_vm - destroy the VM data structure 1969ed24f4bSMarc Zyngier * @kvm: pointer to the KVM struct 1979ed24f4bSMarc Zyngier */ 1989ed24f4bSMarc Zyngier void kvm_arch_destroy_vm(struct kvm *kvm) 1999ed24f4bSMarc Zyngier { 200d7eec236SMarc Zyngier bitmap_free(kvm->arch.pmu_filter); 201583cda1bSAlexandru Elisei free_cpumask_var(kvm->arch.supported_cpus); 202d7eec236SMarc Zyngier 2039ed24f4bSMarc Zyngier kvm_vgic_destroy(kvm); 2049ed24f4bSMarc Zyngier 2059d0c063aSFuad Tabba if (is_protected_kvm_enabled()) 2069d0c063aSFuad Tabba pkvm_destroy_hyp_vm(kvm); 2079d0c063aSFuad Tabba 2085544750eSMarc Zyngier kfree(kvm->arch.mpidr_data); 20927592ae8SMarc Zyngier kvm_destroy_vcpus(kvm); 21052b28657SQuentin Perret 21152b28657SQuentin Perret kvm_unshare_hyp(kvm, kvm + 1); 212fb88707dSOliver Upton 213fb88707dSOliver Upton kvm_arm_teardown_hypercalls(kvm); 2149ed24f4bSMarc Zyngier } 2159ed24f4bSMarc Zyngier 2169ed24f4bSMarc Zyngier int kvm_vm_ioctl_check_extension(struct kvm *kvm, long ext) 2179ed24f4bSMarc Zyngier { 2189ed24f4bSMarc Zyngier int r; 2199ed24f4bSMarc Zyngier switch (ext) { 2209ed24f4bSMarc Zyngier case KVM_CAP_IRQCHIP: 2219ed24f4bSMarc Zyngier r = vgic_present; 2229ed24f4bSMarc Zyngier break; 2239ed24f4bSMarc Zyngier case KVM_CAP_IOEVENTFD: 2249ed24f4bSMarc Zyngier case KVM_CAP_USER_MEMORY: 2259ed24f4bSMarc Zyngier case KVM_CAP_SYNC_MMU: 2269ed24f4bSMarc Zyngier case KVM_CAP_DESTROY_MEMORY_REGION_WORKS: 2279ed24f4bSMarc Zyngier case KVM_CAP_ONE_REG: 2289ed24f4bSMarc Zyngier case KVM_CAP_ARM_PSCI: 2299ed24f4bSMarc Zyngier case KVM_CAP_ARM_PSCI_0_2: 2309ed24f4bSMarc Zyngier case KVM_CAP_READONLY_MEM: 2319ed24f4bSMarc Zyngier case KVM_CAP_MP_STATE: 2329ed24f4bSMarc Zyngier case KVM_CAP_IMMEDIATE_EXIT: 2339ed24f4bSMarc Zyngier case KVM_CAP_VCPU_EVENTS: 2349ed24f4bSMarc Zyngier case KVM_CAP_ARM_IRQ_LINE_LAYOUT_2: 2359ed24f4bSMarc Zyngier case KVM_CAP_ARM_NISV_TO_USER: 2369ed24f4bSMarc Zyngier case KVM_CAP_ARM_INJECT_EXT_DABT: 23736fb4cd5SWill Deacon case KVM_CAP_SET_GUEST_DEBUG: 23836fb4cd5SWill Deacon case KVM_CAP_VCPU_ATTRIBUTES: 2393bf72569SJianyong Wu case KVM_CAP_PTP_KVM: 240bfbab445SOliver Upton case KVM_CAP_ARM_SYSTEM_SUSPEND: 24152882b9cSAlexey Kardashevskiy case KVM_CAP_IRQFD_RESAMPLE: 24230ec7997SMarc Zyngier case KVM_CAP_COUNTER_OFFSET: 2439ed24f4bSMarc Zyngier r = 1; 2449ed24f4bSMarc Zyngier break; 245fa18aca9SMaxim Levitsky case KVM_CAP_SET_GUEST_DEBUG2: 246fa18aca9SMaxim Levitsky return KVM_GUESTDBG_VALID_MASK; 2479ed24f4bSMarc Zyngier case KVM_CAP_ARM_SET_DEVICE_ADDR: 2489ed24f4bSMarc Zyngier r = 1; 2499ed24f4bSMarc Zyngier break; 2509ed24f4bSMarc Zyngier case KVM_CAP_NR_VCPUS: 251f60a00d7SVitaly Kuznetsov /* 252f60a00d7SVitaly Kuznetsov * ARM64 treats KVM_CAP_NR_CPUS differently from all other 253f60a00d7SVitaly Kuznetsov * architectures, as it does not always bound it to 254f60a00d7SVitaly Kuznetsov * KVM_CAP_MAX_VCPUS. It should not matter much because 255f60a00d7SVitaly Kuznetsov * this is just an advisory value. 256f60a00d7SVitaly Kuznetsov */ 257f60a00d7SVitaly Kuznetsov r = min_t(unsigned int, num_online_cpus(), 258f60a00d7SVitaly Kuznetsov kvm_arm_default_max_vcpus()); 2599ed24f4bSMarc Zyngier break; 2609ed24f4bSMarc Zyngier case KVM_CAP_MAX_VCPUS: 2619ed24f4bSMarc Zyngier case KVM_CAP_MAX_VCPU_ID: 2625107000fSMarc Zyngier if (kvm) 263f502cc56SSean Christopherson r = kvm->max_vcpus; 2645107000fSMarc Zyngier else 2655107000fSMarc Zyngier r = kvm_arm_default_max_vcpus(); 2669ed24f4bSMarc Zyngier break; 2679ed24f4bSMarc Zyngier case KVM_CAP_MSI_DEVID: 2689ed24f4bSMarc Zyngier if (!kvm) 2699ed24f4bSMarc Zyngier r = -EINVAL; 2709ed24f4bSMarc Zyngier else 2719ed24f4bSMarc Zyngier r = kvm->arch.vgic.msis_require_devid; 2729ed24f4bSMarc Zyngier break; 2739ed24f4bSMarc Zyngier case KVM_CAP_ARM_USER_IRQ: 2749ed24f4bSMarc Zyngier /* 2759ed24f4bSMarc Zyngier * 1: EL1_VTIMER, EL1_PTIMER, and PMU. 2769ed24f4bSMarc Zyngier * (bump this number if adding more devices) 2779ed24f4bSMarc Zyngier */ 2789ed24f4bSMarc Zyngier r = 1; 2799ed24f4bSMarc Zyngier break; 280673638f4SSteven Price case KVM_CAP_ARM_MTE: 281673638f4SSteven Price r = system_supports_mte(); 282673638f4SSteven Price break; 283004a0124SAndrew Jones case KVM_CAP_STEAL_TIME: 284004a0124SAndrew Jones r = kvm_arm_pvtime_supported(); 285004a0124SAndrew Jones break; 28636fb4cd5SWill Deacon case KVM_CAP_ARM_EL1_32BIT: 287d8569fbaSMark Rutland r = cpus_have_final_cap(ARM64_HAS_32BIT_EL1); 2889ed24f4bSMarc Zyngier break; 28936fb4cd5SWill Deacon case KVM_CAP_GUEST_DEBUG_HW_BPS: 29036fb4cd5SWill Deacon r = get_num_brps(); 29136fb4cd5SWill Deacon break; 29236fb4cd5SWill Deacon case KVM_CAP_GUEST_DEBUG_HW_WPS: 29336fb4cd5SWill Deacon r = get_num_wrps(); 29436fb4cd5SWill Deacon break; 29536fb4cd5SWill Deacon case KVM_CAP_ARM_PMU_V3: 29636fb4cd5SWill Deacon r = kvm_arm_support_pmu_v3(); 29736fb4cd5SWill Deacon break; 29836fb4cd5SWill Deacon case KVM_CAP_ARM_INJECT_SERROR_ESR: 299d8569fbaSMark Rutland r = cpus_have_final_cap(ARM64_HAS_RAS_EXTN); 30036fb4cd5SWill Deacon break; 30136fb4cd5SWill Deacon case KVM_CAP_ARM_VM_IPA_SIZE: 30236fb4cd5SWill Deacon r = get_kvm_ipa_limit(); 30336fb4cd5SWill Deacon break; 30436fb4cd5SWill Deacon case KVM_CAP_ARM_SVE: 30536fb4cd5SWill Deacon r = system_supports_sve(); 30636fb4cd5SWill Deacon break; 30736fb4cd5SWill Deacon case KVM_CAP_ARM_PTRAUTH_ADDRESS: 30836fb4cd5SWill Deacon case KVM_CAP_ARM_PTRAUTH_GENERIC: 30936fb4cd5SWill Deacon r = system_has_full_ptr_auth(); 31036fb4cd5SWill Deacon break; 3112f440b72SRicardo Koller case KVM_CAP_ARM_EAGER_SPLIT_CHUNK_SIZE: 3122f440b72SRicardo Koller if (kvm) 3132f440b72SRicardo Koller r = kvm->arch.mmu.split_page_chunk_size; 3142f440b72SRicardo Koller else 3152f440b72SRicardo Koller r = KVM_ARM_EAGER_SPLIT_CHUNK_SIZE_DEFAULT; 3162f440b72SRicardo Koller break; 3172f440b72SRicardo Koller case KVM_CAP_ARM_SUPPORTED_BLOCK_SIZES: 3182f440b72SRicardo Koller r = kvm_supported_block_sizes(); 3192f440b72SRicardo Koller break; 3203f9cd0caSJing Zhang case KVM_CAP_ARM_SUPPORTED_REG_MASK_RANGES: 3213f9cd0caSJing Zhang r = BIT(0); 3223f9cd0caSJing Zhang break; 32336fb4cd5SWill Deacon default: 32436fb4cd5SWill Deacon r = 0; 3259ed24f4bSMarc Zyngier } 32636fb4cd5SWill Deacon 3279ed24f4bSMarc Zyngier return r; 3289ed24f4bSMarc Zyngier } 3299ed24f4bSMarc Zyngier 3309ed24f4bSMarc Zyngier long kvm_arch_dev_ioctl(struct file *filp, 3319ed24f4bSMarc Zyngier unsigned int ioctl, unsigned long arg) 3329ed24f4bSMarc Zyngier { 3339ed24f4bSMarc Zyngier return -EINVAL; 3349ed24f4bSMarc Zyngier } 3359ed24f4bSMarc Zyngier 3369ed24f4bSMarc Zyngier struct kvm *kvm_arch_alloc_vm(void) 3379ed24f4bSMarc Zyngier { 338115bae92SJia He size_t sz = sizeof(struct kvm); 3399ed24f4bSMarc Zyngier 340115bae92SJia He if (!has_vhe()) 341115bae92SJia He return kzalloc(sz, GFP_KERNEL_ACCOUNT); 342115bae92SJia He 343115bae92SJia He return __vmalloc(sz, GFP_KERNEL_ACCOUNT | __GFP_HIGHMEM | __GFP_ZERO); 3449ed24f4bSMarc Zyngier } 3459ed24f4bSMarc Zyngier 3469ed24f4bSMarc Zyngier int kvm_arch_vcpu_precreate(struct kvm *kvm, unsigned int id) 3479ed24f4bSMarc Zyngier { 3489ed24f4bSMarc Zyngier if (irqchip_in_kernel(kvm) && vgic_initialized(kvm)) 3499ed24f4bSMarc Zyngier return -EBUSY; 3509ed24f4bSMarc Zyngier 351f502cc56SSean Christopherson if (id >= kvm->max_vcpus) 3529ed24f4bSMarc Zyngier return -EINVAL; 3539ed24f4bSMarc Zyngier 3549ed24f4bSMarc Zyngier return 0; 3559ed24f4bSMarc Zyngier } 3569ed24f4bSMarc Zyngier 3579ed24f4bSMarc Zyngier int kvm_arch_vcpu_create(struct kvm_vcpu *vcpu) 3589ed24f4bSMarc Zyngier { 3599ed24f4bSMarc Zyngier int err; 3609ed24f4bSMarc Zyngier 3610acc7239SOliver Upton spin_lock_init(&vcpu->arch.mp_state_lock); 3620acc7239SOliver Upton 363c43120afSOliver Upton #ifdef CONFIG_LOCKDEP 364c43120afSOliver Upton /* Inform lockdep that the config_lock is acquired after vcpu->mutex */ 365c43120afSOliver Upton mutex_lock(&vcpu->mutex); 366c43120afSOliver Upton mutex_lock(&vcpu->kvm->arch.config_lock); 367c43120afSOliver Upton mutex_unlock(&vcpu->kvm->arch.config_lock); 368c43120afSOliver Upton mutex_unlock(&vcpu->mutex); 369c43120afSOliver Upton #endif 370c43120afSOliver Upton 3719ed24f4bSMarc Zyngier /* Force users to call KVM_ARM_VCPU_INIT */ 372ef984060SOliver Upton vcpu_clear_flag(vcpu, VCPU_INITIALIZED); 3739ed24f4bSMarc Zyngier 374e539451bSSean Christopherson vcpu->arch.mmu_page_cache.gfp_zero = __GFP_ZERO; 375e539451bSSean Christopherson 376b4da9187SMarc Zyngier /* 377b4da9187SMarc Zyngier * Default value for the FP state, will be overloaded at load 378b4da9187SMarc Zyngier * time if we support FP (pretty likely) 379b4da9187SMarc Zyngier */ 380b4da9187SMarc Zyngier vcpu->arch.fp_state = FP_STATE_FREE; 381b4da9187SMarc Zyngier 3829ed24f4bSMarc Zyngier /* Set up the timer */ 3839ed24f4bSMarc Zyngier kvm_timer_vcpu_init(vcpu); 3849ed24f4bSMarc Zyngier 3859ed24f4bSMarc Zyngier kvm_pmu_vcpu_init(vcpu); 3869ed24f4bSMarc Zyngier 3879ed24f4bSMarc Zyngier kvm_arm_reset_debug_ptr(vcpu); 3889ed24f4bSMarc Zyngier 3899ed24f4bSMarc Zyngier kvm_arm_pvtime_vcpu_init(&vcpu->arch); 3909ed24f4bSMarc Zyngier 391a0e50aa3SChristoffer Dall vcpu->arch.hw_mmu = &vcpu->kvm->arch.mmu; 392a0e50aa3SChristoffer Dall 3939ed24f4bSMarc Zyngier err = kvm_vgic_vcpu_init(vcpu); 3949ed24f4bSMarc Zyngier if (err) 3959ed24f4bSMarc Zyngier return err; 3969ed24f4bSMarc Zyngier 3973f868e14SQuentin Perret return kvm_share_hyp(vcpu, vcpu + 1); 3989ed24f4bSMarc Zyngier } 3999ed24f4bSMarc Zyngier 4009ed24f4bSMarc Zyngier void kvm_arch_vcpu_postcreate(struct kvm_vcpu *vcpu) 4019ed24f4bSMarc Zyngier { 4029ed24f4bSMarc Zyngier } 4039ed24f4bSMarc Zyngier 4049ed24f4bSMarc Zyngier void kvm_arch_vcpu_destroy(struct kvm_vcpu *vcpu) 4059ed24f4bSMarc Zyngier { 406cc5705fbSMarc Zyngier if (vcpu_has_run_once(vcpu) && unlikely(!irqchip_in_kernel(vcpu->kvm))) 4079ed24f4bSMarc Zyngier static_branch_dec(&userspace_irqchip_in_use); 4089ed24f4bSMarc Zyngier 4099af3e08bSWill Deacon kvm_mmu_free_memory_cache(&vcpu->arch.mmu_page_cache); 4109ed24f4bSMarc Zyngier kvm_timer_vcpu_terminate(vcpu); 4119ed24f4bSMarc Zyngier kvm_pmu_vcpu_destroy(vcpu); 41202e3858fSMarc Zyngier kvm_vgic_vcpu_destroy(vcpu); 4139ed24f4bSMarc Zyngier kvm_arm_vcpu_destroy(vcpu); 4149ed24f4bSMarc Zyngier } 4159ed24f4bSMarc Zyngier 4169ed24f4bSMarc Zyngier void kvm_arch_vcpu_blocking(struct kvm_vcpu *vcpu) 4179ed24f4bSMarc Zyngier { 4186109c5a6SSean Christopherson 4199ed24f4bSMarc Zyngier } 4209ed24f4bSMarc Zyngier 4219ed24f4bSMarc Zyngier void kvm_arch_vcpu_unblocking(struct kvm_vcpu *vcpu) 4229ed24f4bSMarc Zyngier { 4236109c5a6SSean Christopherson 4249ed24f4bSMarc Zyngier } 4259ed24f4bSMarc Zyngier 4269ed24f4bSMarc Zyngier void kvm_arch_vcpu_load(struct kvm_vcpu *vcpu, int cpu) 4279ed24f4bSMarc Zyngier { 428a0e50aa3SChristoffer Dall struct kvm_s2_mmu *mmu; 4299ed24f4bSMarc Zyngier int *last_ran; 4309ed24f4bSMarc Zyngier 431a0e50aa3SChristoffer Dall mmu = vcpu->arch.hw_mmu; 432a0e50aa3SChristoffer Dall last_ran = this_cpu_ptr(mmu->last_vcpu_ran); 4339ed24f4bSMarc Zyngier 4349ed24f4bSMarc Zyngier /* 43501dc9262SMarc Zyngier * We guarantee that both TLBs and I-cache are private to each 43601dc9262SMarc Zyngier * vcpu. If detecting that a vcpu from the same VM has 43701dc9262SMarc Zyngier * previously run on the same physical CPU, call into the 43801dc9262SMarc Zyngier * hypervisor code to nuke the relevant contexts. 43901dc9262SMarc Zyngier * 4409ed24f4bSMarc Zyngier * We might get preempted before the vCPU actually runs, but 4419ed24f4bSMarc Zyngier * over-invalidation doesn't affect correctness. 4429ed24f4bSMarc Zyngier */ 4435f4bd815SMarc Zyngier if (*last_ran != vcpu->vcpu_idx) { 44401dc9262SMarc Zyngier kvm_call_hyp(__kvm_flush_cpu_context, mmu); 4455f4bd815SMarc Zyngier *last_ran = vcpu->vcpu_idx; 4469ed24f4bSMarc Zyngier } 4479ed24f4bSMarc Zyngier 4489ed24f4bSMarc Zyngier vcpu->cpu = cpu; 4499ed24f4bSMarc Zyngier 4509ed24f4bSMarc Zyngier kvm_vgic_load(vcpu); 4519ed24f4bSMarc Zyngier kvm_timer_vcpu_load(vcpu); 45213aeb9b4SDavid Brazdil if (has_vhe()) 45327cde4c0SOliver Upton kvm_vcpu_load_vhe(vcpu); 4549ed24f4bSMarc Zyngier kvm_arch_vcpu_load_fp(vcpu); 4559ed24f4bSMarc Zyngier kvm_vcpu_pmu_restore_guest(vcpu); 4569ed24f4bSMarc Zyngier if (kvm_arm_is_pvtime_enabled(&vcpu->arch)) 4579ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_RECORD_STEAL, vcpu); 4589ed24f4bSMarc Zyngier 4599ed24f4bSMarc Zyngier if (single_task_running()) 4609ed24f4bSMarc Zyngier vcpu_clear_wfx_traps(vcpu); 4619ed24f4bSMarc Zyngier else 4629ed24f4bSMarc Zyngier vcpu_set_wfx_traps(vcpu); 4639ed24f4bSMarc Zyngier 46429eb5a3cSMarc Zyngier if (vcpu_has_ptrauth(vcpu)) 465ef3e40a7SMarc Zyngier vcpu_ptrauth_disable(vcpu); 466d2602bb4SSuzuki K Poulose kvm_arch_vcpu_load_debug_state_flags(vcpu); 467583cda1bSAlexandru Elisei 4681ba11daeSShaoqin Huang if (!cpumask_test_cpu(cpu, vcpu->kvm->arch.supported_cpus)) 469583cda1bSAlexandru Elisei vcpu_set_on_unsupported_cpu(vcpu); 4709ed24f4bSMarc Zyngier } 4719ed24f4bSMarc Zyngier 4729ed24f4bSMarc Zyngier void kvm_arch_vcpu_put(struct kvm_vcpu *vcpu) 4739ed24f4bSMarc Zyngier { 474d2602bb4SSuzuki K Poulose kvm_arch_vcpu_put_debug_state_flags(vcpu); 4759ed24f4bSMarc Zyngier kvm_arch_vcpu_put_fp(vcpu); 47613aeb9b4SDavid Brazdil if (has_vhe()) 47727cde4c0SOliver Upton kvm_vcpu_put_vhe(vcpu); 4789ed24f4bSMarc Zyngier kvm_timer_vcpu_put(vcpu); 4799ed24f4bSMarc Zyngier kvm_vgic_put(vcpu); 4809ed24f4bSMarc Zyngier kvm_vcpu_pmu_restore_host(vcpu); 481100b4f09SShameer Kolothum kvm_arm_vmid_clear_active(); 4829ed24f4bSMarc Zyngier 483583cda1bSAlexandru Elisei vcpu_clear_on_unsupported_cpu(vcpu); 4849ed24f4bSMarc Zyngier vcpu->cpu = -1; 4859ed24f4bSMarc Zyngier } 4869ed24f4bSMarc Zyngier 4870acc7239SOliver Upton static void __kvm_arm_vcpu_power_off(struct kvm_vcpu *vcpu) 4889ed24f4bSMarc Zyngier { 4890acc7239SOliver Upton WRITE_ONCE(vcpu->arch.mp_state.mp_state, KVM_MP_STATE_STOPPED); 4909ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_SLEEP, vcpu); 4919ed24f4bSMarc Zyngier kvm_vcpu_kick(vcpu); 4929ed24f4bSMarc Zyngier } 4939ed24f4bSMarc Zyngier 4940acc7239SOliver Upton void kvm_arm_vcpu_power_off(struct kvm_vcpu *vcpu) 4950acc7239SOliver Upton { 4960acc7239SOliver Upton spin_lock(&vcpu->arch.mp_state_lock); 4970acc7239SOliver Upton __kvm_arm_vcpu_power_off(vcpu); 4980acc7239SOliver Upton spin_unlock(&vcpu->arch.mp_state_lock); 4990acc7239SOliver Upton } 5000acc7239SOliver Upton 501b171f9bbSOliver Upton bool kvm_arm_vcpu_stopped(struct kvm_vcpu *vcpu) 502b171f9bbSOliver Upton { 5030acc7239SOliver Upton return READ_ONCE(vcpu->arch.mp_state.mp_state) == KVM_MP_STATE_STOPPED; 504b171f9bbSOliver Upton } 505b171f9bbSOliver Upton 5067b33a09dSOliver Upton static void kvm_arm_vcpu_suspend(struct kvm_vcpu *vcpu) 5077b33a09dSOliver Upton { 5080acc7239SOliver Upton WRITE_ONCE(vcpu->arch.mp_state.mp_state, KVM_MP_STATE_SUSPENDED); 5097b33a09dSOliver Upton kvm_make_request(KVM_REQ_SUSPEND, vcpu); 5107b33a09dSOliver Upton kvm_vcpu_kick(vcpu); 5117b33a09dSOliver Upton } 5127b33a09dSOliver Upton 5137b33a09dSOliver Upton static bool kvm_arm_vcpu_suspended(struct kvm_vcpu *vcpu) 5147b33a09dSOliver Upton { 5150acc7239SOliver Upton return READ_ONCE(vcpu->arch.mp_state.mp_state) == KVM_MP_STATE_SUSPENDED; 5167b33a09dSOliver Upton } 5177b33a09dSOliver Upton 5189ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_get_mpstate(struct kvm_vcpu *vcpu, 5199ed24f4bSMarc Zyngier struct kvm_mp_state *mp_state) 5209ed24f4bSMarc Zyngier { 5210acc7239SOliver Upton *mp_state = READ_ONCE(vcpu->arch.mp_state); 5229ed24f4bSMarc Zyngier 5239ed24f4bSMarc Zyngier return 0; 5249ed24f4bSMarc Zyngier } 5259ed24f4bSMarc Zyngier 5269ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_set_mpstate(struct kvm_vcpu *vcpu, 5279ed24f4bSMarc Zyngier struct kvm_mp_state *mp_state) 5289ed24f4bSMarc Zyngier { 5299ed24f4bSMarc Zyngier int ret = 0; 5309ed24f4bSMarc Zyngier 5310acc7239SOliver Upton spin_lock(&vcpu->arch.mp_state_lock); 5320acc7239SOliver Upton 5339ed24f4bSMarc Zyngier switch (mp_state->mp_state) { 5349ed24f4bSMarc Zyngier case KVM_MP_STATE_RUNNABLE: 5350acc7239SOliver Upton WRITE_ONCE(vcpu->arch.mp_state, *mp_state); 5369ed24f4bSMarc Zyngier break; 5379ed24f4bSMarc Zyngier case KVM_MP_STATE_STOPPED: 5380acc7239SOliver Upton __kvm_arm_vcpu_power_off(vcpu); 5399ed24f4bSMarc Zyngier break; 5407b33a09dSOliver Upton case KVM_MP_STATE_SUSPENDED: 5417b33a09dSOliver Upton kvm_arm_vcpu_suspend(vcpu); 5429ed24f4bSMarc Zyngier break; 5439ed24f4bSMarc Zyngier default: 5449ed24f4bSMarc Zyngier ret = -EINVAL; 5459ed24f4bSMarc Zyngier } 5469ed24f4bSMarc Zyngier 5470acc7239SOliver Upton spin_unlock(&vcpu->arch.mp_state_lock); 5480acc7239SOliver Upton 5499ed24f4bSMarc Zyngier return ret; 5509ed24f4bSMarc Zyngier } 5519ed24f4bSMarc Zyngier 5529ed24f4bSMarc Zyngier /** 5539ed24f4bSMarc Zyngier * kvm_arch_vcpu_runnable - determine if the vcpu can be scheduled 5549ed24f4bSMarc Zyngier * @v: The VCPU pointer 5559ed24f4bSMarc Zyngier * 5569ed24f4bSMarc Zyngier * If the guest CPU is not waiting for interrupts or an interrupt line is 5579ed24f4bSMarc Zyngier * asserted, the CPU is by definition runnable. 5589ed24f4bSMarc Zyngier */ 5599ed24f4bSMarc Zyngier int kvm_arch_vcpu_runnable(struct kvm_vcpu *v) 5609ed24f4bSMarc Zyngier { 5619ed24f4bSMarc Zyngier bool irq_lines = *vcpu_hcr(v) & (HCR_VI | HCR_VF); 5629ed24f4bSMarc Zyngier return ((irq_lines || kvm_vgic_vcpu_pending_irq(v)) 563b171f9bbSOliver Upton && !kvm_arm_vcpu_stopped(v) && !v->arch.pause); 5649ed24f4bSMarc Zyngier } 5659ed24f4bSMarc Zyngier 5669ed24f4bSMarc Zyngier bool kvm_arch_vcpu_in_kernel(struct kvm_vcpu *vcpu) 5679ed24f4bSMarc Zyngier { 5689ed24f4bSMarc Zyngier return vcpu_mode_priv(vcpu); 5699ed24f4bSMarc Zyngier } 5709ed24f4bSMarc Zyngier 5718e5b0adeSLinus Torvalds #ifdef CONFIG_GUEST_PERF_EVENTS 572e1bfc245SSean Christopherson unsigned long kvm_arch_vcpu_get_ip(struct kvm_vcpu *vcpu) 573e1bfc245SSean Christopherson { 574e1bfc245SSean Christopherson return *vcpu_pc(vcpu); 575e1bfc245SSean Christopherson } 5768e5b0adeSLinus Torvalds #endif 577e1bfc245SSean Christopherson 578b5aa368aSMarc Zyngier static int kvm_vcpu_initialized(struct kvm_vcpu *vcpu) 579052f064dSMarc Zyngier { 580ef984060SOliver Upton return vcpu_get_flag(vcpu, VCPU_INITIALIZED); 581052f064dSMarc Zyngier } 582052f064dSMarc Zyngier 5835544750eSMarc Zyngier static void kvm_init_mpidr_data(struct kvm *kvm) 5845544750eSMarc Zyngier { 5855544750eSMarc Zyngier struct kvm_mpidr_data *data = NULL; 5865544750eSMarc Zyngier unsigned long c, mask, nr_entries; 5875544750eSMarc Zyngier u64 aff_set = 0, aff_clr = ~0UL; 5885544750eSMarc Zyngier struct kvm_vcpu *vcpu; 5895544750eSMarc Zyngier 5905544750eSMarc Zyngier mutex_lock(&kvm->arch.config_lock); 5915544750eSMarc Zyngier 5925544750eSMarc Zyngier if (kvm->arch.mpidr_data || atomic_read(&kvm->online_vcpus) == 1) 5935544750eSMarc Zyngier goto out; 5945544750eSMarc Zyngier 5955544750eSMarc Zyngier kvm_for_each_vcpu(c, vcpu, kvm) { 5965544750eSMarc Zyngier u64 aff = kvm_vcpu_get_mpidr_aff(vcpu); 5975544750eSMarc Zyngier aff_set |= aff; 5985544750eSMarc Zyngier aff_clr &= aff; 5995544750eSMarc Zyngier } 6005544750eSMarc Zyngier 6015544750eSMarc Zyngier /* 6025544750eSMarc Zyngier * A significant bit can be either 0 or 1, and will only appear in 6035544750eSMarc Zyngier * aff_set. Use aff_clr to weed out the useless stuff. 6045544750eSMarc Zyngier */ 6055544750eSMarc Zyngier mask = aff_set ^ aff_clr; 6065544750eSMarc Zyngier nr_entries = BIT_ULL(hweight_long(mask)); 6075544750eSMarc Zyngier 6085544750eSMarc Zyngier /* 6095544750eSMarc Zyngier * Don't let userspace fool us. If we need more than a single page 6105544750eSMarc Zyngier * to describe the compressed MPIDR array, just fall back to the 6115544750eSMarc Zyngier * iterative method. Single vcpu VMs do not need this either. 6125544750eSMarc Zyngier */ 6135544750eSMarc Zyngier if (struct_size(data, cmpidr_to_idx, nr_entries) <= PAGE_SIZE) 6145544750eSMarc Zyngier data = kzalloc(struct_size(data, cmpidr_to_idx, nr_entries), 6155544750eSMarc Zyngier GFP_KERNEL_ACCOUNT); 6165544750eSMarc Zyngier 6175544750eSMarc Zyngier if (!data) 6185544750eSMarc Zyngier goto out; 6195544750eSMarc Zyngier 6205544750eSMarc Zyngier data->mpidr_mask = mask; 6215544750eSMarc Zyngier 6225544750eSMarc Zyngier kvm_for_each_vcpu(c, vcpu, kvm) { 6235544750eSMarc Zyngier u64 aff = kvm_vcpu_get_mpidr_aff(vcpu); 6245544750eSMarc Zyngier u16 index = kvm_mpidr_index(data, aff); 6255544750eSMarc Zyngier 6265544750eSMarc Zyngier data->cmpidr_to_idx[index] = c; 6275544750eSMarc Zyngier } 6285544750eSMarc Zyngier 6295544750eSMarc Zyngier kvm->arch.mpidr_data = data; 6305544750eSMarc Zyngier out: 6315544750eSMarc Zyngier mutex_unlock(&kvm->arch.config_lock); 6325544750eSMarc Zyngier } 6335544750eSMarc Zyngier 634b5aa368aSMarc Zyngier /* 635b5aa368aSMarc Zyngier * Handle both the initialisation that is being done when the vcpu is 636b5aa368aSMarc Zyngier * run for the first time, as well as the updates that must be 637b5aa368aSMarc Zyngier * performed each time we get a new thread dealing with this vcpu. 638b5aa368aSMarc Zyngier */ 639b5aa368aSMarc Zyngier int kvm_arch_vcpu_run_pid_change(struct kvm_vcpu *vcpu) 6409ed24f4bSMarc Zyngier { 6419ed24f4bSMarc Zyngier struct kvm *kvm = vcpu->kvm; 642b5aa368aSMarc Zyngier int ret; 6439ed24f4bSMarc Zyngier 644b5aa368aSMarc Zyngier if (!kvm_vcpu_initialized(vcpu)) 645b5aa368aSMarc Zyngier return -ENOEXEC; 6469ed24f4bSMarc Zyngier 6479ed24f4bSMarc Zyngier if (!kvm_arm_vcpu_is_finalized(vcpu)) 6489ed24f4bSMarc Zyngier return -EPERM; 6499ed24f4bSMarc Zyngier 650b5aa368aSMarc Zyngier ret = kvm_arch_vcpu_run_map_fp(vcpu); 651b5aa368aSMarc Zyngier if (ret) 652b5aa368aSMarc Zyngier return ret; 653b5aa368aSMarc Zyngier 654cc5705fbSMarc Zyngier if (likely(vcpu_has_run_once(vcpu))) 655b5aa368aSMarc Zyngier return 0; 6569ed24f4bSMarc Zyngier 6575544750eSMarc Zyngier kvm_init_mpidr_data(kvm); 6585544750eSMarc Zyngier 659263d6287SAlexandru Elisei kvm_arm_vcpu_init_debug(vcpu); 660263d6287SAlexandru Elisei 6619ed24f4bSMarc Zyngier if (likely(irqchip_in_kernel(kvm))) { 6629ed24f4bSMarc Zyngier /* 6639ed24f4bSMarc Zyngier * Map the VGIC hardware resources before running a vcpu the 6649ed24f4bSMarc Zyngier * first time on this VM. 6659ed24f4bSMarc Zyngier */ 6669ed24f4bSMarc Zyngier ret = kvm_vgic_map_resources(kvm); 6679ed24f4bSMarc Zyngier if (ret) 6689ed24f4bSMarc Zyngier return ret; 6699ed24f4bSMarc Zyngier } 6709ed24f4bSMarc Zyngier 6713ed0b512SMarc Zyngier if (vcpu_has_nv(vcpu)) { 6723ed0b512SMarc Zyngier ret = kvm_init_nv_sysregs(vcpu->kvm); 6733ed0b512SMarc Zyngier if (ret) 6743ed0b512SMarc Zyngier return ret; 6753ed0b512SMarc Zyngier } 6763ed0b512SMarc Zyngier 6779ed24f4bSMarc Zyngier ret = kvm_timer_enable(vcpu); 6789ed24f4bSMarc Zyngier if (ret) 6799ed24f4bSMarc Zyngier return ret; 6809ed24f4bSMarc Zyngier 6819ed24f4bSMarc Zyngier ret = kvm_arm_pmu_v3_enable(vcpu); 6821408e73dSMarc Zyngier if (ret) 6831408e73dSMarc Zyngier return ret; 6841408e73dSMarc Zyngier 6859d0c063aSFuad Tabba if (is_protected_kvm_enabled()) { 6869d0c063aSFuad Tabba ret = pkvm_create_hyp_vm(kvm); 6879d0c063aSFuad Tabba if (ret) 6889d0c063aSFuad Tabba return ret; 6899d0c063aSFuad Tabba } 6909d0c063aSFuad Tabba 6911408e73dSMarc Zyngier if (!irqchip_in_kernel(kvm)) { 6921408e73dSMarc Zyngier /* 6931408e73dSMarc Zyngier * Tell the rest of the code that there are userspace irqchip 6941408e73dSMarc Zyngier * VMs in the wild. 6951408e73dSMarc Zyngier */ 6961408e73dSMarc Zyngier static_branch_inc(&userspace_irqchip_in_use); 6971408e73dSMarc Zyngier } 6989ed24f4bSMarc Zyngier 6992a0c3433SFuad Tabba /* 7002a0c3433SFuad Tabba * Initialize traps for protected VMs. 7012a0c3433SFuad Tabba * NOTE: Move to run in EL2 directly, rather than via a hypercall, once 7022a0c3433SFuad Tabba * the code is in place for first run initialization at EL2. 7032a0c3433SFuad Tabba */ 7042a0c3433SFuad Tabba if (kvm_vm_is_protected(kvm)) 7052a0c3433SFuad Tabba kvm_call_hyp_nvhe(__pkvm_vcpu_init_traps, vcpu); 7062a0c3433SFuad Tabba 7074bba7f7dSOliver Upton mutex_lock(&kvm->arch.config_lock); 70806394531SMarc Zyngier set_bit(KVM_ARCH_FLAG_HAS_RAN_ONCE, &kvm->arch.flags); 7094bba7f7dSOliver Upton mutex_unlock(&kvm->arch.config_lock); 7105177fe91SMarc Zyngier 7119ed24f4bSMarc Zyngier return ret; 7129ed24f4bSMarc Zyngier } 7139ed24f4bSMarc Zyngier 7149ed24f4bSMarc Zyngier bool kvm_arch_intc_initialized(struct kvm *kvm) 7159ed24f4bSMarc Zyngier { 7169ed24f4bSMarc Zyngier return vgic_initialized(kvm); 7179ed24f4bSMarc Zyngier } 7189ed24f4bSMarc Zyngier 7199ed24f4bSMarc Zyngier void kvm_arm_halt_guest(struct kvm *kvm) 7209ed24f4bSMarc Zyngier { 72146808a4cSMarc Zyngier unsigned long i; 7229ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 7239ed24f4bSMarc Zyngier 7249ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) 7259ed24f4bSMarc Zyngier vcpu->arch.pause = true; 7269ed24f4bSMarc Zyngier kvm_make_all_cpus_request(kvm, KVM_REQ_SLEEP); 7279ed24f4bSMarc Zyngier } 7289ed24f4bSMarc Zyngier 7299ed24f4bSMarc Zyngier void kvm_arm_resume_guest(struct kvm *kvm) 7309ed24f4bSMarc Zyngier { 73146808a4cSMarc Zyngier unsigned long i; 7329ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 7339ed24f4bSMarc Zyngier 7349ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) { 7359ed24f4bSMarc Zyngier vcpu->arch.pause = false; 736d92a5d1cSSean Christopherson __kvm_vcpu_wake_up(vcpu); 7379ed24f4bSMarc Zyngier } 7389ed24f4bSMarc Zyngier } 7399ed24f4bSMarc Zyngier 7401c6219e3SOliver Upton static void kvm_vcpu_sleep(struct kvm_vcpu *vcpu) 7419ed24f4bSMarc Zyngier { 74238060944SPaolo Bonzini struct rcuwait *wait = kvm_arch_vcpu_get_wait(vcpu); 7439ed24f4bSMarc Zyngier 74438060944SPaolo Bonzini rcuwait_wait_event(wait, 745b171f9bbSOliver Upton (!kvm_arm_vcpu_stopped(vcpu)) && (!vcpu->arch.pause), 74638060944SPaolo Bonzini TASK_INTERRUPTIBLE); 7479ed24f4bSMarc Zyngier 748b171f9bbSOliver Upton if (kvm_arm_vcpu_stopped(vcpu) || vcpu->arch.pause) { 7499ed24f4bSMarc Zyngier /* Awaken to handle a signal, request we sleep again later. */ 7509ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_SLEEP, vcpu); 7519ed24f4bSMarc Zyngier } 7529ed24f4bSMarc Zyngier 7539ed24f4bSMarc Zyngier /* 7549ed24f4bSMarc Zyngier * Make sure we will observe a potential reset request if we've 7559ed24f4bSMarc Zyngier * observed a change to the power state. Pairs with the smp_wmb() in 7569ed24f4bSMarc Zyngier * kvm_psci_vcpu_on(). 7579ed24f4bSMarc Zyngier */ 7589ed24f4bSMarc Zyngier smp_rmb(); 7599ed24f4bSMarc Zyngier } 7609ed24f4bSMarc Zyngier 7616109c5a6SSean Christopherson /** 7626109c5a6SSean Christopherson * kvm_vcpu_wfi - emulate Wait-For-Interrupt behavior 7636109c5a6SSean Christopherson * @vcpu: The VCPU pointer 7646109c5a6SSean Christopherson * 7656109c5a6SSean Christopherson * Suspend execution of a vCPU until a valid wake event is detected, i.e. until 7666109c5a6SSean Christopherson * the vCPU is runnable. The vCPU may or may not be scheduled out, depending 7676109c5a6SSean Christopherson * on when a wake event arrives, e.g. there may already be a pending wake event. 7686109c5a6SSean Christopherson */ 7696109c5a6SSean Christopherson void kvm_vcpu_wfi(struct kvm_vcpu *vcpu) 7706109c5a6SSean Christopherson { 7716109c5a6SSean Christopherson /* 7726109c5a6SSean Christopherson * Sync back the state of the GIC CPU interface so that we have 7736109c5a6SSean Christopherson * the latest PMR and group enables. This ensures that 7746109c5a6SSean Christopherson * kvm_arch_vcpu_runnable has up-to-date data to decide whether 7756109c5a6SSean Christopherson * we have pending interrupts, e.g. when determining if the 7766109c5a6SSean Christopherson * vCPU should block. 7776109c5a6SSean Christopherson * 7786109c5a6SSean Christopherson * For the same reason, we want to tell GICv4 that we need 7796109c5a6SSean Christopherson * doorbells to be signalled, should an interrupt become pending. 7806109c5a6SSean Christopherson */ 7816109c5a6SSean Christopherson preempt_disable(); 7826109c5a6SSean Christopherson kvm_vgic_vmcr_sync(vcpu); 783b321c31cSMarc Zyngier vcpu_set_flag(vcpu, IN_WFI); 784b321c31cSMarc Zyngier vgic_v4_put(vcpu); 7856109c5a6SSean Christopherson preempt_enable(); 7866109c5a6SSean Christopherson 78791b99ea7SSean Christopherson kvm_vcpu_halt(vcpu); 788eebc538dSMarc Zyngier vcpu_clear_flag(vcpu, IN_WFIT); 7896109c5a6SSean Christopherson 7906109c5a6SSean Christopherson preempt_disable(); 791b321c31cSMarc Zyngier vcpu_clear_flag(vcpu, IN_WFI); 7926109c5a6SSean Christopherson vgic_v4_load(vcpu); 7936109c5a6SSean Christopherson preempt_enable(); 7946109c5a6SSean Christopherson } 7956109c5a6SSean Christopherson 7967b33a09dSOliver Upton static int kvm_vcpu_suspend(struct kvm_vcpu *vcpu) 7977b33a09dSOliver Upton { 7987b33a09dSOliver Upton if (!kvm_arm_vcpu_suspended(vcpu)) 7997b33a09dSOliver Upton return 1; 8007b33a09dSOliver Upton 8017b33a09dSOliver Upton kvm_vcpu_wfi(vcpu); 8027b33a09dSOliver Upton 8037b33a09dSOliver Upton /* 8047b33a09dSOliver Upton * The suspend state is sticky; we do not leave it until userspace 8057b33a09dSOliver Upton * explicitly marks the vCPU as runnable. Request that we suspend again 8067b33a09dSOliver Upton * later. 8077b33a09dSOliver Upton */ 8087b33a09dSOliver Upton kvm_make_request(KVM_REQ_SUSPEND, vcpu); 8097b33a09dSOliver Upton 8107b33a09dSOliver Upton /* 8117b33a09dSOliver Upton * Check to make sure the vCPU is actually runnable. If so, exit to 8127b33a09dSOliver Upton * userspace informing it of the wakeup condition. 8137b33a09dSOliver Upton */ 8147b33a09dSOliver Upton if (kvm_arch_vcpu_runnable(vcpu)) { 8157b33a09dSOliver Upton memset(&vcpu->run->system_event, 0, sizeof(vcpu->run->system_event)); 8167b33a09dSOliver Upton vcpu->run->system_event.type = KVM_SYSTEM_EVENT_WAKEUP; 8177b33a09dSOliver Upton vcpu->run->exit_reason = KVM_EXIT_SYSTEM_EVENT; 8187b33a09dSOliver Upton return 0; 8197b33a09dSOliver Upton } 8207b33a09dSOliver Upton 8217b33a09dSOliver Upton /* 8227b33a09dSOliver Upton * Otherwise, we were unblocked to process a different event, such as a 8237b33a09dSOliver Upton * pending signal. Return 1 and allow kvm_arch_vcpu_ioctl_run() to 8247b33a09dSOliver Upton * process the event. 8257b33a09dSOliver Upton */ 8267b33a09dSOliver Upton return 1; 8277b33a09dSOliver Upton } 8287b33a09dSOliver Upton 8293fdd0459SOliver Upton /** 8303fdd0459SOliver Upton * check_vcpu_requests - check and handle pending vCPU requests 8313fdd0459SOliver Upton * @vcpu: the VCPU pointer 8323fdd0459SOliver Upton * 8333fdd0459SOliver Upton * Return: 1 if we should enter the guest 8343fdd0459SOliver Upton * 0 if we should exit to userspace 8353fdd0459SOliver Upton * < 0 if we should exit to userspace, where the return value indicates 8363fdd0459SOliver Upton * an error 8373fdd0459SOliver Upton */ 8383fdd0459SOliver Upton static int check_vcpu_requests(struct kvm_vcpu *vcpu) 8399ed24f4bSMarc Zyngier { 8409ed24f4bSMarc Zyngier if (kvm_request_pending(vcpu)) { 8419ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_SLEEP, vcpu)) 8421c6219e3SOliver Upton kvm_vcpu_sleep(vcpu); 8439ed24f4bSMarc Zyngier 8449ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu)) 8459ed24f4bSMarc Zyngier kvm_reset_vcpu(vcpu); 8469ed24f4bSMarc Zyngier 8479ed24f4bSMarc Zyngier /* 8489ed24f4bSMarc Zyngier * Clear IRQ_PENDING requests that were made to guarantee 8499ed24f4bSMarc Zyngier * that a VCPU sees new virtual interrupts. 8509ed24f4bSMarc Zyngier */ 8519ed24f4bSMarc Zyngier kvm_check_request(KVM_REQ_IRQ_PENDING, vcpu); 8529ed24f4bSMarc Zyngier 8539ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_RECORD_STEAL, vcpu)) 8549ed24f4bSMarc Zyngier kvm_update_stolen_time(vcpu); 8559ed24f4bSMarc Zyngier 8569ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_RELOAD_GICv4, vcpu)) { 8579ed24f4bSMarc Zyngier /* The distributor enable bits were changed */ 8589ed24f4bSMarc Zyngier preempt_disable(); 859b321c31cSMarc Zyngier vgic_v4_put(vcpu); 8609ed24f4bSMarc Zyngier vgic_v4_load(vcpu); 8619ed24f4bSMarc Zyngier preempt_enable(); 8629ed24f4bSMarc Zyngier } 863d0c94c49SMarc Zyngier 864d0c94c49SMarc Zyngier if (kvm_check_request(KVM_REQ_RELOAD_PMU, vcpu)) 86527131b19SRaghavendra Rao Ananta kvm_vcpu_reload_pmu(vcpu); 8667b33a09dSOliver Upton 867b1f778a2SMarc Zyngier if (kvm_check_request(KVM_REQ_RESYNC_PMU_EL0, vcpu)) 868b1f778a2SMarc Zyngier kvm_vcpu_pmu_restore_guest(vcpu); 869b1f778a2SMarc Zyngier 8707b33a09dSOliver Upton if (kvm_check_request(KVM_REQ_SUSPEND, vcpu)) 8717b33a09dSOliver Upton return kvm_vcpu_suspend(vcpu); 8729cb1096fSGavin Shan 8739cb1096fSGavin Shan if (kvm_dirty_ring_check_request(vcpu)) 8749cb1096fSGavin Shan return 0; 8759ed24f4bSMarc Zyngier } 8763fdd0459SOliver Upton 8773fdd0459SOliver Upton return 1; 8789ed24f4bSMarc Zyngier } 8799ed24f4bSMarc Zyngier 8802f6a49bbSWill Deacon static bool vcpu_mode_is_bad_32bit(struct kvm_vcpu *vcpu) 8812f6a49bbSWill Deacon { 8822f6a49bbSWill Deacon if (likely(!vcpu_mode_is_32bit(vcpu))) 8832f6a49bbSWill Deacon return false; 8842f6a49bbSWill Deacon 885a77b31dcSMarc Zyngier if (vcpu_has_nv(vcpu)) 886a77b31dcSMarc Zyngier return true; 887a77b31dcSMarc Zyngier 888f3c6efc7SOliver Upton return !kvm_supports_32bit_el0(); 8892f6a49bbSWill Deacon } 8902f6a49bbSWill Deacon 8919ed24f4bSMarc Zyngier /** 8926caa5812SOliver Upton * kvm_vcpu_exit_request - returns true if the VCPU should *not* enter the guest 8936caa5812SOliver Upton * @vcpu: The VCPU pointer 8946caa5812SOliver Upton * @ret: Pointer to write optional return code 8956caa5812SOliver Upton * 8966caa5812SOliver Upton * Returns: true if the VCPU needs to return to a preemptible + interruptible 8976caa5812SOliver Upton * and skip guest entry. 8986caa5812SOliver Upton * 8996caa5812SOliver Upton * This function disambiguates between two different types of exits: exits to a 9006caa5812SOliver Upton * preemptible + interruptible kernel context and exits to userspace. For an 9016caa5812SOliver Upton * exit to userspace, this function will write the return code to ret and return 9026caa5812SOliver Upton * true. For an exit to preemptible + interruptible kernel context (i.e. check 9036caa5812SOliver Upton * for pending work and re-enter), return true without writing to ret. 9046caa5812SOliver Upton */ 9056caa5812SOliver Upton static bool kvm_vcpu_exit_request(struct kvm_vcpu *vcpu, int *ret) 9066caa5812SOliver Upton { 9076caa5812SOliver Upton struct kvm_run *run = vcpu->run; 9086caa5812SOliver Upton 9096caa5812SOliver Upton /* 9106caa5812SOliver Upton * If we're using a userspace irqchip, then check if we need 9116caa5812SOliver Upton * to tell a userspace irqchip about timer or PMU level 9126caa5812SOliver Upton * changes and if so, exit to userspace (the actual level 9136caa5812SOliver Upton * state gets updated in kvm_timer_update_run and 9146caa5812SOliver Upton * kvm_pmu_update_run below). 9156caa5812SOliver Upton */ 9166caa5812SOliver Upton if (static_branch_unlikely(&userspace_irqchip_in_use)) { 9176caa5812SOliver Upton if (kvm_timer_should_notify_user(vcpu) || 9186caa5812SOliver Upton kvm_pmu_should_notify_user(vcpu)) { 9196caa5812SOliver Upton *ret = -EINTR; 9206caa5812SOliver Upton run->exit_reason = KVM_EXIT_INTR; 9216caa5812SOliver Upton return true; 9226caa5812SOliver Upton } 9236caa5812SOliver Upton } 9246caa5812SOliver Upton 925583cda1bSAlexandru Elisei if (unlikely(vcpu_on_unsupported_cpu(vcpu))) { 926583cda1bSAlexandru Elisei run->exit_reason = KVM_EXIT_FAIL_ENTRY; 927583cda1bSAlexandru Elisei run->fail_entry.hardware_entry_failure_reason = KVM_EXIT_FAIL_ENTRY_CPU_UNSUPPORTED; 928583cda1bSAlexandru Elisei run->fail_entry.cpu = smp_processor_id(); 929583cda1bSAlexandru Elisei *ret = 0; 930583cda1bSAlexandru Elisei return true; 931583cda1bSAlexandru Elisei } 932583cda1bSAlexandru Elisei 9336caa5812SOliver Upton return kvm_request_pending(vcpu) || 9346caa5812SOliver Upton xfer_to_guest_mode_work_pending(); 9356caa5812SOliver Upton } 9366caa5812SOliver Upton 9378cfe148aSMark Rutland /* 9388cfe148aSMark Rutland * Actually run the vCPU, entering an RCU extended quiescent state (EQS) while 9398cfe148aSMark Rutland * the vCPU is running. 9408cfe148aSMark Rutland * 9418cfe148aSMark Rutland * This must be noinstr as instrumentation may make use of RCU, and this is not 9428cfe148aSMark Rutland * safe during the EQS. 9438cfe148aSMark Rutland */ 9448cfe148aSMark Rutland static int noinstr kvm_arm_vcpu_enter_exit(struct kvm_vcpu *vcpu) 9458cfe148aSMark Rutland { 9468cfe148aSMark Rutland int ret; 9478cfe148aSMark Rutland 9488cfe148aSMark Rutland guest_state_enter_irqoff(); 9498cfe148aSMark Rutland ret = kvm_call_hyp_ret(__kvm_vcpu_run, vcpu); 9508cfe148aSMark Rutland guest_state_exit_irqoff(); 9518cfe148aSMark Rutland 9528cfe148aSMark Rutland return ret; 9538cfe148aSMark Rutland } 9548cfe148aSMark Rutland 9556caa5812SOliver Upton /** 9569ed24f4bSMarc Zyngier * kvm_arch_vcpu_ioctl_run - the main VCPU run function to execute guest code 9579ed24f4bSMarc Zyngier * @vcpu: The VCPU pointer 9589ed24f4bSMarc Zyngier * 9599ed24f4bSMarc Zyngier * This function is called through the VCPU_RUN ioctl called from user space. It 9609ed24f4bSMarc Zyngier * will execute VM code in a loop until the time slice for the process is used 9619ed24f4bSMarc Zyngier * or some emulation is needed from user space in which case the function will 9629ed24f4bSMarc Zyngier * return with return value 0 and with the kvm_run structure filled in with the 9639ed24f4bSMarc Zyngier * required data for the requested emulation. 9649ed24f4bSMarc Zyngier */ 96538060944SPaolo Bonzini int kvm_arch_vcpu_ioctl_run(struct kvm_vcpu *vcpu) 9669ed24f4bSMarc Zyngier { 96738060944SPaolo Bonzini struct kvm_run *run = vcpu->run; 9689ed24f4bSMarc Zyngier int ret; 9699ed24f4bSMarc Zyngier 9709ed24f4bSMarc Zyngier if (run->exit_reason == KVM_EXIT_MMIO) { 97174cc7e0cSTianjia Zhang ret = kvm_handle_mmio_return(vcpu); 9729ed24f4bSMarc Zyngier if (ret) 9739ed24f4bSMarc Zyngier return ret; 9749ed24f4bSMarc Zyngier } 9759ed24f4bSMarc Zyngier 9769ed24f4bSMarc Zyngier vcpu_load(vcpu); 9779ed24f4bSMarc Zyngier 978e3e880bbSZenghui Yu if (run->immediate_exit) { 979e3e880bbSZenghui Yu ret = -EINTR; 980e3e880bbSZenghui Yu goto out; 981e3e880bbSZenghui Yu } 982e3e880bbSZenghui Yu 9839ed24f4bSMarc Zyngier kvm_sigset_activate(vcpu); 9849ed24f4bSMarc Zyngier 9859ed24f4bSMarc Zyngier ret = 1; 9869ed24f4bSMarc Zyngier run->exit_reason = KVM_EXIT_UNKNOWN; 98718f3976fSAlexandru Elisei run->flags = 0; 9889ed24f4bSMarc Zyngier while (ret > 0) { 9899ed24f4bSMarc Zyngier /* 9909ed24f4bSMarc Zyngier * Check conditions before entering the guest 9919ed24f4bSMarc Zyngier */ 9926caa5812SOliver Upton ret = xfer_to_guest_mode_handle_work(vcpu); 9936caa5812SOliver Upton if (!ret) 9946caa5812SOliver Upton ret = 1; 9959ed24f4bSMarc Zyngier 9963fdd0459SOliver Upton if (ret > 0) 9973fdd0459SOliver Upton ret = check_vcpu_requests(vcpu); 9989ed24f4bSMarc Zyngier 9999ed24f4bSMarc Zyngier /* 10009ed24f4bSMarc Zyngier * Preparing the interrupts to be injected also 10019ed24f4bSMarc Zyngier * involves poking the GIC, which must be done in a 10029ed24f4bSMarc Zyngier * non-preemptible context. 10039ed24f4bSMarc Zyngier */ 10049ed24f4bSMarc Zyngier preempt_disable(); 10059ed24f4bSMarc Zyngier 10063248136bSJulien Grall /* 10073248136bSJulien Grall * The VMID allocator only tracks active VMIDs per 10083248136bSJulien Grall * physical CPU, and therefore the VMID allocated may not be 10093248136bSJulien Grall * preserved on VMID roll-over if the task was preempted, 10103248136bSJulien Grall * making a thread's VMID inactive. So we need to call 10113248136bSJulien Grall * kvm_arm_vmid_update() in non-premptible context. 10123248136bSJulien Grall */ 10135eba523eSMarc Zyngier if (kvm_arm_vmid_update(&vcpu->arch.hw_mmu->vmid) && 10145eba523eSMarc Zyngier has_vhe()) 10155eba523eSMarc Zyngier __load_stage2(vcpu->arch.hw_mmu, 10165eba523eSMarc Zyngier vcpu->arch.hw_mmu->arch); 10173248136bSJulien Grall 10189ed24f4bSMarc Zyngier kvm_pmu_flush_hwstate(vcpu); 10199ed24f4bSMarc Zyngier 10209ed24f4bSMarc Zyngier local_irq_disable(); 10219ed24f4bSMarc Zyngier 10229ed24f4bSMarc Zyngier kvm_vgic_flush_hwstate(vcpu); 10239ed24f4bSMarc Zyngier 102484d751a0SFuad Tabba kvm_pmu_update_vcpu_events(vcpu); 102584d751a0SFuad Tabba 10269ed24f4bSMarc Zyngier /* 10279ed24f4bSMarc Zyngier * Ensure we set mode to IN_GUEST_MODE after we disable 10289ed24f4bSMarc Zyngier * interrupts and before the final VCPU requests check. 10299ed24f4bSMarc Zyngier * See the comment in kvm_vcpu_exiting_guest_mode() and 10309ed24f4bSMarc Zyngier * Documentation/virt/kvm/vcpu-requests.rst 10319ed24f4bSMarc Zyngier */ 10329ed24f4bSMarc Zyngier smp_store_mb(vcpu->mode, IN_GUEST_MODE); 10339ed24f4bSMarc Zyngier 10346caa5812SOliver Upton if (ret <= 0 || kvm_vcpu_exit_request(vcpu, &ret)) { 10359ed24f4bSMarc Zyngier vcpu->mode = OUTSIDE_GUEST_MODE; 10369ed24f4bSMarc Zyngier isb(); /* Ensure work in x_flush_hwstate is committed */ 10379ed24f4bSMarc Zyngier kvm_pmu_sync_hwstate(vcpu); 10389ed24f4bSMarc Zyngier if (static_branch_unlikely(&userspace_irqchip_in_use)) 10393c5ff0c6SMarc Zyngier kvm_timer_sync_user(vcpu); 10409ed24f4bSMarc Zyngier kvm_vgic_sync_hwstate(vcpu); 10419ed24f4bSMarc Zyngier local_irq_enable(); 10429ed24f4bSMarc Zyngier preempt_enable(); 10439ed24f4bSMarc Zyngier continue; 10449ed24f4bSMarc Zyngier } 10459ed24f4bSMarc Zyngier 10469ed24f4bSMarc Zyngier kvm_arm_setup_debug(vcpu); 1047af9a0e21SMarc Zyngier kvm_arch_vcpu_ctxflush_fp(vcpu); 10489ed24f4bSMarc Zyngier 10499ed24f4bSMarc Zyngier /************************************************************** 10509ed24f4bSMarc Zyngier * Enter the guest 10519ed24f4bSMarc Zyngier */ 10529ed24f4bSMarc Zyngier trace_kvm_entry(*vcpu_pc(vcpu)); 10538cfe148aSMark Rutland guest_timing_enter_irqoff(); 10549ed24f4bSMarc Zyngier 10558cfe148aSMark Rutland ret = kvm_arm_vcpu_enter_exit(vcpu); 10569ed24f4bSMarc Zyngier 10579ed24f4bSMarc Zyngier vcpu->mode = OUTSIDE_GUEST_MODE; 10589ed24f4bSMarc Zyngier vcpu->stat.exits++; 10599ed24f4bSMarc Zyngier /* 10609ed24f4bSMarc Zyngier * Back from guest 10619ed24f4bSMarc Zyngier *************************************************************/ 10629ed24f4bSMarc Zyngier 10639ed24f4bSMarc Zyngier kvm_arm_clear_debug(vcpu); 10649ed24f4bSMarc Zyngier 10659ed24f4bSMarc Zyngier /* 10669ed24f4bSMarc Zyngier * We must sync the PMU state before the vgic state so 10679ed24f4bSMarc Zyngier * that the vgic can properly sample the updated state of the 10689ed24f4bSMarc Zyngier * interrupt line. 10699ed24f4bSMarc Zyngier */ 10709ed24f4bSMarc Zyngier kvm_pmu_sync_hwstate(vcpu); 10719ed24f4bSMarc Zyngier 10729ed24f4bSMarc Zyngier /* 10739ed24f4bSMarc Zyngier * Sync the vgic state before syncing the timer state because 10749ed24f4bSMarc Zyngier * the timer code needs to know if the virtual timer 10759ed24f4bSMarc Zyngier * interrupts are active. 10769ed24f4bSMarc Zyngier */ 10779ed24f4bSMarc Zyngier kvm_vgic_sync_hwstate(vcpu); 10789ed24f4bSMarc Zyngier 10799ed24f4bSMarc Zyngier /* 10809ed24f4bSMarc Zyngier * Sync the timer hardware state before enabling interrupts as 10819ed24f4bSMarc Zyngier * we don't want vtimer interrupts to race with syncing the 10829ed24f4bSMarc Zyngier * timer virtual interrupt state. 10839ed24f4bSMarc Zyngier */ 10849ed24f4bSMarc Zyngier if (static_branch_unlikely(&userspace_irqchip_in_use)) 10853c5ff0c6SMarc Zyngier kvm_timer_sync_user(vcpu); 10869ed24f4bSMarc Zyngier 10879ed24f4bSMarc Zyngier kvm_arch_vcpu_ctxsync_fp(vcpu); 10889ed24f4bSMarc Zyngier 10899ed24f4bSMarc Zyngier /* 10908cfe148aSMark Rutland * We must ensure that any pending interrupts are taken before 10918cfe148aSMark Rutland * we exit guest timing so that timer ticks are accounted as 10928cfe148aSMark Rutland * guest time. Transiently unmask interrupts so that any 10938cfe148aSMark Rutland * pending interrupts are taken. 10949ed24f4bSMarc Zyngier * 10958cfe148aSMark Rutland * Per ARM DDI 0487G.b section D1.13.4, an ISB (or other 10968cfe148aSMark Rutland * context synchronization event) is necessary to ensure that 10978cfe148aSMark Rutland * pending interrupts are taken. 10989ed24f4bSMarc Zyngier */ 1099f7659f8bSMarc Zyngier if (ARM_EXCEPTION_CODE(ret) == ARM_EXCEPTION_IRQ) { 11009ed24f4bSMarc Zyngier local_irq_enable(); 11018cfe148aSMark Rutland isb(); 11028cfe148aSMark Rutland local_irq_disable(); 1103f7659f8bSMarc Zyngier } 11049ed24f4bSMarc Zyngier 11058cfe148aSMark Rutland guest_timing_exit_irqoff(); 11068cfe148aSMark Rutland 11078cfe148aSMark Rutland local_irq_enable(); 11088cfe148aSMark Rutland 11099ed24f4bSMarc Zyngier trace_kvm_exit(ret, kvm_vcpu_trap_get_class(vcpu), *vcpu_pc(vcpu)); 11109ed24f4bSMarc Zyngier 11119ed24f4bSMarc Zyngier /* Exit types that need handling before we can be preempted */ 111274cc7e0cSTianjia Zhang handle_exit_early(vcpu, ret); 11139ed24f4bSMarc Zyngier 11149ed24f4bSMarc Zyngier preempt_enable(); 11159ed24f4bSMarc Zyngier 111622f55384SQais Yousef /* 111722f55384SQais Yousef * The ARMv8 architecture doesn't give the hypervisor 111822f55384SQais Yousef * a mechanism to prevent a guest from dropping to AArch32 EL0 111922f55384SQais Yousef * if implemented by the CPU. If we spot the guest in such 112022f55384SQais Yousef * state and that we decided it wasn't supposed to do so (like 112122f55384SQais Yousef * with the asymmetric AArch32 case), return to userspace with 112222f55384SQais Yousef * a fatal error. 112322f55384SQais Yousef */ 11242f6a49bbSWill Deacon if (vcpu_mode_is_bad_32bit(vcpu)) { 112522f55384SQais Yousef /* 112622f55384SQais Yousef * As we have caught the guest red-handed, decide that 112722f55384SQais Yousef * it isn't fit for purpose anymore by making the vcpu 112822f55384SQais Yousef * invalid. The VMM can try and fix it by issuing a 112922f55384SQais Yousef * KVM_ARM_VCPU_INIT if it really wants to. 113022f55384SQais Yousef */ 1131ef984060SOliver Upton vcpu_clear_flag(vcpu, VCPU_INITIALIZED); 113222f55384SQais Yousef ret = ARM_EXCEPTION_IL; 113322f55384SQais Yousef } 113422f55384SQais Yousef 113574cc7e0cSTianjia Zhang ret = handle_exit(vcpu, ret); 11369ed24f4bSMarc Zyngier } 11379ed24f4bSMarc Zyngier 11389ed24f4bSMarc Zyngier /* Tell userspace about in-kernel device output levels */ 11399ed24f4bSMarc Zyngier if (unlikely(!irqchip_in_kernel(vcpu->kvm))) { 11409ed24f4bSMarc Zyngier kvm_timer_update_run(vcpu); 11419ed24f4bSMarc Zyngier kvm_pmu_update_run(vcpu); 11429ed24f4bSMarc Zyngier } 11439ed24f4bSMarc Zyngier 11449ed24f4bSMarc Zyngier kvm_sigset_deactivate(vcpu); 11459ed24f4bSMarc Zyngier 1146e3e880bbSZenghui Yu out: 114726778aaaSMarc Zyngier /* 114826778aaaSMarc Zyngier * In the unlikely event that we are returning to userspace 114926778aaaSMarc Zyngier * with pending exceptions or PC adjustment, commit these 115026778aaaSMarc Zyngier * adjustments in order to give userspace a consistent view of 115126778aaaSMarc Zyngier * the vcpu state. Note that this relies on __kvm_adjust_pc() 115226778aaaSMarc Zyngier * being preempt-safe on VHE. 115326778aaaSMarc Zyngier */ 1154699bb2e0SMarc Zyngier if (unlikely(vcpu_get_flag(vcpu, PENDING_EXCEPTION) || 1155699bb2e0SMarc Zyngier vcpu_get_flag(vcpu, INCREMENT_PC))) 115626778aaaSMarc Zyngier kvm_call_hyp(__kvm_adjust_pc, vcpu); 115726778aaaSMarc Zyngier 11589ed24f4bSMarc Zyngier vcpu_put(vcpu); 11599ed24f4bSMarc Zyngier return ret; 11609ed24f4bSMarc Zyngier } 11619ed24f4bSMarc Zyngier 11629ed24f4bSMarc Zyngier static int vcpu_interrupt_line(struct kvm_vcpu *vcpu, int number, bool level) 11639ed24f4bSMarc Zyngier { 11649ed24f4bSMarc Zyngier int bit_index; 11659ed24f4bSMarc Zyngier bool set; 11669ed24f4bSMarc Zyngier unsigned long *hcr; 11679ed24f4bSMarc Zyngier 11689ed24f4bSMarc Zyngier if (number == KVM_ARM_IRQ_CPU_IRQ) 11699ed24f4bSMarc Zyngier bit_index = __ffs(HCR_VI); 11709ed24f4bSMarc Zyngier else /* KVM_ARM_IRQ_CPU_FIQ */ 11719ed24f4bSMarc Zyngier bit_index = __ffs(HCR_VF); 11729ed24f4bSMarc Zyngier 11739ed24f4bSMarc Zyngier hcr = vcpu_hcr(vcpu); 11749ed24f4bSMarc Zyngier if (level) 11759ed24f4bSMarc Zyngier set = test_and_set_bit(bit_index, hcr); 11769ed24f4bSMarc Zyngier else 11779ed24f4bSMarc Zyngier set = test_and_clear_bit(bit_index, hcr); 11789ed24f4bSMarc Zyngier 11799ed24f4bSMarc Zyngier /* 11809ed24f4bSMarc Zyngier * If we didn't change anything, no need to wake up or kick other CPUs 11819ed24f4bSMarc Zyngier */ 11829ed24f4bSMarc Zyngier if (set == level) 11839ed24f4bSMarc Zyngier return 0; 11849ed24f4bSMarc Zyngier 11859ed24f4bSMarc Zyngier /* 11869ed24f4bSMarc Zyngier * The vcpu irq_lines field was updated, wake up sleeping VCPUs and 11879ed24f4bSMarc Zyngier * trigger a world-switch round on the running physical CPU to set the 11889ed24f4bSMarc Zyngier * virtual IRQ/FIQ fields in the HCR appropriately. 11899ed24f4bSMarc Zyngier */ 11909ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_IRQ_PENDING, vcpu); 11919ed24f4bSMarc Zyngier kvm_vcpu_kick(vcpu); 11929ed24f4bSMarc Zyngier 11939ed24f4bSMarc Zyngier return 0; 11949ed24f4bSMarc Zyngier } 11959ed24f4bSMarc Zyngier 11969ed24f4bSMarc Zyngier int kvm_vm_ioctl_irq_line(struct kvm *kvm, struct kvm_irq_level *irq_level, 11979ed24f4bSMarc Zyngier bool line_status) 11989ed24f4bSMarc Zyngier { 11999ed24f4bSMarc Zyngier u32 irq = irq_level->irq; 12009a0a75d3SMarc Zyngier unsigned int irq_type, vcpu_id, irq_num; 12019ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu = NULL; 12029ed24f4bSMarc Zyngier bool level = irq_level->level; 12039ed24f4bSMarc Zyngier 12049ed24f4bSMarc Zyngier irq_type = (irq >> KVM_ARM_IRQ_TYPE_SHIFT) & KVM_ARM_IRQ_TYPE_MASK; 12059a0a75d3SMarc Zyngier vcpu_id = (irq >> KVM_ARM_IRQ_VCPU_SHIFT) & KVM_ARM_IRQ_VCPU_MASK; 12069a0a75d3SMarc Zyngier vcpu_id += ((irq >> KVM_ARM_IRQ_VCPU2_SHIFT) & KVM_ARM_IRQ_VCPU2_MASK) * (KVM_ARM_IRQ_VCPU_MASK + 1); 12079ed24f4bSMarc Zyngier irq_num = (irq >> KVM_ARM_IRQ_NUM_SHIFT) & KVM_ARM_IRQ_NUM_MASK; 12089ed24f4bSMarc Zyngier 12099a0a75d3SMarc Zyngier trace_kvm_irq_line(irq_type, vcpu_id, irq_num, irq_level->level); 12109ed24f4bSMarc Zyngier 12119ed24f4bSMarc Zyngier switch (irq_type) { 12129ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_CPU: 12139ed24f4bSMarc Zyngier if (irqchip_in_kernel(kvm)) 12149ed24f4bSMarc Zyngier return -ENXIO; 12159ed24f4bSMarc Zyngier 12169a0a75d3SMarc Zyngier vcpu = kvm_get_vcpu_by_id(kvm, vcpu_id); 12179ed24f4bSMarc Zyngier if (!vcpu) 12189ed24f4bSMarc Zyngier return -EINVAL; 12199ed24f4bSMarc Zyngier 12209ed24f4bSMarc Zyngier if (irq_num > KVM_ARM_IRQ_CPU_FIQ) 12219ed24f4bSMarc Zyngier return -EINVAL; 12229ed24f4bSMarc Zyngier 12239ed24f4bSMarc Zyngier return vcpu_interrupt_line(vcpu, irq_num, level); 12249ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_PPI: 12259ed24f4bSMarc Zyngier if (!irqchip_in_kernel(kvm)) 12269ed24f4bSMarc Zyngier return -ENXIO; 12279ed24f4bSMarc Zyngier 12289a0a75d3SMarc Zyngier vcpu = kvm_get_vcpu_by_id(kvm, vcpu_id); 12299ed24f4bSMarc Zyngier if (!vcpu) 12309ed24f4bSMarc Zyngier return -EINVAL; 12319ed24f4bSMarc Zyngier 12329ed24f4bSMarc Zyngier if (irq_num < VGIC_NR_SGIS || irq_num >= VGIC_NR_PRIVATE_IRQS) 12339ed24f4bSMarc Zyngier return -EINVAL; 12349ed24f4bSMarc Zyngier 12359a0a75d3SMarc Zyngier return kvm_vgic_inject_irq(kvm, vcpu, irq_num, level, NULL); 12369ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_SPI: 12379ed24f4bSMarc Zyngier if (!irqchip_in_kernel(kvm)) 12389ed24f4bSMarc Zyngier return -ENXIO; 12399ed24f4bSMarc Zyngier 12409ed24f4bSMarc Zyngier if (irq_num < VGIC_NR_PRIVATE_IRQS) 12419ed24f4bSMarc Zyngier return -EINVAL; 12429ed24f4bSMarc Zyngier 12439a0a75d3SMarc Zyngier return kvm_vgic_inject_irq(kvm, NULL, irq_num, level, NULL); 12449ed24f4bSMarc Zyngier } 12459ed24f4bSMarc Zyngier 12469ed24f4bSMarc Zyngier return -EINVAL; 12479ed24f4bSMarc Zyngier } 12489ed24f4bSMarc Zyngier 1249ef150908SOliver Upton static unsigned long system_supported_vcpu_features(void) 1250ef150908SOliver Upton { 1251ef150908SOliver Upton unsigned long features = KVM_VCPU_VALID_FEATURES; 1252ef150908SOliver Upton 1253ef150908SOliver Upton if (!cpus_have_final_cap(ARM64_HAS_32BIT_EL1)) 1254ef150908SOliver Upton clear_bit(KVM_ARM_VCPU_EL1_32BIT, &features); 1255ef150908SOliver Upton 12569116db11SOliver Upton if (!kvm_arm_support_pmu_v3()) 12579116db11SOliver Upton clear_bit(KVM_ARM_VCPU_PMU_V3, &features); 12589116db11SOliver Upton 1259be9c0c01SOliver Upton if (!system_supports_sve()) 1260be9c0c01SOliver Upton clear_bit(KVM_ARM_VCPU_SVE, &features); 1261be9c0c01SOliver Upton 1262baa28a53SOliver Upton if (!system_has_full_ptr_auth()) { 1263baa28a53SOliver Upton clear_bit(KVM_ARM_VCPU_PTRAUTH_ADDRESS, &features); 1264baa28a53SOliver Upton clear_bit(KVM_ARM_VCPU_PTRAUTH_GENERIC, &features); 1265baa28a53SOliver Upton } 1266baa28a53SOliver Upton 126712405b09SOliver Upton if (!cpus_have_final_cap(ARM64_HAS_NESTED_VIRT)) 126812405b09SOliver Upton clear_bit(KVM_ARM_VCPU_HAS_EL2, &features); 126912405b09SOliver Upton 1270ef150908SOliver Upton return features; 1271ef150908SOliver Upton } 1272ef150908SOliver Upton 1273a7a2c72aSOliver Upton static int kvm_vcpu_init_check_features(struct kvm_vcpu *vcpu, 12749ed24f4bSMarc Zyngier const struct kvm_vcpu_init *init) 12759ed24f4bSMarc Zyngier { 1276a7a2c72aSOliver Upton unsigned long features = init->features[0]; 1277a7a2c72aSOliver Upton int i; 12789ed24f4bSMarc Zyngier 1279a7a2c72aSOliver Upton if (features & ~KVM_VCPU_VALID_FEATURES) 12809ed24f4bSMarc Zyngier return -ENOENT; 12819ed24f4bSMarc Zyngier 1282a7a2c72aSOliver Upton for (i = 1; i < ARRAY_SIZE(init->features); i++) { 1283a7a2c72aSOliver Upton if (init->features[i]) 1284a7a2c72aSOliver Upton return -ENOENT; 12859ed24f4bSMarc Zyngier } 12869ed24f4bSMarc Zyngier 1287ef150908SOliver Upton if (features & ~system_supported_vcpu_features()) 1288ef150908SOliver Upton return -EINVAL; 1289ef150908SOliver Upton 1290baa28a53SOliver Upton /* 1291baa28a53SOliver Upton * For now make sure that both address/generic pointer authentication 1292baa28a53SOliver Upton * features are requested by the userspace together. 1293baa28a53SOliver Upton */ 1294baa28a53SOliver Upton if (test_bit(KVM_ARM_VCPU_PTRAUTH_ADDRESS, &features) != 1295baa28a53SOliver Upton test_bit(KVM_ARM_VCPU_PTRAUTH_GENERIC, &features)) 1296baa28a53SOliver Upton return -EINVAL; 1297baa28a53SOliver Upton 1298d99fb82fSOliver Upton /* Disallow NV+SVE for the time being */ 1299d99fb82fSOliver Upton if (test_bit(KVM_ARM_VCPU_HAS_EL2, &features) && 1300d99fb82fSOliver Upton test_bit(KVM_ARM_VCPU_SVE, &features)) 1301d99fb82fSOliver Upton return -EINVAL; 1302d99fb82fSOliver Upton 13032251e9ffSOliver Upton if (!test_bit(KVM_ARM_VCPU_EL1_32BIT, &features)) 13042251e9ffSOliver Upton return 0; 13052251e9ffSOliver Upton 13062251e9ffSOliver Upton /* MTE is incompatible with AArch32 */ 13072251e9ffSOliver Upton if (kvm_has_mte(vcpu->kvm)) 13082251e9ffSOliver Upton return -EINVAL; 13092251e9ffSOliver Upton 13102251e9ffSOliver Upton /* NV is incompatible with AArch32 */ 13112251e9ffSOliver Upton if (test_bit(KVM_ARM_VCPU_HAS_EL2, &features)) 13122251e9ffSOliver Upton return -EINVAL; 13132251e9ffSOliver Upton 1314a7a2c72aSOliver Upton return 0; 1315a7a2c72aSOliver Upton } 1316a7a2c72aSOliver Upton 1317a7a2c72aSOliver Upton static bool kvm_vcpu_init_changed(struct kvm_vcpu *vcpu, 1318a7a2c72aSOliver Upton const struct kvm_vcpu_init *init) 1319a7a2c72aSOliver Upton { 1320a7a2c72aSOliver Upton unsigned long features = init->features[0]; 1321a7a2c72aSOliver Upton 13221de10b7dSOliver Upton return !bitmap_equal(vcpu->kvm->arch.vcpu_features, &features, 13231de10b7dSOliver Upton KVM_VCPU_MAX_FEATURES); 1324a7a2c72aSOliver Upton } 1325a7a2c72aSOliver Upton 132642773357SReiji Watanabe static int kvm_setup_vcpu(struct kvm_vcpu *vcpu) 132742773357SReiji Watanabe { 132842773357SReiji Watanabe struct kvm *kvm = vcpu->kvm; 132942773357SReiji Watanabe int ret = 0; 133042773357SReiji Watanabe 133142773357SReiji Watanabe /* 133242773357SReiji Watanabe * When the vCPU has a PMU, but no PMU is set for the guest 133342773357SReiji Watanabe * yet, set the default one. 133442773357SReiji Watanabe */ 133542773357SReiji Watanabe if (kvm_vcpu_has_pmu(vcpu) && !kvm->arch.arm_pmu) 133642773357SReiji Watanabe ret = kvm_arm_set_default_pmu(kvm); 133742773357SReiji Watanabe 133842773357SReiji Watanabe return ret; 1339a7a2c72aSOliver Upton } 1340a7a2c72aSOliver Upton 1341a7a2c72aSOliver Upton static int __kvm_vcpu_set_target(struct kvm_vcpu *vcpu, 1342a7a2c72aSOliver Upton const struct kvm_vcpu_init *init) 1343a7a2c72aSOliver Upton { 1344a7a2c72aSOliver Upton unsigned long features = init->features[0]; 13452251e9ffSOliver Upton struct kvm *kvm = vcpu->kvm; 13462251e9ffSOliver Upton int ret = -EINVAL; 13472251e9ffSOliver Upton 13482251e9ffSOliver Upton mutex_lock(&kvm->arch.config_lock); 13492251e9ffSOliver Upton 13502251e9ffSOliver Upton if (test_bit(KVM_ARCH_FLAG_VCPU_FEATURES_CONFIGURED, &kvm->arch.flags) && 13511de10b7dSOliver Upton kvm_vcpu_init_changed(vcpu, init)) 13522251e9ffSOliver Upton goto out_unlock; 1353a7a2c72aSOliver Upton 13542251e9ffSOliver Upton bitmap_copy(kvm->arch.vcpu_features, &features, KVM_VCPU_MAX_FEATURES); 13559ed24f4bSMarc Zyngier 135642773357SReiji Watanabe ret = kvm_setup_vcpu(vcpu); 135742773357SReiji Watanabe if (ret) 135842773357SReiji Watanabe goto out_unlock; 135942773357SReiji Watanabe 13609ed24f4bSMarc Zyngier /* Now we know what it is, we can reset it. */ 13613d4b2a4cSOliver Upton kvm_reset_vcpu(vcpu); 13629ed24f4bSMarc Zyngier 13632251e9ffSOliver Upton set_bit(KVM_ARCH_FLAG_VCPU_FEATURES_CONFIGURED, &kvm->arch.flags); 1364ef984060SOliver Upton vcpu_set_flag(vcpu, VCPU_INITIALIZED); 13653d4b2a4cSOliver Upton ret = 0; 13662251e9ffSOliver Upton out_unlock: 13672251e9ffSOliver Upton mutex_unlock(&kvm->arch.config_lock); 13689ed24f4bSMarc Zyngier return ret; 13699ed24f4bSMarc Zyngier } 13709ed24f4bSMarc Zyngier 1371a7a2c72aSOliver Upton static int kvm_vcpu_set_target(struct kvm_vcpu *vcpu, 1372a7a2c72aSOliver Upton const struct kvm_vcpu_init *init) 1373a7a2c72aSOliver Upton { 1374a7a2c72aSOliver Upton int ret; 1375a7a2c72aSOliver Upton 13765346f7e1SOliver Upton if (init->target != KVM_ARM_TARGET_GENERIC_V8 && 13775346f7e1SOliver Upton init->target != kvm_target_cpu()) 1378a7a2c72aSOliver Upton return -EINVAL; 1379a7a2c72aSOliver Upton 1380a7a2c72aSOliver Upton ret = kvm_vcpu_init_check_features(vcpu, init); 1381a7a2c72aSOliver Upton if (ret) 1382a7a2c72aSOliver Upton return ret; 1383a7a2c72aSOliver Upton 1384ef984060SOliver Upton if (!kvm_vcpu_initialized(vcpu)) 1385a7a2c72aSOliver Upton return __kvm_vcpu_set_target(vcpu, init); 1386a7a2c72aSOliver Upton 1387a7a2c72aSOliver Upton if (kvm_vcpu_init_changed(vcpu, init)) 1388a7a2c72aSOliver Upton return -EINVAL; 1389a7a2c72aSOliver Upton 13903d4b2a4cSOliver Upton kvm_reset_vcpu(vcpu); 13913d4b2a4cSOliver Upton return 0; 1392a7a2c72aSOliver Upton } 1393a7a2c72aSOliver Upton 13949ed24f4bSMarc Zyngier static int kvm_arch_vcpu_ioctl_vcpu_init(struct kvm_vcpu *vcpu, 13959ed24f4bSMarc Zyngier struct kvm_vcpu_init *init) 13969ed24f4bSMarc Zyngier { 1397e3c1c0caSOliver Upton bool power_off = false; 13989ed24f4bSMarc Zyngier int ret; 13999ed24f4bSMarc Zyngier 1400e3c1c0caSOliver Upton /* 1401e3c1c0caSOliver Upton * Treat the power-off vCPU feature as ephemeral. Clear the bit to avoid 1402e3c1c0caSOliver Upton * reflecting it in the finalized feature set, thus limiting its scope 1403e3c1c0caSOliver Upton * to a single KVM_ARM_VCPU_INIT call. 1404e3c1c0caSOliver Upton */ 1405192df2aaSOliver Upton if (init->features[0] & BIT(KVM_ARM_VCPU_POWER_OFF)) { 1406192df2aaSOliver Upton init->features[0] &= ~BIT(KVM_ARM_VCPU_POWER_OFF); 1407e3c1c0caSOliver Upton power_off = true; 1408e3c1c0caSOliver Upton } 1409e3c1c0caSOliver Upton 14109ed24f4bSMarc Zyngier ret = kvm_vcpu_set_target(vcpu, init); 14119ed24f4bSMarc Zyngier if (ret) 14129ed24f4bSMarc Zyngier return ret; 14139ed24f4bSMarc Zyngier 14149ed24f4bSMarc Zyngier /* 14159ed24f4bSMarc Zyngier * Ensure a rebooted VM will fault in RAM pages and detect if the 14169ed24f4bSMarc Zyngier * guest MMU is turned off and flush the caches as needed. 1417892713e9SZenghui Yu * 14187ae2f3dbSMarc Zyngier * S2FWB enforces all memory accesses to RAM being cacheable, 14197ae2f3dbSMarc Zyngier * ensuring that the data side is always coherent. We still 14207ae2f3dbSMarc Zyngier * need to invalidate the I-cache though, as FWB does *not* 14217ae2f3dbSMarc Zyngier * imply CTR_EL0.DIC. 14229ed24f4bSMarc Zyngier */ 1423cc5705fbSMarc Zyngier if (vcpu_has_run_once(vcpu)) { 14247ae2f3dbSMarc Zyngier if (!cpus_have_final_cap(ARM64_HAS_STAGE2_FWB)) 14259ed24f4bSMarc Zyngier stage2_unmap_vm(vcpu->kvm); 14267ae2f3dbSMarc Zyngier else 1427fade9c2cSFuad Tabba icache_inval_all_pou(); 14287ae2f3dbSMarc Zyngier } 14299ed24f4bSMarc Zyngier 14309ed24f4bSMarc Zyngier vcpu_reset_hcr(vcpu); 143175c76ab5SMarc Zyngier vcpu->arch.cptr_el2 = kvm_get_reset_cptr_el2(vcpu); 14329ed24f4bSMarc Zyngier 14339ed24f4bSMarc Zyngier /* 14349ed24f4bSMarc Zyngier * Handle the "start in power-off" case. 14359ed24f4bSMarc Zyngier */ 14364ff910beSReiji Watanabe spin_lock(&vcpu->arch.mp_state_lock); 14374ff910beSReiji Watanabe 1438e3c1c0caSOliver Upton if (power_off) 14394ff910beSReiji Watanabe __kvm_arm_vcpu_power_off(vcpu); 14409ed24f4bSMarc Zyngier else 14410acc7239SOliver Upton WRITE_ONCE(vcpu->arch.mp_state.mp_state, KVM_MP_STATE_RUNNABLE); 14429ed24f4bSMarc Zyngier 14434ff910beSReiji Watanabe spin_unlock(&vcpu->arch.mp_state_lock); 14449ed24f4bSMarc Zyngier 14459ed24f4bSMarc Zyngier return 0; 14469ed24f4bSMarc Zyngier } 14479ed24f4bSMarc Zyngier 14489ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_attr(struct kvm_vcpu *vcpu, 14499ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 14509ed24f4bSMarc Zyngier { 14519ed24f4bSMarc Zyngier int ret = -ENXIO; 14529ed24f4bSMarc Zyngier 14539ed24f4bSMarc Zyngier switch (attr->group) { 14549ed24f4bSMarc Zyngier default: 14559ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_set_attr(vcpu, attr); 14569ed24f4bSMarc Zyngier break; 14579ed24f4bSMarc Zyngier } 14589ed24f4bSMarc Zyngier 14599ed24f4bSMarc Zyngier return ret; 14609ed24f4bSMarc Zyngier } 14619ed24f4bSMarc Zyngier 14629ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_attr(struct kvm_vcpu *vcpu, 14639ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 14649ed24f4bSMarc Zyngier { 14659ed24f4bSMarc Zyngier int ret = -ENXIO; 14669ed24f4bSMarc Zyngier 14679ed24f4bSMarc Zyngier switch (attr->group) { 14689ed24f4bSMarc Zyngier default: 14699ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_get_attr(vcpu, attr); 14709ed24f4bSMarc Zyngier break; 14719ed24f4bSMarc Zyngier } 14729ed24f4bSMarc Zyngier 14739ed24f4bSMarc Zyngier return ret; 14749ed24f4bSMarc Zyngier } 14759ed24f4bSMarc Zyngier 14769ed24f4bSMarc Zyngier static int kvm_arm_vcpu_has_attr(struct kvm_vcpu *vcpu, 14779ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 14789ed24f4bSMarc Zyngier { 14799ed24f4bSMarc Zyngier int ret = -ENXIO; 14809ed24f4bSMarc Zyngier 14819ed24f4bSMarc Zyngier switch (attr->group) { 14829ed24f4bSMarc Zyngier default: 14839ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_has_attr(vcpu, attr); 14849ed24f4bSMarc Zyngier break; 14859ed24f4bSMarc Zyngier } 14869ed24f4bSMarc Zyngier 14879ed24f4bSMarc Zyngier return ret; 14889ed24f4bSMarc Zyngier } 14899ed24f4bSMarc Zyngier 14909ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_events(struct kvm_vcpu *vcpu, 14919ed24f4bSMarc Zyngier struct kvm_vcpu_events *events) 14929ed24f4bSMarc Zyngier { 14939ed24f4bSMarc Zyngier memset(events, 0, sizeof(*events)); 14949ed24f4bSMarc Zyngier 14959ed24f4bSMarc Zyngier return __kvm_arm_vcpu_get_events(vcpu, events); 14969ed24f4bSMarc Zyngier } 14979ed24f4bSMarc Zyngier 14989ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_events(struct kvm_vcpu *vcpu, 14999ed24f4bSMarc Zyngier struct kvm_vcpu_events *events) 15009ed24f4bSMarc Zyngier { 15019ed24f4bSMarc Zyngier int i; 15029ed24f4bSMarc Zyngier 15039ed24f4bSMarc Zyngier /* check whether the reserved field is zero */ 15049ed24f4bSMarc Zyngier for (i = 0; i < ARRAY_SIZE(events->reserved); i++) 15059ed24f4bSMarc Zyngier if (events->reserved[i]) 15069ed24f4bSMarc Zyngier return -EINVAL; 15079ed24f4bSMarc Zyngier 15089ed24f4bSMarc Zyngier /* check whether the pad field is zero */ 15099ed24f4bSMarc Zyngier for (i = 0; i < ARRAY_SIZE(events->exception.pad); i++) 15109ed24f4bSMarc Zyngier if (events->exception.pad[i]) 15119ed24f4bSMarc Zyngier return -EINVAL; 15129ed24f4bSMarc Zyngier 15139ed24f4bSMarc Zyngier return __kvm_arm_vcpu_set_events(vcpu, events); 15149ed24f4bSMarc Zyngier } 15159ed24f4bSMarc Zyngier 15169ed24f4bSMarc Zyngier long kvm_arch_vcpu_ioctl(struct file *filp, 15179ed24f4bSMarc Zyngier unsigned int ioctl, unsigned long arg) 15189ed24f4bSMarc Zyngier { 15199ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu = filp->private_data; 15209ed24f4bSMarc Zyngier void __user *argp = (void __user *)arg; 15219ed24f4bSMarc Zyngier struct kvm_device_attr attr; 15229ed24f4bSMarc Zyngier long r; 15239ed24f4bSMarc Zyngier 15249ed24f4bSMarc Zyngier switch (ioctl) { 15259ed24f4bSMarc Zyngier case KVM_ARM_VCPU_INIT: { 15269ed24f4bSMarc Zyngier struct kvm_vcpu_init init; 15279ed24f4bSMarc Zyngier 15289ed24f4bSMarc Zyngier r = -EFAULT; 15299ed24f4bSMarc Zyngier if (copy_from_user(&init, argp, sizeof(init))) 15309ed24f4bSMarc Zyngier break; 15319ed24f4bSMarc Zyngier 15329ed24f4bSMarc Zyngier r = kvm_arch_vcpu_ioctl_vcpu_init(vcpu, &init); 15339ed24f4bSMarc Zyngier break; 15349ed24f4bSMarc Zyngier } 15359ed24f4bSMarc Zyngier case KVM_SET_ONE_REG: 15369ed24f4bSMarc Zyngier case KVM_GET_ONE_REG: { 15379ed24f4bSMarc Zyngier struct kvm_one_reg reg; 15389ed24f4bSMarc Zyngier 15399ed24f4bSMarc Zyngier r = -ENOEXEC; 15409ed24f4bSMarc Zyngier if (unlikely(!kvm_vcpu_initialized(vcpu))) 15419ed24f4bSMarc Zyngier break; 15429ed24f4bSMarc Zyngier 15439ed24f4bSMarc Zyngier r = -EFAULT; 15449ed24f4bSMarc Zyngier if (copy_from_user(®, argp, sizeof(reg))) 15459ed24f4bSMarc Zyngier break; 15469ed24f4bSMarc Zyngier 15476826c684SOliver Upton /* 15486826c684SOliver Upton * We could owe a reset due to PSCI. Handle the pending reset 15496826c684SOliver Upton * here to ensure userspace register accesses are ordered after 15506826c684SOliver Upton * the reset. 15516826c684SOliver Upton */ 15526826c684SOliver Upton if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu)) 15536826c684SOliver Upton kvm_reset_vcpu(vcpu); 15546826c684SOliver Upton 15559ed24f4bSMarc Zyngier if (ioctl == KVM_SET_ONE_REG) 15569ed24f4bSMarc Zyngier r = kvm_arm_set_reg(vcpu, ®); 15579ed24f4bSMarc Zyngier else 15589ed24f4bSMarc Zyngier r = kvm_arm_get_reg(vcpu, ®); 15599ed24f4bSMarc Zyngier break; 15609ed24f4bSMarc Zyngier } 15619ed24f4bSMarc Zyngier case KVM_GET_REG_LIST: { 15629ed24f4bSMarc Zyngier struct kvm_reg_list __user *user_list = argp; 15639ed24f4bSMarc Zyngier struct kvm_reg_list reg_list; 15649ed24f4bSMarc Zyngier unsigned n; 15659ed24f4bSMarc Zyngier 15669ed24f4bSMarc Zyngier r = -ENOEXEC; 15679ed24f4bSMarc Zyngier if (unlikely(!kvm_vcpu_initialized(vcpu))) 15689ed24f4bSMarc Zyngier break; 15699ed24f4bSMarc Zyngier 15709ed24f4bSMarc Zyngier r = -EPERM; 15719ed24f4bSMarc Zyngier if (!kvm_arm_vcpu_is_finalized(vcpu)) 15729ed24f4bSMarc Zyngier break; 15739ed24f4bSMarc Zyngier 15749ed24f4bSMarc Zyngier r = -EFAULT; 15759ed24f4bSMarc Zyngier if (copy_from_user(®_list, user_list, sizeof(reg_list))) 15769ed24f4bSMarc Zyngier break; 15779ed24f4bSMarc Zyngier n = reg_list.n; 15789ed24f4bSMarc Zyngier reg_list.n = kvm_arm_num_regs(vcpu); 15799ed24f4bSMarc Zyngier if (copy_to_user(user_list, ®_list, sizeof(reg_list))) 15809ed24f4bSMarc Zyngier break; 15819ed24f4bSMarc Zyngier r = -E2BIG; 15829ed24f4bSMarc Zyngier if (n < reg_list.n) 15839ed24f4bSMarc Zyngier break; 15849ed24f4bSMarc Zyngier r = kvm_arm_copy_reg_indices(vcpu, user_list->reg); 15859ed24f4bSMarc Zyngier break; 15869ed24f4bSMarc Zyngier } 15879ed24f4bSMarc Zyngier case KVM_SET_DEVICE_ATTR: { 15889ed24f4bSMarc Zyngier r = -EFAULT; 15899ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 15909ed24f4bSMarc Zyngier break; 15919ed24f4bSMarc Zyngier r = kvm_arm_vcpu_set_attr(vcpu, &attr); 15929ed24f4bSMarc Zyngier break; 15939ed24f4bSMarc Zyngier } 15949ed24f4bSMarc Zyngier case KVM_GET_DEVICE_ATTR: { 15959ed24f4bSMarc Zyngier r = -EFAULT; 15969ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 15979ed24f4bSMarc Zyngier break; 15989ed24f4bSMarc Zyngier r = kvm_arm_vcpu_get_attr(vcpu, &attr); 15999ed24f4bSMarc Zyngier break; 16009ed24f4bSMarc Zyngier } 16019ed24f4bSMarc Zyngier case KVM_HAS_DEVICE_ATTR: { 16029ed24f4bSMarc Zyngier r = -EFAULT; 16039ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 16049ed24f4bSMarc Zyngier break; 16059ed24f4bSMarc Zyngier r = kvm_arm_vcpu_has_attr(vcpu, &attr); 16069ed24f4bSMarc Zyngier break; 16079ed24f4bSMarc Zyngier } 16089ed24f4bSMarc Zyngier case KVM_GET_VCPU_EVENTS: { 16099ed24f4bSMarc Zyngier struct kvm_vcpu_events events; 16109ed24f4bSMarc Zyngier 16119ed24f4bSMarc Zyngier if (kvm_arm_vcpu_get_events(vcpu, &events)) 16129ed24f4bSMarc Zyngier return -EINVAL; 16139ed24f4bSMarc Zyngier 16149ed24f4bSMarc Zyngier if (copy_to_user(argp, &events, sizeof(events))) 16159ed24f4bSMarc Zyngier return -EFAULT; 16169ed24f4bSMarc Zyngier 16179ed24f4bSMarc Zyngier return 0; 16189ed24f4bSMarc Zyngier } 16199ed24f4bSMarc Zyngier case KVM_SET_VCPU_EVENTS: { 16209ed24f4bSMarc Zyngier struct kvm_vcpu_events events; 16219ed24f4bSMarc Zyngier 16229ed24f4bSMarc Zyngier if (copy_from_user(&events, argp, sizeof(events))) 16239ed24f4bSMarc Zyngier return -EFAULT; 16249ed24f4bSMarc Zyngier 16259ed24f4bSMarc Zyngier return kvm_arm_vcpu_set_events(vcpu, &events); 16269ed24f4bSMarc Zyngier } 16279ed24f4bSMarc Zyngier case KVM_ARM_VCPU_FINALIZE: { 16289ed24f4bSMarc Zyngier int what; 16299ed24f4bSMarc Zyngier 16309ed24f4bSMarc Zyngier if (!kvm_vcpu_initialized(vcpu)) 16319ed24f4bSMarc Zyngier return -ENOEXEC; 16329ed24f4bSMarc Zyngier 16339ed24f4bSMarc Zyngier if (get_user(what, (const int __user *)argp)) 16349ed24f4bSMarc Zyngier return -EFAULT; 16359ed24f4bSMarc Zyngier 16369ed24f4bSMarc Zyngier return kvm_arm_vcpu_finalize(vcpu, what); 16379ed24f4bSMarc Zyngier } 16389ed24f4bSMarc Zyngier default: 16399ed24f4bSMarc Zyngier r = -EINVAL; 16409ed24f4bSMarc Zyngier } 16419ed24f4bSMarc Zyngier 16429ed24f4bSMarc Zyngier return r; 16439ed24f4bSMarc Zyngier } 16449ed24f4bSMarc Zyngier 16459ed24f4bSMarc Zyngier void kvm_arch_sync_dirty_log(struct kvm *kvm, struct kvm_memory_slot *memslot) 16469ed24f4bSMarc Zyngier { 16479ed24f4bSMarc Zyngier 16489ed24f4bSMarc Zyngier } 16499ed24f4bSMarc Zyngier 16509ed24f4bSMarc Zyngier static int kvm_vm_ioctl_set_device_addr(struct kvm *kvm, 16519ed24f4bSMarc Zyngier struct kvm_arm_device_addr *dev_addr) 16529ed24f4bSMarc Zyngier { 16539f968c92SMarc Zyngier switch (FIELD_GET(KVM_ARM_DEVICE_ID_MASK, dev_addr->id)) { 16549ed24f4bSMarc Zyngier case KVM_ARM_DEVICE_VGIC_V2: 16559ed24f4bSMarc Zyngier if (!vgic_present) 16569ed24f4bSMarc Zyngier return -ENXIO; 16579f968c92SMarc Zyngier return kvm_set_legacy_vgic_v2_addr(kvm, dev_addr); 16589ed24f4bSMarc Zyngier default: 16599ed24f4bSMarc Zyngier return -ENODEV; 16609ed24f4bSMarc Zyngier } 16619ed24f4bSMarc Zyngier } 16629ed24f4bSMarc Zyngier 1663e0fc6b21SOliver Upton static int kvm_vm_has_attr(struct kvm *kvm, struct kvm_device_attr *attr) 1664e0fc6b21SOliver Upton { 1665e0fc6b21SOliver Upton switch (attr->group) { 1666821d935cSOliver Upton case KVM_ARM_VM_SMCCC_CTRL: 1667821d935cSOliver Upton return kvm_vm_smccc_has_attr(kvm, attr); 1668e0fc6b21SOliver Upton default: 1669e0fc6b21SOliver Upton return -ENXIO; 1670e0fc6b21SOliver Upton } 1671e0fc6b21SOliver Upton } 1672e0fc6b21SOliver Upton 1673e0fc6b21SOliver Upton static int kvm_vm_set_attr(struct kvm *kvm, struct kvm_device_attr *attr) 1674e0fc6b21SOliver Upton { 1675e0fc6b21SOliver Upton switch (attr->group) { 1676821d935cSOliver Upton case KVM_ARM_VM_SMCCC_CTRL: 1677821d935cSOliver Upton return kvm_vm_smccc_set_attr(kvm, attr); 1678e0fc6b21SOliver Upton default: 1679e0fc6b21SOliver Upton return -ENXIO; 1680e0fc6b21SOliver Upton } 1681e0fc6b21SOliver Upton } 1682e0fc6b21SOliver Upton 1683d8708b80SThomas Huth int kvm_arch_vm_ioctl(struct file *filp, unsigned int ioctl, unsigned long arg) 16849ed24f4bSMarc Zyngier { 16859ed24f4bSMarc Zyngier struct kvm *kvm = filp->private_data; 16869ed24f4bSMarc Zyngier void __user *argp = (void __user *)arg; 1687e0fc6b21SOliver Upton struct kvm_device_attr attr; 16889ed24f4bSMarc Zyngier 16899ed24f4bSMarc Zyngier switch (ioctl) { 16909ed24f4bSMarc Zyngier case KVM_CREATE_IRQCHIP: { 16919ed24f4bSMarc Zyngier int ret; 16929ed24f4bSMarc Zyngier if (!vgic_present) 16939ed24f4bSMarc Zyngier return -ENXIO; 16949ed24f4bSMarc Zyngier mutex_lock(&kvm->lock); 16959ed24f4bSMarc Zyngier ret = kvm_vgic_create(kvm, KVM_DEV_TYPE_ARM_VGIC_V2); 16969ed24f4bSMarc Zyngier mutex_unlock(&kvm->lock); 16979ed24f4bSMarc Zyngier return ret; 16989ed24f4bSMarc Zyngier } 16999ed24f4bSMarc Zyngier case KVM_ARM_SET_DEVICE_ADDR: { 17009ed24f4bSMarc Zyngier struct kvm_arm_device_addr dev_addr; 17019ed24f4bSMarc Zyngier 17029ed24f4bSMarc Zyngier if (copy_from_user(&dev_addr, argp, sizeof(dev_addr))) 17039ed24f4bSMarc Zyngier return -EFAULT; 17049ed24f4bSMarc Zyngier return kvm_vm_ioctl_set_device_addr(kvm, &dev_addr); 17059ed24f4bSMarc Zyngier } 17069ed24f4bSMarc Zyngier case KVM_ARM_PREFERRED_TARGET: { 17075346f7e1SOliver Upton struct kvm_vcpu_init init = { 17085346f7e1SOliver Upton .target = KVM_ARM_TARGET_GENERIC_V8, 17095346f7e1SOliver Upton }; 17109ed24f4bSMarc Zyngier 17119ed24f4bSMarc Zyngier if (copy_to_user(argp, &init, sizeof(init))) 17129ed24f4bSMarc Zyngier return -EFAULT; 17139ed24f4bSMarc Zyngier 17149ed24f4bSMarc Zyngier return 0; 17159ed24f4bSMarc Zyngier } 1716f0376edbSSteven Price case KVM_ARM_MTE_COPY_TAGS: { 1717f0376edbSSteven Price struct kvm_arm_copy_mte_tags copy_tags; 1718f0376edbSSteven Price 1719f0376edbSSteven Price if (copy_from_user(©_tags, argp, sizeof(copy_tags))) 1720f0376edbSSteven Price return -EFAULT; 1721f0376edbSSteven Price return kvm_vm_ioctl_mte_copy_tags(kvm, ©_tags); 1722f0376edbSSteven Price } 172330ec7997SMarc Zyngier case KVM_ARM_SET_COUNTER_OFFSET: { 172430ec7997SMarc Zyngier struct kvm_arm_counter_offset offset; 172530ec7997SMarc Zyngier 172630ec7997SMarc Zyngier if (copy_from_user(&offset, argp, sizeof(offset))) 172730ec7997SMarc Zyngier return -EFAULT; 172830ec7997SMarc Zyngier return kvm_vm_ioctl_set_counter_offset(kvm, &offset); 172930ec7997SMarc Zyngier } 1730e0fc6b21SOliver Upton case KVM_HAS_DEVICE_ATTR: { 1731e0fc6b21SOliver Upton if (copy_from_user(&attr, argp, sizeof(attr))) 1732e0fc6b21SOliver Upton return -EFAULT; 1733e0fc6b21SOliver Upton 1734e0fc6b21SOliver Upton return kvm_vm_has_attr(kvm, &attr); 1735e0fc6b21SOliver Upton } 1736e0fc6b21SOliver Upton case KVM_SET_DEVICE_ATTR: { 1737e0fc6b21SOliver Upton if (copy_from_user(&attr, argp, sizeof(attr))) 1738e0fc6b21SOliver Upton return -EFAULT; 1739e0fc6b21SOliver Upton 1740e0fc6b21SOliver Upton return kvm_vm_set_attr(kvm, &attr); 1741e0fc6b21SOliver Upton } 17423f9cd0caSJing Zhang case KVM_ARM_GET_REG_WRITABLE_MASKS: { 17433f9cd0caSJing Zhang struct reg_mask_range range; 17443f9cd0caSJing Zhang 17453f9cd0caSJing Zhang if (copy_from_user(&range, argp, sizeof(range))) 17463f9cd0caSJing Zhang return -EFAULT; 17473f9cd0caSJing Zhang return kvm_vm_ioctl_get_reg_writable_masks(kvm, &range); 17483f9cd0caSJing Zhang } 17499ed24f4bSMarc Zyngier default: 17509ed24f4bSMarc Zyngier return -EINVAL; 17519ed24f4bSMarc Zyngier } 17529ed24f4bSMarc Zyngier } 17539ed24f4bSMarc Zyngier 175496906a91SMarc Zyngier /* unlocks vcpus from @vcpu_lock_idx and smaller */ 175596906a91SMarc Zyngier static void unlock_vcpus(struct kvm *kvm, int vcpu_lock_idx) 175696906a91SMarc Zyngier { 175796906a91SMarc Zyngier struct kvm_vcpu *tmp_vcpu; 175896906a91SMarc Zyngier 175996906a91SMarc Zyngier for (; vcpu_lock_idx >= 0; vcpu_lock_idx--) { 176096906a91SMarc Zyngier tmp_vcpu = kvm_get_vcpu(kvm, vcpu_lock_idx); 176196906a91SMarc Zyngier mutex_unlock(&tmp_vcpu->mutex); 176296906a91SMarc Zyngier } 176396906a91SMarc Zyngier } 176496906a91SMarc Zyngier 176596906a91SMarc Zyngier void unlock_all_vcpus(struct kvm *kvm) 176696906a91SMarc Zyngier { 176796906a91SMarc Zyngier lockdep_assert_held(&kvm->lock); 176896906a91SMarc Zyngier 176996906a91SMarc Zyngier unlock_vcpus(kvm, atomic_read(&kvm->online_vcpus) - 1); 177096906a91SMarc Zyngier } 177196906a91SMarc Zyngier 177296906a91SMarc Zyngier /* Returns true if all vcpus were locked, false otherwise */ 177396906a91SMarc Zyngier bool lock_all_vcpus(struct kvm *kvm) 177496906a91SMarc Zyngier { 177596906a91SMarc Zyngier struct kvm_vcpu *tmp_vcpu; 177696906a91SMarc Zyngier unsigned long c; 177796906a91SMarc Zyngier 177896906a91SMarc Zyngier lockdep_assert_held(&kvm->lock); 177996906a91SMarc Zyngier 178096906a91SMarc Zyngier /* 178196906a91SMarc Zyngier * Any time a vcpu is in an ioctl (including running), the 178296906a91SMarc Zyngier * core KVM code tries to grab the vcpu->mutex. 178396906a91SMarc Zyngier * 178496906a91SMarc Zyngier * By grabbing the vcpu->mutex of all VCPUs we ensure that no 178596906a91SMarc Zyngier * other VCPUs can fiddle with the state while we access it. 178696906a91SMarc Zyngier */ 178796906a91SMarc Zyngier kvm_for_each_vcpu(c, tmp_vcpu, kvm) { 178896906a91SMarc Zyngier if (!mutex_trylock(&tmp_vcpu->mutex)) { 178996906a91SMarc Zyngier unlock_vcpus(kvm, c - 1); 179096906a91SMarc Zyngier return false; 179196906a91SMarc Zyngier } 179296906a91SMarc Zyngier } 179396906a91SMarc Zyngier 179496906a91SMarc Zyngier return true; 179596906a91SMarc Zyngier } 179696906a91SMarc Zyngier 179730c95391SDavid Brazdil static unsigned long nvhe_percpu_size(void) 179830c95391SDavid Brazdil { 179930c95391SDavid Brazdil return (unsigned long)CHOOSE_NVHE_SYM(__per_cpu_end) - 180030c95391SDavid Brazdil (unsigned long)CHOOSE_NVHE_SYM(__per_cpu_start); 180130c95391SDavid Brazdil } 180230c95391SDavid Brazdil 180330c95391SDavid Brazdil static unsigned long nvhe_percpu_order(void) 180430c95391SDavid Brazdil { 180530c95391SDavid Brazdil unsigned long size = nvhe_percpu_size(); 180630c95391SDavid Brazdil 180730c95391SDavid Brazdil return size ? get_order(size) : 0; 180830c95391SDavid Brazdil } 180930c95391SDavid Brazdil 1810b881cdceSWill Deacon /* A lookup table holding the hypervisor VA for each vector slot */ 1811b881cdceSWill Deacon static void *hyp_spectre_vector_selector[BP_HARDEN_EL2_SLOTS]; 1812de5bcdb4SWill Deacon 1813b881cdceSWill Deacon static void kvm_init_vector_slot(void *base, enum arm64_hyp_spectre_vector slot) 1814b881cdceSWill Deacon { 1815bc1d2892SQuentin Perret hyp_spectre_vector_selector[slot] = __kvm_vector_slot2addr(base, slot); 18169ef2b48bSWill Deacon } 18179ef2b48bSWill Deacon 1818b881cdceSWill Deacon static int kvm_init_vector_slots(void) 1819b881cdceSWill Deacon { 1820b881cdceSWill Deacon int err; 1821b881cdceSWill Deacon void *base; 1822b881cdceSWill Deacon 1823b881cdceSWill Deacon base = kern_hyp_va(kvm_ksym_ref(__kvm_hyp_vector)); 1824b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_DIRECT); 1825b881cdceSWill Deacon 1826b881cdceSWill Deacon base = kern_hyp_va(kvm_ksym_ref(__bp_harden_hyp_vecs)); 1827b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_SPECTRE_DIRECT); 1828b881cdceSWill Deacon 18292e403167SQuentin Perret if (kvm_system_needs_idmapped_vectors() && 18302e403167SQuentin Perret !is_protected_kvm_enabled()) { 1831b881cdceSWill Deacon err = create_hyp_exec_mappings(__pa_symbol(__bp_harden_hyp_vecs), 1832b881cdceSWill Deacon __BP_HARDEN_HYP_VECS_SZ, &base); 1833b881cdceSWill Deacon if (err) 1834b881cdceSWill Deacon return err; 1835b881cdceSWill Deacon } 18369ef2b48bSWill Deacon 1837b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_INDIRECT); 1838b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_SPECTRE_INDIRECT); 18399ef2b48bSWill Deacon return 0; 18409ef2b48bSWill Deacon } 18419ef2b48bSWill Deacon 184253bf620aSSean Christopherson static void __init cpu_prepare_hyp_mode(int cpu, u32 hyp_va_bits) 18439ed24f4bSMarc Zyngier { 18449cc77581SQuentin Perret struct kvm_nvhe_init_params *params = per_cpu_ptr_nvhe_sym(kvm_init_params, cpu); 1845bd412e2aSRyan Roberts u64 mmfr0 = read_sanitised_ftr_reg(SYS_ID_AA64MMFR0_EL1); 1846d3e1086cSDavid Brazdil unsigned long tcr; 18479ed24f4bSMarc Zyngier 184871b3ec5fSDavid Brazdil /* 184971b3ec5fSDavid Brazdil * Calculate the raw per-cpu offset without a translation from the 185071b3ec5fSDavid Brazdil * kernel's mapping to the linear mapping, and store it in tpidr_el2 185171b3ec5fSDavid Brazdil * so that we can use adr_l to access per-cpu variables in EL2. 1852e1663372SSteven Price * Also drop the KASAN tag which gets in the way... 185371b3ec5fSDavid Brazdil */ 18549cc77581SQuentin Perret params->tpidr_el2 = (unsigned long)kasan_reset_tag(per_cpu_ptr_nvhe_sym(__per_cpu_start, cpu)) - 185530c95391SDavid Brazdil (unsigned long)kvm_ksym_ref(CHOOSE_NVHE_SYM(__per_cpu_start)); 185671b3ec5fSDavid Brazdil 1857d3e1086cSDavid Brazdil params->mair_el2 = read_sysreg(mair_el1); 1858d3e1086cSDavid Brazdil 1859cff3b5cfSMarc Zyngier tcr = read_sysreg(tcr_el1); 1860cff3b5cfSMarc Zyngier if (cpus_have_final_cap(ARM64_KVM_HVHE)) { 1861cff3b5cfSMarc Zyngier tcr |= TCR_EPD1_MASK; 1862cff3b5cfSMarc Zyngier } else { 1863cff3b5cfSMarc Zyngier tcr &= TCR_EL2_MASK; 1864cff3b5cfSMarc Zyngier tcr |= TCR_EL2_RES1; 1865cff3b5cfSMarc Zyngier } 1866d3e1086cSDavid Brazdil tcr &= ~TCR_T0SZ_MASK; 1867579d7ebeSRyan Roberts tcr |= TCR_T0SZ(hyp_va_bits); 1868bd412e2aSRyan Roberts tcr &= ~TCR_EL2_PS_MASK; 1869bd412e2aSRyan Roberts tcr |= FIELD_PREP(TCR_EL2_PS_MASK, kvm_get_parange(mmfr0)); 1870bd412e2aSRyan Roberts if (kvm_lpa2_is_enabled()) 1871bd412e2aSRyan Roberts tcr |= TCR_EL2_DS; 1872d3e1086cSDavid Brazdil params->tcr_el2 = tcr; 1873d3e1086cSDavid Brazdil 187463fec243SDavid Brazdil params->pgd_pa = kvm_mmu_get_httbr(); 1875734864c1SQuentin Perret if (is_protected_kvm_enabled()) 1876734864c1SQuentin Perret params->hcr_el2 = HCR_HOST_NVHE_PROTECTED_FLAGS; 1877734864c1SQuentin Perret else 1878734864c1SQuentin Perret params->hcr_el2 = HCR_HOST_NVHE_FLAGS; 1879d0daf5a2SMarc Zyngier if (cpus_have_final_cap(ARM64_KVM_HVHE)) 1880d0daf5a2SMarc Zyngier params->hcr_el2 |= HCR_E2H; 1881734864c1SQuentin Perret params->vttbr = params->vtcr = 0; 188263fec243SDavid Brazdil 188363fec243SDavid Brazdil /* 188463fec243SDavid Brazdil * Flush the init params from the data cache because the struct will 188563fec243SDavid Brazdil * be read while the MMU is off. 188663fec243SDavid Brazdil */ 188763fec243SDavid Brazdil kvm_flush_dcache_to_poc(params, sizeof(*params)); 18889cc77581SQuentin Perret } 18899cc77581SQuentin Perret 1890bfa79a80SQuentin Perret static void hyp_install_host_vector(void) 18919cc77581SQuentin Perret { 18929cc77581SQuentin Perret struct kvm_nvhe_init_params *params; 18939cc77581SQuentin Perret struct arm_smccc_res res; 18949cc77581SQuentin Perret 18959cc77581SQuentin Perret /* Switch from the HYP stub to our own HYP init vector */ 18969cc77581SQuentin Perret __hyp_set_vectors(kvm_get_idmap_vector()); 18979ed24f4bSMarc Zyngier 189871b3ec5fSDavid Brazdil /* 189971b3ec5fSDavid Brazdil * Call initialization code, and switch to the full blown HYP code. 190071b3ec5fSDavid Brazdil * If the cpucaps haven't been finalized yet, something has gone very 190171b3ec5fSDavid Brazdil * wrong, and hyp will crash and burn when it uses any 1902d8569fbaSMark Rutland * cpus_have_*_cap() wrapper. 190371b3ec5fSDavid Brazdil */ 190471b3ec5fSDavid Brazdil BUG_ON(!system_capabilities_finalized()); 19059cc77581SQuentin Perret params = this_cpu_ptr_nvhe_sym(kvm_init_params); 190663fec243SDavid Brazdil arm_smccc_1_1_hvc(KVM_HOST_SMCCC_FUNC(__kvm_hyp_init), virt_to_phys(params), &res); 190704e4caa8SAndrew Scull WARN_ON(res.a0 != SMCCC_RET_SUCCESS); 1908bfa79a80SQuentin Perret } 1909bfa79a80SQuentin Perret 1910bfa79a80SQuentin Perret static void cpu_init_hyp_mode(void) 1911bfa79a80SQuentin Perret { 1912bfa79a80SQuentin Perret hyp_install_host_vector(); 191371b3ec5fSDavid Brazdil 191471b3ec5fSDavid Brazdil /* 191571b3ec5fSDavid Brazdil * Disabling SSBD on a non-VHE system requires us to enable SSBS 191671b3ec5fSDavid Brazdil * at EL2. 191771b3ec5fSDavid Brazdil */ 191871b3ec5fSDavid Brazdil if (this_cpu_has_cap(ARM64_SSBS) && 1919d63d975aSMarc Zyngier arm64_get_spectre_v4_state() == SPECTRE_VULNERABLE) { 192013aeb9b4SDavid Brazdil kvm_call_hyp_nvhe(__kvm_enable_ssbs); 192171b3ec5fSDavid Brazdil } 19229ed24f4bSMarc Zyngier } 19239ed24f4bSMarc Zyngier 19249ed24f4bSMarc Zyngier static void cpu_hyp_reset(void) 19259ed24f4bSMarc Zyngier { 19269ed24f4bSMarc Zyngier if (!is_kernel_in_hyp_mode()) 19279ed24f4bSMarc Zyngier __hyp_reset_vectors(); 19289ed24f4bSMarc Zyngier } 19299ed24f4bSMarc Zyngier 1930042c76a9SWill Deacon /* 1931042c76a9SWill Deacon * EL2 vectors can be mapped and rerouted in a number of ways, 1932042c76a9SWill Deacon * depending on the kernel configuration and CPU present: 1933042c76a9SWill Deacon * 1934042c76a9SWill Deacon * - If the CPU is affected by Spectre-v2, the hardening sequence is 1935042c76a9SWill Deacon * placed in one of the vector slots, which is executed before jumping 1936042c76a9SWill Deacon * to the real vectors. 1937042c76a9SWill Deacon * 1938c4792b6dSWill Deacon * - If the CPU also has the ARM64_SPECTRE_V3A cap, the slot 1939042c76a9SWill Deacon * containing the hardening sequence is mapped next to the idmap page, 1940042c76a9SWill Deacon * and executed before jumping to the real vectors. 1941042c76a9SWill Deacon * 1942c4792b6dSWill Deacon * - If the CPU only has the ARM64_SPECTRE_V3A cap, then an 1943042c76a9SWill Deacon * empty slot is selected, mapped next to the idmap page, and 1944042c76a9SWill Deacon * executed before jumping to the real vectors. 1945042c76a9SWill Deacon * 1946c4792b6dSWill Deacon * Note that ARM64_SPECTRE_V3A is somewhat incompatible with 1947042c76a9SWill Deacon * VHE, as we don't have hypervisor-specific mappings. If the system 1948042c76a9SWill Deacon * is VHE and yet selects this capability, it will be ignored. 1949042c76a9SWill Deacon */ 1950042c76a9SWill Deacon static void cpu_set_hyp_vector(void) 1951042c76a9SWill Deacon { 19526279017eSWill Deacon struct bp_hardening_data *data = this_cpu_ptr(&bp_hardening_data); 1953b881cdceSWill Deacon void *vector = hyp_spectre_vector_selector[data->slot]; 1954042c76a9SWill Deacon 1955bfa79a80SQuentin Perret if (!is_protected_kvm_enabled()) 1956b881cdceSWill Deacon *this_cpu_ptr_hyp_sym(kvm_hyp_vector) = (unsigned long)vector; 1957bfa79a80SQuentin Perret else 1958bfa79a80SQuentin Perret kvm_call_hyp_nvhe(__pkvm_cpu_set_vector, data->slot); 1959042c76a9SWill Deacon } 1960042c76a9SWill Deacon 19618579a185SWill Deacon static void cpu_hyp_init_context(void) 19629ed24f4bSMarc Zyngier { 19632a1198c9SDavid Brazdil kvm_init_host_cpu_context(&this_cpu_ptr_hyp_sym(kvm_host_data)->host_ctxt); 19649ed24f4bSMarc Zyngier 19658579a185SWill Deacon if (!is_kernel_in_hyp_mode()) 19668579a185SWill Deacon cpu_init_hyp_mode(); 19678579a185SWill Deacon } 19688579a185SWill Deacon 19698579a185SWill Deacon static void cpu_hyp_init_features(void) 19708579a185SWill Deacon { 19718579a185SWill Deacon cpu_set_hyp_vector(); 19728579a185SWill Deacon kvm_arm_init_debug(); 1973a0e47952SAndrew Scull 19749ed24f4bSMarc Zyngier if (is_kernel_in_hyp_mode()) 19759ed24f4bSMarc Zyngier kvm_timer_init_vhe(); 19769ed24f4bSMarc Zyngier 19779ed24f4bSMarc Zyngier if (vgic_present) 19789ed24f4bSMarc Zyngier kvm_vgic_init_cpu_hardware(); 19799ed24f4bSMarc Zyngier } 19809ed24f4bSMarc Zyngier 19818579a185SWill Deacon static void cpu_hyp_reinit(void) 19828579a185SWill Deacon { 19838579a185SWill Deacon cpu_hyp_reset(); 19848579a185SWill Deacon cpu_hyp_init_context(); 19858579a185SWill Deacon cpu_hyp_init_features(); 19868579a185SWill Deacon } 19878579a185SWill Deacon 1988733c758eSOliver Upton static void cpu_hyp_init(void *discard) 19899ed24f4bSMarc Zyngier { 1990733c758eSOliver Upton if (!__this_cpu_read(kvm_hyp_initialized)) { 19919ed24f4bSMarc Zyngier cpu_hyp_reinit(); 1992733c758eSOliver Upton __this_cpu_write(kvm_hyp_initialized, 1); 1993733c758eSOliver Upton } 1994733c758eSOliver Upton } 1995733c758eSOliver Upton 1996733c758eSOliver Upton static void cpu_hyp_uninit(void *discard) 1997733c758eSOliver Upton { 1998733c758eSOliver Upton if (__this_cpu_read(kvm_hyp_initialized)) { 1999733c758eSOliver Upton cpu_hyp_reset(); 2000733c758eSOliver Upton __this_cpu_write(kvm_hyp_initialized, 0); 20019ed24f4bSMarc Zyngier } 20029ed24f4bSMarc Zyngier } 20039ed24f4bSMarc Zyngier 20049ed24f4bSMarc Zyngier int kvm_arch_hardware_enable(void) 20059ed24f4bSMarc Zyngier { 2006970dee09SMarc Zyngier /* 2007970dee09SMarc Zyngier * Most calls to this function are made with migration 2008970dee09SMarc Zyngier * disabled, but not with preemption disabled. The former is 2009970dee09SMarc Zyngier * enough to ensure correctness, but most of the helpers 2010970dee09SMarc Zyngier * expect the later and will throw a tantrum otherwise. 2011970dee09SMarc Zyngier */ 2012970dee09SMarc Zyngier preempt_disable(); 2013970dee09SMarc Zyngier 2014733c758eSOliver Upton cpu_hyp_init(NULL); 2015466d27e4SMarc Zyngier 2016466d27e4SMarc Zyngier kvm_vgic_cpu_up(); 2017466d27e4SMarc Zyngier kvm_timer_cpu_up(); 2018466d27e4SMarc Zyngier 2019970dee09SMarc Zyngier preempt_enable(); 2020970dee09SMarc Zyngier 20219ed24f4bSMarc Zyngier return 0; 20229ed24f4bSMarc Zyngier } 20239ed24f4bSMarc Zyngier 20249ed24f4bSMarc Zyngier void kvm_arch_hardware_disable(void) 20259ed24f4bSMarc Zyngier { 2026466d27e4SMarc Zyngier kvm_timer_cpu_down(); 2027466d27e4SMarc Zyngier kvm_vgic_cpu_down(); 2028466d27e4SMarc Zyngier 2029fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 2030733c758eSOliver Upton cpu_hyp_uninit(NULL); 20319ed24f4bSMarc Zyngier } 20329ed24f4bSMarc Zyngier 20339ed24f4bSMarc Zyngier #ifdef CONFIG_CPU_PM 20349ed24f4bSMarc Zyngier static int hyp_init_cpu_pm_notifier(struct notifier_block *self, 20359ed24f4bSMarc Zyngier unsigned long cmd, 20369ed24f4bSMarc Zyngier void *v) 20379ed24f4bSMarc Zyngier { 20389ed24f4bSMarc Zyngier /* 2039733c758eSOliver Upton * kvm_hyp_initialized is left with its old value over 20409ed24f4bSMarc Zyngier * PM_ENTER->PM_EXIT. It is used to indicate PM_EXIT should 20419ed24f4bSMarc Zyngier * re-enable hyp. 20429ed24f4bSMarc Zyngier */ 20439ed24f4bSMarc Zyngier switch (cmd) { 20449ed24f4bSMarc Zyngier case CPU_PM_ENTER: 2045733c758eSOliver Upton if (__this_cpu_read(kvm_hyp_initialized)) 20469ed24f4bSMarc Zyngier /* 2047733c758eSOliver Upton * don't update kvm_hyp_initialized here 2048733c758eSOliver Upton * so that the hyp will be re-enabled 20499ed24f4bSMarc Zyngier * when we resume. See below. 20509ed24f4bSMarc Zyngier */ 20519ed24f4bSMarc Zyngier cpu_hyp_reset(); 20529ed24f4bSMarc Zyngier 20539ed24f4bSMarc Zyngier return NOTIFY_OK; 20549ed24f4bSMarc Zyngier case CPU_PM_ENTER_FAILED: 20559ed24f4bSMarc Zyngier case CPU_PM_EXIT: 2056733c758eSOliver Upton if (__this_cpu_read(kvm_hyp_initialized)) 2057733c758eSOliver Upton /* The hyp was enabled before suspend. */ 20589ed24f4bSMarc Zyngier cpu_hyp_reinit(); 20599ed24f4bSMarc Zyngier 20609ed24f4bSMarc Zyngier return NOTIFY_OK; 20619ed24f4bSMarc Zyngier 20629ed24f4bSMarc Zyngier default: 20639ed24f4bSMarc Zyngier return NOTIFY_DONE; 20649ed24f4bSMarc Zyngier } 20659ed24f4bSMarc Zyngier } 20669ed24f4bSMarc Zyngier 20679ed24f4bSMarc Zyngier static struct notifier_block hyp_init_cpu_pm_nb = { 20689ed24f4bSMarc Zyngier .notifier_call = hyp_init_cpu_pm_notifier, 20699ed24f4bSMarc Zyngier }; 20709ed24f4bSMarc Zyngier 207153bf620aSSean Christopherson static void __init hyp_cpu_pm_init(void) 20729ed24f4bSMarc Zyngier { 2073fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 20749ed24f4bSMarc Zyngier cpu_pm_register_notifier(&hyp_init_cpu_pm_nb); 20759ed24f4bSMarc Zyngier } 207653bf620aSSean Christopherson static void __init hyp_cpu_pm_exit(void) 20779ed24f4bSMarc Zyngier { 2078fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 20799ed24f4bSMarc Zyngier cpu_pm_unregister_notifier(&hyp_init_cpu_pm_nb); 20809ed24f4bSMarc Zyngier } 20819ed24f4bSMarc Zyngier #else 208253bf620aSSean Christopherson static inline void __init hyp_cpu_pm_init(void) 20839ed24f4bSMarc Zyngier { 20849ed24f4bSMarc Zyngier } 208553bf620aSSean Christopherson static inline void __init hyp_cpu_pm_exit(void) 20869ed24f4bSMarc Zyngier { 20879ed24f4bSMarc Zyngier } 20889ed24f4bSMarc Zyngier #endif 20899ed24f4bSMarc Zyngier 209053bf620aSSean Christopherson static void __init init_cpu_logical_map(void) 209194f5e8a4SDavid Brazdil { 209294f5e8a4SDavid Brazdil unsigned int cpu; 209394f5e8a4SDavid Brazdil 209494f5e8a4SDavid Brazdil /* 209594f5e8a4SDavid Brazdil * Copy the MPIDR <-> logical CPU ID mapping to hyp. 209621ea4578SJulia Lawall * Only copy the set of online CPUs whose features have been checked 209794f5e8a4SDavid Brazdil * against the finalized system capabilities. The hypervisor will not 209894f5e8a4SDavid Brazdil * allow any other CPUs from the `possible` set to boot. 209994f5e8a4SDavid Brazdil */ 210094f5e8a4SDavid Brazdil for_each_online_cpu(cpu) 210161fe0c37SDavid Brazdil hyp_cpu_logical_map[cpu] = cpu_logical_map(cpu); 210294f5e8a4SDavid Brazdil } 210394f5e8a4SDavid Brazdil 2104767c973fSMarc Zyngier #define init_psci_0_1_impl_state(config, what) \ 2105767c973fSMarc Zyngier config.psci_0_1_ ## what ## _implemented = psci_ops.what 2106767c973fSMarc Zyngier 210753bf620aSSean Christopherson static bool __init init_psci_relay(void) 2108eeeee719SDavid Brazdil { 2109eeeee719SDavid Brazdil /* 2110eeeee719SDavid Brazdil * If PSCI has not been initialized, protected KVM cannot install 2111eeeee719SDavid Brazdil * itself on newly booted CPUs. 2112eeeee719SDavid Brazdil */ 2113eeeee719SDavid Brazdil if (!psci_ops.get_version) { 2114eeeee719SDavid Brazdil kvm_err("Cannot initialize protected mode without PSCI\n"); 2115eeeee719SDavid Brazdil return false; 2116eeeee719SDavid Brazdil } 2117eeeee719SDavid Brazdil 2118ff367fe4SDavid Brazdil kvm_host_psci_config.version = psci_ops.get_version(); 211912bdce4fSWill Deacon kvm_host_psci_config.smccc_version = arm_smccc_get_version(); 2120ff367fe4SDavid Brazdil 2121ff367fe4SDavid Brazdil if (kvm_host_psci_config.version == PSCI_VERSION(0, 1)) { 2122ff367fe4SDavid Brazdil kvm_host_psci_config.function_ids_0_1 = get_psci_0_1_function_ids(); 2123767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_suspend); 2124767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_on); 2125767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_off); 2126767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, migrate); 2127ff367fe4SDavid Brazdil } 2128eeeee719SDavid Brazdil return true; 2129eeeee719SDavid Brazdil } 2130eeeee719SDavid Brazdil 213153bf620aSSean Christopherson static int __init init_subsystems(void) 21329ed24f4bSMarc Zyngier { 21339ed24f4bSMarc Zyngier int err = 0; 21349ed24f4bSMarc Zyngier 21359ed24f4bSMarc Zyngier /* 21369ed24f4bSMarc Zyngier * Enable hardware so that subsystem initialisation can access EL2. 21379ed24f4bSMarc Zyngier */ 2138733c758eSOliver Upton on_each_cpu(cpu_hyp_init, NULL, 1); 21399ed24f4bSMarc Zyngier 21409ed24f4bSMarc Zyngier /* 21419ed24f4bSMarc Zyngier * Register CPU lower-power notifier 21429ed24f4bSMarc Zyngier */ 21439ed24f4bSMarc Zyngier hyp_cpu_pm_init(); 21449ed24f4bSMarc Zyngier 21459ed24f4bSMarc Zyngier /* 21469ed24f4bSMarc Zyngier * Init HYP view of VGIC 21479ed24f4bSMarc Zyngier */ 21489ed24f4bSMarc Zyngier err = kvm_vgic_hyp_init(); 21499ed24f4bSMarc Zyngier switch (err) { 21509ed24f4bSMarc Zyngier case 0: 21519ed24f4bSMarc Zyngier vgic_present = true; 21529ed24f4bSMarc Zyngier break; 21539ed24f4bSMarc Zyngier case -ENODEV: 21549ed24f4bSMarc Zyngier case -ENXIO: 21559ed24f4bSMarc Zyngier vgic_present = false; 21569ed24f4bSMarc Zyngier err = 0; 21579ed24f4bSMarc Zyngier break; 21589ed24f4bSMarc Zyngier default: 21599ed24f4bSMarc Zyngier goto out; 21609ed24f4bSMarc Zyngier } 21619ed24f4bSMarc Zyngier 21629ed24f4bSMarc Zyngier /* 21639ed24f4bSMarc Zyngier * Init HYP architected timer support 21649ed24f4bSMarc Zyngier */ 21659ed24f4bSMarc Zyngier err = kvm_timer_hyp_init(vgic_present); 21669ed24f4bSMarc Zyngier if (err) 21679ed24f4bSMarc Zyngier goto out; 21689ed24f4bSMarc Zyngier 216917ed14ebSSean Christopherson kvm_register_perf_callbacks(NULL); 217017ed14ebSSean Christopherson 21719ed24f4bSMarc Zyngier out: 217278b3bf48SSean Christopherson if (err) 217378b3bf48SSean Christopherson hyp_cpu_pm_exit(); 217478b3bf48SSean Christopherson 2175fa8c3d65SDavid Brazdil if (err || !is_protected_kvm_enabled()) 2176733c758eSOliver Upton on_each_cpu(cpu_hyp_uninit, NULL, 1); 21779ed24f4bSMarc Zyngier 21789ed24f4bSMarc Zyngier return err; 21799ed24f4bSMarc Zyngier } 21809ed24f4bSMarc Zyngier 218153bf620aSSean Christopherson static void __init teardown_subsystems(void) 218278b3bf48SSean Christopherson { 218378b3bf48SSean Christopherson kvm_unregister_perf_callbacks(); 218478b3bf48SSean Christopherson hyp_cpu_pm_exit(); 218578b3bf48SSean Christopherson } 218678b3bf48SSean Christopherson 218753bf620aSSean Christopherson static void __init teardown_hyp_mode(void) 21889ed24f4bSMarc Zyngier { 21899ed24f4bSMarc Zyngier int cpu; 21909ed24f4bSMarc Zyngier 21919ed24f4bSMarc Zyngier free_hyp_pgds(); 219230c95391SDavid Brazdil for_each_possible_cpu(cpu) { 21939ed24f4bSMarc Zyngier free_page(per_cpu(kvm_arm_hyp_stack_page, cpu)); 2194fe41a7f8SQuentin Perret free_pages(kvm_nvhe_sym(kvm_arm_hyp_percpu_base)[cpu], nvhe_percpu_order()); 219530c95391SDavid Brazdil } 21969ed24f4bSMarc Zyngier } 21979ed24f4bSMarc Zyngier 219853bf620aSSean Christopherson static int __init do_pkvm_init(u32 hyp_va_bits) 2199bfa79a80SQuentin Perret { 2200fe41a7f8SQuentin Perret void *per_cpu_base = kvm_ksym_ref(kvm_nvhe_sym(kvm_arm_hyp_percpu_base)); 2201bfa79a80SQuentin Perret int ret; 2202bfa79a80SQuentin Perret 2203bfa79a80SQuentin Perret preempt_disable(); 22048579a185SWill Deacon cpu_hyp_init_context(); 2205bfa79a80SQuentin Perret ret = kvm_call_hyp_nvhe(__pkvm_init, hyp_mem_base, hyp_mem_size, 2206bfa79a80SQuentin Perret num_possible_cpus(), kern_hyp_va(per_cpu_base), 2207bfa79a80SQuentin Perret hyp_va_bits); 22088579a185SWill Deacon cpu_hyp_init_features(); 22098579a185SWill Deacon 22108579a185SWill Deacon /* 22118579a185SWill Deacon * The stub hypercalls are now disabled, so set our local flag to 22128579a185SWill Deacon * prevent a later re-init attempt in kvm_arch_hardware_enable(). 22138579a185SWill Deacon */ 2214733c758eSOliver Upton __this_cpu_write(kvm_hyp_initialized, 1); 2215bfa79a80SQuentin Perret preempt_enable(); 2216bfa79a80SQuentin Perret 2217bfa79a80SQuentin Perret return ret; 2218bfa79a80SQuentin Perret } 2219bfa79a80SQuentin Perret 2220e8162521SFuad Tabba static u64 get_hyp_id_aa64pfr0_el1(void) 2221e8162521SFuad Tabba { 2222e8162521SFuad Tabba /* 2223e8162521SFuad Tabba * Track whether the system isn't affected by spectre/meltdown in the 2224e8162521SFuad Tabba * hypervisor's view of id_aa64pfr0_el1, used for protected VMs. 2225e8162521SFuad Tabba * Although this is per-CPU, we make it global for simplicity, e.g., not 2226e8162521SFuad Tabba * to have to worry about vcpu migration. 2227e8162521SFuad Tabba * 2228e8162521SFuad Tabba * Unlike for non-protected VMs, userspace cannot override this for 2229e8162521SFuad Tabba * protected VMs. 2230e8162521SFuad Tabba */ 2231e8162521SFuad Tabba u64 val = read_sanitised_ftr_reg(SYS_ID_AA64PFR0_EL1); 2232e8162521SFuad Tabba 2233e8162521SFuad Tabba val &= ~(ARM64_FEATURE_MASK(ID_AA64PFR0_EL1_CSV2) | 2234e8162521SFuad Tabba ARM64_FEATURE_MASK(ID_AA64PFR0_EL1_CSV3)); 2235e8162521SFuad Tabba 2236e8162521SFuad Tabba val |= FIELD_PREP(ARM64_FEATURE_MASK(ID_AA64PFR0_EL1_CSV2), 2237e8162521SFuad Tabba arm64_get_spectre_v2_state() == SPECTRE_UNAFFECTED); 2238e8162521SFuad Tabba val |= FIELD_PREP(ARM64_FEATURE_MASK(ID_AA64PFR0_EL1_CSV3), 2239e8162521SFuad Tabba arm64_get_meltdown_state() == SPECTRE_UNAFFECTED); 2240e8162521SFuad Tabba 2241e8162521SFuad Tabba return val; 2242e8162521SFuad Tabba } 2243e8162521SFuad Tabba 22446c165223SWill Deacon static void kvm_hyp_init_symbols(void) 2245bfa79a80SQuentin Perret { 2246e8162521SFuad Tabba kvm_nvhe_sym(id_aa64pfr0_el1_sys_val) = get_hyp_id_aa64pfr0_el1(); 22476c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64pfr1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64PFR1_EL1); 22486c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64isar0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR0_EL1); 22496c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64isar1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR1_EL1); 2250def8c222SVladimir Murzin kvm_nvhe_sym(id_aa64isar2_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR2_EL1); 22517c419937SMarc Zyngier kvm_nvhe_sym(id_aa64mmfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR0_EL1); 22527c419937SMarc Zyngier kvm_nvhe_sym(id_aa64mmfr1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR1_EL1); 22536c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64mmfr2_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR2_EL1); 22548669651cSQuentin Perret kvm_nvhe_sym(id_aa64smfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64SMFR0_EL1); 225513e248aaSWill Deacon kvm_nvhe_sym(__icache_flags) = __icache_flags; 225673f38ef2SWill Deacon kvm_nvhe_sym(kvm_arm_vmid_bits) = kvm_arm_vmid_bits; 22576c165223SWill Deacon } 22586c165223SWill Deacon 225953bf620aSSean Christopherson static int __init kvm_hyp_init_protection(u32 hyp_va_bits) 22606c165223SWill Deacon { 22616c165223SWill Deacon void *addr = phys_to_virt(hyp_mem_base); 22626c165223SWill Deacon int ret; 22637c419937SMarc Zyngier 2264bfa79a80SQuentin Perret ret = create_hyp_mappings(addr, addr + hyp_mem_size, PAGE_HYP); 2265bfa79a80SQuentin Perret if (ret) 2266bfa79a80SQuentin Perret return ret; 2267bfa79a80SQuentin Perret 2268bfa79a80SQuentin Perret ret = do_pkvm_init(hyp_va_bits); 2269bfa79a80SQuentin Perret if (ret) 2270bfa79a80SQuentin Perret return ret; 2271bfa79a80SQuentin Perret 2272bfa79a80SQuentin Perret free_hyp_pgds(); 2273bfa79a80SQuentin Perret 2274bfa79a80SQuentin Perret return 0; 2275bfa79a80SQuentin Perret } 2276bfa79a80SQuentin Perret 22778c15c2a0SMostafa Saleh static void pkvm_hyp_init_ptrauth(void) 22788c15c2a0SMostafa Saleh { 22798c15c2a0SMostafa Saleh struct kvm_cpu_context *hyp_ctxt; 22808c15c2a0SMostafa Saleh int cpu; 22818c15c2a0SMostafa Saleh 22828c15c2a0SMostafa Saleh for_each_possible_cpu(cpu) { 22838c15c2a0SMostafa Saleh hyp_ctxt = per_cpu_ptr_nvhe_sym(kvm_hyp_ctxt, cpu); 22848c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APIAKEYLO_EL1] = get_random_long(); 22858c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APIAKEYHI_EL1] = get_random_long(); 22868c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APIBKEYLO_EL1] = get_random_long(); 22878c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APIBKEYHI_EL1] = get_random_long(); 22888c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APDAKEYLO_EL1] = get_random_long(); 22898c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APDAKEYHI_EL1] = get_random_long(); 22908c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APDBKEYLO_EL1] = get_random_long(); 22918c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APDBKEYHI_EL1] = get_random_long(); 22928c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APGAKEYLO_EL1] = get_random_long(); 22938c15c2a0SMostafa Saleh hyp_ctxt->sys_regs[APGAKEYHI_EL1] = get_random_long(); 22948c15c2a0SMostafa Saleh } 22958c15c2a0SMostafa Saleh } 22968c15c2a0SMostafa Saleh 229767d953d4SMarc Zyngier /* Inits Hyp-mode on all online CPUs */ 229853bf620aSSean Christopherson static int __init init_hyp_mode(void) 22999ed24f4bSMarc Zyngier { 2300bfa79a80SQuentin Perret u32 hyp_va_bits; 23019ed24f4bSMarc Zyngier int cpu; 2302bfa79a80SQuentin Perret int err = -ENOMEM; 2303bfa79a80SQuentin Perret 2304bfa79a80SQuentin Perret /* 2305bfa79a80SQuentin Perret * The protected Hyp-mode cannot be initialized if the memory pool 2306bfa79a80SQuentin Perret * allocation has failed. 2307bfa79a80SQuentin Perret */ 2308bfa79a80SQuentin Perret if (is_protected_kvm_enabled() && !hyp_mem_base) 2309bfa79a80SQuentin Perret goto out_err; 23109ed24f4bSMarc Zyngier 23119ed24f4bSMarc Zyngier /* 23129ed24f4bSMarc Zyngier * Allocate Hyp PGD and setup Hyp identity mapping 23139ed24f4bSMarc Zyngier */ 2314bfa79a80SQuentin Perret err = kvm_mmu_init(&hyp_va_bits); 23159ed24f4bSMarc Zyngier if (err) 23169ed24f4bSMarc Zyngier goto out_err; 23179ed24f4bSMarc Zyngier 23189ed24f4bSMarc Zyngier /* 23199ed24f4bSMarc Zyngier * Allocate stack pages for Hypervisor-mode 23209ed24f4bSMarc Zyngier */ 23219ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 23229ed24f4bSMarc Zyngier unsigned long stack_page; 23239ed24f4bSMarc Zyngier 23249ed24f4bSMarc Zyngier stack_page = __get_free_page(GFP_KERNEL); 23259ed24f4bSMarc Zyngier if (!stack_page) { 23269ed24f4bSMarc Zyngier err = -ENOMEM; 23279ed24f4bSMarc Zyngier goto out_err; 23289ed24f4bSMarc Zyngier } 23299ed24f4bSMarc Zyngier 23309ed24f4bSMarc Zyngier per_cpu(kvm_arm_hyp_stack_page, cpu) = stack_page; 23319ed24f4bSMarc Zyngier } 23329ed24f4bSMarc Zyngier 23339ed24f4bSMarc Zyngier /* 233430c95391SDavid Brazdil * Allocate and initialize pages for Hypervisor-mode percpu regions. 233530c95391SDavid Brazdil */ 233630c95391SDavid Brazdil for_each_possible_cpu(cpu) { 233730c95391SDavid Brazdil struct page *page; 233830c95391SDavid Brazdil void *page_addr; 233930c95391SDavid Brazdil 234030c95391SDavid Brazdil page = alloc_pages(GFP_KERNEL, nvhe_percpu_order()); 234130c95391SDavid Brazdil if (!page) { 234230c95391SDavid Brazdil err = -ENOMEM; 234330c95391SDavid Brazdil goto out_err; 234430c95391SDavid Brazdil } 234530c95391SDavid Brazdil 234630c95391SDavid Brazdil page_addr = page_address(page); 234730c95391SDavid Brazdil memcpy(page_addr, CHOOSE_NVHE_SYM(__per_cpu_start), nvhe_percpu_size()); 2348fe41a7f8SQuentin Perret kvm_nvhe_sym(kvm_arm_hyp_percpu_base)[cpu] = (unsigned long)page_addr; 234930c95391SDavid Brazdil } 235030c95391SDavid Brazdil 235130c95391SDavid Brazdil /* 23529ed24f4bSMarc Zyngier * Map the Hyp-code called directly from the host 23539ed24f4bSMarc Zyngier */ 23549ed24f4bSMarc Zyngier err = create_hyp_mappings(kvm_ksym_ref(__hyp_text_start), 23559ed24f4bSMarc Zyngier kvm_ksym_ref(__hyp_text_end), PAGE_HYP_EXEC); 23569ed24f4bSMarc Zyngier if (err) { 23579ed24f4bSMarc Zyngier kvm_err("Cannot map world-switch code\n"); 23589ed24f4bSMarc Zyngier goto out_err; 23599ed24f4bSMarc Zyngier } 23609ed24f4bSMarc Zyngier 236116174eeaSDavid Brazdil err = create_hyp_mappings(kvm_ksym_ref(__hyp_rodata_start), 236216174eeaSDavid Brazdil kvm_ksym_ref(__hyp_rodata_end), PAGE_HYP_RO); 23632d7bf218SDavid Brazdil if (err) { 236416174eeaSDavid Brazdil kvm_err("Cannot map .hyp.rodata section\n"); 23652d7bf218SDavid Brazdil goto out_err; 23662d7bf218SDavid Brazdil } 23672d7bf218SDavid Brazdil 23689ed24f4bSMarc Zyngier err = create_hyp_mappings(kvm_ksym_ref(__start_rodata), 23699ed24f4bSMarc Zyngier kvm_ksym_ref(__end_rodata), PAGE_HYP_RO); 23709ed24f4bSMarc Zyngier if (err) { 23719ed24f4bSMarc Zyngier kvm_err("Cannot map rodata section\n"); 23729ed24f4bSMarc Zyngier goto out_err; 23739ed24f4bSMarc Zyngier } 23749ed24f4bSMarc Zyngier 2375380e18adSQuentin Perret /* 2376380e18adSQuentin Perret * .hyp.bss is guaranteed to be placed at the beginning of the .bss 2377380e18adSQuentin Perret * section thanks to an assertion in the linker script. Map it RW and 2378380e18adSQuentin Perret * the rest of .bss RO. 2379380e18adSQuentin Perret */ 2380380e18adSQuentin Perret err = create_hyp_mappings(kvm_ksym_ref(__hyp_bss_start), 2381380e18adSQuentin Perret kvm_ksym_ref(__hyp_bss_end), PAGE_HYP); 2382380e18adSQuentin Perret if (err) { 2383380e18adSQuentin Perret kvm_err("Cannot map hyp bss section: %d\n", err); 2384380e18adSQuentin Perret goto out_err; 2385380e18adSQuentin Perret } 2386380e18adSQuentin Perret 2387380e18adSQuentin Perret err = create_hyp_mappings(kvm_ksym_ref(__hyp_bss_end), 23889ed24f4bSMarc Zyngier kvm_ksym_ref(__bss_stop), PAGE_HYP_RO); 23899ed24f4bSMarc Zyngier if (err) { 23909ed24f4bSMarc Zyngier kvm_err("Cannot map bss section\n"); 23919ed24f4bSMarc Zyngier goto out_err; 23929ed24f4bSMarc Zyngier } 23939ed24f4bSMarc Zyngier 23949ed24f4bSMarc Zyngier /* 23959ed24f4bSMarc Zyngier * Map the Hyp stack pages 23969ed24f4bSMarc Zyngier */ 23979ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 2398ce335431SKalesh Singh struct kvm_nvhe_init_params *params = per_cpu_ptr_nvhe_sym(kvm_init_params, cpu); 23999ed24f4bSMarc Zyngier char *stack_page = (char *)per_cpu(kvm_arm_hyp_stack_page, cpu); 24009ed24f4bSMarc Zyngier 2401f156a7d1SVincent Donnefort err = create_hyp_stack(__pa(stack_page), ¶ms->stack_hyp_va); 24029ed24f4bSMarc Zyngier if (err) { 24039ed24f4bSMarc Zyngier kvm_err("Cannot map hyp stack\n"); 24049ed24f4bSMarc Zyngier goto out_err; 24059ed24f4bSMarc Zyngier } 2406ce335431SKalesh Singh 2407ce335431SKalesh Singh /* 2408ce335431SKalesh Singh * Save the stack PA in nvhe_init_params. This will be needed 2409ce335431SKalesh Singh * to recreate the stack mapping in protected nVHE mode. 2410ce335431SKalesh Singh * __hyp_pa() won't do the right thing there, since the stack 2411ce335431SKalesh Singh * has been mapped in the flexible private VA space. 2412ce335431SKalesh Singh */ 2413ce335431SKalesh Singh params->stack_pa = __pa(stack_page); 24149ed24f4bSMarc Zyngier } 24159ed24f4bSMarc Zyngier 24169ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 2417fe41a7f8SQuentin Perret char *percpu_begin = (char *)kvm_nvhe_sym(kvm_arm_hyp_percpu_base)[cpu]; 241830c95391SDavid Brazdil char *percpu_end = percpu_begin + nvhe_percpu_size(); 24199ed24f4bSMarc Zyngier 24209cc77581SQuentin Perret /* Map Hyp percpu pages */ 242130c95391SDavid Brazdil err = create_hyp_mappings(percpu_begin, percpu_end, PAGE_HYP); 24229ed24f4bSMarc Zyngier if (err) { 242330c95391SDavid Brazdil kvm_err("Cannot map hyp percpu region\n"); 24246e3bfbb2SAndrew Scull goto out_err; 24256e3bfbb2SAndrew Scull } 24269cc77581SQuentin Perret 24279cc77581SQuentin Perret /* Prepare the CPU initialization parameters */ 2428579d7ebeSRyan Roberts cpu_prepare_hyp_mode(cpu, hyp_va_bits); 24299ed24f4bSMarc Zyngier } 24309ed24f4bSMarc Zyngier 24316c165223SWill Deacon kvm_hyp_init_symbols(); 24326c165223SWill Deacon 2433eeeee719SDavid Brazdil if (is_protected_kvm_enabled()) { 24348c15c2a0SMostafa Saleh if (IS_ENABLED(CONFIG_ARM64_PTR_AUTH_KERNEL) && 2435d8569fbaSMark Rutland cpus_have_final_cap(ARM64_HAS_ADDRESS_AUTH)) 24368c15c2a0SMostafa Saleh pkvm_hyp_init_ptrauth(); 24378c15c2a0SMostafa Saleh 243894f5e8a4SDavid Brazdil init_cpu_logical_map(); 243994f5e8a4SDavid Brazdil 244052b9e265SWang Wensheng if (!init_psci_relay()) { 244152b9e265SWang Wensheng err = -ENODEV; 2442eeeee719SDavid Brazdil goto out_err; 2443eeeee719SDavid Brazdil } 2444eeeee719SDavid Brazdil 2445bfa79a80SQuentin Perret err = kvm_hyp_init_protection(hyp_va_bits); 2446bfa79a80SQuentin Perret if (err) { 2447bfa79a80SQuentin Perret kvm_err("Failed to init hyp memory protection\n"); 2448bfa79a80SQuentin Perret goto out_err; 2449bfa79a80SQuentin Perret } 2450bfa79a80SQuentin Perret } 24519ed24f4bSMarc Zyngier 24529ed24f4bSMarc Zyngier return 0; 24539ed24f4bSMarc Zyngier 24549ed24f4bSMarc Zyngier out_err: 24559ed24f4bSMarc Zyngier teardown_hyp_mode(); 24569ed24f4bSMarc Zyngier kvm_err("error initializing Hyp mode: %d\n", err); 24579ed24f4bSMarc Zyngier return err; 24589ed24f4bSMarc Zyngier } 24599ed24f4bSMarc Zyngier 24609ed24f4bSMarc Zyngier struct kvm_vcpu *kvm_mpidr_to_vcpu(struct kvm *kvm, unsigned long mpidr) 24619ed24f4bSMarc Zyngier { 24629ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 246346808a4cSMarc Zyngier unsigned long i; 24649ed24f4bSMarc Zyngier 24659ed24f4bSMarc Zyngier mpidr &= MPIDR_HWID_BITMASK; 246654a8006dSMarc Zyngier 246754a8006dSMarc Zyngier if (kvm->arch.mpidr_data) { 246854a8006dSMarc Zyngier u16 idx = kvm_mpidr_index(kvm->arch.mpidr_data, mpidr); 246954a8006dSMarc Zyngier 247054a8006dSMarc Zyngier vcpu = kvm_get_vcpu(kvm, 247154a8006dSMarc Zyngier kvm->arch.mpidr_data->cmpidr_to_idx[idx]); 247254a8006dSMarc Zyngier if (mpidr != kvm_vcpu_get_mpidr_aff(vcpu)) 247354a8006dSMarc Zyngier vcpu = NULL; 247454a8006dSMarc Zyngier 247554a8006dSMarc Zyngier return vcpu; 247654a8006dSMarc Zyngier } 247754a8006dSMarc Zyngier 24789ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) { 24799ed24f4bSMarc Zyngier if (mpidr == kvm_vcpu_get_mpidr_aff(vcpu)) 24809ed24f4bSMarc Zyngier return vcpu; 24819ed24f4bSMarc Zyngier } 24829ed24f4bSMarc Zyngier return NULL; 24839ed24f4bSMarc Zyngier } 24849ed24f4bSMarc Zyngier 2485d663b8a2SPaolo Bonzini bool kvm_arch_irqchip_in_kernel(struct kvm *kvm) 2486d663b8a2SPaolo Bonzini { 2487d663b8a2SPaolo Bonzini return irqchip_in_kernel(kvm); 2488d663b8a2SPaolo Bonzini } 2489d663b8a2SPaolo Bonzini 24909ed24f4bSMarc Zyngier bool kvm_arch_has_irq_bypass(void) 24919ed24f4bSMarc Zyngier { 24929ed24f4bSMarc Zyngier return true; 24939ed24f4bSMarc Zyngier } 24949ed24f4bSMarc Zyngier 24959ed24f4bSMarc Zyngier int kvm_arch_irq_bypass_add_producer(struct irq_bypass_consumer *cons, 24969ed24f4bSMarc Zyngier struct irq_bypass_producer *prod) 24979ed24f4bSMarc Zyngier { 24989ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 24999ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 25009ed24f4bSMarc Zyngier 25019ed24f4bSMarc Zyngier return kvm_vgic_v4_set_forwarding(irqfd->kvm, prod->irq, 25029ed24f4bSMarc Zyngier &irqfd->irq_entry); 25039ed24f4bSMarc Zyngier } 25049ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_del_producer(struct irq_bypass_consumer *cons, 25059ed24f4bSMarc Zyngier struct irq_bypass_producer *prod) 25069ed24f4bSMarc Zyngier { 25079ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 25089ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 25099ed24f4bSMarc Zyngier 25109ed24f4bSMarc Zyngier kvm_vgic_v4_unset_forwarding(irqfd->kvm, prod->irq, 25119ed24f4bSMarc Zyngier &irqfd->irq_entry); 25129ed24f4bSMarc Zyngier } 25139ed24f4bSMarc Zyngier 25149ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_stop(struct irq_bypass_consumer *cons) 25159ed24f4bSMarc Zyngier { 25169ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 25179ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 25189ed24f4bSMarc Zyngier 25199ed24f4bSMarc Zyngier kvm_arm_halt_guest(irqfd->kvm); 25209ed24f4bSMarc Zyngier } 25219ed24f4bSMarc Zyngier 25229ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_start(struct irq_bypass_consumer *cons) 25239ed24f4bSMarc Zyngier { 25249ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 25259ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 25269ed24f4bSMarc Zyngier 25279ed24f4bSMarc Zyngier kvm_arm_resume_guest(irqfd->kvm); 25289ed24f4bSMarc Zyngier } 25299ed24f4bSMarc Zyngier 253067d953d4SMarc Zyngier /* Initialize Hyp-mode and memory mappings on all CPUs */ 253153bf620aSSean Christopherson static __init int kvm_arm_init(void) 25329ed24f4bSMarc Zyngier { 25339ed24f4bSMarc Zyngier int err; 25349ed24f4bSMarc Zyngier bool in_hyp_mode; 25359ed24f4bSMarc Zyngier 25369ed24f4bSMarc Zyngier if (!is_hyp_mode_available()) { 25379ed24f4bSMarc Zyngier kvm_info("HYP mode not available\n"); 25389ed24f4bSMarc Zyngier return -ENODEV; 25399ed24f4bSMarc Zyngier } 25409ed24f4bSMarc Zyngier 2541b6a68b97SMarc Zyngier if (kvm_get_mode() == KVM_MODE_NONE) { 2542b6a68b97SMarc Zyngier kvm_info("KVM disabled from command line\n"); 2543b6a68b97SMarc Zyngier return -ENODEV; 2544b6a68b97SMarc Zyngier } 2545b6a68b97SMarc Zyngier 2546f1f0c0cfSAlexandru Elisei err = kvm_sys_reg_table_init(); 2547f1f0c0cfSAlexandru Elisei if (err) { 2548f1f0c0cfSAlexandru Elisei kvm_info("Error initializing system register tables"); 2549f1f0c0cfSAlexandru Elisei return err; 2550f1f0c0cfSAlexandru Elisei } 2551f1f0c0cfSAlexandru Elisei 25529ed24f4bSMarc Zyngier in_hyp_mode = is_kernel_in_hyp_mode(); 25539ed24f4bSMarc Zyngier 255496d389caSRob Herring if (cpus_have_final_cap(ARM64_WORKAROUND_DEVICE_LOAD_ACQUIRE) || 255596d389caSRob Herring cpus_have_final_cap(ARM64_WORKAROUND_1508412)) 2556abf532ccSRob Herring kvm_info("Guests without required CPU erratum workarounds can deadlock system!\n" \ 2557abf532ccSRob Herring "Only trusted guests should be used on this system.\n"); 2558abf532ccSRob Herring 2559bf249d9eSAnshuman Khandual err = kvm_set_ipa_limit(); 25609ed24f4bSMarc Zyngier if (err) 25619ed24f4bSMarc Zyngier return err; 25629ed24f4bSMarc Zyngier 25639ed24f4bSMarc Zyngier err = kvm_arm_init_sve(); 25649ed24f4bSMarc Zyngier if (err) 25659ed24f4bSMarc Zyngier return err; 25669ed24f4bSMarc Zyngier 25673248136bSJulien Grall err = kvm_arm_vmid_alloc_init(); 25683248136bSJulien Grall if (err) { 25693248136bSJulien Grall kvm_err("Failed to initialize VMID allocator.\n"); 25703248136bSJulien Grall return err; 25713248136bSJulien Grall } 25723248136bSJulien Grall 25739ed24f4bSMarc Zyngier if (!in_hyp_mode) { 25749ed24f4bSMarc Zyngier err = init_hyp_mode(); 25759ed24f4bSMarc Zyngier if (err) 25769ed24f4bSMarc Zyngier goto out_err; 25779ed24f4bSMarc Zyngier } 25789ed24f4bSMarc Zyngier 2579b881cdceSWill Deacon err = kvm_init_vector_slots(); 2580b881cdceSWill Deacon if (err) { 2581b881cdceSWill Deacon kvm_err("Cannot initialise vector slots\n"); 25826baaeda8SSean Christopherson goto out_hyp; 2583b881cdceSWill Deacon } 2584b881cdceSWill Deacon 25859ed24f4bSMarc Zyngier err = init_subsystems(); 25869ed24f4bSMarc Zyngier if (err) 258778b3bf48SSean Christopherson goto out_hyp; 25889ed24f4bSMarc Zyngier 2589f19f6644SDavid Brazdil if (is_protected_kvm_enabled()) { 25903eb681fbSDavid Brazdil kvm_info("Protected nVHE mode initialized successfully\n"); 2591f19f6644SDavid Brazdil } else if (in_hyp_mode) { 25929ed24f4bSMarc Zyngier kvm_info("VHE mode initialized successfully\n"); 2593f19f6644SDavid Brazdil } else { 2594*1f3ca702SJoey Gouly char mode = cpus_have_final_cap(ARM64_KVM_HVHE) ? 'h' : 'n'; 2595*1f3ca702SJoey Gouly kvm_info("Hyp mode (%cVHE) initialized successfully\n", mode); 2596f19f6644SDavid Brazdil } 25979ed24f4bSMarc Zyngier 25981dc0f02dSSean Christopherson /* 25991dc0f02dSSean Christopherson * FIXME: Do something reasonable if kvm_init() fails after pKVM 26001dc0f02dSSean Christopherson * hypervisor protection is finalized. 26011dc0f02dSSean Christopherson */ 260281a1cf9fSSean Christopherson err = kvm_init(sizeof(struct kvm_vcpu), 0, THIS_MODULE); 26031dc0f02dSSean Christopherson if (err) 26041dc0f02dSSean Christopherson goto out_subs; 26051dc0f02dSSean Christopherson 2606fa729bc7SSudeep Holla kvm_arm_initialised = true; 2607fa729bc7SSudeep Holla 26089ed24f4bSMarc Zyngier return 0; 26099ed24f4bSMarc Zyngier 26106baaeda8SSean Christopherson out_subs: 261178b3bf48SSean Christopherson teardown_subsystems(); 26126baaeda8SSean Christopherson out_hyp: 26139ed24f4bSMarc Zyngier if (!in_hyp_mode) 26149ed24f4bSMarc Zyngier teardown_hyp_mode(); 26159ed24f4bSMarc Zyngier out_err: 26163248136bSJulien Grall kvm_arm_vmid_alloc_free(); 26179ed24f4bSMarc Zyngier return err; 26189ed24f4bSMarc Zyngier } 26199ed24f4bSMarc Zyngier 2620d8b369c4SDavid Brazdil static int __init early_kvm_mode_cfg(char *arg) 2621d8b369c4SDavid Brazdil { 2622d8b369c4SDavid Brazdil if (!arg) 2623d8b369c4SDavid Brazdil return -EINVAL; 2624d8b369c4SDavid Brazdil 2625b2a4d007SElliot Berman if (strcmp(arg, "none") == 0) { 2626b2a4d007SElliot Berman kvm_mode = KVM_MODE_NONE; 2627b2a4d007SElliot Berman return 0; 2628b2a4d007SElliot Berman } 2629b2a4d007SElliot Berman 2630b2a4d007SElliot Berman if (!is_hyp_mode_available()) { 2631b2a4d007SElliot Berman pr_warn_once("KVM is not available. Ignoring kvm-arm.mode\n"); 2632b2a4d007SElliot Berman return 0; 2633b2a4d007SElliot Berman } 2634b2a4d007SElliot Berman 2635d8b369c4SDavid Brazdil if (strcmp(arg, "protected") == 0) { 2636cde5042aSWill Deacon if (!is_kernel_in_hyp_mode()) 2637d8b369c4SDavid Brazdil kvm_mode = KVM_MODE_PROTECTED; 2638cde5042aSWill Deacon else 2639cde5042aSWill Deacon pr_warn_once("Protected KVM not available with VHE\n"); 2640cde5042aSWill Deacon 2641d8b369c4SDavid Brazdil return 0; 2642d8b369c4SDavid Brazdil } 2643d8b369c4SDavid Brazdil 2644b6a68b97SMarc Zyngier if (strcmp(arg, "nvhe") == 0 && !WARN_ON(is_kernel_in_hyp_mode())) { 2645b6a68b97SMarc Zyngier kvm_mode = KVM_MODE_DEFAULT; 26461945a067SMarc Zyngier return 0; 2647b6a68b97SMarc Zyngier } 2648b6a68b97SMarc Zyngier 2649675cabc8SJintack Lim if (strcmp(arg, "nested") == 0 && !WARN_ON(!is_kernel_in_hyp_mode())) { 2650675cabc8SJintack Lim kvm_mode = KVM_MODE_NV; 2651675cabc8SJintack Lim return 0; 2652675cabc8SJintack Lim } 2653675cabc8SJintack Lim 2654d8b369c4SDavid Brazdil return -EINVAL; 2655d8b369c4SDavid Brazdil } 2656d8b369c4SDavid Brazdil early_param("kvm-arm.mode", early_kvm_mode_cfg); 2657d8b369c4SDavid Brazdil 26583eb681fbSDavid Brazdil enum kvm_mode kvm_get_mode(void) 26593eb681fbSDavid Brazdil { 26603eb681fbSDavid Brazdil return kvm_mode; 26613eb681fbSDavid Brazdil } 26623eb681fbSDavid Brazdil 26631dc0f02dSSean Christopherson module_init(kvm_arm_init); 2664