19ed24f4bSMarc Zyngier // SPDX-License-Identifier: GPL-2.0-only 29ed24f4bSMarc Zyngier /* 39ed24f4bSMarc Zyngier * Copyright (C) 2012 - Virtual Open Systems and Columbia University 49ed24f4bSMarc Zyngier * Author: Christoffer Dall <c.dall@virtualopensystems.com> 59ed24f4bSMarc Zyngier */ 69ed24f4bSMarc Zyngier 79ed24f4bSMarc Zyngier #include <linux/bug.h> 89ed24f4bSMarc Zyngier #include <linux/cpu_pm.h> 96caa5812SOliver Upton #include <linux/entry-kvm.h> 109ed24f4bSMarc Zyngier #include <linux/errno.h> 119ed24f4bSMarc Zyngier #include <linux/err.h> 129ed24f4bSMarc Zyngier #include <linux/kvm_host.h> 139ed24f4bSMarc Zyngier #include <linux/list.h> 149ed24f4bSMarc Zyngier #include <linux/module.h> 159ed24f4bSMarc Zyngier #include <linux/vmalloc.h> 169ed24f4bSMarc Zyngier #include <linux/fs.h> 179ed24f4bSMarc Zyngier #include <linux/mman.h> 189ed24f4bSMarc Zyngier #include <linux/sched.h> 1947e6223cSMarc Zyngier #include <linux/kmemleak.h> 209ed24f4bSMarc Zyngier #include <linux/kvm.h> 219ed24f4bSMarc Zyngier #include <linux/kvm_irqfd.h> 229ed24f4bSMarc Zyngier #include <linux/irqbypass.h> 239ed24f4bSMarc Zyngier #include <linux/sched/stat.h> 24eeeee719SDavid Brazdil #include <linux/psci.h> 259ed24f4bSMarc Zyngier #include <trace/events/kvm.h> 269ed24f4bSMarc Zyngier 279ed24f4bSMarc Zyngier #define CREATE_TRACE_POINTS 289ed24f4bSMarc Zyngier #include "trace_arm.h" 299ed24f4bSMarc Zyngier 309ed24f4bSMarc Zyngier #include <linux/uaccess.h> 319ed24f4bSMarc Zyngier #include <asm/ptrace.h> 329ed24f4bSMarc Zyngier #include <asm/mman.h> 339ed24f4bSMarc Zyngier #include <asm/tlbflush.h> 349ed24f4bSMarc Zyngier #include <asm/cacheflush.h> 359ed24f4bSMarc Zyngier #include <asm/cpufeature.h> 369ed24f4bSMarc Zyngier #include <asm/virt.h> 379ed24f4bSMarc Zyngier #include <asm/kvm_arm.h> 389ed24f4bSMarc Zyngier #include <asm/kvm_asm.h> 399ed24f4bSMarc Zyngier #include <asm/kvm_mmu.h> 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; 49f19f6644SDavid Brazdil DEFINE_STATIC_KEY_FALSE(kvm_protected_mode_initialized); 50d8b369c4SDavid Brazdil 5114ef9d04SMarc Zyngier DECLARE_KVM_HYP_PER_CPU(unsigned long, kvm_hyp_vector); 5214ef9d04SMarc Zyngier 53db129d48SKalesh Singh DEFINE_PER_CPU(unsigned long, kvm_arm_hyp_stack_page); 5463fec243SDavid Brazdil DECLARE_KVM_NVHE_PER_CPU(struct kvm_nvhe_init_params, kvm_init_params); 559ed24f4bSMarc Zyngier 569ed24f4bSMarc Zyngier static bool vgic_present; 579ed24f4bSMarc Zyngier 589ed24f4bSMarc Zyngier static DEFINE_PER_CPU(unsigned char, kvm_arm_hardware_enabled); 599ed24f4bSMarc Zyngier DEFINE_STATIC_KEY_FALSE(userspace_irqchip_in_use); 609ed24f4bSMarc Zyngier 619ed24f4bSMarc Zyngier int kvm_arch_vcpu_should_kick(struct kvm_vcpu *vcpu) 629ed24f4bSMarc Zyngier { 639ed24f4bSMarc Zyngier return kvm_vcpu_exiting_guest_mode(vcpu) == IN_GUEST_MODE; 649ed24f4bSMarc Zyngier } 659ed24f4bSMarc Zyngier 669ed24f4bSMarc Zyngier int kvm_vm_ioctl_enable_cap(struct kvm *kvm, 679ed24f4bSMarc Zyngier struct kvm_enable_cap *cap) 689ed24f4bSMarc Zyngier { 699ed24f4bSMarc Zyngier int r; 709ed24f4bSMarc Zyngier 719ed24f4bSMarc Zyngier if (cap->flags) 729ed24f4bSMarc Zyngier return -EINVAL; 739ed24f4bSMarc Zyngier 749ed24f4bSMarc Zyngier switch (cap->cap) { 759ed24f4bSMarc Zyngier case KVM_CAP_ARM_NISV_TO_USER: 769ed24f4bSMarc Zyngier r = 0; 7706394531SMarc Zyngier set_bit(KVM_ARCH_FLAG_RETURN_NISV_IO_ABORT_TO_USER, 7806394531SMarc Zyngier &kvm->arch.flags); 799ed24f4bSMarc Zyngier break; 80673638f4SSteven Price case KVM_CAP_ARM_MTE: 81c4d7c518SSteven Price mutex_lock(&kvm->lock); 82c4d7c518SSteven Price if (!system_supports_mte() || kvm->created_vcpus) { 83c4d7c518SSteven Price r = -EINVAL; 84c4d7c518SSteven Price } else { 85673638f4SSteven Price r = 0; 8606394531SMarc Zyngier set_bit(KVM_ARCH_FLAG_MTE_ENABLED, &kvm->arch.flags); 87c4d7c518SSteven Price } 88c4d7c518SSteven Price mutex_unlock(&kvm->lock); 89673638f4SSteven Price break; 90bfbab445SOliver Upton case KVM_CAP_ARM_SYSTEM_SUSPEND: 91bfbab445SOliver Upton r = 0; 92bfbab445SOliver Upton set_bit(KVM_ARCH_FLAG_SYSTEM_SUSPEND_ENABLED, &kvm->arch.flags); 93bfbab445SOliver Upton break; 949ed24f4bSMarc Zyngier default: 959ed24f4bSMarc Zyngier r = -EINVAL; 969ed24f4bSMarc Zyngier break; 979ed24f4bSMarc Zyngier } 989ed24f4bSMarc Zyngier 999ed24f4bSMarc Zyngier return r; 1009ed24f4bSMarc Zyngier } 1019ed24f4bSMarc Zyngier 1025107000fSMarc Zyngier static int kvm_arm_default_max_vcpus(void) 1035107000fSMarc Zyngier { 1045107000fSMarc Zyngier return vgic_present ? kvm_vgic_get_max_vcpus() : KVM_MAX_VCPUS; 1055107000fSMarc Zyngier } 1065107000fSMarc Zyngier 1074f1df628SMarc Zyngier static void set_default_spectre(struct kvm *kvm) 10823711a5eSMarc Zyngier { 10923711a5eSMarc Zyngier /* 11023711a5eSMarc Zyngier * The default is to expose CSV2 == 1 if the HW isn't affected. 11123711a5eSMarc Zyngier * Although this is a per-CPU feature, we make it global because 11223711a5eSMarc Zyngier * asymmetric systems are just a nuisance. 11323711a5eSMarc Zyngier * 11423711a5eSMarc Zyngier * Userspace can override this as long as it doesn't promise 11523711a5eSMarc Zyngier * the impossible. 11623711a5eSMarc Zyngier */ 11723711a5eSMarc Zyngier if (arm64_get_spectre_v2_state() == SPECTRE_UNAFFECTED) 11823711a5eSMarc Zyngier kvm->arch.pfr0_csv2 = 1; 1194f1df628SMarc Zyngier if (arm64_get_meltdown_state() == SPECTRE_UNAFFECTED) 1204f1df628SMarc Zyngier kvm->arch.pfr0_csv3 = 1; 12123711a5eSMarc Zyngier } 12223711a5eSMarc Zyngier 1239ed24f4bSMarc Zyngier /** 1249ed24f4bSMarc Zyngier * kvm_arch_init_vm - initializes a VM data structure 1259ed24f4bSMarc Zyngier * @kvm: pointer to the KVM struct 1269ed24f4bSMarc Zyngier */ 1279ed24f4bSMarc Zyngier int kvm_arch_init_vm(struct kvm *kvm, unsigned long type) 1289ed24f4bSMarc Zyngier { 129a0e50aa3SChristoffer Dall int ret; 1309ed24f4bSMarc Zyngier 1313f868e14SQuentin Perret ret = kvm_share_hyp(kvm, kvm + 1); 1329ed24f4bSMarc Zyngier if (ret) 133315775ffSQuentin Perret return ret; 1349ed24f4bSMarc Zyngier 1359d0c063aSFuad Tabba ret = pkvm_init_host_vm(kvm); 1369d0c063aSFuad Tabba if (ret) 137315775ffSQuentin Perret goto err_unshare_kvm; 1389ed24f4bSMarc Zyngier 1395f623a59SOliver Upton if (!zalloc_cpumask_var(&kvm->arch.supported_cpus, GFP_KERNEL_ACCOUNT)) { 140ae187fecSWill Deacon ret = -ENOMEM; 141315775ffSQuentin Perret goto err_unshare_kvm; 142ae187fecSWill Deacon } 143583cda1bSAlexandru Elisei cpumask_copy(kvm->arch.supported_cpus, cpu_possible_mask); 144583cda1bSAlexandru Elisei 145315775ffSQuentin Perret ret = kvm_init_stage2_mmu(kvm, &kvm->arch.mmu, type); 146315775ffSQuentin Perret if (ret) 147315775ffSQuentin Perret goto err_free_cpumask; 148315775ffSQuentin Perret 1499ed24f4bSMarc Zyngier kvm_vgic_early_init(kvm); 1509ed24f4bSMarc Zyngier 1519ed24f4bSMarc Zyngier /* The maximum number of VCPUs is limited by the host's GIC model */ 152f502cc56SSean Christopherson kvm->max_vcpus = kvm_arm_default_max_vcpus(); 1539ed24f4bSMarc Zyngier 1544f1df628SMarc Zyngier set_default_spectre(kvm); 15505714cabSRaghavendra Rao Ananta kvm_arm_init_hypercalls(kvm); 15623711a5eSMarc Zyngier 1573d0dba57SMarc Zyngier /* 1583d0dba57SMarc Zyngier * Initialise the default PMUver before there is a chance to 1593d0dba57SMarc Zyngier * create an actual PMU. 1603d0dba57SMarc Zyngier */ 1613d0dba57SMarc Zyngier kvm->arch.dfr0_pmuver.imp = kvm_arm_pmu_get_pmuver_limit(); 1623d0dba57SMarc Zyngier 163315775ffSQuentin Perret return 0; 164315775ffSQuentin Perret 165315775ffSQuentin Perret err_free_cpumask: 166315775ffSQuentin Perret free_cpumask_var(kvm->arch.supported_cpus); 167315775ffSQuentin Perret err_unshare_kvm: 168315775ffSQuentin Perret kvm_unshare_hyp(kvm, kvm + 1); 1699ed24f4bSMarc Zyngier return ret; 1709ed24f4bSMarc Zyngier } 1719ed24f4bSMarc Zyngier 1729ed24f4bSMarc Zyngier vm_fault_t kvm_arch_vcpu_fault(struct kvm_vcpu *vcpu, struct vm_fault *vmf) 1739ed24f4bSMarc Zyngier { 1749ed24f4bSMarc Zyngier return VM_FAULT_SIGBUS; 1759ed24f4bSMarc Zyngier } 1769ed24f4bSMarc Zyngier 1779ed24f4bSMarc Zyngier 1789ed24f4bSMarc Zyngier /** 1799ed24f4bSMarc Zyngier * kvm_arch_destroy_vm - destroy the VM data structure 1809ed24f4bSMarc Zyngier * @kvm: pointer to the KVM struct 1819ed24f4bSMarc Zyngier */ 1829ed24f4bSMarc Zyngier void kvm_arch_destroy_vm(struct kvm *kvm) 1839ed24f4bSMarc Zyngier { 184d7eec236SMarc Zyngier bitmap_free(kvm->arch.pmu_filter); 185583cda1bSAlexandru Elisei free_cpumask_var(kvm->arch.supported_cpus); 186d7eec236SMarc Zyngier 1879ed24f4bSMarc Zyngier kvm_vgic_destroy(kvm); 1889ed24f4bSMarc Zyngier 1899d0c063aSFuad Tabba if (is_protected_kvm_enabled()) 1909d0c063aSFuad Tabba pkvm_destroy_hyp_vm(kvm); 1919d0c063aSFuad Tabba 19227592ae8SMarc Zyngier kvm_destroy_vcpus(kvm); 19352b28657SQuentin Perret 19452b28657SQuentin Perret kvm_unshare_hyp(kvm, kvm + 1); 195fb88707dSOliver Upton 196fb88707dSOliver Upton kvm_arm_teardown_hypercalls(kvm); 1979ed24f4bSMarc Zyngier } 1989ed24f4bSMarc Zyngier 1999ed24f4bSMarc Zyngier int kvm_vm_ioctl_check_extension(struct kvm *kvm, long ext) 2009ed24f4bSMarc Zyngier { 2019ed24f4bSMarc Zyngier int r; 2029ed24f4bSMarc Zyngier switch (ext) { 2039ed24f4bSMarc Zyngier case KVM_CAP_IRQCHIP: 2049ed24f4bSMarc Zyngier r = vgic_present; 2059ed24f4bSMarc Zyngier break; 2069ed24f4bSMarc Zyngier case KVM_CAP_IOEVENTFD: 2079ed24f4bSMarc Zyngier case KVM_CAP_DEVICE_CTRL: 2089ed24f4bSMarc Zyngier case KVM_CAP_USER_MEMORY: 2099ed24f4bSMarc Zyngier case KVM_CAP_SYNC_MMU: 2109ed24f4bSMarc Zyngier case KVM_CAP_DESTROY_MEMORY_REGION_WORKS: 2119ed24f4bSMarc Zyngier case KVM_CAP_ONE_REG: 2129ed24f4bSMarc Zyngier case KVM_CAP_ARM_PSCI: 2139ed24f4bSMarc Zyngier case KVM_CAP_ARM_PSCI_0_2: 2149ed24f4bSMarc Zyngier case KVM_CAP_READONLY_MEM: 2159ed24f4bSMarc Zyngier case KVM_CAP_MP_STATE: 2169ed24f4bSMarc Zyngier case KVM_CAP_IMMEDIATE_EXIT: 2179ed24f4bSMarc Zyngier case KVM_CAP_VCPU_EVENTS: 2189ed24f4bSMarc Zyngier case KVM_CAP_ARM_IRQ_LINE_LAYOUT_2: 2199ed24f4bSMarc Zyngier case KVM_CAP_ARM_NISV_TO_USER: 2209ed24f4bSMarc Zyngier case KVM_CAP_ARM_INJECT_EXT_DABT: 22136fb4cd5SWill Deacon case KVM_CAP_SET_GUEST_DEBUG: 22236fb4cd5SWill Deacon case KVM_CAP_VCPU_ATTRIBUTES: 2233bf72569SJianyong Wu case KVM_CAP_PTP_KVM: 224bfbab445SOliver Upton case KVM_CAP_ARM_SYSTEM_SUSPEND: 2259ed24f4bSMarc Zyngier r = 1; 2269ed24f4bSMarc Zyngier break; 227fa18aca9SMaxim Levitsky case KVM_CAP_SET_GUEST_DEBUG2: 228fa18aca9SMaxim Levitsky return KVM_GUESTDBG_VALID_MASK; 2299ed24f4bSMarc Zyngier case KVM_CAP_ARM_SET_DEVICE_ADDR: 2309ed24f4bSMarc Zyngier r = 1; 2319ed24f4bSMarc Zyngier break; 2329ed24f4bSMarc Zyngier case KVM_CAP_NR_VCPUS: 233f60a00d7SVitaly Kuznetsov /* 234f60a00d7SVitaly Kuznetsov * ARM64 treats KVM_CAP_NR_CPUS differently from all other 235f60a00d7SVitaly Kuznetsov * architectures, as it does not always bound it to 236f60a00d7SVitaly Kuznetsov * KVM_CAP_MAX_VCPUS. It should not matter much because 237f60a00d7SVitaly Kuznetsov * this is just an advisory value. 238f60a00d7SVitaly Kuznetsov */ 239f60a00d7SVitaly Kuznetsov r = min_t(unsigned int, num_online_cpus(), 240f60a00d7SVitaly Kuznetsov kvm_arm_default_max_vcpus()); 2419ed24f4bSMarc Zyngier break; 2429ed24f4bSMarc Zyngier case KVM_CAP_MAX_VCPUS: 2439ed24f4bSMarc Zyngier case KVM_CAP_MAX_VCPU_ID: 2445107000fSMarc Zyngier if (kvm) 245f502cc56SSean Christopherson r = kvm->max_vcpus; 2465107000fSMarc Zyngier else 2475107000fSMarc Zyngier r = kvm_arm_default_max_vcpus(); 2489ed24f4bSMarc Zyngier break; 2499ed24f4bSMarc Zyngier case KVM_CAP_MSI_DEVID: 2509ed24f4bSMarc Zyngier if (!kvm) 2519ed24f4bSMarc Zyngier r = -EINVAL; 2529ed24f4bSMarc Zyngier else 2539ed24f4bSMarc Zyngier r = kvm->arch.vgic.msis_require_devid; 2549ed24f4bSMarc Zyngier break; 2559ed24f4bSMarc Zyngier case KVM_CAP_ARM_USER_IRQ: 2569ed24f4bSMarc Zyngier /* 2579ed24f4bSMarc Zyngier * 1: EL1_VTIMER, EL1_PTIMER, and PMU. 2589ed24f4bSMarc Zyngier * (bump this number if adding more devices) 2599ed24f4bSMarc Zyngier */ 2609ed24f4bSMarc Zyngier r = 1; 2619ed24f4bSMarc Zyngier break; 262673638f4SSteven Price case KVM_CAP_ARM_MTE: 263673638f4SSteven Price r = system_supports_mte(); 264673638f4SSteven Price break; 265004a0124SAndrew Jones case KVM_CAP_STEAL_TIME: 266004a0124SAndrew Jones r = kvm_arm_pvtime_supported(); 267004a0124SAndrew Jones break; 26836fb4cd5SWill Deacon case KVM_CAP_ARM_EL1_32BIT: 26936fb4cd5SWill Deacon r = cpus_have_const_cap(ARM64_HAS_32BIT_EL1); 2709ed24f4bSMarc Zyngier break; 27136fb4cd5SWill Deacon case KVM_CAP_GUEST_DEBUG_HW_BPS: 27236fb4cd5SWill Deacon r = get_num_brps(); 27336fb4cd5SWill Deacon break; 27436fb4cd5SWill Deacon case KVM_CAP_GUEST_DEBUG_HW_WPS: 27536fb4cd5SWill Deacon r = get_num_wrps(); 27636fb4cd5SWill Deacon break; 27736fb4cd5SWill Deacon case KVM_CAP_ARM_PMU_V3: 27836fb4cd5SWill Deacon r = kvm_arm_support_pmu_v3(); 27936fb4cd5SWill Deacon break; 28036fb4cd5SWill Deacon case KVM_CAP_ARM_INJECT_SERROR_ESR: 28136fb4cd5SWill Deacon r = cpus_have_const_cap(ARM64_HAS_RAS_EXTN); 28236fb4cd5SWill Deacon break; 28336fb4cd5SWill Deacon case KVM_CAP_ARM_VM_IPA_SIZE: 28436fb4cd5SWill Deacon r = get_kvm_ipa_limit(); 28536fb4cd5SWill Deacon break; 28636fb4cd5SWill Deacon case KVM_CAP_ARM_SVE: 28736fb4cd5SWill Deacon r = system_supports_sve(); 28836fb4cd5SWill Deacon break; 28936fb4cd5SWill Deacon case KVM_CAP_ARM_PTRAUTH_ADDRESS: 29036fb4cd5SWill Deacon case KVM_CAP_ARM_PTRAUTH_GENERIC: 29136fb4cd5SWill Deacon r = system_has_full_ptr_auth(); 29236fb4cd5SWill Deacon break; 29336fb4cd5SWill Deacon default: 29436fb4cd5SWill Deacon r = 0; 2959ed24f4bSMarc Zyngier } 29636fb4cd5SWill Deacon 2979ed24f4bSMarc Zyngier return r; 2989ed24f4bSMarc Zyngier } 2999ed24f4bSMarc Zyngier 3009ed24f4bSMarc Zyngier long kvm_arch_dev_ioctl(struct file *filp, 3019ed24f4bSMarc Zyngier unsigned int ioctl, unsigned long arg) 3029ed24f4bSMarc Zyngier { 3039ed24f4bSMarc Zyngier return -EINVAL; 3049ed24f4bSMarc Zyngier } 3059ed24f4bSMarc Zyngier 3069ed24f4bSMarc Zyngier struct kvm *kvm_arch_alloc_vm(void) 3079ed24f4bSMarc Zyngier { 308115bae92SJia He size_t sz = sizeof(struct kvm); 3099ed24f4bSMarc Zyngier 310115bae92SJia He if (!has_vhe()) 311115bae92SJia He return kzalloc(sz, GFP_KERNEL_ACCOUNT); 312115bae92SJia He 313115bae92SJia He return __vmalloc(sz, GFP_KERNEL_ACCOUNT | __GFP_HIGHMEM | __GFP_ZERO); 3149ed24f4bSMarc Zyngier } 3159ed24f4bSMarc Zyngier 3169ed24f4bSMarc Zyngier int kvm_arch_vcpu_precreate(struct kvm *kvm, unsigned int id) 3179ed24f4bSMarc Zyngier { 3189ed24f4bSMarc Zyngier if (irqchip_in_kernel(kvm) && vgic_initialized(kvm)) 3199ed24f4bSMarc Zyngier return -EBUSY; 3209ed24f4bSMarc Zyngier 321f502cc56SSean Christopherson if (id >= kvm->max_vcpus) 3229ed24f4bSMarc Zyngier return -EINVAL; 3239ed24f4bSMarc Zyngier 3249ed24f4bSMarc Zyngier return 0; 3259ed24f4bSMarc Zyngier } 3269ed24f4bSMarc Zyngier 3279ed24f4bSMarc Zyngier int kvm_arch_vcpu_create(struct kvm_vcpu *vcpu) 3289ed24f4bSMarc Zyngier { 3299ed24f4bSMarc Zyngier int err; 3309ed24f4bSMarc Zyngier 3319ed24f4bSMarc Zyngier /* Force users to call KVM_ARM_VCPU_INIT */ 3329ed24f4bSMarc Zyngier vcpu->arch.target = -1; 3339ed24f4bSMarc Zyngier bitmap_zero(vcpu->arch.features, KVM_VCPU_MAX_FEATURES); 3349ed24f4bSMarc Zyngier 335e539451bSSean Christopherson vcpu->arch.mmu_page_cache.gfp_zero = __GFP_ZERO; 336e539451bSSean Christopherson 337b4da9187SMarc Zyngier /* 338b4da9187SMarc Zyngier * Default value for the FP state, will be overloaded at load 339b4da9187SMarc Zyngier * time if we support FP (pretty likely) 340b4da9187SMarc Zyngier */ 341b4da9187SMarc Zyngier vcpu->arch.fp_state = FP_STATE_FREE; 342b4da9187SMarc Zyngier 3439ed24f4bSMarc Zyngier /* Set up the timer */ 3449ed24f4bSMarc Zyngier kvm_timer_vcpu_init(vcpu); 3459ed24f4bSMarc Zyngier 3469ed24f4bSMarc Zyngier kvm_pmu_vcpu_init(vcpu); 3479ed24f4bSMarc Zyngier 3489ed24f4bSMarc Zyngier kvm_arm_reset_debug_ptr(vcpu); 3499ed24f4bSMarc Zyngier 3509ed24f4bSMarc Zyngier kvm_arm_pvtime_vcpu_init(&vcpu->arch); 3519ed24f4bSMarc Zyngier 352a0e50aa3SChristoffer Dall vcpu->arch.hw_mmu = &vcpu->kvm->arch.mmu; 353a0e50aa3SChristoffer Dall 3549ed24f4bSMarc Zyngier err = kvm_vgic_vcpu_init(vcpu); 3559ed24f4bSMarc Zyngier if (err) 3569ed24f4bSMarc Zyngier return err; 3579ed24f4bSMarc Zyngier 3583f868e14SQuentin Perret return kvm_share_hyp(vcpu, vcpu + 1); 3599ed24f4bSMarc Zyngier } 3609ed24f4bSMarc Zyngier 3619ed24f4bSMarc Zyngier void kvm_arch_vcpu_postcreate(struct kvm_vcpu *vcpu) 3629ed24f4bSMarc Zyngier { 3639ed24f4bSMarc Zyngier } 3649ed24f4bSMarc Zyngier 3659ed24f4bSMarc Zyngier void kvm_arch_vcpu_destroy(struct kvm_vcpu *vcpu) 3669ed24f4bSMarc Zyngier { 367cc5705fbSMarc Zyngier if (vcpu_has_run_once(vcpu) && unlikely(!irqchip_in_kernel(vcpu->kvm))) 3689ed24f4bSMarc Zyngier static_branch_dec(&userspace_irqchip_in_use); 3699ed24f4bSMarc Zyngier 3709af3e08bSWill Deacon kvm_mmu_free_memory_cache(&vcpu->arch.mmu_page_cache); 3719ed24f4bSMarc Zyngier kvm_timer_vcpu_terminate(vcpu); 3729ed24f4bSMarc Zyngier kvm_pmu_vcpu_destroy(vcpu); 3739ed24f4bSMarc Zyngier 3749ed24f4bSMarc Zyngier kvm_arm_vcpu_destroy(vcpu); 3759ed24f4bSMarc Zyngier } 3769ed24f4bSMarc Zyngier 3779ed24f4bSMarc Zyngier void kvm_arch_vcpu_blocking(struct kvm_vcpu *vcpu) 3789ed24f4bSMarc Zyngier { 3796109c5a6SSean Christopherson 3809ed24f4bSMarc Zyngier } 3819ed24f4bSMarc Zyngier 3829ed24f4bSMarc Zyngier void kvm_arch_vcpu_unblocking(struct kvm_vcpu *vcpu) 3839ed24f4bSMarc Zyngier { 3846109c5a6SSean Christopherson 3859ed24f4bSMarc Zyngier } 3869ed24f4bSMarc Zyngier 3879ed24f4bSMarc Zyngier void kvm_arch_vcpu_load(struct kvm_vcpu *vcpu, int cpu) 3889ed24f4bSMarc Zyngier { 389a0e50aa3SChristoffer Dall struct kvm_s2_mmu *mmu; 3909ed24f4bSMarc Zyngier int *last_ran; 3919ed24f4bSMarc Zyngier 392a0e50aa3SChristoffer Dall mmu = vcpu->arch.hw_mmu; 393a0e50aa3SChristoffer Dall last_ran = this_cpu_ptr(mmu->last_vcpu_ran); 3949ed24f4bSMarc Zyngier 3959ed24f4bSMarc Zyngier /* 39601dc9262SMarc Zyngier * We guarantee that both TLBs and I-cache are private to each 39701dc9262SMarc Zyngier * vcpu. If detecting that a vcpu from the same VM has 39801dc9262SMarc Zyngier * previously run on the same physical CPU, call into the 39901dc9262SMarc Zyngier * hypervisor code to nuke the relevant contexts. 40001dc9262SMarc Zyngier * 4019ed24f4bSMarc Zyngier * We might get preempted before the vCPU actually runs, but 4029ed24f4bSMarc Zyngier * over-invalidation doesn't affect correctness. 4039ed24f4bSMarc Zyngier */ 4049ed24f4bSMarc Zyngier if (*last_ran != vcpu->vcpu_id) { 40501dc9262SMarc Zyngier kvm_call_hyp(__kvm_flush_cpu_context, mmu); 4069ed24f4bSMarc Zyngier *last_ran = vcpu->vcpu_id; 4079ed24f4bSMarc Zyngier } 4089ed24f4bSMarc Zyngier 4099ed24f4bSMarc Zyngier vcpu->cpu = cpu; 4109ed24f4bSMarc Zyngier 4119ed24f4bSMarc Zyngier kvm_vgic_load(vcpu); 4129ed24f4bSMarc Zyngier kvm_timer_vcpu_load(vcpu); 41313aeb9b4SDavid Brazdil if (has_vhe()) 41413aeb9b4SDavid Brazdil kvm_vcpu_load_sysregs_vhe(vcpu); 4159ed24f4bSMarc Zyngier kvm_arch_vcpu_load_fp(vcpu); 4169ed24f4bSMarc Zyngier kvm_vcpu_pmu_restore_guest(vcpu); 4179ed24f4bSMarc Zyngier if (kvm_arm_is_pvtime_enabled(&vcpu->arch)) 4189ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_RECORD_STEAL, vcpu); 4199ed24f4bSMarc Zyngier 4209ed24f4bSMarc Zyngier if (single_task_running()) 4219ed24f4bSMarc Zyngier vcpu_clear_wfx_traps(vcpu); 4229ed24f4bSMarc Zyngier else 4239ed24f4bSMarc Zyngier vcpu_set_wfx_traps(vcpu); 4249ed24f4bSMarc Zyngier 42529eb5a3cSMarc Zyngier if (vcpu_has_ptrauth(vcpu)) 426ef3e40a7SMarc Zyngier vcpu_ptrauth_disable(vcpu); 427d2602bb4SSuzuki K Poulose kvm_arch_vcpu_load_debug_state_flags(vcpu); 428583cda1bSAlexandru Elisei 429583cda1bSAlexandru Elisei if (!cpumask_test_cpu(smp_processor_id(), vcpu->kvm->arch.supported_cpus)) 430583cda1bSAlexandru Elisei vcpu_set_on_unsupported_cpu(vcpu); 4319ed24f4bSMarc Zyngier } 4329ed24f4bSMarc Zyngier 4339ed24f4bSMarc Zyngier void kvm_arch_vcpu_put(struct kvm_vcpu *vcpu) 4349ed24f4bSMarc Zyngier { 435d2602bb4SSuzuki K Poulose kvm_arch_vcpu_put_debug_state_flags(vcpu); 4369ed24f4bSMarc Zyngier kvm_arch_vcpu_put_fp(vcpu); 43713aeb9b4SDavid Brazdil if (has_vhe()) 43813aeb9b4SDavid Brazdil kvm_vcpu_put_sysregs_vhe(vcpu); 4399ed24f4bSMarc Zyngier kvm_timer_vcpu_put(vcpu); 4409ed24f4bSMarc Zyngier kvm_vgic_put(vcpu); 4419ed24f4bSMarc Zyngier kvm_vcpu_pmu_restore_host(vcpu); 442100b4f09SShameer Kolothum kvm_arm_vmid_clear_active(); 4439ed24f4bSMarc Zyngier 444583cda1bSAlexandru Elisei vcpu_clear_on_unsupported_cpu(vcpu); 4459ed24f4bSMarc Zyngier vcpu->cpu = -1; 4469ed24f4bSMarc Zyngier } 4479ed24f4bSMarc Zyngier 4481e579429SOliver Upton void kvm_arm_vcpu_power_off(struct kvm_vcpu *vcpu) 4499ed24f4bSMarc Zyngier { 450b171f9bbSOliver Upton vcpu->arch.mp_state.mp_state = KVM_MP_STATE_STOPPED; 4519ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_SLEEP, vcpu); 4529ed24f4bSMarc Zyngier kvm_vcpu_kick(vcpu); 4539ed24f4bSMarc Zyngier } 4549ed24f4bSMarc Zyngier 455b171f9bbSOliver Upton bool kvm_arm_vcpu_stopped(struct kvm_vcpu *vcpu) 456b171f9bbSOliver Upton { 457b171f9bbSOliver Upton return vcpu->arch.mp_state.mp_state == KVM_MP_STATE_STOPPED; 458b171f9bbSOliver Upton } 459b171f9bbSOliver Upton 4607b33a09dSOliver Upton static void kvm_arm_vcpu_suspend(struct kvm_vcpu *vcpu) 4617b33a09dSOliver Upton { 4627b33a09dSOliver Upton vcpu->arch.mp_state.mp_state = KVM_MP_STATE_SUSPENDED; 4637b33a09dSOliver Upton kvm_make_request(KVM_REQ_SUSPEND, vcpu); 4647b33a09dSOliver Upton kvm_vcpu_kick(vcpu); 4657b33a09dSOliver Upton } 4667b33a09dSOliver Upton 4677b33a09dSOliver Upton static bool kvm_arm_vcpu_suspended(struct kvm_vcpu *vcpu) 4687b33a09dSOliver Upton { 4697b33a09dSOliver Upton return vcpu->arch.mp_state.mp_state == KVM_MP_STATE_SUSPENDED; 4707b33a09dSOliver Upton } 4717b33a09dSOliver Upton 4729ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_get_mpstate(struct kvm_vcpu *vcpu, 4739ed24f4bSMarc Zyngier struct kvm_mp_state *mp_state) 4749ed24f4bSMarc Zyngier { 475b171f9bbSOliver Upton *mp_state = vcpu->arch.mp_state; 4769ed24f4bSMarc Zyngier 4779ed24f4bSMarc Zyngier return 0; 4789ed24f4bSMarc Zyngier } 4799ed24f4bSMarc Zyngier 4809ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_set_mpstate(struct kvm_vcpu *vcpu, 4819ed24f4bSMarc Zyngier struct kvm_mp_state *mp_state) 4829ed24f4bSMarc Zyngier { 4839ed24f4bSMarc Zyngier int ret = 0; 4849ed24f4bSMarc Zyngier 4859ed24f4bSMarc Zyngier switch (mp_state->mp_state) { 4869ed24f4bSMarc Zyngier case KVM_MP_STATE_RUNNABLE: 487b171f9bbSOliver Upton vcpu->arch.mp_state = *mp_state; 4889ed24f4bSMarc Zyngier break; 4899ed24f4bSMarc Zyngier case KVM_MP_STATE_STOPPED: 4901e579429SOliver Upton kvm_arm_vcpu_power_off(vcpu); 4919ed24f4bSMarc Zyngier break; 4927b33a09dSOliver Upton case KVM_MP_STATE_SUSPENDED: 4937b33a09dSOliver Upton kvm_arm_vcpu_suspend(vcpu); 4949ed24f4bSMarc Zyngier break; 4959ed24f4bSMarc Zyngier default: 4969ed24f4bSMarc Zyngier ret = -EINVAL; 4979ed24f4bSMarc Zyngier } 4989ed24f4bSMarc Zyngier 4999ed24f4bSMarc Zyngier return ret; 5009ed24f4bSMarc Zyngier } 5019ed24f4bSMarc Zyngier 5029ed24f4bSMarc Zyngier /** 5039ed24f4bSMarc Zyngier * kvm_arch_vcpu_runnable - determine if the vcpu can be scheduled 5049ed24f4bSMarc Zyngier * @v: The VCPU pointer 5059ed24f4bSMarc Zyngier * 5069ed24f4bSMarc Zyngier * If the guest CPU is not waiting for interrupts or an interrupt line is 5079ed24f4bSMarc Zyngier * asserted, the CPU is by definition runnable. 5089ed24f4bSMarc Zyngier */ 5099ed24f4bSMarc Zyngier int kvm_arch_vcpu_runnable(struct kvm_vcpu *v) 5109ed24f4bSMarc Zyngier { 5119ed24f4bSMarc Zyngier bool irq_lines = *vcpu_hcr(v) & (HCR_VI | HCR_VF); 5129ed24f4bSMarc Zyngier return ((irq_lines || kvm_vgic_vcpu_pending_irq(v)) 513b171f9bbSOliver Upton && !kvm_arm_vcpu_stopped(v) && !v->arch.pause); 5149ed24f4bSMarc Zyngier } 5159ed24f4bSMarc Zyngier 5169ed24f4bSMarc Zyngier bool kvm_arch_vcpu_in_kernel(struct kvm_vcpu *vcpu) 5179ed24f4bSMarc Zyngier { 5189ed24f4bSMarc Zyngier return vcpu_mode_priv(vcpu); 5199ed24f4bSMarc Zyngier } 5209ed24f4bSMarc Zyngier 5218e5b0adeSLinus Torvalds #ifdef CONFIG_GUEST_PERF_EVENTS 522e1bfc245SSean Christopherson unsigned long kvm_arch_vcpu_get_ip(struct kvm_vcpu *vcpu) 523e1bfc245SSean Christopherson { 524e1bfc245SSean Christopherson return *vcpu_pc(vcpu); 525e1bfc245SSean Christopherson } 5268e5b0adeSLinus Torvalds #endif 527e1bfc245SSean Christopherson 528b5aa368aSMarc Zyngier static int kvm_vcpu_initialized(struct kvm_vcpu *vcpu) 529052f064dSMarc Zyngier { 530b5aa368aSMarc Zyngier return vcpu->arch.target >= 0; 531052f064dSMarc Zyngier } 532052f064dSMarc Zyngier 533b5aa368aSMarc Zyngier /* 534b5aa368aSMarc Zyngier * Handle both the initialisation that is being done when the vcpu is 535b5aa368aSMarc Zyngier * run for the first time, as well as the updates that must be 536b5aa368aSMarc Zyngier * performed each time we get a new thread dealing with this vcpu. 537b5aa368aSMarc Zyngier */ 538b5aa368aSMarc Zyngier int kvm_arch_vcpu_run_pid_change(struct kvm_vcpu *vcpu) 5399ed24f4bSMarc Zyngier { 5409ed24f4bSMarc Zyngier struct kvm *kvm = vcpu->kvm; 541b5aa368aSMarc Zyngier int ret; 5429ed24f4bSMarc Zyngier 543b5aa368aSMarc Zyngier if (!kvm_vcpu_initialized(vcpu)) 544b5aa368aSMarc Zyngier return -ENOEXEC; 5459ed24f4bSMarc Zyngier 5469ed24f4bSMarc Zyngier if (!kvm_arm_vcpu_is_finalized(vcpu)) 5479ed24f4bSMarc Zyngier return -EPERM; 5489ed24f4bSMarc Zyngier 549b5aa368aSMarc Zyngier ret = kvm_arch_vcpu_run_map_fp(vcpu); 550b5aa368aSMarc Zyngier if (ret) 551b5aa368aSMarc Zyngier return ret; 552b5aa368aSMarc Zyngier 553cc5705fbSMarc Zyngier if (likely(vcpu_has_run_once(vcpu))) 554b5aa368aSMarc Zyngier return 0; 5559ed24f4bSMarc Zyngier 556263d6287SAlexandru Elisei kvm_arm_vcpu_init_debug(vcpu); 557263d6287SAlexandru Elisei 5589ed24f4bSMarc Zyngier if (likely(irqchip_in_kernel(kvm))) { 5599ed24f4bSMarc Zyngier /* 5609ed24f4bSMarc Zyngier * Map the VGIC hardware resources before running a vcpu the 5619ed24f4bSMarc Zyngier * first time on this VM. 5629ed24f4bSMarc Zyngier */ 5639ed24f4bSMarc Zyngier ret = kvm_vgic_map_resources(kvm); 5649ed24f4bSMarc Zyngier if (ret) 5659ed24f4bSMarc Zyngier return ret; 5669ed24f4bSMarc Zyngier } 5679ed24f4bSMarc Zyngier 5689ed24f4bSMarc Zyngier ret = kvm_timer_enable(vcpu); 5699ed24f4bSMarc Zyngier if (ret) 5709ed24f4bSMarc Zyngier return ret; 5719ed24f4bSMarc Zyngier 5729ed24f4bSMarc Zyngier ret = kvm_arm_pmu_v3_enable(vcpu); 5731408e73dSMarc Zyngier if (ret) 5741408e73dSMarc Zyngier return ret; 5751408e73dSMarc Zyngier 5769d0c063aSFuad Tabba if (is_protected_kvm_enabled()) { 5779d0c063aSFuad Tabba ret = pkvm_create_hyp_vm(kvm); 5789d0c063aSFuad Tabba if (ret) 5799d0c063aSFuad Tabba return ret; 5809d0c063aSFuad Tabba } 5819d0c063aSFuad Tabba 5821408e73dSMarc Zyngier if (!irqchip_in_kernel(kvm)) { 5831408e73dSMarc Zyngier /* 5841408e73dSMarc Zyngier * Tell the rest of the code that there are userspace irqchip 5851408e73dSMarc Zyngier * VMs in the wild. 5861408e73dSMarc Zyngier */ 5871408e73dSMarc Zyngier static_branch_inc(&userspace_irqchip_in_use); 5881408e73dSMarc Zyngier } 5899ed24f4bSMarc Zyngier 5902a0c3433SFuad Tabba /* 5912a0c3433SFuad Tabba * Initialize traps for protected VMs. 5922a0c3433SFuad Tabba * NOTE: Move to run in EL2 directly, rather than via a hypercall, once 5932a0c3433SFuad Tabba * the code is in place for first run initialization at EL2. 5942a0c3433SFuad Tabba */ 5952a0c3433SFuad Tabba if (kvm_vm_is_protected(kvm)) 5962a0c3433SFuad Tabba kvm_call_hyp_nvhe(__pkvm_vcpu_init_traps, vcpu); 5972a0c3433SFuad Tabba 5985177fe91SMarc Zyngier mutex_lock(&kvm->lock); 59906394531SMarc Zyngier set_bit(KVM_ARCH_FLAG_HAS_RAN_ONCE, &kvm->arch.flags); 6005177fe91SMarc Zyngier mutex_unlock(&kvm->lock); 6015177fe91SMarc Zyngier 6029ed24f4bSMarc Zyngier return ret; 6039ed24f4bSMarc Zyngier } 6049ed24f4bSMarc Zyngier 6059ed24f4bSMarc Zyngier bool kvm_arch_intc_initialized(struct kvm *kvm) 6069ed24f4bSMarc Zyngier { 6079ed24f4bSMarc Zyngier return vgic_initialized(kvm); 6089ed24f4bSMarc Zyngier } 6099ed24f4bSMarc Zyngier 6109ed24f4bSMarc Zyngier void kvm_arm_halt_guest(struct kvm *kvm) 6119ed24f4bSMarc Zyngier { 61246808a4cSMarc Zyngier unsigned long i; 6139ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 6149ed24f4bSMarc Zyngier 6159ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) 6169ed24f4bSMarc Zyngier vcpu->arch.pause = true; 6179ed24f4bSMarc Zyngier kvm_make_all_cpus_request(kvm, KVM_REQ_SLEEP); 6189ed24f4bSMarc Zyngier } 6199ed24f4bSMarc Zyngier 6209ed24f4bSMarc Zyngier void kvm_arm_resume_guest(struct kvm *kvm) 6219ed24f4bSMarc Zyngier { 62246808a4cSMarc Zyngier unsigned long i; 6239ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 6249ed24f4bSMarc Zyngier 6259ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) { 6269ed24f4bSMarc Zyngier vcpu->arch.pause = false; 627d92a5d1cSSean Christopherson __kvm_vcpu_wake_up(vcpu); 6289ed24f4bSMarc Zyngier } 6299ed24f4bSMarc Zyngier } 6309ed24f4bSMarc Zyngier 6311c6219e3SOliver Upton static void kvm_vcpu_sleep(struct kvm_vcpu *vcpu) 6329ed24f4bSMarc Zyngier { 63338060944SPaolo Bonzini struct rcuwait *wait = kvm_arch_vcpu_get_wait(vcpu); 6349ed24f4bSMarc Zyngier 63538060944SPaolo Bonzini rcuwait_wait_event(wait, 636b171f9bbSOliver Upton (!kvm_arm_vcpu_stopped(vcpu)) && (!vcpu->arch.pause), 63738060944SPaolo Bonzini TASK_INTERRUPTIBLE); 6389ed24f4bSMarc Zyngier 639b171f9bbSOliver Upton if (kvm_arm_vcpu_stopped(vcpu) || vcpu->arch.pause) { 6409ed24f4bSMarc Zyngier /* Awaken to handle a signal, request we sleep again later. */ 6419ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_SLEEP, vcpu); 6429ed24f4bSMarc Zyngier } 6439ed24f4bSMarc Zyngier 6449ed24f4bSMarc Zyngier /* 6459ed24f4bSMarc Zyngier * Make sure we will observe a potential reset request if we've 6469ed24f4bSMarc Zyngier * observed a change to the power state. Pairs with the smp_wmb() in 6479ed24f4bSMarc Zyngier * kvm_psci_vcpu_on(). 6489ed24f4bSMarc Zyngier */ 6499ed24f4bSMarc Zyngier smp_rmb(); 6509ed24f4bSMarc Zyngier } 6519ed24f4bSMarc Zyngier 6526109c5a6SSean Christopherson /** 6536109c5a6SSean Christopherson * kvm_vcpu_wfi - emulate Wait-For-Interrupt behavior 6546109c5a6SSean Christopherson * @vcpu: The VCPU pointer 6556109c5a6SSean Christopherson * 6566109c5a6SSean Christopherson * Suspend execution of a vCPU until a valid wake event is detected, i.e. until 6576109c5a6SSean Christopherson * the vCPU is runnable. The vCPU may or may not be scheduled out, depending 6586109c5a6SSean Christopherson * on when a wake event arrives, e.g. there may already be a pending wake event. 6596109c5a6SSean Christopherson */ 6606109c5a6SSean Christopherson void kvm_vcpu_wfi(struct kvm_vcpu *vcpu) 6616109c5a6SSean Christopherson { 6626109c5a6SSean Christopherson /* 6636109c5a6SSean Christopherson * Sync back the state of the GIC CPU interface so that we have 6646109c5a6SSean Christopherson * the latest PMR and group enables. This ensures that 6656109c5a6SSean Christopherson * kvm_arch_vcpu_runnable has up-to-date data to decide whether 6666109c5a6SSean Christopherson * we have pending interrupts, e.g. when determining if the 6676109c5a6SSean Christopherson * vCPU should block. 6686109c5a6SSean Christopherson * 6696109c5a6SSean Christopherson * For the same reason, we want to tell GICv4 that we need 6706109c5a6SSean Christopherson * doorbells to be signalled, should an interrupt become pending. 6716109c5a6SSean Christopherson */ 6726109c5a6SSean Christopherson preempt_disable(); 6736109c5a6SSean Christopherson kvm_vgic_vmcr_sync(vcpu); 6746109c5a6SSean Christopherson vgic_v4_put(vcpu, true); 6756109c5a6SSean Christopherson preempt_enable(); 6766109c5a6SSean Christopherson 67791b99ea7SSean Christopherson kvm_vcpu_halt(vcpu); 678eebc538dSMarc Zyngier vcpu_clear_flag(vcpu, IN_WFIT); 6796109c5a6SSean Christopherson 6806109c5a6SSean Christopherson preempt_disable(); 6816109c5a6SSean Christopherson vgic_v4_load(vcpu); 6826109c5a6SSean Christopherson preempt_enable(); 6836109c5a6SSean Christopherson } 6846109c5a6SSean Christopherson 6857b33a09dSOliver Upton static int kvm_vcpu_suspend(struct kvm_vcpu *vcpu) 6867b33a09dSOliver Upton { 6877b33a09dSOliver Upton if (!kvm_arm_vcpu_suspended(vcpu)) 6887b33a09dSOliver Upton return 1; 6897b33a09dSOliver Upton 6907b33a09dSOliver Upton kvm_vcpu_wfi(vcpu); 6917b33a09dSOliver Upton 6927b33a09dSOliver Upton /* 6937b33a09dSOliver Upton * The suspend state is sticky; we do not leave it until userspace 6947b33a09dSOliver Upton * explicitly marks the vCPU as runnable. Request that we suspend again 6957b33a09dSOliver Upton * later. 6967b33a09dSOliver Upton */ 6977b33a09dSOliver Upton kvm_make_request(KVM_REQ_SUSPEND, vcpu); 6987b33a09dSOliver Upton 6997b33a09dSOliver Upton /* 7007b33a09dSOliver Upton * Check to make sure the vCPU is actually runnable. If so, exit to 7017b33a09dSOliver Upton * userspace informing it of the wakeup condition. 7027b33a09dSOliver Upton */ 7037b33a09dSOliver Upton if (kvm_arch_vcpu_runnable(vcpu)) { 7047b33a09dSOliver Upton memset(&vcpu->run->system_event, 0, sizeof(vcpu->run->system_event)); 7057b33a09dSOliver Upton vcpu->run->system_event.type = KVM_SYSTEM_EVENT_WAKEUP; 7067b33a09dSOliver Upton vcpu->run->exit_reason = KVM_EXIT_SYSTEM_EVENT; 7077b33a09dSOliver Upton return 0; 7087b33a09dSOliver Upton } 7097b33a09dSOliver Upton 7107b33a09dSOliver Upton /* 7117b33a09dSOliver Upton * Otherwise, we were unblocked to process a different event, such as a 7127b33a09dSOliver Upton * pending signal. Return 1 and allow kvm_arch_vcpu_ioctl_run() to 7137b33a09dSOliver Upton * process the event. 7147b33a09dSOliver Upton */ 7157b33a09dSOliver Upton return 1; 7167b33a09dSOliver Upton } 7177b33a09dSOliver Upton 7183fdd0459SOliver Upton /** 7193fdd0459SOliver Upton * check_vcpu_requests - check and handle pending vCPU requests 7203fdd0459SOliver Upton * @vcpu: the VCPU pointer 7213fdd0459SOliver Upton * 7223fdd0459SOliver Upton * Return: 1 if we should enter the guest 7233fdd0459SOliver Upton * 0 if we should exit to userspace 7243fdd0459SOliver Upton * < 0 if we should exit to userspace, where the return value indicates 7253fdd0459SOliver Upton * an error 7263fdd0459SOliver Upton */ 7273fdd0459SOliver Upton static int check_vcpu_requests(struct kvm_vcpu *vcpu) 7289ed24f4bSMarc Zyngier { 7299ed24f4bSMarc Zyngier if (kvm_request_pending(vcpu)) { 7309ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_SLEEP, vcpu)) 7311c6219e3SOliver Upton kvm_vcpu_sleep(vcpu); 7329ed24f4bSMarc Zyngier 7339ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu)) 7349ed24f4bSMarc Zyngier kvm_reset_vcpu(vcpu); 7359ed24f4bSMarc Zyngier 7369ed24f4bSMarc Zyngier /* 7379ed24f4bSMarc Zyngier * Clear IRQ_PENDING requests that were made to guarantee 7389ed24f4bSMarc Zyngier * that a VCPU sees new virtual interrupts. 7399ed24f4bSMarc Zyngier */ 7409ed24f4bSMarc Zyngier kvm_check_request(KVM_REQ_IRQ_PENDING, vcpu); 7419ed24f4bSMarc Zyngier 7429ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_RECORD_STEAL, vcpu)) 7439ed24f4bSMarc Zyngier kvm_update_stolen_time(vcpu); 7449ed24f4bSMarc Zyngier 7459ed24f4bSMarc Zyngier if (kvm_check_request(KVM_REQ_RELOAD_GICv4, vcpu)) { 7469ed24f4bSMarc Zyngier /* The distributor enable bits were changed */ 7479ed24f4bSMarc Zyngier preempt_disable(); 7489ed24f4bSMarc Zyngier vgic_v4_put(vcpu, false); 7499ed24f4bSMarc Zyngier vgic_v4_load(vcpu); 7509ed24f4bSMarc Zyngier preempt_enable(); 7519ed24f4bSMarc Zyngier } 752d0c94c49SMarc Zyngier 753d0c94c49SMarc Zyngier if (kvm_check_request(KVM_REQ_RELOAD_PMU, vcpu)) 754d0c94c49SMarc Zyngier kvm_pmu_handle_pmcr(vcpu, 755d0c94c49SMarc Zyngier __vcpu_sys_reg(vcpu, PMCR_EL0)); 7567b33a09dSOliver Upton 7577b33a09dSOliver Upton if (kvm_check_request(KVM_REQ_SUSPEND, vcpu)) 7587b33a09dSOliver Upton return kvm_vcpu_suspend(vcpu); 7599cb1096fSGavin Shan 7609cb1096fSGavin Shan if (kvm_dirty_ring_check_request(vcpu)) 7619cb1096fSGavin Shan return 0; 7629ed24f4bSMarc Zyngier } 7633fdd0459SOliver Upton 7643fdd0459SOliver Upton return 1; 7659ed24f4bSMarc Zyngier } 7669ed24f4bSMarc Zyngier 7672f6a49bbSWill Deacon static bool vcpu_mode_is_bad_32bit(struct kvm_vcpu *vcpu) 7682f6a49bbSWill Deacon { 7692f6a49bbSWill Deacon if (likely(!vcpu_mode_is_32bit(vcpu))) 7702f6a49bbSWill Deacon return false; 7712f6a49bbSWill Deacon 772f3c6efc7SOliver Upton return !kvm_supports_32bit_el0(); 7732f6a49bbSWill Deacon } 7742f6a49bbSWill Deacon 7759ed24f4bSMarc Zyngier /** 7766caa5812SOliver Upton * kvm_vcpu_exit_request - returns true if the VCPU should *not* enter the guest 7776caa5812SOliver Upton * @vcpu: The VCPU pointer 7786caa5812SOliver Upton * @ret: Pointer to write optional return code 7796caa5812SOliver Upton * 7806caa5812SOliver Upton * Returns: true if the VCPU needs to return to a preemptible + interruptible 7816caa5812SOliver Upton * and skip guest entry. 7826caa5812SOliver Upton * 7836caa5812SOliver Upton * This function disambiguates between two different types of exits: exits to a 7846caa5812SOliver Upton * preemptible + interruptible kernel context and exits to userspace. For an 7856caa5812SOliver Upton * exit to userspace, this function will write the return code to ret and return 7866caa5812SOliver Upton * true. For an exit to preemptible + interruptible kernel context (i.e. check 7876caa5812SOliver Upton * for pending work and re-enter), return true without writing to ret. 7886caa5812SOliver Upton */ 7896caa5812SOliver Upton static bool kvm_vcpu_exit_request(struct kvm_vcpu *vcpu, int *ret) 7906caa5812SOliver Upton { 7916caa5812SOliver Upton struct kvm_run *run = vcpu->run; 7926caa5812SOliver Upton 7936caa5812SOliver Upton /* 7946caa5812SOliver Upton * If we're using a userspace irqchip, then check if we need 7956caa5812SOliver Upton * to tell a userspace irqchip about timer or PMU level 7966caa5812SOliver Upton * changes and if so, exit to userspace (the actual level 7976caa5812SOliver Upton * state gets updated in kvm_timer_update_run and 7986caa5812SOliver Upton * kvm_pmu_update_run below). 7996caa5812SOliver Upton */ 8006caa5812SOliver Upton if (static_branch_unlikely(&userspace_irqchip_in_use)) { 8016caa5812SOliver Upton if (kvm_timer_should_notify_user(vcpu) || 8026caa5812SOliver Upton kvm_pmu_should_notify_user(vcpu)) { 8036caa5812SOliver Upton *ret = -EINTR; 8046caa5812SOliver Upton run->exit_reason = KVM_EXIT_INTR; 8056caa5812SOliver Upton return true; 8066caa5812SOliver Upton } 8076caa5812SOliver Upton } 8086caa5812SOliver Upton 809583cda1bSAlexandru Elisei if (unlikely(vcpu_on_unsupported_cpu(vcpu))) { 810583cda1bSAlexandru Elisei run->exit_reason = KVM_EXIT_FAIL_ENTRY; 811583cda1bSAlexandru Elisei run->fail_entry.hardware_entry_failure_reason = KVM_EXIT_FAIL_ENTRY_CPU_UNSUPPORTED; 812583cda1bSAlexandru Elisei run->fail_entry.cpu = smp_processor_id(); 813583cda1bSAlexandru Elisei *ret = 0; 814583cda1bSAlexandru Elisei return true; 815583cda1bSAlexandru Elisei } 816583cda1bSAlexandru Elisei 8176caa5812SOliver Upton return kvm_request_pending(vcpu) || 8186caa5812SOliver Upton xfer_to_guest_mode_work_pending(); 8196caa5812SOliver Upton } 8206caa5812SOliver Upton 8218cfe148aSMark Rutland /* 8228cfe148aSMark Rutland * Actually run the vCPU, entering an RCU extended quiescent state (EQS) while 8238cfe148aSMark Rutland * the vCPU is running. 8248cfe148aSMark Rutland * 8258cfe148aSMark Rutland * This must be noinstr as instrumentation may make use of RCU, and this is not 8268cfe148aSMark Rutland * safe during the EQS. 8278cfe148aSMark Rutland */ 8288cfe148aSMark Rutland static int noinstr kvm_arm_vcpu_enter_exit(struct kvm_vcpu *vcpu) 8298cfe148aSMark Rutland { 8308cfe148aSMark Rutland int ret; 8318cfe148aSMark Rutland 8328cfe148aSMark Rutland guest_state_enter_irqoff(); 8338cfe148aSMark Rutland ret = kvm_call_hyp_ret(__kvm_vcpu_run, vcpu); 8348cfe148aSMark Rutland guest_state_exit_irqoff(); 8358cfe148aSMark Rutland 8368cfe148aSMark Rutland return ret; 8378cfe148aSMark Rutland } 8388cfe148aSMark Rutland 8396caa5812SOliver Upton /** 8409ed24f4bSMarc Zyngier * kvm_arch_vcpu_ioctl_run - the main VCPU run function to execute guest code 8419ed24f4bSMarc Zyngier * @vcpu: The VCPU pointer 8429ed24f4bSMarc Zyngier * 8439ed24f4bSMarc Zyngier * This function is called through the VCPU_RUN ioctl called from user space. It 8449ed24f4bSMarc Zyngier * will execute VM code in a loop until the time slice for the process is used 8459ed24f4bSMarc Zyngier * or some emulation is needed from user space in which case the function will 8469ed24f4bSMarc Zyngier * return with return value 0 and with the kvm_run structure filled in with the 8479ed24f4bSMarc Zyngier * required data for the requested emulation. 8489ed24f4bSMarc Zyngier */ 84938060944SPaolo Bonzini int kvm_arch_vcpu_ioctl_run(struct kvm_vcpu *vcpu) 8509ed24f4bSMarc Zyngier { 85138060944SPaolo Bonzini struct kvm_run *run = vcpu->run; 8529ed24f4bSMarc Zyngier int ret; 8539ed24f4bSMarc Zyngier 8549ed24f4bSMarc Zyngier if (run->exit_reason == KVM_EXIT_MMIO) { 85574cc7e0cSTianjia Zhang ret = kvm_handle_mmio_return(vcpu); 8569ed24f4bSMarc Zyngier if (ret) 8579ed24f4bSMarc Zyngier return ret; 8589ed24f4bSMarc Zyngier } 8599ed24f4bSMarc Zyngier 8609ed24f4bSMarc Zyngier vcpu_load(vcpu); 8619ed24f4bSMarc Zyngier 862e3e880bbSZenghui Yu if (run->immediate_exit) { 863e3e880bbSZenghui Yu ret = -EINTR; 864e3e880bbSZenghui Yu goto out; 865e3e880bbSZenghui Yu } 866e3e880bbSZenghui Yu 8679ed24f4bSMarc Zyngier kvm_sigset_activate(vcpu); 8689ed24f4bSMarc Zyngier 8699ed24f4bSMarc Zyngier ret = 1; 8709ed24f4bSMarc Zyngier run->exit_reason = KVM_EXIT_UNKNOWN; 87118f3976fSAlexandru Elisei run->flags = 0; 8729ed24f4bSMarc Zyngier while (ret > 0) { 8739ed24f4bSMarc Zyngier /* 8749ed24f4bSMarc Zyngier * Check conditions before entering the guest 8759ed24f4bSMarc Zyngier */ 8766caa5812SOliver Upton ret = xfer_to_guest_mode_handle_work(vcpu); 8776caa5812SOliver Upton if (!ret) 8786caa5812SOliver Upton ret = 1; 8799ed24f4bSMarc Zyngier 8803fdd0459SOliver Upton if (ret > 0) 8813fdd0459SOliver Upton ret = check_vcpu_requests(vcpu); 8829ed24f4bSMarc Zyngier 8839ed24f4bSMarc Zyngier /* 8849ed24f4bSMarc Zyngier * Preparing the interrupts to be injected also 8859ed24f4bSMarc Zyngier * involves poking the GIC, which must be done in a 8869ed24f4bSMarc Zyngier * non-preemptible context. 8879ed24f4bSMarc Zyngier */ 8889ed24f4bSMarc Zyngier preempt_disable(); 8899ed24f4bSMarc Zyngier 8903248136bSJulien Grall /* 8913248136bSJulien Grall * The VMID allocator only tracks active VMIDs per 8923248136bSJulien Grall * physical CPU, and therefore the VMID allocated may not be 8933248136bSJulien Grall * preserved on VMID roll-over if the task was preempted, 8943248136bSJulien Grall * making a thread's VMID inactive. So we need to call 8953248136bSJulien Grall * kvm_arm_vmid_update() in non-premptible context. 8963248136bSJulien Grall */ 8973248136bSJulien Grall kvm_arm_vmid_update(&vcpu->arch.hw_mmu->vmid); 8983248136bSJulien Grall 8999ed24f4bSMarc Zyngier kvm_pmu_flush_hwstate(vcpu); 9009ed24f4bSMarc Zyngier 9019ed24f4bSMarc Zyngier local_irq_disable(); 9029ed24f4bSMarc Zyngier 9039ed24f4bSMarc Zyngier kvm_vgic_flush_hwstate(vcpu); 9049ed24f4bSMarc Zyngier 90584d751a0SFuad Tabba kvm_pmu_update_vcpu_events(vcpu); 90684d751a0SFuad Tabba 9079ed24f4bSMarc Zyngier /* 9089ed24f4bSMarc Zyngier * Ensure we set mode to IN_GUEST_MODE after we disable 9099ed24f4bSMarc Zyngier * interrupts and before the final VCPU requests check. 9109ed24f4bSMarc Zyngier * See the comment in kvm_vcpu_exiting_guest_mode() and 9119ed24f4bSMarc Zyngier * Documentation/virt/kvm/vcpu-requests.rst 9129ed24f4bSMarc Zyngier */ 9139ed24f4bSMarc Zyngier smp_store_mb(vcpu->mode, IN_GUEST_MODE); 9149ed24f4bSMarc Zyngier 9156caa5812SOliver Upton if (ret <= 0 || kvm_vcpu_exit_request(vcpu, &ret)) { 9169ed24f4bSMarc Zyngier vcpu->mode = OUTSIDE_GUEST_MODE; 9179ed24f4bSMarc Zyngier isb(); /* Ensure work in x_flush_hwstate is committed */ 9189ed24f4bSMarc Zyngier kvm_pmu_sync_hwstate(vcpu); 9199ed24f4bSMarc Zyngier if (static_branch_unlikely(&userspace_irqchip_in_use)) 9203c5ff0c6SMarc Zyngier kvm_timer_sync_user(vcpu); 9219ed24f4bSMarc Zyngier kvm_vgic_sync_hwstate(vcpu); 9229ed24f4bSMarc Zyngier local_irq_enable(); 9239ed24f4bSMarc Zyngier preempt_enable(); 9249ed24f4bSMarc Zyngier continue; 9259ed24f4bSMarc Zyngier } 9269ed24f4bSMarc Zyngier 9279ed24f4bSMarc Zyngier kvm_arm_setup_debug(vcpu); 928af9a0e21SMarc Zyngier kvm_arch_vcpu_ctxflush_fp(vcpu); 9299ed24f4bSMarc Zyngier 9309ed24f4bSMarc Zyngier /************************************************************** 9319ed24f4bSMarc Zyngier * Enter the guest 9329ed24f4bSMarc Zyngier */ 9339ed24f4bSMarc Zyngier trace_kvm_entry(*vcpu_pc(vcpu)); 9348cfe148aSMark Rutland guest_timing_enter_irqoff(); 9359ed24f4bSMarc Zyngier 9368cfe148aSMark Rutland ret = kvm_arm_vcpu_enter_exit(vcpu); 9379ed24f4bSMarc Zyngier 9389ed24f4bSMarc Zyngier vcpu->mode = OUTSIDE_GUEST_MODE; 9399ed24f4bSMarc Zyngier vcpu->stat.exits++; 9409ed24f4bSMarc Zyngier /* 9419ed24f4bSMarc Zyngier * Back from guest 9429ed24f4bSMarc Zyngier *************************************************************/ 9439ed24f4bSMarc Zyngier 9449ed24f4bSMarc Zyngier kvm_arm_clear_debug(vcpu); 9459ed24f4bSMarc Zyngier 9469ed24f4bSMarc Zyngier /* 9479ed24f4bSMarc Zyngier * We must sync the PMU state before the vgic state so 9489ed24f4bSMarc Zyngier * that the vgic can properly sample the updated state of the 9499ed24f4bSMarc Zyngier * interrupt line. 9509ed24f4bSMarc Zyngier */ 9519ed24f4bSMarc Zyngier kvm_pmu_sync_hwstate(vcpu); 9529ed24f4bSMarc Zyngier 9539ed24f4bSMarc Zyngier /* 9549ed24f4bSMarc Zyngier * Sync the vgic state before syncing the timer state because 9559ed24f4bSMarc Zyngier * the timer code needs to know if the virtual timer 9569ed24f4bSMarc Zyngier * interrupts are active. 9579ed24f4bSMarc Zyngier */ 9589ed24f4bSMarc Zyngier kvm_vgic_sync_hwstate(vcpu); 9599ed24f4bSMarc Zyngier 9609ed24f4bSMarc Zyngier /* 9619ed24f4bSMarc Zyngier * Sync the timer hardware state before enabling interrupts as 9629ed24f4bSMarc Zyngier * we don't want vtimer interrupts to race with syncing the 9639ed24f4bSMarc Zyngier * timer virtual interrupt state. 9649ed24f4bSMarc Zyngier */ 9659ed24f4bSMarc Zyngier if (static_branch_unlikely(&userspace_irqchip_in_use)) 9663c5ff0c6SMarc Zyngier kvm_timer_sync_user(vcpu); 9679ed24f4bSMarc Zyngier 9689ed24f4bSMarc Zyngier kvm_arch_vcpu_ctxsync_fp(vcpu); 9699ed24f4bSMarc Zyngier 9709ed24f4bSMarc Zyngier /* 9718cfe148aSMark Rutland * We must ensure that any pending interrupts are taken before 9728cfe148aSMark Rutland * we exit guest timing so that timer ticks are accounted as 9738cfe148aSMark Rutland * guest time. Transiently unmask interrupts so that any 9748cfe148aSMark Rutland * pending interrupts are taken. 9759ed24f4bSMarc Zyngier * 9768cfe148aSMark Rutland * Per ARM DDI 0487G.b section D1.13.4, an ISB (or other 9778cfe148aSMark Rutland * context synchronization event) is necessary to ensure that 9788cfe148aSMark Rutland * pending interrupts are taken. 9799ed24f4bSMarc Zyngier */ 980f7659f8bSMarc Zyngier if (ARM_EXCEPTION_CODE(ret) == ARM_EXCEPTION_IRQ) { 9819ed24f4bSMarc Zyngier local_irq_enable(); 9828cfe148aSMark Rutland isb(); 9838cfe148aSMark Rutland local_irq_disable(); 984f7659f8bSMarc Zyngier } 9859ed24f4bSMarc Zyngier 9868cfe148aSMark Rutland guest_timing_exit_irqoff(); 9878cfe148aSMark Rutland 9888cfe148aSMark Rutland local_irq_enable(); 9898cfe148aSMark Rutland 9909ed24f4bSMarc Zyngier trace_kvm_exit(ret, kvm_vcpu_trap_get_class(vcpu), *vcpu_pc(vcpu)); 9919ed24f4bSMarc Zyngier 9929ed24f4bSMarc Zyngier /* Exit types that need handling before we can be preempted */ 99374cc7e0cSTianjia Zhang handle_exit_early(vcpu, ret); 9949ed24f4bSMarc Zyngier 9959ed24f4bSMarc Zyngier preempt_enable(); 9969ed24f4bSMarc Zyngier 99722f55384SQais Yousef /* 99822f55384SQais Yousef * The ARMv8 architecture doesn't give the hypervisor 99922f55384SQais Yousef * a mechanism to prevent a guest from dropping to AArch32 EL0 100022f55384SQais Yousef * if implemented by the CPU. If we spot the guest in such 100122f55384SQais Yousef * state and that we decided it wasn't supposed to do so (like 100222f55384SQais Yousef * with the asymmetric AArch32 case), return to userspace with 100322f55384SQais Yousef * a fatal error. 100422f55384SQais Yousef */ 10052f6a49bbSWill Deacon if (vcpu_mode_is_bad_32bit(vcpu)) { 100622f55384SQais Yousef /* 100722f55384SQais Yousef * As we have caught the guest red-handed, decide that 100822f55384SQais Yousef * it isn't fit for purpose anymore by making the vcpu 100922f55384SQais Yousef * invalid. The VMM can try and fix it by issuing a 101022f55384SQais Yousef * KVM_ARM_VCPU_INIT if it really wants to. 101122f55384SQais Yousef */ 101222f55384SQais Yousef vcpu->arch.target = -1; 101322f55384SQais Yousef ret = ARM_EXCEPTION_IL; 101422f55384SQais Yousef } 101522f55384SQais Yousef 101674cc7e0cSTianjia Zhang ret = handle_exit(vcpu, ret); 10179ed24f4bSMarc Zyngier } 10189ed24f4bSMarc Zyngier 10199ed24f4bSMarc Zyngier /* Tell userspace about in-kernel device output levels */ 10209ed24f4bSMarc Zyngier if (unlikely(!irqchip_in_kernel(vcpu->kvm))) { 10219ed24f4bSMarc Zyngier kvm_timer_update_run(vcpu); 10229ed24f4bSMarc Zyngier kvm_pmu_update_run(vcpu); 10239ed24f4bSMarc Zyngier } 10249ed24f4bSMarc Zyngier 10259ed24f4bSMarc Zyngier kvm_sigset_deactivate(vcpu); 10269ed24f4bSMarc Zyngier 1027e3e880bbSZenghui Yu out: 102826778aaaSMarc Zyngier /* 102926778aaaSMarc Zyngier * In the unlikely event that we are returning to userspace 103026778aaaSMarc Zyngier * with pending exceptions or PC adjustment, commit these 103126778aaaSMarc Zyngier * adjustments in order to give userspace a consistent view of 103226778aaaSMarc Zyngier * the vcpu state. Note that this relies on __kvm_adjust_pc() 103326778aaaSMarc Zyngier * being preempt-safe on VHE. 103426778aaaSMarc Zyngier */ 1035699bb2e0SMarc Zyngier if (unlikely(vcpu_get_flag(vcpu, PENDING_EXCEPTION) || 1036699bb2e0SMarc Zyngier vcpu_get_flag(vcpu, INCREMENT_PC))) 103726778aaaSMarc Zyngier kvm_call_hyp(__kvm_adjust_pc, vcpu); 103826778aaaSMarc Zyngier 10399ed24f4bSMarc Zyngier vcpu_put(vcpu); 10409ed24f4bSMarc Zyngier return ret; 10419ed24f4bSMarc Zyngier } 10429ed24f4bSMarc Zyngier 10439ed24f4bSMarc Zyngier static int vcpu_interrupt_line(struct kvm_vcpu *vcpu, int number, bool level) 10449ed24f4bSMarc Zyngier { 10459ed24f4bSMarc Zyngier int bit_index; 10469ed24f4bSMarc Zyngier bool set; 10479ed24f4bSMarc Zyngier unsigned long *hcr; 10489ed24f4bSMarc Zyngier 10499ed24f4bSMarc Zyngier if (number == KVM_ARM_IRQ_CPU_IRQ) 10509ed24f4bSMarc Zyngier bit_index = __ffs(HCR_VI); 10519ed24f4bSMarc Zyngier else /* KVM_ARM_IRQ_CPU_FIQ */ 10529ed24f4bSMarc Zyngier bit_index = __ffs(HCR_VF); 10539ed24f4bSMarc Zyngier 10549ed24f4bSMarc Zyngier hcr = vcpu_hcr(vcpu); 10559ed24f4bSMarc Zyngier if (level) 10569ed24f4bSMarc Zyngier set = test_and_set_bit(bit_index, hcr); 10579ed24f4bSMarc Zyngier else 10589ed24f4bSMarc Zyngier set = test_and_clear_bit(bit_index, hcr); 10599ed24f4bSMarc Zyngier 10609ed24f4bSMarc Zyngier /* 10619ed24f4bSMarc Zyngier * If we didn't change anything, no need to wake up or kick other CPUs 10629ed24f4bSMarc Zyngier */ 10639ed24f4bSMarc Zyngier if (set == level) 10649ed24f4bSMarc Zyngier return 0; 10659ed24f4bSMarc Zyngier 10669ed24f4bSMarc Zyngier /* 10679ed24f4bSMarc Zyngier * The vcpu irq_lines field was updated, wake up sleeping VCPUs and 10689ed24f4bSMarc Zyngier * trigger a world-switch round on the running physical CPU to set the 10699ed24f4bSMarc Zyngier * virtual IRQ/FIQ fields in the HCR appropriately. 10709ed24f4bSMarc Zyngier */ 10719ed24f4bSMarc Zyngier kvm_make_request(KVM_REQ_IRQ_PENDING, vcpu); 10729ed24f4bSMarc Zyngier kvm_vcpu_kick(vcpu); 10739ed24f4bSMarc Zyngier 10749ed24f4bSMarc Zyngier return 0; 10759ed24f4bSMarc Zyngier } 10769ed24f4bSMarc Zyngier 10779ed24f4bSMarc Zyngier int kvm_vm_ioctl_irq_line(struct kvm *kvm, struct kvm_irq_level *irq_level, 10789ed24f4bSMarc Zyngier bool line_status) 10799ed24f4bSMarc Zyngier { 10809ed24f4bSMarc Zyngier u32 irq = irq_level->irq; 10819ed24f4bSMarc Zyngier unsigned int irq_type, vcpu_idx, irq_num; 10829ed24f4bSMarc Zyngier int nrcpus = atomic_read(&kvm->online_vcpus); 10839ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu = NULL; 10849ed24f4bSMarc Zyngier bool level = irq_level->level; 10859ed24f4bSMarc Zyngier 10869ed24f4bSMarc Zyngier irq_type = (irq >> KVM_ARM_IRQ_TYPE_SHIFT) & KVM_ARM_IRQ_TYPE_MASK; 10879ed24f4bSMarc Zyngier vcpu_idx = (irq >> KVM_ARM_IRQ_VCPU_SHIFT) & KVM_ARM_IRQ_VCPU_MASK; 10889ed24f4bSMarc Zyngier vcpu_idx += ((irq >> KVM_ARM_IRQ_VCPU2_SHIFT) & KVM_ARM_IRQ_VCPU2_MASK) * (KVM_ARM_IRQ_VCPU_MASK + 1); 10899ed24f4bSMarc Zyngier irq_num = (irq >> KVM_ARM_IRQ_NUM_SHIFT) & KVM_ARM_IRQ_NUM_MASK; 10909ed24f4bSMarc Zyngier 10919ed24f4bSMarc Zyngier trace_kvm_irq_line(irq_type, vcpu_idx, irq_num, irq_level->level); 10929ed24f4bSMarc Zyngier 10939ed24f4bSMarc Zyngier switch (irq_type) { 10949ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_CPU: 10959ed24f4bSMarc Zyngier if (irqchip_in_kernel(kvm)) 10969ed24f4bSMarc Zyngier return -ENXIO; 10979ed24f4bSMarc Zyngier 10989ed24f4bSMarc Zyngier if (vcpu_idx >= nrcpus) 10999ed24f4bSMarc Zyngier return -EINVAL; 11009ed24f4bSMarc Zyngier 11019ed24f4bSMarc Zyngier vcpu = kvm_get_vcpu(kvm, vcpu_idx); 11029ed24f4bSMarc Zyngier if (!vcpu) 11039ed24f4bSMarc Zyngier return -EINVAL; 11049ed24f4bSMarc Zyngier 11059ed24f4bSMarc Zyngier if (irq_num > KVM_ARM_IRQ_CPU_FIQ) 11069ed24f4bSMarc Zyngier return -EINVAL; 11079ed24f4bSMarc Zyngier 11089ed24f4bSMarc Zyngier return vcpu_interrupt_line(vcpu, irq_num, level); 11099ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_PPI: 11109ed24f4bSMarc Zyngier if (!irqchip_in_kernel(kvm)) 11119ed24f4bSMarc Zyngier return -ENXIO; 11129ed24f4bSMarc Zyngier 11139ed24f4bSMarc Zyngier if (vcpu_idx >= nrcpus) 11149ed24f4bSMarc Zyngier return -EINVAL; 11159ed24f4bSMarc Zyngier 11169ed24f4bSMarc Zyngier vcpu = kvm_get_vcpu(kvm, vcpu_idx); 11179ed24f4bSMarc Zyngier if (!vcpu) 11189ed24f4bSMarc Zyngier return -EINVAL; 11199ed24f4bSMarc Zyngier 11209ed24f4bSMarc Zyngier if (irq_num < VGIC_NR_SGIS || irq_num >= VGIC_NR_PRIVATE_IRQS) 11219ed24f4bSMarc Zyngier return -EINVAL; 11229ed24f4bSMarc Zyngier 11239ed24f4bSMarc Zyngier return kvm_vgic_inject_irq(kvm, vcpu->vcpu_id, irq_num, level, NULL); 11249ed24f4bSMarc Zyngier case KVM_ARM_IRQ_TYPE_SPI: 11259ed24f4bSMarc Zyngier if (!irqchip_in_kernel(kvm)) 11269ed24f4bSMarc Zyngier return -ENXIO; 11279ed24f4bSMarc Zyngier 11289ed24f4bSMarc Zyngier if (irq_num < VGIC_NR_PRIVATE_IRQS) 11299ed24f4bSMarc Zyngier return -EINVAL; 11309ed24f4bSMarc Zyngier 11319ed24f4bSMarc Zyngier return kvm_vgic_inject_irq(kvm, 0, irq_num, level, NULL); 11329ed24f4bSMarc Zyngier } 11339ed24f4bSMarc Zyngier 11349ed24f4bSMarc Zyngier return -EINVAL; 11359ed24f4bSMarc Zyngier } 11369ed24f4bSMarc Zyngier 11379ed24f4bSMarc Zyngier static int kvm_vcpu_set_target(struct kvm_vcpu *vcpu, 11389ed24f4bSMarc Zyngier const struct kvm_vcpu_init *init) 11399ed24f4bSMarc Zyngier { 11409ed24f4bSMarc Zyngier unsigned int i, ret; 11416b7982feSAnshuman Khandual u32 phys_target = kvm_target_cpu(); 11429ed24f4bSMarc Zyngier 11439ed24f4bSMarc Zyngier if (init->target != phys_target) 11449ed24f4bSMarc Zyngier return -EINVAL; 11459ed24f4bSMarc Zyngier 11469ed24f4bSMarc Zyngier /* 11479ed24f4bSMarc Zyngier * Secondary and subsequent calls to KVM_ARM_VCPU_INIT must 11489ed24f4bSMarc Zyngier * use the same target. 11499ed24f4bSMarc Zyngier */ 11509ed24f4bSMarc Zyngier if (vcpu->arch.target != -1 && vcpu->arch.target != init->target) 11519ed24f4bSMarc Zyngier return -EINVAL; 11529ed24f4bSMarc Zyngier 11539ed24f4bSMarc Zyngier /* -ENOENT for unknown features, -EINVAL for invalid combinations. */ 11549ed24f4bSMarc Zyngier for (i = 0; i < sizeof(init->features) * 8; i++) { 11559ed24f4bSMarc Zyngier bool set = (init->features[i / 32] & (1 << (i % 32))); 11569ed24f4bSMarc Zyngier 11579ed24f4bSMarc Zyngier if (set && i >= KVM_VCPU_MAX_FEATURES) 11589ed24f4bSMarc Zyngier return -ENOENT; 11599ed24f4bSMarc Zyngier 11609ed24f4bSMarc Zyngier /* 11619ed24f4bSMarc Zyngier * Secondary and subsequent calls to KVM_ARM_VCPU_INIT must 11629ed24f4bSMarc Zyngier * use the same feature set. 11639ed24f4bSMarc Zyngier */ 11649ed24f4bSMarc Zyngier if (vcpu->arch.target != -1 && i < KVM_VCPU_MAX_FEATURES && 11659ed24f4bSMarc Zyngier test_bit(i, vcpu->arch.features) != set) 11669ed24f4bSMarc Zyngier return -EINVAL; 11679ed24f4bSMarc Zyngier 11689ed24f4bSMarc Zyngier if (set) 11699ed24f4bSMarc Zyngier set_bit(i, vcpu->arch.features); 11709ed24f4bSMarc Zyngier } 11719ed24f4bSMarc Zyngier 11729ed24f4bSMarc Zyngier vcpu->arch.target = phys_target; 11739ed24f4bSMarc Zyngier 11749ed24f4bSMarc Zyngier /* Now we know what it is, we can reset it. */ 11759ed24f4bSMarc Zyngier ret = kvm_reset_vcpu(vcpu); 11769ed24f4bSMarc Zyngier if (ret) { 11779ed24f4bSMarc Zyngier vcpu->arch.target = -1; 11789ed24f4bSMarc Zyngier bitmap_zero(vcpu->arch.features, KVM_VCPU_MAX_FEATURES); 11799ed24f4bSMarc Zyngier } 11809ed24f4bSMarc Zyngier 11819ed24f4bSMarc Zyngier return ret; 11829ed24f4bSMarc Zyngier } 11839ed24f4bSMarc Zyngier 11849ed24f4bSMarc Zyngier static int kvm_arch_vcpu_ioctl_vcpu_init(struct kvm_vcpu *vcpu, 11859ed24f4bSMarc Zyngier struct kvm_vcpu_init *init) 11869ed24f4bSMarc Zyngier { 11879ed24f4bSMarc Zyngier int ret; 11889ed24f4bSMarc Zyngier 11899ed24f4bSMarc Zyngier ret = kvm_vcpu_set_target(vcpu, init); 11909ed24f4bSMarc Zyngier if (ret) 11919ed24f4bSMarc Zyngier return ret; 11929ed24f4bSMarc Zyngier 11939ed24f4bSMarc Zyngier /* 11949ed24f4bSMarc Zyngier * Ensure a rebooted VM will fault in RAM pages and detect if the 11959ed24f4bSMarc Zyngier * guest MMU is turned off and flush the caches as needed. 1196892713e9SZenghui Yu * 11977ae2f3dbSMarc Zyngier * S2FWB enforces all memory accesses to RAM being cacheable, 11987ae2f3dbSMarc Zyngier * ensuring that the data side is always coherent. We still 11997ae2f3dbSMarc Zyngier * need to invalidate the I-cache though, as FWB does *not* 12007ae2f3dbSMarc Zyngier * imply CTR_EL0.DIC. 12019ed24f4bSMarc Zyngier */ 1202cc5705fbSMarc Zyngier if (vcpu_has_run_once(vcpu)) { 12037ae2f3dbSMarc Zyngier if (!cpus_have_final_cap(ARM64_HAS_STAGE2_FWB)) 12049ed24f4bSMarc Zyngier stage2_unmap_vm(vcpu->kvm); 12057ae2f3dbSMarc Zyngier else 1206fade9c2cSFuad Tabba icache_inval_all_pou(); 12077ae2f3dbSMarc Zyngier } 12089ed24f4bSMarc Zyngier 12099ed24f4bSMarc Zyngier vcpu_reset_hcr(vcpu); 1210cd496228SFuad Tabba vcpu->arch.cptr_el2 = CPTR_EL2_DEFAULT; 12119ed24f4bSMarc Zyngier 12129ed24f4bSMarc Zyngier /* 12139ed24f4bSMarc Zyngier * Handle the "start in power-off" case. 12149ed24f4bSMarc Zyngier */ 12159ed24f4bSMarc Zyngier if (test_bit(KVM_ARM_VCPU_POWER_OFF, vcpu->arch.features)) 12161e579429SOliver Upton kvm_arm_vcpu_power_off(vcpu); 12179ed24f4bSMarc Zyngier else 1218b171f9bbSOliver Upton vcpu->arch.mp_state.mp_state = KVM_MP_STATE_RUNNABLE; 12199ed24f4bSMarc Zyngier 12209ed24f4bSMarc Zyngier return 0; 12219ed24f4bSMarc Zyngier } 12229ed24f4bSMarc Zyngier 12239ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_attr(struct kvm_vcpu *vcpu, 12249ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 12259ed24f4bSMarc Zyngier { 12269ed24f4bSMarc Zyngier int ret = -ENXIO; 12279ed24f4bSMarc Zyngier 12289ed24f4bSMarc Zyngier switch (attr->group) { 12299ed24f4bSMarc Zyngier default: 12309ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_set_attr(vcpu, attr); 12319ed24f4bSMarc Zyngier break; 12329ed24f4bSMarc Zyngier } 12339ed24f4bSMarc Zyngier 12349ed24f4bSMarc Zyngier return ret; 12359ed24f4bSMarc Zyngier } 12369ed24f4bSMarc Zyngier 12379ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_attr(struct kvm_vcpu *vcpu, 12389ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 12399ed24f4bSMarc Zyngier { 12409ed24f4bSMarc Zyngier int ret = -ENXIO; 12419ed24f4bSMarc Zyngier 12429ed24f4bSMarc Zyngier switch (attr->group) { 12439ed24f4bSMarc Zyngier default: 12449ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_get_attr(vcpu, attr); 12459ed24f4bSMarc Zyngier break; 12469ed24f4bSMarc Zyngier } 12479ed24f4bSMarc Zyngier 12489ed24f4bSMarc Zyngier return ret; 12499ed24f4bSMarc Zyngier } 12509ed24f4bSMarc Zyngier 12519ed24f4bSMarc Zyngier static int kvm_arm_vcpu_has_attr(struct kvm_vcpu *vcpu, 12529ed24f4bSMarc Zyngier struct kvm_device_attr *attr) 12539ed24f4bSMarc Zyngier { 12549ed24f4bSMarc Zyngier int ret = -ENXIO; 12559ed24f4bSMarc Zyngier 12569ed24f4bSMarc Zyngier switch (attr->group) { 12579ed24f4bSMarc Zyngier default: 12589ed24f4bSMarc Zyngier ret = kvm_arm_vcpu_arch_has_attr(vcpu, attr); 12599ed24f4bSMarc Zyngier break; 12609ed24f4bSMarc Zyngier } 12619ed24f4bSMarc Zyngier 12629ed24f4bSMarc Zyngier return ret; 12639ed24f4bSMarc Zyngier } 12649ed24f4bSMarc Zyngier 12659ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_events(struct kvm_vcpu *vcpu, 12669ed24f4bSMarc Zyngier struct kvm_vcpu_events *events) 12679ed24f4bSMarc Zyngier { 12689ed24f4bSMarc Zyngier memset(events, 0, sizeof(*events)); 12699ed24f4bSMarc Zyngier 12709ed24f4bSMarc Zyngier return __kvm_arm_vcpu_get_events(vcpu, events); 12719ed24f4bSMarc Zyngier } 12729ed24f4bSMarc Zyngier 12739ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_events(struct kvm_vcpu *vcpu, 12749ed24f4bSMarc Zyngier struct kvm_vcpu_events *events) 12759ed24f4bSMarc Zyngier { 12769ed24f4bSMarc Zyngier int i; 12779ed24f4bSMarc Zyngier 12789ed24f4bSMarc Zyngier /* check whether the reserved field is zero */ 12799ed24f4bSMarc Zyngier for (i = 0; i < ARRAY_SIZE(events->reserved); i++) 12809ed24f4bSMarc Zyngier if (events->reserved[i]) 12819ed24f4bSMarc Zyngier return -EINVAL; 12829ed24f4bSMarc Zyngier 12839ed24f4bSMarc Zyngier /* check whether the pad field is zero */ 12849ed24f4bSMarc Zyngier for (i = 0; i < ARRAY_SIZE(events->exception.pad); i++) 12859ed24f4bSMarc Zyngier if (events->exception.pad[i]) 12869ed24f4bSMarc Zyngier return -EINVAL; 12879ed24f4bSMarc Zyngier 12889ed24f4bSMarc Zyngier return __kvm_arm_vcpu_set_events(vcpu, events); 12899ed24f4bSMarc Zyngier } 12909ed24f4bSMarc Zyngier 12919ed24f4bSMarc Zyngier long kvm_arch_vcpu_ioctl(struct file *filp, 12929ed24f4bSMarc Zyngier unsigned int ioctl, unsigned long arg) 12939ed24f4bSMarc Zyngier { 12949ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu = filp->private_data; 12959ed24f4bSMarc Zyngier void __user *argp = (void __user *)arg; 12969ed24f4bSMarc Zyngier struct kvm_device_attr attr; 12979ed24f4bSMarc Zyngier long r; 12989ed24f4bSMarc Zyngier 12999ed24f4bSMarc Zyngier switch (ioctl) { 13009ed24f4bSMarc Zyngier case KVM_ARM_VCPU_INIT: { 13019ed24f4bSMarc Zyngier struct kvm_vcpu_init init; 13029ed24f4bSMarc Zyngier 13039ed24f4bSMarc Zyngier r = -EFAULT; 13049ed24f4bSMarc Zyngier if (copy_from_user(&init, argp, sizeof(init))) 13059ed24f4bSMarc Zyngier break; 13069ed24f4bSMarc Zyngier 13079ed24f4bSMarc Zyngier r = kvm_arch_vcpu_ioctl_vcpu_init(vcpu, &init); 13089ed24f4bSMarc Zyngier break; 13099ed24f4bSMarc Zyngier } 13109ed24f4bSMarc Zyngier case KVM_SET_ONE_REG: 13119ed24f4bSMarc Zyngier case KVM_GET_ONE_REG: { 13129ed24f4bSMarc Zyngier struct kvm_one_reg reg; 13139ed24f4bSMarc Zyngier 13149ed24f4bSMarc Zyngier r = -ENOEXEC; 13159ed24f4bSMarc Zyngier if (unlikely(!kvm_vcpu_initialized(vcpu))) 13169ed24f4bSMarc Zyngier break; 13179ed24f4bSMarc Zyngier 13189ed24f4bSMarc Zyngier r = -EFAULT; 13199ed24f4bSMarc Zyngier if (copy_from_user(®, argp, sizeof(reg))) 13209ed24f4bSMarc Zyngier break; 13219ed24f4bSMarc Zyngier 13226826c684SOliver Upton /* 13236826c684SOliver Upton * We could owe a reset due to PSCI. Handle the pending reset 13246826c684SOliver Upton * here to ensure userspace register accesses are ordered after 13256826c684SOliver Upton * the reset. 13266826c684SOliver Upton */ 13276826c684SOliver Upton if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu)) 13286826c684SOliver Upton kvm_reset_vcpu(vcpu); 13296826c684SOliver Upton 13309ed24f4bSMarc Zyngier if (ioctl == KVM_SET_ONE_REG) 13319ed24f4bSMarc Zyngier r = kvm_arm_set_reg(vcpu, ®); 13329ed24f4bSMarc Zyngier else 13339ed24f4bSMarc Zyngier r = kvm_arm_get_reg(vcpu, ®); 13349ed24f4bSMarc Zyngier break; 13359ed24f4bSMarc Zyngier } 13369ed24f4bSMarc Zyngier case KVM_GET_REG_LIST: { 13379ed24f4bSMarc Zyngier struct kvm_reg_list __user *user_list = argp; 13389ed24f4bSMarc Zyngier struct kvm_reg_list reg_list; 13399ed24f4bSMarc Zyngier unsigned n; 13409ed24f4bSMarc Zyngier 13419ed24f4bSMarc Zyngier r = -ENOEXEC; 13429ed24f4bSMarc Zyngier if (unlikely(!kvm_vcpu_initialized(vcpu))) 13439ed24f4bSMarc Zyngier break; 13449ed24f4bSMarc Zyngier 13459ed24f4bSMarc Zyngier r = -EPERM; 13469ed24f4bSMarc Zyngier if (!kvm_arm_vcpu_is_finalized(vcpu)) 13479ed24f4bSMarc Zyngier break; 13489ed24f4bSMarc Zyngier 13499ed24f4bSMarc Zyngier r = -EFAULT; 13509ed24f4bSMarc Zyngier if (copy_from_user(®_list, user_list, sizeof(reg_list))) 13519ed24f4bSMarc Zyngier break; 13529ed24f4bSMarc Zyngier n = reg_list.n; 13539ed24f4bSMarc Zyngier reg_list.n = kvm_arm_num_regs(vcpu); 13549ed24f4bSMarc Zyngier if (copy_to_user(user_list, ®_list, sizeof(reg_list))) 13559ed24f4bSMarc Zyngier break; 13569ed24f4bSMarc Zyngier r = -E2BIG; 13579ed24f4bSMarc Zyngier if (n < reg_list.n) 13589ed24f4bSMarc Zyngier break; 13599ed24f4bSMarc Zyngier r = kvm_arm_copy_reg_indices(vcpu, user_list->reg); 13609ed24f4bSMarc Zyngier break; 13619ed24f4bSMarc Zyngier } 13629ed24f4bSMarc Zyngier case KVM_SET_DEVICE_ATTR: { 13639ed24f4bSMarc Zyngier r = -EFAULT; 13649ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 13659ed24f4bSMarc Zyngier break; 13669ed24f4bSMarc Zyngier r = kvm_arm_vcpu_set_attr(vcpu, &attr); 13679ed24f4bSMarc Zyngier break; 13689ed24f4bSMarc Zyngier } 13699ed24f4bSMarc Zyngier case KVM_GET_DEVICE_ATTR: { 13709ed24f4bSMarc Zyngier r = -EFAULT; 13719ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 13729ed24f4bSMarc Zyngier break; 13739ed24f4bSMarc Zyngier r = kvm_arm_vcpu_get_attr(vcpu, &attr); 13749ed24f4bSMarc Zyngier break; 13759ed24f4bSMarc Zyngier } 13769ed24f4bSMarc Zyngier case KVM_HAS_DEVICE_ATTR: { 13779ed24f4bSMarc Zyngier r = -EFAULT; 13789ed24f4bSMarc Zyngier if (copy_from_user(&attr, argp, sizeof(attr))) 13799ed24f4bSMarc Zyngier break; 13809ed24f4bSMarc Zyngier r = kvm_arm_vcpu_has_attr(vcpu, &attr); 13819ed24f4bSMarc Zyngier break; 13829ed24f4bSMarc Zyngier } 13839ed24f4bSMarc Zyngier case KVM_GET_VCPU_EVENTS: { 13849ed24f4bSMarc Zyngier struct kvm_vcpu_events events; 13859ed24f4bSMarc Zyngier 13869ed24f4bSMarc Zyngier if (kvm_arm_vcpu_get_events(vcpu, &events)) 13879ed24f4bSMarc Zyngier return -EINVAL; 13889ed24f4bSMarc Zyngier 13899ed24f4bSMarc Zyngier if (copy_to_user(argp, &events, sizeof(events))) 13909ed24f4bSMarc Zyngier return -EFAULT; 13919ed24f4bSMarc Zyngier 13929ed24f4bSMarc Zyngier return 0; 13939ed24f4bSMarc Zyngier } 13949ed24f4bSMarc Zyngier case KVM_SET_VCPU_EVENTS: { 13959ed24f4bSMarc Zyngier struct kvm_vcpu_events events; 13969ed24f4bSMarc Zyngier 13979ed24f4bSMarc Zyngier if (copy_from_user(&events, argp, sizeof(events))) 13989ed24f4bSMarc Zyngier return -EFAULT; 13999ed24f4bSMarc Zyngier 14009ed24f4bSMarc Zyngier return kvm_arm_vcpu_set_events(vcpu, &events); 14019ed24f4bSMarc Zyngier } 14029ed24f4bSMarc Zyngier case KVM_ARM_VCPU_FINALIZE: { 14039ed24f4bSMarc Zyngier int what; 14049ed24f4bSMarc Zyngier 14059ed24f4bSMarc Zyngier if (!kvm_vcpu_initialized(vcpu)) 14069ed24f4bSMarc Zyngier return -ENOEXEC; 14079ed24f4bSMarc Zyngier 14089ed24f4bSMarc Zyngier if (get_user(what, (const int __user *)argp)) 14099ed24f4bSMarc Zyngier return -EFAULT; 14109ed24f4bSMarc Zyngier 14119ed24f4bSMarc Zyngier return kvm_arm_vcpu_finalize(vcpu, what); 14129ed24f4bSMarc Zyngier } 14139ed24f4bSMarc Zyngier default: 14149ed24f4bSMarc Zyngier r = -EINVAL; 14159ed24f4bSMarc Zyngier } 14169ed24f4bSMarc Zyngier 14179ed24f4bSMarc Zyngier return r; 14189ed24f4bSMarc Zyngier } 14199ed24f4bSMarc Zyngier 14209ed24f4bSMarc Zyngier void kvm_arch_sync_dirty_log(struct kvm *kvm, struct kvm_memory_slot *memslot) 14219ed24f4bSMarc Zyngier { 14229ed24f4bSMarc Zyngier 14239ed24f4bSMarc Zyngier } 14249ed24f4bSMarc Zyngier 14259ed24f4bSMarc Zyngier void kvm_arch_flush_remote_tlbs_memslot(struct kvm *kvm, 14266c9dd6d2SPaolo Bonzini const struct kvm_memory_slot *memslot) 14279ed24f4bSMarc Zyngier { 14289ed24f4bSMarc Zyngier kvm_flush_remote_tlbs(kvm); 14299ed24f4bSMarc Zyngier } 14309ed24f4bSMarc Zyngier 14319ed24f4bSMarc Zyngier static int kvm_vm_ioctl_set_device_addr(struct kvm *kvm, 14329ed24f4bSMarc Zyngier struct kvm_arm_device_addr *dev_addr) 14339ed24f4bSMarc Zyngier { 14349f968c92SMarc Zyngier switch (FIELD_GET(KVM_ARM_DEVICE_ID_MASK, dev_addr->id)) { 14359ed24f4bSMarc Zyngier case KVM_ARM_DEVICE_VGIC_V2: 14369ed24f4bSMarc Zyngier if (!vgic_present) 14379ed24f4bSMarc Zyngier return -ENXIO; 14389f968c92SMarc Zyngier return kvm_set_legacy_vgic_v2_addr(kvm, dev_addr); 14399ed24f4bSMarc Zyngier default: 14409ed24f4bSMarc Zyngier return -ENODEV; 14419ed24f4bSMarc Zyngier } 14429ed24f4bSMarc Zyngier } 14439ed24f4bSMarc Zyngier 1444e0fc6b21SOliver Upton static int kvm_vm_has_attr(struct kvm *kvm, struct kvm_device_attr *attr) 1445e0fc6b21SOliver Upton { 1446e0fc6b21SOliver Upton switch (attr->group) { 1447*821d935cSOliver Upton case KVM_ARM_VM_SMCCC_CTRL: 1448*821d935cSOliver Upton return kvm_vm_smccc_has_attr(kvm, attr); 1449e0fc6b21SOliver Upton default: 1450e0fc6b21SOliver Upton return -ENXIO; 1451e0fc6b21SOliver Upton } 1452e0fc6b21SOliver Upton } 1453e0fc6b21SOliver Upton 1454e0fc6b21SOliver Upton static int kvm_vm_set_attr(struct kvm *kvm, struct kvm_device_attr *attr) 1455e0fc6b21SOliver Upton { 1456e0fc6b21SOliver Upton switch (attr->group) { 1457*821d935cSOliver Upton case KVM_ARM_VM_SMCCC_CTRL: 1458*821d935cSOliver Upton return kvm_vm_smccc_set_attr(kvm, attr); 1459e0fc6b21SOliver Upton default: 1460e0fc6b21SOliver Upton return -ENXIO; 1461e0fc6b21SOliver Upton } 1462e0fc6b21SOliver Upton } 1463e0fc6b21SOliver Upton 14649ed24f4bSMarc Zyngier long kvm_arch_vm_ioctl(struct file *filp, 14659ed24f4bSMarc Zyngier unsigned int ioctl, unsigned long arg) 14669ed24f4bSMarc Zyngier { 14679ed24f4bSMarc Zyngier struct kvm *kvm = filp->private_data; 14689ed24f4bSMarc Zyngier void __user *argp = (void __user *)arg; 1469e0fc6b21SOliver Upton struct kvm_device_attr attr; 14709ed24f4bSMarc Zyngier 14719ed24f4bSMarc Zyngier switch (ioctl) { 14729ed24f4bSMarc Zyngier case KVM_CREATE_IRQCHIP: { 14739ed24f4bSMarc Zyngier int ret; 14749ed24f4bSMarc Zyngier if (!vgic_present) 14759ed24f4bSMarc Zyngier return -ENXIO; 14769ed24f4bSMarc Zyngier mutex_lock(&kvm->lock); 14779ed24f4bSMarc Zyngier ret = kvm_vgic_create(kvm, KVM_DEV_TYPE_ARM_VGIC_V2); 14789ed24f4bSMarc Zyngier mutex_unlock(&kvm->lock); 14799ed24f4bSMarc Zyngier return ret; 14809ed24f4bSMarc Zyngier } 14819ed24f4bSMarc Zyngier case KVM_ARM_SET_DEVICE_ADDR: { 14829ed24f4bSMarc Zyngier struct kvm_arm_device_addr dev_addr; 14839ed24f4bSMarc Zyngier 14849ed24f4bSMarc Zyngier if (copy_from_user(&dev_addr, argp, sizeof(dev_addr))) 14859ed24f4bSMarc Zyngier return -EFAULT; 14869ed24f4bSMarc Zyngier return kvm_vm_ioctl_set_device_addr(kvm, &dev_addr); 14879ed24f4bSMarc Zyngier } 14889ed24f4bSMarc Zyngier case KVM_ARM_PREFERRED_TARGET: { 14899ed24f4bSMarc Zyngier struct kvm_vcpu_init init; 14909ed24f4bSMarc Zyngier 149108e873cbSYueHaibing kvm_vcpu_preferred_target(&init); 14929ed24f4bSMarc Zyngier 14939ed24f4bSMarc Zyngier if (copy_to_user(argp, &init, sizeof(init))) 14949ed24f4bSMarc Zyngier return -EFAULT; 14959ed24f4bSMarc Zyngier 14969ed24f4bSMarc Zyngier return 0; 14979ed24f4bSMarc Zyngier } 1498f0376edbSSteven Price case KVM_ARM_MTE_COPY_TAGS: { 1499f0376edbSSteven Price struct kvm_arm_copy_mte_tags copy_tags; 1500f0376edbSSteven Price 1501f0376edbSSteven Price if (copy_from_user(©_tags, argp, sizeof(copy_tags))) 1502f0376edbSSteven Price return -EFAULT; 1503f0376edbSSteven Price return kvm_vm_ioctl_mte_copy_tags(kvm, ©_tags); 1504f0376edbSSteven Price } 1505e0fc6b21SOliver Upton case KVM_HAS_DEVICE_ATTR: { 1506e0fc6b21SOliver Upton if (copy_from_user(&attr, argp, sizeof(attr))) 1507e0fc6b21SOliver Upton return -EFAULT; 1508e0fc6b21SOliver Upton 1509e0fc6b21SOliver Upton return kvm_vm_has_attr(kvm, &attr); 1510e0fc6b21SOliver Upton } 1511e0fc6b21SOliver Upton case KVM_SET_DEVICE_ATTR: { 1512e0fc6b21SOliver Upton if (copy_from_user(&attr, argp, sizeof(attr))) 1513e0fc6b21SOliver Upton return -EFAULT; 1514e0fc6b21SOliver Upton 1515e0fc6b21SOliver Upton return kvm_vm_set_attr(kvm, &attr); 1516e0fc6b21SOliver Upton } 15179ed24f4bSMarc Zyngier default: 15189ed24f4bSMarc Zyngier return -EINVAL; 15199ed24f4bSMarc Zyngier } 15209ed24f4bSMarc Zyngier } 15219ed24f4bSMarc Zyngier 152230c95391SDavid Brazdil static unsigned long nvhe_percpu_size(void) 152330c95391SDavid Brazdil { 152430c95391SDavid Brazdil return (unsigned long)CHOOSE_NVHE_SYM(__per_cpu_end) - 152530c95391SDavid Brazdil (unsigned long)CHOOSE_NVHE_SYM(__per_cpu_start); 152630c95391SDavid Brazdil } 152730c95391SDavid Brazdil 152830c95391SDavid Brazdil static unsigned long nvhe_percpu_order(void) 152930c95391SDavid Brazdil { 153030c95391SDavid Brazdil unsigned long size = nvhe_percpu_size(); 153130c95391SDavid Brazdil 153230c95391SDavid Brazdil return size ? get_order(size) : 0; 153330c95391SDavid Brazdil } 153430c95391SDavid Brazdil 1535b881cdceSWill Deacon /* A lookup table holding the hypervisor VA for each vector slot */ 1536b881cdceSWill Deacon static void *hyp_spectre_vector_selector[BP_HARDEN_EL2_SLOTS]; 1537de5bcdb4SWill Deacon 1538b881cdceSWill Deacon static void kvm_init_vector_slot(void *base, enum arm64_hyp_spectre_vector slot) 1539b881cdceSWill Deacon { 1540bc1d2892SQuentin Perret hyp_spectre_vector_selector[slot] = __kvm_vector_slot2addr(base, slot); 15419ef2b48bSWill Deacon } 15429ef2b48bSWill Deacon 1543b881cdceSWill Deacon static int kvm_init_vector_slots(void) 1544b881cdceSWill Deacon { 1545b881cdceSWill Deacon int err; 1546b881cdceSWill Deacon void *base; 1547b881cdceSWill Deacon 1548b881cdceSWill Deacon base = kern_hyp_va(kvm_ksym_ref(__kvm_hyp_vector)); 1549b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_DIRECT); 1550b881cdceSWill Deacon 1551b881cdceSWill Deacon base = kern_hyp_va(kvm_ksym_ref(__bp_harden_hyp_vecs)); 1552b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_SPECTRE_DIRECT); 1553b881cdceSWill Deacon 15542e403167SQuentin Perret if (kvm_system_needs_idmapped_vectors() && 15552e403167SQuentin Perret !is_protected_kvm_enabled()) { 1556b881cdceSWill Deacon err = create_hyp_exec_mappings(__pa_symbol(__bp_harden_hyp_vecs), 1557b881cdceSWill Deacon __BP_HARDEN_HYP_VECS_SZ, &base); 1558b881cdceSWill Deacon if (err) 1559b881cdceSWill Deacon return err; 1560b881cdceSWill Deacon } 15619ef2b48bSWill Deacon 1562b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_INDIRECT); 1563b881cdceSWill Deacon kvm_init_vector_slot(base, HYP_VECTOR_SPECTRE_INDIRECT); 15649ef2b48bSWill Deacon return 0; 15659ef2b48bSWill Deacon } 15669ef2b48bSWill Deacon 156753bf620aSSean Christopherson static void __init cpu_prepare_hyp_mode(int cpu, u32 hyp_va_bits) 15689ed24f4bSMarc Zyngier { 15699cc77581SQuentin Perret struct kvm_nvhe_init_params *params = per_cpu_ptr_nvhe_sym(kvm_init_params, cpu); 1570d3e1086cSDavid Brazdil unsigned long tcr; 15719ed24f4bSMarc Zyngier 157271b3ec5fSDavid Brazdil /* 157371b3ec5fSDavid Brazdil * Calculate the raw per-cpu offset without a translation from the 157471b3ec5fSDavid Brazdil * kernel's mapping to the linear mapping, and store it in tpidr_el2 157571b3ec5fSDavid Brazdil * so that we can use adr_l to access per-cpu variables in EL2. 1576e1663372SSteven Price * Also drop the KASAN tag which gets in the way... 157771b3ec5fSDavid Brazdil */ 15789cc77581SQuentin Perret params->tpidr_el2 = (unsigned long)kasan_reset_tag(per_cpu_ptr_nvhe_sym(__per_cpu_start, cpu)) - 157930c95391SDavid Brazdil (unsigned long)kvm_ksym_ref(CHOOSE_NVHE_SYM(__per_cpu_start)); 158071b3ec5fSDavid Brazdil 1581d3e1086cSDavid Brazdil params->mair_el2 = read_sysreg(mair_el1); 1582d3e1086cSDavid Brazdil 1583d3e1086cSDavid Brazdil tcr = (read_sysreg(tcr_el1) & TCR_EL2_MASK) | TCR_EL2_RES1; 1584d3e1086cSDavid Brazdil tcr &= ~TCR_T0SZ_MASK; 1585579d7ebeSRyan Roberts tcr |= TCR_T0SZ(hyp_va_bits); 1586d3e1086cSDavid Brazdil params->tcr_el2 = tcr; 1587d3e1086cSDavid Brazdil 158863fec243SDavid Brazdil params->pgd_pa = kvm_mmu_get_httbr(); 1589734864c1SQuentin Perret if (is_protected_kvm_enabled()) 1590734864c1SQuentin Perret params->hcr_el2 = HCR_HOST_NVHE_PROTECTED_FLAGS; 1591734864c1SQuentin Perret else 1592734864c1SQuentin Perret params->hcr_el2 = HCR_HOST_NVHE_FLAGS; 1593734864c1SQuentin Perret params->vttbr = params->vtcr = 0; 159463fec243SDavid Brazdil 159563fec243SDavid Brazdil /* 159663fec243SDavid Brazdil * Flush the init params from the data cache because the struct will 159763fec243SDavid Brazdil * be read while the MMU is off. 159863fec243SDavid Brazdil */ 159963fec243SDavid Brazdil kvm_flush_dcache_to_poc(params, sizeof(*params)); 16009cc77581SQuentin Perret } 16019cc77581SQuentin Perret 1602bfa79a80SQuentin Perret static void hyp_install_host_vector(void) 16039cc77581SQuentin Perret { 16049cc77581SQuentin Perret struct kvm_nvhe_init_params *params; 16059cc77581SQuentin Perret struct arm_smccc_res res; 16069cc77581SQuentin Perret 16079cc77581SQuentin Perret /* Switch from the HYP stub to our own HYP init vector */ 16089cc77581SQuentin Perret __hyp_set_vectors(kvm_get_idmap_vector()); 16099ed24f4bSMarc Zyngier 161071b3ec5fSDavid Brazdil /* 161171b3ec5fSDavid Brazdil * Call initialization code, and switch to the full blown HYP code. 161271b3ec5fSDavid Brazdil * If the cpucaps haven't been finalized yet, something has gone very 161371b3ec5fSDavid Brazdil * wrong, and hyp will crash and burn when it uses any 161471b3ec5fSDavid Brazdil * cpus_have_const_cap() wrapper. 161571b3ec5fSDavid Brazdil */ 161671b3ec5fSDavid Brazdil BUG_ON(!system_capabilities_finalized()); 16179cc77581SQuentin Perret params = this_cpu_ptr_nvhe_sym(kvm_init_params); 161863fec243SDavid Brazdil arm_smccc_1_1_hvc(KVM_HOST_SMCCC_FUNC(__kvm_hyp_init), virt_to_phys(params), &res); 161904e4caa8SAndrew Scull WARN_ON(res.a0 != SMCCC_RET_SUCCESS); 1620bfa79a80SQuentin Perret } 1621bfa79a80SQuentin Perret 1622bfa79a80SQuentin Perret static void cpu_init_hyp_mode(void) 1623bfa79a80SQuentin Perret { 1624bfa79a80SQuentin Perret hyp_install_host_vector(); 162571b3ec5fSDavid Brazdil 162671b3ec5fSDavid Brazdil /* 162771b3ec5fSDavid Brazdil * Disabling SSBD on a non-VHE system requires us to enable SSBS 162871b3ec5fSDavid Brazdil * at EL2. 162971b3ec5fSDavid Brazdil */ 163071b3ec5fSDavid Brazdil if (this_cpu_has_cap(ARM64_SSBS) && 1631d63d975aSMarc Zyngier arm64_get_spectre_v4_state() == SPECTRE_VULNERABLE) { 163213aeb9b4SDavid Brazdil kvm_call_hyp_nvhe(__kvm_enable_ssbs); 163371b3ec5fSDavid Brazdil } 16349ed24f4bSMarc Zyngier } 16359ed24f4bSMarc Zyngier 16369ed24f4bSMarc Zyngier static void cpu_hyp_reset(void) 16379ed24f4bSMarc Zyngier { 16389ed24f4bSMarc Zyngier if (!is_kernel_in_hyp_mode()) 16399ed24f4bSMarc Zyngier __hyp_reset_vectors(); 16409ed24f4bSMarc Zyngier } 16419ed24f4bSMarc Zyngier 1642042c76a9SWill Deacon /* 1643042c76a9SWill Deacon * EL2 vectors can be mapped and rerouted in a number of ways, 1644042c76a9SWill Deacon * depending on the kernel configuration and CPU present: 1645042c76a9SWill Deacon * 1646042c76a9SWill Deacon * - If the CPU is affected by Spectre-v2, the hardening sequence is 1647042c76a9SWill Deacon * placed in one of the vector slots, which is executed before jumping 1648042c76a9SWill Deacon * to the real vectors. 1649042c76a9SWill Deacon * 1650c4792b6dSWill Deacon * - If the CPU also has the ARM64_SPECTRE_V3A cap, the slot 1651042c76a9SWill Deacon * containing the hardening sequence is mapped next to the idmap page, 1652042c76a9SWill Deacon * and executed before jumping to the real vectors. 1653042c76a9SWill Deacon * 1654c4792b6dSWill Deacon * - If the CPU only has the ARM64_SPECTRE_V3A cap, then an 1655042c76a9SWill Deacon * empty slot is selected, mapped next to the idmap page, and 1656042c76a9SWill Deacon * executed before jumping to the real vectors. 1657042c76a9SWill Deacon * 1658c4792b6dSWill Deacon * Note that ARM64_SPECTRE_V3A is somewhat incompatible with 1659042c76a9SWill Deacon * VHE, as we don't have hypervisor-specific mappings. If the system 1660042c76a9SWill Deacon * is VHE and yet selects this capability, it will be ignored. 1661042c76a9SWill Deacon */ 1662042c76a9SWill Deacon static void cpu_set_hyp_vector(void) 1663042c76a9SWill Deacon { 16646279017eSWill Deacon struct bp_hardening_data *data = this_cpu_ptr(&bp_hardening_data); 1665b881cdceSWill Deacon void *vector = hyp_spectre_vector_selector[data->slot]; 1666042c76a9SWill Deacon 1667bfa79a80SQuentin Perret if (!is_protected_kvm_enabled()) 1668b881cdceSWill Deacon *this_cpu_ptr_hyp_sym(kvm_hyp_vector) = (unsigned long)vector; 1669bfa79a80SQuentin Perret else 1670bfa79a80SQuentin Perret kvm_call_hyp_nvhe(__pkvm_cpu_set_vector, data->slot); 1671042c76a9SWill Deacon } 1672042c76a9SWill Deacon 16738579a185SWill Deacon static void cpu_hyp_init_context(void) 16749ed24f4bSMarc Zyngier { 16752a1198c9SDavid Brazdil kvm_init_host_cpu_context(&this_cpu_ptr_hyp_sym(kvm_host_data)->host_ctxt); 16769ed24f4bSMarc Zyngier 16778579a185SWill Deacon if (!is_kernel_in_hyp_mode()) 16788579a185SWill Deacon cpu_init_hyp_mode(); 16798579a185SWill Deacon } 16808579a185SWill Deacon 16818579a185SWill Deacon static void cpu_hyp_init_features(void) 16828579a185SWill Deacon { 16838579a185SWill Deacon cpu_set_hyp_vector(); 16848579a185SWill Deacon kvm_arm_init_debug(); 1685a0e47952SAndrew Scull 16869ed24f4bSMarc Zyngier if (is_kernel_in_hyp_mode()) 16879ed24f4bSMarc Zyngier kvm_timer_init_vhe(); 16889ed24f4bSMarc Zyngier 16899ed24f4bSMarc Zyngier if (vgic_present) 16909ed24f4bSMarc Zyngier kvm_vgic_init_cpu_hardware(); 16919ed24f4bSMarc Zyngier } 16929ed24f4bSMarc Zyngier 16938579a185SWill Deacon static void cpu_hyp_reinit(void) 16948579a185SWill Deacon { 16958579a185SWill Deacon cpu_hyp_reset(); 16968579a185SWill Deacon cpu_hyp_init_context(); 16978579a185SWill Deacon cpu_hyp_init_features(); 16988579a185SWill Deacon } 16998579a185SWill Deacon 17009ed24f4bSMarc Zyngier static void _kvm_arch_hardware_enable(void *discard) 17019ed24f4bSMarc Zyngier { 17029ed24f4bSMarc Zyngier if (!__this_cpu_read(kvm_arm_hardware_enabled)) { 17039ed24f4bSMarc Zyngier cpu_hyp_reinit(); 17049ed24f4bSMarc Zyngier __this_cpu_write(kvm_arm_hardware_enabled, 1); 17059ed24f4bSMarc Zyngier } 17069ed24f4bSMarc Zyngier } 17079ed24f4bSMarc Zyngier 17089ed24f4bSMarc Zyngier int kvm_arch_hardware_enable(void) 17099ed24f4bSMarc Zyngier { 1710466d27e4SMarc Zyngier int was_enabled = __this_cpu_read(kvm_arm_hardware_enabled); 1711466d27e4SMarc Zyngier 17129ed24f4bSMarc Zyngier _kvm_arch_hardware_enable(NULL); 1713466d27e4SMarc Zyngier 1714466d27e4SMarc Zyngier if (!was_enabled) { 1715466d27e4SMarc Zyngier kvm_vgic_cpu_up(); 1716466d27e4SMarc Zyngier kvm_timer_cpu_up(); 1717466d27e4SMarc Zyngier } 1718466d27e4SMarc Zyngier 17199ed24f4bSMarc Zyngier return 0; 17209ed24f4bSMarc Zyngier } 17219ed24f4bSMarc Zyngier 17229ed24f4bSMarc Zyngier static void _kvm_arch_hardware_disable(void *discard) 17239ed24f4bSMarc Zyngier { 17249ed24f4bSMarc Zyngier if (__this_cpu_read(kvm_arm_hardware_enabled)) { 17259ed24f4bSMarc Zyngier cpu_hyp_reset(); 17269ed24f4bSMarc Zyngier __this_cpu_write(kvm_arm_hardware_enabled, 0); 17279ed24f4bSMarc Zyngier } 17289ed24f4bSMarc Zyngier } 17299ed24f4bSMarc Zyngier 17309ed24f4bSMarc Zyngier void kvm_arch_hardware_disable(void) 17319ed24f4bSMarc Zyngier { 1732466d27e4SMarc Zyngier if (__this_cpu_read(kvm_arm_hardware_enabled)) { 1733466d27e4SMarc Zyngier kvm_timer_cpu_down(); 1734466d27e4SMarc Zyngier kvm_vgic_cpu_down(); 1735466d27e4SMarc Zyngier } 1736466d27e4SMarc Zyngier 1737fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 17389ed24f4bSMarc Zyngier _kvm_arch_hardware_disable(NULL); 17399ed24f4bSMarc Zyngier } 17409ed24f4bSMarc Zyngier 17419ed24f4bSMarc Zyngier #ifdef CONFIG_CPU_PM 17429ed24f4bSMarc Zyngier static int hyp_init_cpu_pm_notifier(struct notifier_block *self, 17439ed24f4bSMarc Zyngier unsigned long cmd, 17449ed24f4bSMarc Zyngier void *v) 17459ed24f4bSMarc Zyngier { 17469ed24f4bSMarc Zyngier /* 17479ed24f4bSMarc Zyngier * kvm_arm_hardware_enabled is left with its old value over 17489ed24f4bSMarc Zyngier * PM_ENTER->PM_EXIT. It is used to indicate PM_EXIT should 17499ed24f4bSMarc Zyngier * re-enable hyp. 17509ed24f4bSMarc Zyngier */ 17519ed24f4bSMarc Zyngier switch (cmd) { 17529ed24f4bSMarc Zyngier case CPU_PM_ENTER: 17539ed24f4bSMarc Zyngier if (__this_cpu_read(kvm_arm_hardware_enabled)) 17549ed24f4bSMarc Zyngier /* 17559ed24f4bSMarc Zyngier * don't update kvm_arm_hardware_enabled here 17569ed24f4bSMarc Zyngier * so that the hardware will be re-enabled 17579ed24f4bSMarc Zyngier * when we resume. See below. 17589ed24f4bSMarc Zyngier */ 17599ed24f4bSMarc Zyngier cpu_hyp_reset(); 17609ed24f4bSMarc Zyngier 17619ed24f4bSMarc Zyngier return NOTIFY_OK; 17629ed24f4bSMarc Zyngier case CPU_PM_ENTER_FAILED: 17639ed24f4bSMarc Zyngier case CPU_PM_EXIT: 17649ed24f4bSMarc Zyngier if (__this_cpu_read(kvm_arm_hardware_enabled)) 17659ed24f4bSMarc Zyngier /* The hardware was enabled before suspend. */ 17669ed24f4bSMarc Zyngier cpu_hyp_reinit(); 17679ed24f4bSMarc Zyngier 17689ed24f4bSMarc Zyngier return NOTIFY_OK; 17699ed24f4bSMarc Zyngier 17709ed24f4bSMarc Zyngier default: 17719ed24f4bSMarc Zyngier return NOTIFY_DONE; 17729ed24f4bSMarc Zyngier } 17739ed24f4bSMarc Zyngier } 17749ed24f4bSMarc Zyngier 17759ed24f4bSMarc Zyngier static struct notifier_block hyp_init_cpu_pm_nb = { 17769ed24f4bSMarc Zyngier .notifier_call = hyp_init_cpu_pm_notifier, 17779ed24f4bSMarc Zyngier }; 17789ed24f4bSMarc Zyngier 177953bf620aSSean Christopherson static void __init hyp_cpu_pm_init(void) 17809ed24f4bSMarc Zyngier { 1781fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 17829ed24f4bSMarc Zyngier cpu_pm_register_notifier(&hyp_init_cpu_pm_nb); 17839ed24f4bSMarc Zyngier } 178453bf620aSSean Christopherson static void __init hyp_cpu_pm_exit(void) 17859ed24f4bSMarc Zyngier { 1786fa8c3d65SDavid Brazdil if (!is_protected_kvm_enabled()) 17879ed24f4bSMarc Zyngier cpu_pm_unregister_notifier(&hyp_init_cpu_pm_nb); 17889ed24f4bSMarc Zyngier } 17899ed24f4bSMarc Zyngier #else 179053bf620aSSean Christopherson static inline void __init hyp_cpu_pm_init(void) 17919ed24f4bSMarc Zyngier { 17929ed24f4bSMarc Zyngier } 179353bf620aSSean Christopherson static inline void __init hyp_cpu_pm_exit(void) 17949ed24f4bSMarc Zyngier { 17959ed24f4bSMarc Zyngier } 17969ed24f4bSMarc Zyngier #endif 17979ed24f4bSMarc Zyngier 179853bf620aSSean Christopherson static void __init init_cpu_logical_map(void) 179994f5e8a4SDavid Brazdil { 180094f5e8a4SDavid Brazdil unsigned int cpu; 180194f5e8a4SDavid Brazdil 180294f5e8a4SDavid Brazdil /* 180394f5e8a4SDavid Brazdil * Copy the MPIDR <-> logical CPU ID mapping to hyp. 180421ea4578SJulia Lawall * Only copy the set of online CPUs whose features have been checked 180594f5e8a4SDavid Brazdil * against the finalized system capabilities. The hypervisor will not 180694f5e8a4SDavid Brazdil * allow any other CPUs from the `possible` set to boot. 180794f5e8a4SDavid Brazdil */ 180894f5e8a4SDavid Brazdil for_each_online_cpu(cpu) 180961fe0c37SDavid Brazdil hyp_cpu_logical_map[cpu] = cpu_logical_map(cpu); 181094f5e8a4SDavid Brazdil } 181194f5e8a4SDavid Brazdil 1812767c973fSMarc Zyngier #define init_psci_0_1_impl_state(config, what) \ 1813767c973fSMarc Zyngier config.psci_0_1_ ## what ## _implemented = psci_ops.what 1814767c973fSMarc Zyngier 181553bf620aSSean Christopherson static bool __init init_psci_relay(void) 1816eeeee719SDavid Brazdil { 1817eeeee719SDavid Brazdil /* 1818eeeee719SDavid Brazdil * If PSCI has not been initialized, protected KVM cannot install 1819eeeee719SDavid Brazdil * itself on newly booted CPUs. 1820eeeee719SDavid Brazdil */ 1821eeeee719SDavid Brazdil if (!psci_ops.get_version) { 1822eeeee719SDavid Brazdil kvm_err("Cannot initialize protected mode without PSCI\n"); 1823eeeee719SDavid Brazdil return false; 1824eeeee719SDavid Brazdil } 1825eeeee719SDavid Brazdil 1826ff367fe4SDavid Brazdil kvm_host_psci_config.version = psci_ops.get_version(); 1827ff367fe4SDavid Brazdil 1828ff367fe4SDavid Brazdil if (kvm_host_psci_config.version == PSCI_VERSION(0, 1)) { 1829ff367fe4SDavid Brazdil kvm_host_psci_config.function_ids_0_1 = get_psci_0_1_function_ids(); 1830767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_suspend); 1831767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_on); 1832767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, cpu_off); 1833767c973fSMarc Zyngier init_psci_0_1_impl_state(kvm_host_psci_config, migrate); 1834ff367fe4SDavid Brazdil } 1835eeeee719SDavid Brazdil return true; 1836eeeee719SDavid Brazdil } 1837eeeee719SDavid Brazdil 183853bf620aSSean Christopherson static int __init init_subsystems(void) 18399ed24f4bSMarc Zyngier { 18409ed24f4bSMarc Zyngier int err = 0; 18419ed24f4bSMarc Zyngier 18429ed24f4bSMarc Zyngier /* 18439ed24f4bSMarc Zyngier * Enable hardware so that subsystem initialisation can access EL2. 18449ed24f4bSMarc Zyngier */ 18459ed24f4bSMarc Zyngier on_each_cpu(_kvm_arch_hardware_enable, NULL, 1); 18469ed24f4bSMarc Zyngier 18479ed24f4bSMarc Zyngier /* 18489ed24f4bSMarc Zyngier * Register CPU lower-power notifier 18499ed24f4bSMarc Zyngier */ 18509ed24f4bSMarc Zyngier hyp_cpu_pm_init(); 18519ed24f4bSMarc Zyngier 18529ed24f4bSMarc Zyngier /* 18539ed24f4bSMarc Zyngier * Init HYP view of VGIC 18549ed24f4bSMarc Zyngier */ 18559ed24f4bSMarc Zyngier err = kvm_vgic_hyp_init(); 18569ed24f4bSMarc Zyngier switch (err) { 18579ed24f4bSMarc Zyngier case 0: 18589ed24f4bSMarc Zyngier vgic_present = true; 18599ed24f4bSMarc Zyngier break; 18609ed24f4bSMarc Zyngier case -ENODEV: 18619ed24f4bSMarc Zyngier case -ENXIO: 18629ed24f4bSMarc Zyngier vgic_present = false; 18639ed24f4bSMarc Zyngier err = 0; 18649ed24f4bSMarc Zyngier break; 18659ed24f4bSMarc Zyngier default: 18669ed24f4bSMarc Zyngier goto out; 18679ed24f4bSMarc Zyngier } 18689ed24f4bSMarc Zyngier 18699ed24f4bSMarc Zyngier /* 18709ed24f4bSMarc Zyngier * Init HYP architected timer support 18719ed24f4bSMarc Zyngier */ 18729ed24f4bSMarc Zyngier err = kvm_timer_hyp_init(vgic_present); 18739ed24f4bSMarc Zyngier if (err) 18749ed24f4bSMarc Zyngier goto out; 18759ed24f4bSMarc Zyngier 187617ed14ebSSean Christopherson kvm_register_perf_callbacks(NULL); 187717ed14ebSSean Christopherson 18789ed24f4bSMarc Zyngier out: 187978b3bf48SSean Christopherson if (err) 188078b3bf48SSean Christopherson hyp_cpu_pm_exit(); 188178b3bf48SSean Christopherson 1882fa8c3d65SDavid Brazdil if (err || !is_protected_kvm_enabled()) 18839ed24f4bSMarc Zyngier on_each_cpu(_kvm_arch_hardware_disable, NULL, 1); 18849ed24f4bSMarc Zyngier 18859ed24f4bSMarc Zyngier return err; 18869ed24f4bSMarc Zyngier } 18879ed24f4bSMarc Zyngier 188853bf620aSSean Christopherson static void __init teardown_subsystems(void) 188978b3bf48SSean Christopherson { 189078b3bf48SSean Christopherson kvm_unregister_perf_callbacks(); 189178b3bf48SSean Christopherson hyp_cpu_pm_exit(); 189278b3bf48SSean Christopherson } 189378b3bf48SSean Christopherson 189453bf620aSSean Christopherson static void __init teardown_hyp_mode(void) 18959ed24f4bSMarc Zyngier { 18969ed24f4bSMarc Zyngier int cpu; 18979ed24f4bSMarc Zyngier 18989ed24f4bSMarc Zyngier free_hyp_pgds(); 189930c95391SDavid Brazdil for_each_possible_cpu(cpu) { 19009ed24f4bSMarc Zyngier free_page(per_cpu(kvm_arm_hyp_stack_page, cpu)); 1901fe41a7f8SQuentin Perret free_pages(kvm_nvhe_sym(kvm_arm_hyp_percpu_base)[cpu], nvhe_percpu_order()); 190230c95391SDavid Brazdil } 19039ed24f4bSMarc Zyngier } 19049ed24f4bSMarc Zyngier 190553bf620aSSean Christopherson static int __init do_pkvm_init(u32 hyp_va_bits) 1906bfa79a80SQuentin Perret { 1907fe41a7f8SQuentin Perret void *per_cpu_base = kvm_ksym_ref(kvm_nvhe_sym(kvm_arm_hyp_percpu_base)); 1908bfa79a80SQuentin Perret int ret; 1909bfa79a80SQuentin Perret 1910bfa79a80SQuentin Perret preempt_disable(); 19118579a185SWill Deacon cpu_hyp_init_context(); 1912bfa79a80SQuentin Perret ret = kvm_call_hyp_nvhe(__pkvm_init, hyp_mem_base, hyp_mem_size, 1913bfa79a80SQuentin Perret num_possible_cpus(), kern_hyp_va(per_cpu_base), 1914bfa79a80SQuentin Perret hyp_va_bits); 19158579a185SWill Deacon cpu_hyp_init_features(); 19168579a185SWill Deacon 19178579a185SWill Deacon /* 19188579a185SWill Deacon * The stub hypercalls are now disabled, so set our local flag to 19198579a185SWill Deacon * prevent a later re-init attempt in kvm_arch_hardware_enable(). 19208579a185SWill Deacon */ 19218579a185SWill Deacon __this_cpu_write(kvm_arm_hardware_enabled, 1); 1922bfa79a80SQuentin Perret preempt_enable(); 1923bfa79a80SQuentin Perret 1924bfa79a80SQuentin Perret return ret; 1925bfa79a80SQuentin Perret } 1926bfa79a80SQuentin Perret 19276c165223SWill Deacon static void kvm_hyp_init_symbols(void) 1928bfa79a80SQuentin Perret { 19296c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64pfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64PFR0_EL1); 19306c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64pfr1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64PFR1_EL1); 19316c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64isar0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR0_EL1); 19326c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64isar1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR1_EL1); 1933def8c222SVladimir Murzin kvm_nvhe_sym(id_aa64isar2_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR2_EL1); 19347c419937SMarc Zyngier kvm_nvhe_sym(id_aa64mmfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR0_EL1); 19357c419937SMarc Zyngier kvm_nvhe_sym(id_aa64mmfr1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR1_EL1); 19366c30bfb1SFuad Tabba kvm_nvhe_sym(id_aa64mmfr2_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR2_EL1); 19378669651cSQuentin Perret kvm_nvhe_sym(id_aa64smfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64SMFR0_EL1); 193813e248aaSWill Deacon kvm_nvhe_sym(__icache_flags) = __icache_flags; 193973f38ef2SWill Deacon kvm_nvhe_sym(kvm_arm_vmid_bits) = kvm_arm_vmid_bits; 19406c165223SWill Deacon } 19416c165223SWill Deacon 194253bf620aSSean Christopherson static int __init kvm_hyp_init_protection(u32 hyp_va_bits) 19436c165223SWill Deacon { 19446c165223SWill Deacon void *addr = phys_to_virt(hyp_mem_base); 19456c165223SWill Deacon int ret; 19467c419937SMarc Zyngier 1947bfa79a80SQuentin Perret ret = create_hyp_mappings(addr, addr + hyp_mem_size, PAGE_HYP); 1948bfa79a80SQuentin Perret if (ret) 1949bfa79a80SQuentin Perret return ret; 1950bfa79a80SQuentin Perret 1951bfa79a80SQuentin Perret ret = do_pkvm_init(hyp_va_bits); 1952bfa79a80SQuentin Perret if (ret) 1953bfa79a80SQuentin Perret return ret; 1954bfa79a80SQuentin Perret 1955bfa79a80SQuentin Perret free_hyp_pgds(); 1956bfa79a80SQuentin Perret 1957bfa79a80SQuentin Perret return 0; 1958bfa79a80SQuentin Perret } 1959bfa79a80SQuentin Perret 196067d953d4SMarc Zyngier /* Inits Hyp-mode on all online CPUs */ 196153bf620aSSean Christopherson static int __init init_hyp_mode(void) 19629ed24f4bSMarc Zyngier { 1963bfa79a80SQuentin Perret u32 hyp_va_bits; 19649ed24f4bSMarc Zyngier int cpu; 1965bfa79a80SQuentin Perret int err = -ENOMEM; 1966bfa79a80SQuentin Perret 1967bfa79a80SQuentin Perret /* 1968bfa79a80SQuentin Perret * The protected Hyp-mode cannot be initialized if the memory pool 1969bfa79a80SQuentin Perret * allocation has failed. 1970bfa79a80SQuentin Perret */ 1971bfa79a80SQuentin Perret if (is_protected_kvm_enabled() && !hyp_mem_base) 1972bfa79a80SQuentin Perret goto out_err; 19739ed24f4bSMarc Zyngier 19749ed24f4bSMarc Zyngier /* 19759ed24f4bSMarc Zyngier * Allocate Hyp PGD and setup Hyp identity mapping 19769ed24f4bSMarc Zyngier */ 1977bfa79a80SQuentin Perret err = kvm_mmu_init(&hyp_va_bits); 19789ed24f4bSMarc Zyngier if (err) 19799ed24f4bSMarc Zyngier goto out_err; 19809ed24f4bSMarc Zyngier 19819ed24f4bSMarc Zyngier /* 19829ed24f4bSMarc Zyngier * Allocate stack pages for Hypervisor-mode 19839ed24f4bSMarc Zyngier */ 19849ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 19859ed24f4bSMarc Zyngier unsigned long stack_page; 19869ed24f4bSMarc Zyngier 19879ed24f4bSMarc Zyngier stack_page = __get_free_page(GFP_KERNEL); 19889ed24f4bSMarc Zyngier if (!stack_page) { 19899ed24f4bSMarc Zyngier err = -ENOMEM; 19909ed24f4bSMarc Zyngier goto out_err; 19919ed24f4bSMarc Zyngier } 19929ed24f4bSMarc Zyngier 19939ed24f4bSMarc Zyngier per_cpu(kvm_arm_hyp_stack_page, cpu) = stack_page; 19949ed24f4bSMarc Zyngier } 19959ed24f4bSMarc Zyngier 19969ed24f4bSMarc Zyngier /* 199730c95391SDavid Brazdil * Allocate and initialize pages for Hypervisor-mode percpu regions. 199830c95391SDavid Brazdil */ 199930c95391SDavid Brazdil for_each_possible_cpu(cpu) { 200030c95391SDavid Brazdil struct page *page; 200130c95391SDavid Brazdil void *page_addr; 200230c95391SDavid Brazdil 200330c95391SDavid Brazdil page = alloc_pages(GFP_KERNEL, nvhe_percpu_order()); 200430c95391SDavid Brazdil if (!page) { 200530c95391SDavid Brazdil err = -ENOMEM; 200630c95391SDavid Brazdil goto out_err; 200730c95391SDavid Brazdil } 200830c95391SDavid Brazdil 200930c95391SDavid Brazdil page_addr = page_address(page); 201030c95391SDavid Brazdil memcpy(page_addr, CHOOSE_NVHE_SYM(__per_cpu_start), nvhe_percpu_size()); 2011fe41a7f8SQuentin Perret kvm_nvhe_sym(kvm_arm_hyp_percpu_base)[cpu] = (unsigned long)page_addr; 201230c95391SDavid Brazdil } 201330c95391SDavid Brazdil 201430c95391SDavid Brazdil /* 20159ed24f4bSMarc Zyngier * Map the Hyp-code called directly from the host 20169ed24f4bSMarc Zyngier */ 20179ed24f4bSMarc Zyngier err = create_hyp_mappings(kvm_ksym_ref(__hyp_text_start), 20189ed24f4bSMarc Zyngier kvm_ksym_ref(__hyp_text_end), PAGE_HYP_EXEC); 20199ed24f4bSMarc Zyngier if (err) { 20209ed24f4bSMarc Zyngier kvm_err("Cannot map world-switch code\n"); 20219ed24f4bSMarc Zyngier goto out_err; 20229ed24f4bSMarc Zyngier } 20239ed24f4bSMarc Zyngier 202416174eeaSDavid Brazdil err = create_hyp_mappings(kvm_ksym_ref(__hyp_rodata_start), 202516174eeaSDavid Brazdil kvm_ksym_ref(__hyp_rodata_end), PAGE_HYP_RO); 20262d7bf218SDavid Brazdil if (err) { 202716174eeaSDavid Brazdil kvm_err("Cannot map .hyp.rodata section\n"); 20282d7bf218SDavid Brazdil goto out_err; 20292d7bf218SDavid Brazdil } 20302d7bf218SDavid Brazdil 20319ed24f4bSMarc Zyngier err = create_hyp_mappings(kvm_ksym_ref(__start_rodata), 20329ed24f4bSMarc Zyngier kvm_ksym_ref(__end_rodata), PAGE_HYP_RO); 20339ed24f4bSMarc Zyngier if (err) { 20349ed24f4bSMarc Zyngier kvm_err("Cannot map rodata section\n"); 20359ed24f4bSMarc Zyngier goto out_err; 20369ed24f4bSMarc Zyngier } 20379ed24f4bSMarc Zyngier 2038380e18adSQuentin Perret /* 2039380e18adSQuentin Perret * .hyp.bss is guaranteed to be placed at the beginning of the .bss 2040380e18adSQuentin Perret * section thanks to an assertion in the linker script. Map it RW and 2041380e18adSQuentin Perret * the rest of .bss RO. 2042380e18adSQuentin Perret */ 2043380e18adSQuentin Perret err = create_hyp_mappings(kvm_ksym_ref(__hyp_bss_start), 2044380e18adSQuentin Perret kvm_ksym_ref(__hyp_bss_end), PAGE_HYP); 2045380e18adSQuentin Perret if (err) { 2046380e18adSQuentin Perret kvm_err("Cannot map hyp bss section: %d\n", err); 2047380e18adSQuentin Perret goto out_err; 2048380e18adSQuentin Perret } 2049380e18adSQuentin Perret 2050380e18adSQuentin Perret err = create_hyp_mappings(kvm_ksym_ref(__hyp_bss_end), 20519ed24f4bSMarc Zyngier kvm_ksym_ref(__bss_stop), PAGE_HYP_RO); 20529ed24f4bSMarc Zyngier if (err) { 20539ed24f4bSMarc Zyngier kvm_err("Cannot map bss section\n"); 20549ed24f4bSMarc Zyngier goto out_err; 20559ed24f4bSMarc Zyngier } 20569ed24f4bSMarc Zyngier 20579ed24f4bSMarc Zyngier /* 20589ed24f4bSMarc Zyngier * Map the Hyp stack pages 20599ed24f4bSMarc Zyngier */ 20609ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 2061ce335431SKalesh Singh struct kvm_nvhe_init_params *params = per_cpu_ptr_nvhe_sym(kvm_init_params, cpu); 20629ed24f4bSMarc Zyngier char *stack_page = (char *)per_cpu(kvm_arm_hyp_stack_page, cpu); 2063ce335431SKalesh Singh unsigned long hyp_addr; 20649ed24f4bSMarc Zyngier 2065ce335431SKalesh Singh /* 2066ce335431SKalesh Singh * Allocate a contiguous HYP private VA range for the stack 2067ce335431SKalesh Singh * and guard page. The allocation is also aligned based on 2068ce335431SKalesh Singh * the order of its size. 2069ce335431SKalesh Singh */ 2070ce335431SKalesh Singh err = hyp_alloc_private_va_range(PAGE_SIZE * 2, &hyp_addr); 2071ce335431SKalesh Singh if (err) { 2072ce335431SKalesh Singh kvm_err("Cannot allocate hyp stack guard page\n"); 2073ce335431SKalesh Singh goto out_err; 2074ce335431SKalesh Singh } 2075ce335431SKalesh Singh 2076ce335431SKalesh Singh /* 2077ce335431SKalesh Singh * Since the stack grows downwards, map the stack to the page 2078ce335431SKalesh Singh * at the higher address and leave the lower guard page 2079ce335431SKalesh Singh * unbacked. 2080ce335431SKalesh Singh * 2081ce335431SKalesh Singh * Any valid stack address now has the PAGE_SHIFT bit as 1 2082ce335431SKalesh Singh * and addresses corresponding to the guard page have the 2083ce335431SKalesh Singh * PAGE_SHIFT bit as 0 - this is used for overflow detection. 2084ce335431SKalesh Singh */ 2085ce335431SKalesh Singh err = __create_hyp_mappings(hyp_addr + PAGE_SIZE, PAGE_SIZE, 2086ce335431SKalesh Singh __pa(stack_page), PAGE_HYP); 20879ed24f4bSMarc Zyngier if (err) { 20889ed24f4bSMarc Zyngier kvm_err("Cannot map hyp stack\n"); 20899ed24f4bSMarc Zyngier goto out_err; 20909ed24f4bSMarc Zyngier } 2091ce335431SKalesh Singh 2092ce335431SKalesh Singh /* 2093ce335431SKalesh Singh * Save the stack PA in nvhe_init_params. This will be needed 2094ce335431SKalesh Singh * to recreate the stack mapping in protected nVHE mode. 2095ce335431SKalesh Singh * __hyp_pa() won't do the right thing there, since the stack 2096ce335431SKalesh Singh * has been mapped in the flexible private VA space. 2097ce335431SKalesh Singh */ 2098ce335431SKalesh Singh params->stack_pa = __pa(stack_page); 2099ce335431SKalesh Singh 2100ce335431SKalesh Singh params->stack_hyp_va = hyp_addr + (2 * PAGE_SIZE); 21019ed24f4bSMarc Zyngier } 21029ed24f4bSMarc Zyngier 21039ed24f4bSMarc Zyngier for_each_possible_cpu(cpu) { 2104fe41a7f8SQuentin Perret char *percpu_begin = (char *)kvm_nvhe_sym(kvm_arm_hyp_percpu_base)[cpu]; 210530c95391SDavid Brazdil char *percpu_end = percpu_begin + nvhe_percpu_size(); 21069ed24f4bSMarc Zyngier 21079cc77581SQuentin Perret /* Map Hyp percpu pages */ 210830c95391SDavid Brazdil err = create_hyp_mappings(percpu_begin, percpu_end, PAGE_HYP); 21099ed24f4bSMarc Zyngier if (err) { 211030c95391SDavid Brazdil kvm_err("Cannot map hyp percpu region\n"); 21116e3bfbb2SAndrew Scull goto out_err; 21126e3bfbb2SAndrew Scull } 21139cc77581SQuentin Perret 21149cc77581SQuentin Perret /* Prepare the CPU initialization parameters */ 2115579d7ebeSRyan Roberts cpu_prepare_hyp_mode(cpu, hyp_va_bits); 21169ed24f4bSMarc Zyngier } 21179ed24f4bSMarc Zyngier 21186c165223SWill Deacon kvm_hyp_init_symbols(); 21196c165223SWill Deacon 2120eeeee719SDavid Brazdil if (is_protected_kvm_enabled()) { 212194f5e8a4SDavid Brazdil init_cpu_logical_map(); 212294f5e8a4SDavid Brazdil 212352b9e265SWang Wensheng if (!init_psci_relay()) { 212452b9e265SWang Wensheng err = -ENODEV; 2125eeeee719SDavid Brazdil goto out_err; 2126eeeee719SDavid Brazdil } 2127eeeee719SDavid Brazdil 2128bfa79a80SQuentin Perret err = kvm_hyp_init_protection(hyp_va_bits); 2129bfa79a80SQuentin Perret if (err) { 2130bfa79a80SQuentin Perret kvm_err("Failed to init hyp memory protection\n"); 2131bfa79a80SQuentin Perret goto out_err; 2132bfa79a80SQuentin Perret } 2133bfa79a80SQuentin Perret } 21349ed24f4bSMarc Zyngier 21359ed24f4bSMarc Zyngier return 0; 21369ed24f4bSMarc Zyngier 21379ed24f4bSMarc Zyngier out_err: 21389ed24f4bSMarc Zyngier teardown_hyp_mode(); 21399ed24f4bSMarc Zyngier kvm_err("error initializing Hyp mode: %d\n", err); 21409ed24f4bSMarc Zyngier return err; 21419ed24f4bSMarc Zyngier } 21429ed24f4bSMarc Zyngier 214353bf620aSSean Christopherson static void __init _kvm_host_prot_finalize(void *arg) 21441025c8c0SQuentin Perret { 21452f2e1a50SWill Deacon int *err = arg; 21462f2e1a50SWill Deacon 21472f2e1a50SWill Deacon if (WARN_ON(kvm_call_hyp_nvhe(__pkvm_prot_finalize))) 21482f2e1a50SWill Deacon WRITE_ONCE(*err, -EINVAL); 21492f2e1a50SWill Deacon } 21502f2e1a50SWill Deacon 215153bf620aSSean Christopherson static int __init pkvm_drop_host_privileges(void) 21522f2e1a50SWill Deacon { 21532f2e1a50SWill Deacon int ret = 0; 21542f2e1a50SWill Deacon 21552f2e1a50SWill Deacon /* 21562f2e1a50SWill Deacon * Flip the static key upfront as that may no longer be possible 21572f2e1a50SWill Deacon * once the host stage 2 is installed. 21582f2e1a50SWill Deacon */ 21592f2e1a50SWill Deacon static_branch_enable(&kvm_protected_mode_initialized); 21602f2e1a50SWill Deacon on_each_cpu(_kvm_host_prot_finalize, &ret, 1); 21612f2e1a50SWill Deacon return ret; 21621025c8c0SQuentin Perret } 21631025c8c0SQuentin Perret 216453bf620aSSean Christopherson static int __init finalize_hyp_mode(void) 2165bfa79a80SQuentin Perret { 2166bfa79a80SQuentin Perret if (!is_protected_kvm_enabled()) 2167bfa79a80SQuentin Perret return 0; 2168bfa79a80SQuentin Perret 216947e6223cSMarc Zyngier /* 217056961c63SQuentin Perret * Exclude HYP sections from kmemleak so that they don't get peeked 217156961c63SQuentin Perret * at, which would end badly once inaccessible. 217247e6223cSMarc Zyngier */ 217347e6223cSMarc Zyngier kmemleak_free_part(__hyp_bss_start, __hyp_bss_end - __hyp_bss_start); 2174522c9a64SZenghui Yu kmemleak_free_part_phys(hyp_mem_base, hyp_mem_size); 21752f2e1a50SWill Deacon return pkvm_drop_host_privileges(); 2176bfa79a80SQuentin Perret } 2177bfa79a80SQuentin Perret 21789ed24f4bSMarc Zyngier struct kvm_vcpu *kvm_mpidr_to_vcpu(struct kvm *kvm, unsigned long mpidr) 21799ed24f4bSMarc Zyngier { 21809ed24f4bSMarc Zyngier struct kvm_vcpu *vcpu; 218146808a4cSMarc Zyngier unsigned long i; 21829ed24f4bSMarc Zyngier 21839ed24f4bSMarc Zyngier mpidr &= MPIDR_HWID_BITMASK; 21849ed24f4bSMarc Zyngier kvm_for_each_vcpu(i, vcpu, kvm) { 21859ed24f4bSMarc Zyngier if (mpidr == kvm_vcpu_get_mpidr_aff(vcpu)) 21869ed24f4bSMarc Zyngier return vcpu; 21879ed24f4bSMarc Zyngier } 21889ed24f4bSMarc Zyngier return NULL; 21899ed24f4bSMarc Zyngier } 21909ed24f4bSMarc Zyngier 2191d663b8a2SPaolo Bonzini bool kvm_arch_irqchip_in_kernel(struct kvm *kvm) 2192d663b8a2SPaolo Bonzini { 2193d663b8a2SPaolo Bonzini return irqchip_in_kernel(kvm); 2194d663b8a2SPaolo Bonzini } 2195d663b8a2SPaolo Bonzini 21969ed24f4bSMarc Zyngier bool kvm_arch_has_irq_bypass(void) 21979ed24f4bSMarc Zyngier { 21989ed24f4bSMarc Zyngier return true; 21999ed24f4bSMarc Zyngier } 22009ed24f4bSMarc Zyngier 22019ed24f4bSMarc Zyngier int kvm_arch_irq_bypass_add_producer(struct irq_bypass_consumer *cons, 22029ed24f4bSMarc Zyngier struct irq_bypass_producer *prod) 22039ed24f4bSMarc Zyngier { 22049ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 22059ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 22069ed24f4bSMarc Zyngier 22079ed24f4bSMarc Zyngier return kvm_vgic_v4_set_forwarding(irqfd->kvm, prod->irq, 22089ed24f4bSMarc Zyngier &irqfd->irq_entry); 22099ed24f4bSMarc Zyngier } 22109ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_del_producer(struct irq_bypass_consumer *cons, 22119ed24f4bSMarc Zyngier struct irq_bypass_producer *prod) 22129ed24f4bSMarc Zyngier { 22139ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 22149ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 22159ed24f4bSMarc Zyngier 22169ed24f4bSMarc Zyngier kvm_vgic_v4_unset_forwarding(irqfd->kvm, prod->irq, 22179ed24f4bSMarc Zyngier &irqfd->irq_entry); 22189ed24f4bSMarc Zyngier } 22199ed24f4bSMarc Zyngier 22209ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_stop(struct irq_bypass_consumer *cons) 22219ed24f4bSMarc Zyngier { 22229ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 22239ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 22249ed24f4bSMarc Zyngier 22259ed24f4bSMarc Zyngier kvm_arm_halt_guest(irqfd->kvm); 22269ed24f4bSMarc Zyngier } 22279ed24f4bSMarc Zyngier 22289ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_start(struct irq_bypass_consumer *cons) 22299ed24f4bSMarc Zyngier { 22309ed24f4bSMarc Zyngier struct kvm_kernel_irqfd *irqfd = 22319ed24f4bSMarc Zyngier container_of(cons, struct kvm_kernel_irqfd, consumer); 22329ed24f4bSMarc Zyngier 22339ed24f4bSMarc Zyngier kvm_arm_resume_guest(irqfd->kvm); 22349ed24f4bSMarc Zyngier } 22359ed24f4bSMarc Zyngier 223667d953d4SMarc Zyngier /* Initialize Hyp-mode and memory mappings on all CPUs */ 223753bf620aSSean Christopherson static __init int kvm_arm_init(void) 22389ed24f4bSMarc Zyngier { 22399ed24f4bSMarc Zyngier int err; 22409ed24f4bSMarc Zyngier bool in_hyp_mode; 22419ed24f4bSMarc Zyngier 22429ed24f4bSMarc Zyngier if (!is_hyp_mode_available()) { 22439ed24f4bSMarc Zyngier kvm_info("HYP mode not available\n"); 22449ed24f4bSMarc Zyngier return -ENODEV; 22459ed24f4bSMarc Zyngier } 22469ed24f4bSMarc Zyngier 2247b6a68b97SMarc Zyngier if (kvm_get_mode() == KVM_MODE_NONE) { 2248b6a68b97SMarc Zyngier kvm_info("KVM disabled from command line\n"); 2249b6a68b97SMarc Zyngier return -ENODEV; 2250b6a68b97SMarc Zyngier } 2251b6a68b97SMarc Zyngier 2252f1f0c0cfSAlexandru Elisei err = kvm_sys_reg_table_init(); 2253f1f0c0cfSAlexandru Elisei if (err) { 2254f1f0c0cfSAlexandru Elisei kvm_info("Error initializing system register tables"); 2255f1f0c0cfSAlexandru Elisei return err; 2256f1f0c0cfSAlexandru Elisei } 2257f1f0c0cfSAlexandru Elisei 22589ed24f4bSMarc Zyngier in_hyp_mode = is_kernel_in_hyp_mode(); 22599ed24f4bSMarc Zyngier 226096d389caSRob Herring if (cpus_have_final_cap(ARM64_WORKAROUND_DEVICE_LOAD_ACQUIRE) || 226196d389caSRob Herring cpus_have_final_cap(ARM64_WORKAROUND_1508412)) 2262abf532ccSRob Herring kvm_info("Guests without required CPU erratum workarounds can deadlock system!\n" \ 2263abf532ccSRob Herring "Only trusted guests should be used on this system.\n"); 2264abf532ccSRob Herring 2265bf249d9eSAnshuman Khandual err = kvm_set_ipa_limit(); 22669ed24f4bSMarc Zyngier if (err) 22679ed24f4bSMarc Zyngier return err; 22689ed24f4bSMarc Zyngier 22699ed24f4bSMarc Zyngier err = kvm_arm_init_sve(); 22709ed24f4bSMarc Zyngier if (err) 22719ed24f4bSMarc Zyngier return err; 22729ed24f4bSMarc Zyngier 22733248136bSJulien Grall err = kvm_arm_vmid_alloc_init(); 22743248136bSJulien Grall if (err) { 22753248136bSJulien Grall kvm_err("Failed to initialize VMID allocator.\n"); 22763248136bSJulien Grall return err; 22773248136bSJulien Grall } 22783248136bSJulien Grall 22799ed24f4bSMarc Zyngier if (!in_hyp_mode) { 22809ed24f4bSMarc Zyngier err = init_hyp_mode(); 22819ed24f4bSMarc Zyngier if (err) 22829ed24f4bSMarc Zyngier goto out_err; 22839ed24f4bSMarc Zyngier } 22849ed24f4bSMarc Zyngier 2285b881cdceSWill Deacon err = kvm_init_vector_slots(); 2286b881cdceSWill Deacon if (err) { 2287b881cdceSWill Deacon kvm_err("Cannot initialise vector slots\n"); 22886baaeda8SSean Christopherson goto out_hyp; 2289b881cdceSWill Deacon } 2290b881cdceSWill Deacon 22919ed24f4bSMarc Zyngier err = init_subsystems(); 22929ed24f4bSMarc Zyngier if (err) 229378b3bf48SSean Christopherson goto out_hyp; 22949ed24f4bSMarc Zyngier 2295bfa79a80SQuentin Perret if (!in_hyp_mode) { 2296bfa79a80SQuentin Perret err = finalize_hyp_mode(); 2297bfa79a80SQuentin Perret if (err) { 2298bfa79a80SQuentin Perret kvm_err("Failed to finalize Hyp protection\n"); 22996baaeda8SSean Christopherson goto out_subs; 2300bfa79a80SQuentin Perret } 2301bfa79a80SQuentin Perret } 2302bfa79a80SQuentin Perret 2303f19f6644SDavid Brazdil if (is_protected_kvm_enabled()) { 23043eb681fbSDavid Brazdil kvm_info("Protected nVHE mode initialized successfully\n"); 2305f19f6644SDavid Brazdil } else if (in_hyp_mode) { 23069ed24f4bSMarc Zyngier kvm_info("VHE mode initialized successfully\n"); 2307f19f6644SDavid Brazdil } else { 23089ed24f4bSMarc Zyngier kvm_info("Hyp mode initialized successfully\n"); 2309f19f6644SDavid Brazdil } 23109ed24f4bSMarc Zyngier 23111dc0f02dSSean Christopherson /* 23121dc0f02dSSean Christopherson * FIXME: Do something reasonable if kvm_init() fails after pKVM 23131dc0f02dSSean Christopherson * hypervisor protection is finalized. 23141dc0f02dSSean Christopherson */ 231581a1cf9fSSean Christopherson err = kvm_init(sizeof(struct kvm_vcpu), 0, THIS_MODULE); 23161dc0f02dSSean Christopherson if (err) 23171dc0f02dSSean Christopherson goto out_subs; 23181dc0f02dSSean Christopherson 23199ed24f4bSMarc Zyngier return 0; 23209ed24f4bSMarc Zyngier 23216baaeda8SSean Christopherson out_subs: 232278b3bf48SSean Christopherson teardown_subsystems(); 23236baaeda8SSean Christopherson out_hyp: 23249ed24f4bSMarc Zyngier if (!in_hyp_mode) 23259ed24f4bSMarc Zyngier teardown_hyp_mode(); 23269ed24f4bSMarc Zyngier out_err: 23273248136bSJulien Grall kvm_arm_vmid_alloc_free(); 23289ed24f4bSMarc Zyngier return err; 23299ed24f4bSMarc Zyngier } 23309ed24f4bSMarc Zyngier 2331d8b369c4SDavid Brazdil static int __init early_kvm_mode_cfg(char *arg) 2332d8b369c4SDavid Brazdil { 2333d8b369c4SDavid Brazdil if (!arg) 2334d8b369c4SDavid Brazdil return -EINVAL; 2335d8b369c4SDavid Brazdil 2336b2a4d007SElliot Berman if (strcmp(arg, "none") == 0) { 2337b2a4d007SElliot Berman kvm_mode = KVM_MODE_NONE; 2338b2a4d007SElliot Berman return 0; 2339b2a4d007SElliot Berman } 2340b2a4d007SElliot Berman 2341b2a4d007SElliot Berman if (!is_hyp_mode_available()) { 2342b2a4d007SElliot Berman pr_warn_once("KVM is not available. Ignoring kvm-arm.mode\n"); 2343b2a4d007SElliot Berman return 0; 2344b2a4d007SElliot Berman } 2345b2a4d007SElliot Berman 2346d8b369c4SDavid Brazdil if (strcmp(arg, "protected") == 0) { 2347cde5042aSWill Deacon if (!is_kernel_in_hyp_mode()) 2348d8b369c4SDavid Brazdil kvm_mode = KVM_MODE_PROTECTED; 2349cde5042aSWill Deacon else 2350cde5042aSWill Deacon pr_warn_once("Protected KVM not available with VHE\n"); 2351cde5042aSWill Deacon 2352d8b369c4SDavid Brazdil return 0; 2353d8b369c4SDavid Brazdil } 2354d8b369c4SDavid Brazdil 2355b6a68b97SMarc Zyngier if (strcmp(arg, "nvhe") == 0 && !WARN_ON(is_kernel_in_hyp_mode())) { 2356b6a68b97SMarc Zyngier kvm_mode = KVM_MODE_DEFAULT; 23571945a067SMarc Zyngier return 0; 2358b6a68b97SMarc Zyngier } 2359b6a68b97SMarc Zyngier 2360675cabc8SJintack Lim if (strcmp(arg, "nested") == 0 && !WARN_ON(!is_kernel_in_hyp_mode())) { 2361675cabc8SJintack Lim kvm_mode = KVM_MODE_NV; 2362675cabc8SJintack Lim return 0; 2363675cabc8SJintack Lim } 2364675cabc8SJintack Lim 2365d8b369c4SDavid Brazdil return -EINVAL; 2366d8b369c4SDavid Brazdil } 2367d8b369c4SDavid Brazdil early_param("kvm-arm.mode", early_kvm_mode_cfg); 2368d8b369c4SDavid Brazdil 23693eb681fbSDavid Brazdil enum kvm_mode kvm_get_mode(void) 23703eb681fbSDavid Brazdil { 23713eb681fbSDavid Brazdil return kvm_mode; 23723eb681fbSDavid Brazdil } 23733eb681fbSDavid Brazdil 23741dc0f02dSSean Christopherson module_init(kvm_arm_init); 2375