xref: /openbmc/linux/arch/arm64/kvm/arm.c (revision bfbab445)
19ed24f4bSMarc Zyngier // SPDX-License-Identifier: GPL-2.0-only
29ed24f4bSMarc Zyngier /*
39ed24f4bSMarc Zyngier  * Copyright (C) 2012 - Virtual Open Systems and Columbia University
49ed24f4bSMarc Zyngier  * Author: Christoffer Dall <c.dall@virtualopensystems.com>
59ed24f4bSMarc Zyngier  */
69ed24f4bSMarc Zyngier 
79ed24f4bSMarc Zyngier #include <linux/bug.h>
89ed24f4bSMarc Zyngier #include <linux/cpu_pm.h>
96caa5812SOliver Upton #include <linux/entry-kvm.h>
109ed24f4bSMarc Zyngier #include <linux/errno.h>
119ed24f4bSMarc Zyngier #include <linux/err.h>
129ed24f4bSMarc Zyngier #include <linux/kvm_host.h>
139ed24f4bSMarc Zyngier #include <linux/list.h>
149ed24f4bSMarc Zyngier #include <linux/module.h>
159ed24f4bSMarc Zyngier #include <linux/vmalloc.h>
169ed24f4bSMarc Zyngier #include <linux/fs.h>
179ed24f4bSMarc Zyngier #include <linux/mman.h>
189ed24f4bSMarc Zyngier #include <linux/sched.h>
1947e6223cSMarc Zyngier #include <linux/kmemleak.h>
209ed24f4bSMarc Zyngier #include <linux/kvm.h>
219ed24f4bSMarc Zyngier #include <linux/kvm_irqfd.h>
229ed24f4bSMarc Zyngier #include <linux/irqbypass.h>
239ed24f4bSMarc Zyngier #include <linux/sched/stat.h>
24eeeee719SDavid Brazdil #include <linux/psci.h>
259ed24f4bSMarc Zyngier #include <trace/events/kvm.h>
269ed24f4bSMarc Zyngier 
279ed24f4bSMarc Zyngier #define CREATE_TRACE_POINTS
289ed24f4bSMarc Zyngier #include "trace_arm.h"
299ed24f4bSMarc Zyngier 
309ed24f4bSMarc Zyngier #include <linux/uaccess.h>
319ed24f4bSMarc Zyngier #include <asm/ptrace.h>
329ed24f4bSMarc Zyngier #include <asm/mman.h>
339ed24f4bSMarc Zyngier #include <asm/tlbflush.h>
349ed24f4bSMarc Zyngier #include <asm/cacheflush.h>
359ed24f4bSMarc Zyngier #include <asm/cpufeature.h>
369ed24f4bSMarc Zyngier #include <asm/virt.h>
379ed24f4bSMarc Zyngier #include <asm/kvm_arm.h>
389ed24f4bSMarc Zyngier #include <asm/kvm_asm.h>
399ed24f4bSMarc Zyngier #include <asm/kvm_mmu.h>
409ed24f4bSMarc Zyngier #include <asm/kvm_emulate.h>
419ed24f4bSMarc Zyngier #include <asm/sections.h>
429ed24f4bSMarc Zyngier 
439ed24f4bSMarc Zyngier #include <kvm/arm_hypercalls.h>
449ed24f4bSMarc Zyngier #include <kvm/arm_pmu.h>
459ed24f4bSMarc Zyngier #include <kvm/arm_psci.h>
469ed24f4bSMarc Zyngier 
47d8b369c4SDavid Brazdil static enum kvm_mode kvm_mode = KVM_MODE_DEFAULT;
48f19f6644SDavid Brazdil DEFINE_STATIC_KEY_FALSE(kvm_protected_mode_initialized);
49d8b369c4SDavid Brazdil 
5014ef9d04SMarc Zyngier DECLARE_KVM_HYP_PER_CPU(unsigned long, kvm_hyp_vector);
5114ef9d04SMarc Zyngier 
529ed24f4bSMarc Zyngier static DEFINE_PER_CPU(unsigned long, kvm_arm_hyp_stack_page);
5330c95391SDavid Brazdil unsigned long kvm_arm_hyp_percpu_base[NR_CPUS];
5463fec243SDavid Brazdil DECLARE_KVM_NVHE_PER_CPU(struct kvm_nvhe_init_params, kvm_init_params);
559ed24f4bSMarc Zyngier 
569ed24f4bSMarc Zyngier 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_arch_hardware_setup(void *opaque)
679ed24f4bSMarc Zyngier {
689ed24f4bSMarc Zyngier 	return 0;
699ed24f4bSMarc Zyngier }
709ed24f4bSMarc Zyngier 
719ed24f4bSMarc Zyngier int kvm_arch_check_processor_compat(void *opaque)
729ed24f4bSMarc Zyngier {
739ed24f4bSMarc Zyngier 	return 0;
749ed24f4bSMarc Zyngier }
759ed24f4bSMarc Zyngier 
769ed24f4bSMarc Zyngier int kvm_vm_ioctl_enable_cap(struct kvm *kvm,
779ed24f4bSMarc Zyngier 			    struct kvm_enable_cap *cap)
789ed24f4bSMarc Zyngier {
799ed24f4bSMarc Zyngier 	int r;
809ed24f4bSMarc Zyngier 
819ed24f4bSMarc Zyngier 	if (cap->flags)
829ed24f4bSMarc Zyngier 		return -EINVAL;
839ed24f4bSMarc Zyngier 
849ed24f4bSMarc Zyngier 	switch (cap->cap) {
859ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_NISV_TO_USER:
869ed24f4bSMarc Zyngier 		r = 0;
8706394531SMarc Zyngier 		set_bit(KVM_ARCH_FLAG_RETURN_NISV_IO_ABORT_TO_USER,
8806394531SMarc Zyngier 			&kvm->arch.flags);
899ed24f4bSMarc Zyngier 		break;
90673638f4SSteven Price 	case KVM_CAP_ARM_MTE:
91c4d7c518SSteven Price 		mutex_lock(&kvm->lock);
92c4d7c518SSteven Price 		if (!system_supports_mte() || kvm->created_vcpus) {
93c4d7c518SSteven Price 			r = -EINVAL;
94c4d7c518SSteven Price 		} else {
95673638f4SSteven Price 			r = 0;
9606394531SMarc Zyngier 			set_bit(KVM_ARCH_FLAG_MTE_ENABLED, &kvm->arch.flags);
97c4d7c518SSteven Price 		}
98c4d7c518SSteven Price 		mutex_unlock(&kvm->lock);
99673638f4SSteven Price 		break;
100*bfbab445SOliver Upton 	case KVM_CAP_ARM_SYSTEM_SUSPEND:
101*bfbab445SOliver Upton 		r = 0;
102*bfbab445SOliver Upton 		set_bit(KVM_ARCH_FLAG_SYSTEM_SUSPEND_ENABLED, &kvm->arch.flags);
103*bfbab445SOliver Upton 		break;
1049ed24f4bSMarc Zyngier 	default:
1059ed24f4bSMarc Zyngier 		r = -EINVAL;
1069ed24f4bSMarc Zyngier 		break;
1079ed24f4bSMarc Zyngier 	}
1089ed24f4bSMarc Zyngier 
1099ed24f4bSMarc Zyngier 	return r;
1109ed24f4bSMarc Zyngier }
1119ed24f4bSMarc Zyngier 
1125107000fSMarc Zyngier static int kvm_arm_default_max_vcpus(void)
1135107000fSMarc Zyngier {
1145107000fSMarc Zyngier 	return vgic_present ? kvm_vgic_get_max_vcpus() : KVM_MAX_VCPUS;
1155107000fSMarc Zyngier }
1165107000fSMarc Zyngier 
1174f1df628SMarc Zyngier static void set_default_spectre(struct kvm *kvm)
11823711a5eSMarc Zyngier {
11923711a5eSMarc Zyngier 	/*
12023711a5eSMarc Zyngier 	 * The default is to expose CSV2 == 1 if the HW isn't affected.
12123711a5eSMarc Zyngier 	 * Although this is a per-CPU feature, we make it global because
12223711a5eSMarc Zyngier 	 * asymmetric systems are just a nuisance.
12323711a5eSMarc Zyngier 	 *
12423711a5eSMarc Zyngier 	 * Userspace can override this as long as it doesn't promise
12523711a5eSMarc Zyngier 	 * the impossible.
12623711a5eSMarc Zyngier 	 */
12723711a5eSMarc Zyngier 	if (arm64_get_spectre_v2_state() == SPECTRE_UNAFFECTED)
12823711a5eSMarc Zyngier 		kvm->arch.pfr0_csv2 = 1;
1294f1df628SMarc Zyngier 	if (arm64_get_meltdown_state() == SPECTRE_UNAFFECTED)
1304f1df628SMarc Zyngier 		kvm->arch.pfr0_csv3 = 1;
13123711a5eSMarc Zyngier }
13223711a5eSMarc Zyngier 
1339ed24f4bSMarc Zyngier /**
1349ed24f4bSMarc Zyngier  * kvm_arch_init_vm - initializes a VM data structure
1359ed24f4bSMarc Zyngier  * @kvm:	pointer to the KVM struct
1369ed24f4bSMarc Zyngier  */
1379ed24f4bSMarc Zyngier int kvm_arch_init_vm(struct kvm *kvm, unsigned long type)
1389ed24f4bSMarc Zyngier {
139a0e50aa3SChristoffer Dall 	int ret;
1409ed24f4bSMarc Zyngier 
1419ed24f4bSMarc Zyngier 	ret = kvm_arm_setup_stage2(kvm, type);
1429ed24f4bSMarc Zyngier 	if (ret)
1439ed24f4bSMarc Zyngier 		return ret;
1449ed24f4bSMarc Zyngier 
145a0e50aa3SChristoffer Dall 	ret = kvm_init_stage2_mmu(kvm, &kvm->arch.mmu);
1469ed24f4bSMarc Zyngier 	if (ret)
147a0e50aa3SChristoffer Dall 		return ret;
1489ed24f4bSMarc Zyngier 
1493f868e14SQuentin Perret 	ret = kvm_share_hyp(kvm, kvm + 1);
1509ed24f4bSMarc Zyngier 	if (ret)
1519ed24f4bSMarc Zyngier 		goto out_free_stage2_pgd;
1529ed24f4bSMarc Zyngier 
153583cda1bSAlexandru Elisei 	if (!zalloc_cpumask_var(&kvm->arch.supported_cpus, GFP_KERNEL))
154583cda1bSAlexandru Elisei 		goto out_free_stage2_pgd;
155583cda1bSAlexandru Elisei 	cpumask_copy(kvm->arch.supported_cpus, cpu_possible_mask);
156583cda1bSAlexandru Elisei 
1579ed24f4bSMarc Zyngier 	kvm_vgic_early_init(kvm);
1589ed24f4bSMarc Zyngier 
1599ed24f4bSMarc Zyngier 	/* The maximum number of VCPUs is limited by the host's GIC model */
1605107000fSMarc Zyngier 	kvm->arch.max_vcpus = kvm_arm_default_max_vcpus();
1619ed24f4bSMarc Zyngier 
1624f1df628SMarc Zyngier 	set_default_spectre(kvm);
16323711a5eSMarc Zyngier 
1649ed24f4bSMarc Zyngier 	return ret;
1659ed24f4bSMarc Zyngier out_free_stage2_pgd:
166a0e50aa3SChristoffer Dall 	kvm_free_stage2_pgd(&kvm->arch.mmu);
1679ed24f4bSMarc Zyngier 	return ret;
1689ed24f4bSMarc Zyngier }
1699ed24f4bSMarc Zyngier 
1709ed24f4bSMarc Zyngier vm_fault_t kvm_arch_vcpu_fault(struct kvm_vcpu *vcpu, struct vm_fault *vmf)
1719ed24f4bSMarc Zyngier {
1729ed24f4bSMarc Zyngier 	return VM_FAULT_SIGBUS;
1739ed24f4bSMarc Zyngier }
1749ed24f4bSMarc Zyngier 
1759ed24f4bSMarc Zyngier 
1769ed24f4bSMarc Zyngier /**
1779ed24f4bSMarc Zyngier  * kvm_arch_destroy_vm - destroy the VM data structure
1789ed24f4bSMarc Zyngier  * @kvm:	pointer to the KVM struct
1799ed24f4bSMarc Zyngier  */
1809ed24f4bSMarc Zyngier void kvm_arch_destroy_vm(struct kvm *kvm)
1819ed24f4bSMarc Zyngier {
182d7eec236SMarc Zyngier 	bitmap_free(kvm->arch.pmu_filter);
183583cda1bSAlexandru Elisei 	free_cpumask_var(kvm->arch.supported_cpus);
184d7eec236SMarc Zyngier 
1859ed24f4bSMarc Zyngier 	kvm_vgic_destroy(kvm);
1869ed24f4bSMarc Zyngier 
18727592ae8SMarc Zyngier 	kvm_destroy_vcpus(kvm);
18852b28657SQuentin Perret 
18952b28657SQuentin Perret 	kvm_unshare_hyp(kvm, kvm + 1);
1909ed24f4bSMarc Zyngier }
1919ed24f4bSMarc Zyngier 
1929ed24f4bSMarc Zyngier int kvm_vm_ioctl_check_extension(struct kvm *kvm, long ext)
1939ed24f4bSMarc Zyngier {
1949ed24f4bSMarc Zyngier 	int r;
1959ed24f4bSMarc Zyngier 	switch (ext) {
1969ed24f4bSMarc Zyngier 	case KVM_CAP_IRQCHIP:
1979ed24f4bSMarc Zyngier 		r = vgic_present;
1989ed24f4bSMarc Zyngier 		break;
1999ed24f4bSMarc Zyngier 	case KVM_CAP_IOEVENTFD:
2009ed24f4bSMarc Zyngier 	case KVM_CAP_DEVICE_CTRL:
2019ed24f4bSMarc Zyngier 	case KVM_CAP_USER_MEMORY:
2029ed24f4bSMarc Zyngier 	case KVM_CAP_SYNC_MMU:
2039ed24f4bSMarc Zyngier 	case KVM_CAP_DESTROY_MEMORY_REGION_WORKS:
2049ed24f4bSMarc Zyngier 	case KVM_CAP_ONE_REG:
2059ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_PSCI:
2069ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_PSCI_0_2:
2079ed24f4bSMarc Zyngier 	case KVM_CAP_READONLY_MEM:
2089ed24f4bSMarc Zyngier 	case KVM_CAP_MP_STATE:
2099ed24f4bSMarc Zyngier 	case KVM_CAP_IMMEDIATE_EXIT:
2109ed24f4bSMarc Zyngier 	case KVM_CAP_VCPU_EVENTS:
2119ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_IRQ_LINE_LAYOUT_2:
2129ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_NISV_TO_USER:
2139ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_INJECT_EXT_DABT:
21436fb4cd5SWill Deacon 	case KVM_CAP_SET_GUEST_DEBUG:
21536fb4cd5SWill Deacon 	case KVM_CAP_VCPU_ATTRIBUTES:
2163bf72569SJianyong Wu 	case KVM_CAP_PTP_KVM:
217*bfbab445SOliver Upton 	case KVM_CAP_ARM_SYSTEM_SUSPEND:
2189ed24f4bSMarc Zyngier 		r = 1;
2199ed24f4bSMarc Zyngier 		break;
220fa18aca9SMaxim Levitsky 	case KVM_CAP_SET_GUEST_DEBUG2:
221fa18aca9SMaxim Levitsky 		return KVM_GUESTDBG_VALID_MASK;
2229ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_SET_DEVICE_ADDR:
2239ed24f4bSMarc Zyngier 		r = 1;
2249ed24f4bSMarc Zyngier 		break;
2259ed24f4bSMarc Zyngier 	case KVM_CAP_NR_VCPUS:
226f60a00d7SVitaly Kuznetsov 		/*
227f60a00d7SVitaly Kuznetsov 		 * ARM64 treats KVM_CAP_NR_CPUS differently from all other
228f60a00d7SVitaly Kuznetsov 		 * architectures, as it does not always bound it to
229f60a00d7SVitaly Kuznetsov 		 * KVM_CAP_MAX_VCPUS. It should not matter much because
230f60a00d7SVitaly Kuznetsov 		 * this is just an advisory value.
231f60a00d7SVitaly Kuznetsov 		 */
232f60a00d7SVitaly Kuznetsov 		r = min_t(unsigned int, num_online_cpus(),
233f60a00d7SVitaly Kuznetsov 			  kvm_arm_default_max_vcpus());
2349ed24f4bSMarc Zyngier 		break;
2359ed24f4bSMarc Zyngier 	case KVM_CAP_MAX_VCPUS:
2369ed24f4bSMarc Zyngier 	case KVM_CAP_MAX_VCPU_ID:
2375107000fSMarc Zyngier 		if (kvm)
2385107000fSMarc Zyngier 			r = kvm->arch.max_vcpus;
2395107000fSMarc Zyngier 		else
2405107000fSMarc Zyngier 			r = kvm_arm_default_max_vcpus();
2419ed24f4bSMarc Zyngier 		break;
2429ed24f4bSMarc Zyngier 	case KVM_CAP_MSI_DEVID:
2439ed24f4bSMarc Zyngier 		if (!kvm)
2449ed24f4bSMarc Zyngier 			r = -EINVAL;
2459ed24f4bSMarc Zyngier 		else
2469ed24f4bSMarc Zyngier 			r = kvm->arch.vgic.msis_require_devid;
2479ed24f4bSMarc Zyngier 		break;
2489ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_USER_IRQ:
2499ed24f4bSMarc Zyngier 		/*
2509ed24f4bSMarc Zyngier 		 * 1: EL1_VTIMER, EL1_PTIMER, and PMU.
2519ed24f4bSMarc Zyngier 		 * (bump this number if adding more devices)
2529ed24f4bSMarc Zyngier 		 */
2539ed24f4bSMarc Zyngier 		r = 1;
2549ed24f4bSMarc Zyngier 		break;
255673638f4SSteven Price 	case KVM_CAP_ARM_MTE:
256673638f4SSteven Price 		r = system_supports_mte();
257673638f4SSteven Price 		break;
258004a0124SAndrew Jones 	case KVM_CAP_STEAL_TIME:
259004a0124SAndrew Jones 		r = kvm_arm_pvtime_supported();
260004a0124SAndrew Jones 		break;
26136fb4cd5SWill Deacon 	case KVM_CAP_ARM_EL1_32BIT:
26236fb4cd5SWill Deacon 		r = cpus_have_const_cap(ARM64_HAS_32BIT_EL1);
2639ed24f4bSMarc Zyngier 		break;
26436fb4cd5SWill Deacon 	case KVM_CAP_GUEST_DEBUG_HW_BPS:
26536fb4cd5SWill Deacon 		r = get_num_brps();
26636fb4cd5SWill Deacon 		break;
26736fb4cd5SWill Deacon 	case KVM_CAP_GUEST_DEBUG_HW_WPS:
26836fb4cd5SWill Deacon 		r = get_num_wrps();
26936fb4cd5SWill Deacon 		break;
27036fb4cd5SWill Deacon 	case KVM_CAP_ARM_PMU_V3:
27136fb4cd5SWill Deacon 		r = kvm_arm_support_pmu_v3();
27236fb4cd5SWill Deacon 		break;
27336fb4cd5SWill Deacon 	case KVM_CAP_ARM_INJECT_SERROR_ESR:
27436fb4cd5SWill Deacon 		r = cpus_have_const_cap(ARM64_HAS_RAS_EXTN);
27536fb4cd5SWill Deacon 		break;
27636fb4cd5SWill Deacon 	case KVM_CAP_ARM_VM_IPA_SIZE:
27736fb4cd5SWill Deacon 		r = get_kvm_ipa_limit();
27836fb4cd5SWill Deacon 		break;
27936fb4cd5SWill Deacon 	case KVM_CAP_ARM_SVE:
28036fb4cd5SWill Deacon 		r = system_supports_sve();
28136fb4cd5SWill Deacon 		break;
28236fb4cd5SWill Deacon 	case KVM_CAP_ARM_PTRAUTH_ADDRESS:
28336fb4cd5SWill Deacon 	case KVM_CAP_ARM_PTRAUTH_GENERIC:
28436fb4cd5SWill Deacon 		r = system_has_full_ptr_auth();
28536fb4cd5SWill Deacon 		break;
28636fb4cd5SWill Deacon 	default:
28736fb4cd5SWill Deacon 		r = 0;
2889ed24f4bSMarc Zyngier 	}
28936fb4cd5SWill Deacon 
2909ed24f4bSMarc Zyngier 	return r;
2919ed24f4bSMarc Zyngier }
2929ed24f4bSMarc Zyngier 
2939ed24f4bSMarc Zyngier long kvm_arch_dev_ioctl(struct file *filp,
2949ed24f4bSMarc Zyngier 			unsigned int ioctl, unsigned long arg)
2959ed24f4bSMarc Zyngier {
2969ed24f4bSMarc Zyngier 	return -EINVAL;
2979ed24f4bSMarc Zyngier }
2989ed24f4bSMarc Zyngier 
2999ed24f4bSMarc Zyngier struct kvm *kvm_arch_alloc_vm(void)
3009ed24f4bSMarc Zyngier {
301115bae92SJia He 	size_t sz = sizeof(struct kvm);
3029ed24f4bSMarc Zyngier 
303115bae92SJia He 	if (!has_vhe())
304115bae92SJia He 		return kzalloc(sz, GFP_KERNEL_ACCOUNT);
305115bae92SJia He 
306115bae92SJia He 	return __vmalloc(sz, GFP_KERNEL_ACCOUNT | __GFP_HIGHMEM | __GFP_ZERO);
3079ed24f4bSMarc Zyngier }
3089ed24f4bSMarc Zyngier 
3099ed24f4bSMarc Zyngier int kvm_arch_vcpu_precreate(struct kvm *kvm, unsigned int id)
3109ed24f4bSMarc Zyngier {
3119ed24f4bSMarc Zyngier 	if (irqchip_in_kernel(kvm) && vgic_initialized(kvm))
3129ed24f4bSMarc Zyngier 		return -EBUSY;
3139ed24f4bSMarc Zyngier 
3149ed24f4bSMarc Zyngier 	if (id >= kvm->arch.max_vcpus)
3159ed24f4bSMarc Zyngier 		return -EINVAL;
3169ed24f4bSMarc Zyngier 
3179ed24f4bSMarc Zyngier 	return 0;
3189ed24f4bSMarc Zyngier }
3199ed24f4bSMarc Zyngier 
3209ed24f4bSMarc Zyngier int kvm_arch_vcpu_create(struct kvm_vcpu *vcpu)
3219ed24f4bSMarc Zyngier {
3229ed24f4bSMarc Zyngier 	int err;
3239ed24f4bSMarc Zyngier 
3249ed24f4bSMarc Zyngier 	/* Force users to call KVM_ARM_VCPU_INIT */
3259ed24f4bSMarc Zyngier 	vcpu->arch.target = -1;
3269ed24f4bSMarc Zyngier 	bitmap_zero(vcpu->arch.features, KVM_VCPU_MAX_FEATURES);
3279ed24f4bSMarc Zyngier 
328e539451bSSean Christopherson 	vcpu->arch.mmu_page_cache.gfp_zero = __GFP_ZERO;
329e539451bSSean Christopherson 
3309ed24f4bSMarc Zyngier 	/* Set up the timer */
3319ed24f4bSMarc Zyngier 	kvm_timer_vcpu_init(vcpu);
3329ed24f4bSMarc Zyngier 
3339ed24f4bSMarc Zyngier 	kvm_pmu_vcpu_init(vcpu);
3349ed24f4bSMarc Zyngier 
3359ed24f4bSMarc Zyngier 	kvm_arm_reset_debug_ptr(vcpu);
3369ed24f4bSMarc Zyngier 
3379ed24f4bSMarc Zyngier 	kvm_arm_pvtime_vcpu_init(&vcpu->arch);
3389ed24f4bSMarc Zyngier 
339a0e50aa3SChristoffer Dall 	vcpu->arch.hw_mmu = &vcpu->kvm->arch.mmu;
340a0e50aa3SChristoffer Dall 
3419ed24f4bSMarc Zyngier 	err = kvm_vgic_vcpu_init(vcpu);
3429ed24f4bSMarc Zyngier 	if (err)
3439ed24f4bSMarc Zyngier 		return err;
3449ed24f4bSMarc Zyngier 
3453f868e14SQuentin Perret 	return kvm_share_hyp(vcpu, vcpu + 1);
3469ed24f4bSMarc Zyngier }
3479ed24f4bSMarc Zyngier 
3489ed24f4bSMarc Zyngier void kvm_arch_vcpu_postcreate(struct kvm_vcpu *vcpu)
3499ed24f4bSMarc Zyngier {
3509ed24f4bSMarc Zyngier }
3519ed24f4bSMarc Zyngier 
3529ed24f4bSMarc Zyngier void kvm_arch_vcpu_destroy(struct kvm_vcpu *vcpu)
3539ed24f4bSMarc Zyngier {
354cc5705fbSMarc Zyngier 	if (vcpu_has_run_once(vcpu) && unlikely(!irqchip_in_kernel(vcpu->kvm)))
3559ed24f4bSMarc Zyngier 		static_branch_dec(&userspace_irqchip_in_use);
3569ed24f4bSMarc Zyngier 
3579af3e08bSWill Deacon 	kvm_mmu_free_memory_cache(&vcpu->arch.mmu_page_cache);
3589ed24f4bSMarc Zyngier 	kvm_timer_vcpu_terminate(vcpu);
3599ed24f4bSMarc Zyngier 	kvm_pmu_vcpu_destroy(vcpu);
3609ed24f4bSMarc Zyngier 
3619ed24f4bSMarc Zyngier 	kvm_arm_vcpu_destroy(vcpu);
3629ed24f4bSMarc Zyngier }
3639ed24f4bSMarc Zyngier 
3649ed24f4bSMarc Zyngier int kvm_cpu_has_pending_timer(struct kvm_vcpu *vcpu)
3659ed24f4bSMarc Zyngier {
3669ed24f4bSMarc Zyngier 	return kvm_timer_is_pending(vcpu);
3679ed24f4bSMarc Zyngier }
3689ed24f4bSMarc Zyngier 
3699ed24f4bSMarc Zyngier void kvm_arch_vcpu_blocking(struct kvm_vcpu *vcpu)
3709ed24f4bSMarc Zyngier {
3716109c5a6SSean Christopherson 
3729ed24f4bSMarc Zyngier }
3739ed24f4bSMarc Zyngier 
3749ed24f4bSMarc Zyngier void kvm_arch_vcpu_unblocking(struct kvm_vcpu *vcpu)
3759ed24f4bSMarc Zyngier {
3766109c5a6SSean Christopherson 
3779ed24f4bSMarc Zyngier }
3789ed24f4bSMarc Zyngier 
3799ed24f4bSMarc Zyngier void kvm_arch_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
3809ed24f4bSMarc Zyngier {
381a0e50aa3SChristoffer Dall 	struct kvm_s2_mmu *mmu;
3829ed24f4bSMarc Zyngier 	int *last_ran;
3839ed24f4bSMarc Zyngier 
384a0e50aa3SChristoffer Dall 	mmu = vcpu->arch.hw_mmu;
385a0e50aa3SChristoffer Dall 	last_ran = this_cpu_ptr(mmu->last_vcpu_ran);
3869ed24f4bSMarc Zyngier 
3879ed24f4bSMarc Zyngier 	/*
38801dc9262SMarc Zyngier 	 * We guarantee that both TLBs and I-cache are private to each
38901dc9262SMarc Zyngier 	 * vcpu. If detecting that a vcpu from the same VM has
39001dc9262SMarc Zyngier 	 * previously run on the same physical CPU, call into the
39101dc9262SMarc Zyngier 	 * hypervisor code to nuke the relevant contexts.
39201dc9262SMarc Zyngier 	 *
3939ed24f4bSMarc Zyngier 	 * We might get preempted before the vCPU actually runs, but
3949ed24f4bSMarc Zyngier 	 * over-invalidation doesn't affect correctness.
3959ed24f4bSMarc Zyngier 	 */
3969ed24f4bSMarc Zyngier 	if (*last_ran != vcpu->vcpu_id) {
39701dc9262SMarc Zyngier 		kvm_call_hyp(__kvm_flush_cpu_context, mmu);
3989ed24f4bSMarc Zyngier 		*last_ran = vcpu->vcpu_id;
3999ed24f4bSMarc Zyngier 	}
4009ed24f4bSMarc Zyngier 
4019ed24f4bSMarc Zyngier 	vcpu->cpu = cpu;
4029ed24f4bSMarc Zyngier 
4039ed24f4bSMarc Zyngier 	kvm_vgic_load(vcpu);
4049ed24f4bSMarc Zyngier 	kvm_timer_vcpu_load(vcpu);
40513aeb9b4SDavid Brazdil 	if (has_vhe())
40613aeb9b4SDavid Brazdil 		kvm_vcpu_load_sysregs_vhe(vcpu);
4079ed24f4bSMarc Zyngier 	kvm_arch_vcpu_load_fp(vcpu);
4089ed24f4bSMarc Zyngier 	kvm_vcpu_pmu_restore_guest(vcpu);
4099ed24f4bSMarc Zyngier 	if (kvm_arm_is_pvtime_enabled(&vcpu->arch))
4109ed24f4bSMarc Zyngier 		kvm_make_request(KVM_REQ_RECORD_STEAL, vcpu);
4119ed24f4bSMarc Zyngier 
4129ed24f4bSMarc Zyngier 	if (single_task_running())
4139ed24f4bSMarc Zyngier 		vcpu_clear_wfx_traps(vcpu);
4149ed24f4bSMarc Zyngier 	else
4159ed24f4bSMarc Zyngier 		vcpu_set_wfx_traps(vcpu);
4169ed24f4bSMarc Zyngier 
41729eb5a3cSMarc Zyngier 	if (vcpu_has_ptrauth(vcpu))
418ef3e40a7SMarc Zyngier 		vcpu_ptrauth_disable(vcpu);
419d2602bb4SSuzuki K Poulose 	kvm_arch_vcpu_load_debug_state_flags(vcpu);
420583cda1bSAlexandru Elisei 
421583cda1bSAlexandru Elisei 	if (!cpumask_test_cpu(smp_processor_id(), vcpu->kvm->arch.supported_cpus))
422583cda1bSAlexandru Elisei 		vcpu_set_on_unsupported_cpu(vcpu);
4239ed24f4bSMarc Zyngier }
4249ed24f4bSMarc Zyngier 
4259ed24f4bSMarc Zyngier void kvm_arch_vcpu_put(struct kvm_vcpu *vcpu)
4269ed24f4bSMarc Zyngier {
427d2602bb4SSuzuki K Poulose 	kvm_arch_vcpu_put_debug_state_flags(vcpu);
4289ed24f4bSMarc Zyngier 	kvm_arch_vcpu_put_fp(vcpu);
42913aeb9b4SDavid Brazdil 	if (has_vhe())
43013aeb9b4SDavid Brazdil 		kvm_vcpu_put_sysregs_vhe(vcpu);
4319ed24f4bSMarc Zyngier 	kvm_timer_vcpu_put(vcpu);
4329ed24f4bSMarc Zyngier 	kvm_vgic_put(vcpu);
4339ed24f4bSMarc Zyngier 	kvm_vcpu_pmu_restore_host(vcpu);
434100b4f09SShameer Kolothum 	kvm_arm_vmid_clear_active();
4359ed24f4bSMarc Zyngier 
436583cda1bSAlexandru Elisei 	vcpu_clear_on_unsupported_cpu(vcpu);
4379ed24f4bSMarc Zyngier 	vcpu->cpu = -1;
4389ed24f4bSMarc Zyngier }
4399ed24f4bSMarc Zyngier 
4401e579429SOliver Upton void kvm_arm_vcpu_power_off(struct kvm_vcpu *vcpu)
4419ed24f4bSMarc Zyngier {
442b171f9bbSOliver Upton 	vcpu->arch.mp_state.mp_state = KVM_MP_STATE_STOPPED;
4439ed24f4bSMarc Zyngier 	kvm_make_request(KVM_REQ_SLEEP, vcpu);
4449ed24f4bSMarc Zyngier 	kvm_vcpu_kick(vcpu);
4459ed24f4bSMarc Zyngier }
4469ed24f4bSMarc Zyngier 
447b171f9bbSOliver Upton bool kvm_arm_vcpu_stopped(struct kvm_vcpu *vcpu)
448b171f9bbSOliver Upton {
449b171f9bbSOliver Upton 	return vcpu->arch.mp_state.mp_state == KVM_MP_STATE_STOPPED;
450b171f9bbSOliver Upton }
451b171f9bbSOliver Upton 
4527b33a09dSOliver Upton static void kvm_arm_vcpu_suspend(struct kvm_vcpu *vcpu)
4537b33a09dSOliver Upton {
4547b33a09dSOliver Upton 	vcpu->arch.mp_state.mp_state = KVM_MP_STATE_SUSPENDED;
4557b33a09dSOliver Upton 	kvm_make_request(KVM_REQ_SUSPEND, vcpu);
4567b33a09dSOliver Upton 	kvm_vcpu_kick(vcpu);
4577b33a09dSOliver Upton }
4587b33a09dSOliver Upton 
4597b33a09dSOliver Upton static bool kvm_arm_vcpu_suspended(struct kvm_vcpu *vcpu)
4607b33a09dSOliver Upton {
4617b33a09dSOliver Upton 	return vcpu->arch.mp_state.mp_state == KVM_MP_STATE_SUSPENDED;
4627b33a09dSOliver Upton }
4637b33a09dSOliver Upton 
4649ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_get_mpstate(struct kvm_vcpu *vcpu,
4659ed24f4bSMarc Zyngier 				    struct kvm_mp_state *mp_state)
4669ed24f4bSMarc Zyngier {
467b171f9bbSOliver Upton 	*mp_state = vcpu->arch.mp_state;
4689ed24f4bSMarc Zyngier 
4699ed24f4bSMarc Zyngier 	return 0;
4709ed24f4bSMarc Zyngier }
4719ed24f4bSMarc Zyngier 
4729ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_set_mpstate(struct kvm_vcpu *vcpu,
4739ed24f4bSMarc Zyngier 				    struct kvm_mp_state *mp_state)
4749ed24f4bSMarc Zyngier {
4759ed24f4bSMarc Zyngier 	int ret = 0;
4769ed24f4bSMarc Zyngier 
4779ed24f4bSMarc Zyngier 	switch (mp_state->mp_state) {
4789ed24f4bSMarc Zyngier 	case KVM_MP_STATE_RUNNABLE:
479b171f9bbSOliver Upton 		vcpu->arch.mp_state = *mp_state;
4809ed24f4bSMarc Zyngier 		break;
4819ed24f4bSMarc Zyngier 	case KVM_MP_STATE_STOPPED:
4821e579429SOliver Upton 		kvm_arm_vcpu_power_off(vcpu);
4839ed24f4bSMarc Zyngier 		break;
4847b33a09dSOliver Upton 	case KVM_MP_STATE_SUSPENDED:
4857b33a09dSOliver Upton 		kvm_arm_vcpu_suspend(vcpu);
4867b33a09dSOliver Upton 		break;
4879ed24f4bSMarc Zyngier 	default:
4889ed24f4bSMarc Zyngier 		ret = -EINVAL;
4899ed24f4bSMarc Zyngier 	}
4909ed24f4bSMarc Zyngier 
4919ed24f4bSMarc Zyngier 	return ret;
4929ed24f4bSMarc Zyngier }
4939ed24f4bSMarc Zyngier 
4949ed24f4bSMarc Zyngier /**
4959ed24f4bSMarc Zyngier  * kvm_arch_vcpu_runnable - determine if the vcpu can be scheduled
4969ed24f4bSMarc Zyngier  * @v:		The VCPU pointer
4979ed24f4bSMarc Zyngier  *
4989ed24f4bSMarc Zyngier  * If the guest CPU is not waiting for interrupts or an interrupt line is
4999ed24f4bSMarc Zyngier  * asserted, the CPU is by definition runnable.
5009ed24f4bSMarc Zyngier  */
5019ed24f4bSMarc Zyngier int kvm_arch_vcpu_runnable(struct kvm_vcpu *v)
5029ed24f4bSMarc Zyngier {
5039ed24f4bSMarc Zyngier 	bool irq_lines = *vcpu_hcr(v) & (HCR_VI | HCR_VF);
5049ed24f4bSMarc Zyngier 	return ((irq_lines || kvm_vgic_vcpu_pending_irq(v))
505b171f9bbSOliver Upton 		&& !kvm_arm_vcpu_stopped(v) && !v->arch.pause);
5069ed24f4bSMarc Zyngier }
5079ed24f4bSMarc Zyngier 
5089ed24f4bSMarc Zyngier bool kvm_arch_vcpu_in_kernel(struct kvm_vcpu *vcpu)
5099ed24f4bSMarc Zyngier {
5109ed24f4bSMarc Zyngier 	return vcpu_mode_priv(vcpu);
5119ed24f4bSMarc Zyngier }
5129ed24f4bSMarc Zyngier 
5138e5b0adeSLinus Torvalds #ifdef CONFIG_GUEST_PERF_EVENTS
514e1bfc245SSean Christopherson unsigned long kvm_arch_vcpu_get_ip(struct kvm_vcpu *vcpu)
515e1bfc245SSean Christopherson {
516e1bfc245SSean Christopherson 	return *vcpu_pc(vcpu);
517e1bfc245SSean Christopherson }
5188e5b0adeSLinus Torvalds #endif
519e1bfc245SSean Christopherson 
520b5aa368aSMarc Zyngier static int kvm_vcpu_initialized(struct kvm_vcpu *vcpu)
521052f064dSMarc Zyngier {
522b5aa368aSMarc Zyngier 	return vcpu->arch.target >= 0;
523052f064dSMarc Zyngier }
524052f064dSMarc Zyngier 
525b5aa368aSMarc Zyngier /*
526b5aa368aSMarc Zyngier  * Handle both the initialisation that is being done when the vcpu is
527b5aa368aSMarc Zyngier  * run for the first time, as well as the updates that must be
528b5aa368aSMarc Zyngier  * performed each time we get a new thread dealing with this vcpu.
529b5aa368aSMarc Zyngier  */
530b5aa368aSMarc Zyngier int kvm_arch_vcpu_run_pid_change(struct kvm_vcpu *vcpu)
5319ed24f4bSMarc Zyngier {
5329ed24f4bSMarc Zyngier 	struct kvm *kvm = vcpu->kvm;
533b5aa368aSMarc Zyngier 	int ret;
5349ed24f4bSMarc Zyngier 
535b5aa368aSMarc Zyngier 	if (!kvm_vcpu_initialized(vcpu))
536b5aa368aSMarc Zyngier 		return -ENOEXEC;
5379ed24f4bSMarc Zyngier 
5389ed24f4bSMarc Zyngier 	if (!kvm_arm_vcpu_is_finalized(vcpu))
5399ed24f4bSMarc Zyngier 		return -EPERM;
5409ed24f4bSMarc Zyngier 
541b5aa368aSMarc Zyngier 	ret = kvm_arch_vcpu_run_map_fp(vcpu);
542b5aa368aSMarc Zyngier 	if (ret)
543b5aa368aSMarc Zyngier 		return ret;
544b5aa368aSMarc Zyngier 
545cc5705fbSMarc Zyngier 	if (likely(vcpu_has_run_once(vcpu)))
546b5aa368aSMarc Zyngier 		return 0;
5479ed24f4bSMarc Zyngier 
548263d6287SAlexandru Elisei 	kvm_arm_vcpu_init_debug(vcpu);
549263d6287SAlexandru Elisei 
5509ed24f4bSMarc Zyngier 	if (likely(irqchip_in_kernel(kvm))) {
5519ed24f4bSMarc Zyngier 		/*
5529ed24f4bSMarc Zyngier 		 * Map the VGIC hardware resources before running a vcpu the
5539ed24f4bSMarc Zyngier 		 * first time on this VM.
5549ed24f4bSMarc Zyngier 		 */
5559ed24f4bSMarc Zyngier 		ret = kvm_vgic_map_resources(kvm);
5569ed24f4bSMarc Zyngier 		if (ret)
5579ed24f4bSMarc Zyngier 			return ret;
5589ed24f4bSMarc Zyngier 	}
5599ed24f4bSMarc Zyngier 
5609ed24f4bSMarc Zyngier 	ret = kvm_timer_enable(vcpu);
5619ed24f4bSMarc Zyngier 	if (ret)
5629ed24f4bSMarc Zyngier 		return ret;
5639ed24f4bSMarc Zyngier 
5649ed24f4bSMarc Zyngier 	ret = kvm_arm_pmu_v3_enable(vcpu);
5651408e73dSMarc Zyngier 	if (ret)
5661408e73dSMarc Zyngier 		return ret;
5671408e73dSMarc Zyngier 
5681408e73dSMarc Zyngier 	if (!irqchip_in_kernel(kvm)) {
5691408e73dSMarc Zyngier 		/*
5701408e73dSMarc Zyngier 		 * Tell the rest of the code that there are userspace irqchip
5711408e73dSMarc Zyngier 		 * VMs in the wild.
5721408e73dSMarc Zyngier 		 */
5731408e73dSMarc Zyngier 		static_branch_inc(&userspace_irqchip_in_use);
5741408e73dSMarc Zyngier 	}
5759ed24f4bSMarc Zyngier 
5762a0c3433SFuad Tabba 	/*
5772a0c3433SFuad Tabba 	 * Initialize traps for protected VMs.
5782a0c3433SFuad Tabba 	 * NOTE: Move to run in EL2 directly, rather than via a hypercall, once
5792a0c3433SFuad Tabba 	 * the code is in place for first run initialization at EL2.
5802a0c3433SFuad Tabba 	 */
5812a0c3433SFuad Tabba 	if (kvm_vm_is_protected(kvm))
5822a0c3433SFuad Tabba 		kvm_call_hyp_nvhe(__pkvm_vcpu_init_traps, vcpu);
5832a0c3433SFuad Tabba 
5845177fe91SMarc Zyngier 	mutex_lock(&kvm->lock);
58506394531SMarc Zyngier 	set_bit(KVM_ARCH_FLAG_HAS_RAN_ONCE, &kvm->arch.flags);
5865177fe91SMarc Zyngier 	mutex_unlock(&kvm->lock);
5875177fe91SMarc Zyngier 
5889ed24f4bSMarc Zyngier 	return ret;
5899ed24f4bSMarc Zyngier }
5909ed24f4bSMarc Zyngier 
5919ed24f4bSMarc Zyngier bool kvm_arch_intc_initialized(struct kvm *kvm)
5929ed24f4bSMarc Zyngier {
5939ed24f4bSMarc Zyngier 	return vgic_initialized(kvm);
5949ed24f4bSMarc Zyngier }
5959ed24f4bSMarc Zyngier 
5969ed24f4bSMarc Zyngier void kvm_arm_halt_guest(struct kvm *kvm)
5979ed24f4bSMarc Zyngier {
59846808a4cSMarc Zyngier 	unsigned long i;
5999ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu;
6009ed24f4bSMarc Zyngier 
6019ed24f4bSMarc Zyngier 	kvm_for_each_vcpu(i, vcpu, kvm)
6029ed24f4bSMarc Zyngier 		vcpu->arch.pause = true;
6039ed24f4bSMarc Zyngier 	kvm_make_all_cpus_request(kvm, KVM_REQ_SLEEP);
6049ed24f4bSMarc Zyngier }
6059ed24f4bSMarc Zyngier 
6069ed24f4bSMarc Zyngier void kvm_arm_resume_guest(struct kvm *kvm)
6079ed24f4bSMarc Zyngier {
60846808a4cSMarc Zyngier 	unsigned long i;
6099ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu;
6109ed24f4bSMarc Zyngier 
6119ed24f4bSMarc Zyngier 	kvm_for_each_vcpu(i, vcpu, kvm) {
6129ed24f4bSMarc Zyngier 		vcpu->arch.pause = false;
613d92a5d1cSSean Christopherson 		__kvm_vcpu_wake_up(vcpu);
6149ed24f4bSMarc Zyngier 	}
6159ed24f4bSMarc Zyngier }
6169ed24f4bSMarc Zyngier 
6171c6219e3SOliver Upton static void kvm_vcpu_sleep(struct kvm_vcpu *vcpu)
6189ed24f4bSMarc Zyngier {
61938060944SPaolo Bonzini 	struct rcuwait *wait = kvm_arch_vcpu_get_wait(vcpu);
6209ed24f4bSMarc Zyngier 
62138060944SPaolo Bonzini 	rcuwait_wait_event(wait,
622b171f9bbSOliver Upton 			   (!kvm_arm_vcpu_stopped(vcpu)) && (!vcpu->arch.pause),
62338060944SPaolo Bonzini 			   TASK_INTERRUPTIBLE);
6249ed24f4bSMarc Zyngier 
625b171f9bbSOliver Upton 	if (kvm_arm_vcpu_stopped(vcpu) || vcpu->arch.pause) {
6269ed24f4bSMarc Zyngier 		/* Awaken to handle a signal, request we sleep again later. */
6279ed24f4bSMarc Zyngier 		kvm_make_request(KVM_REQ_SLEEP, vcpu);
6289ed24f4bSMarc Zyngier 	}
6299ed24f4bSMarc Zyngier 
6309ed24f4bSMarc Zyngier 	/*
6319ed24f4bSMarc Zyngier 	 * Make sure we will observe a potential reset request if we've
6329ed24f4bSMarc Zyngier 	 * observed a change to the power state. Pairs with the smp_wmb() in
6339ed24f4bSMarc Zyngier 	 * kvm_psci_vcpu_on().
6349ed24f4bSMarc Zyngier 	 */
6359ed24f4bSMarc Zyngier 	smp_rmb();
6369ed24f4bSMarc Zyngier }
6379ed24f4bSMarc Zyngier 
6386109c5a6SSean Christopherson /**
6396109c5a6SSean Christopherson  * kvm_vcpu_wfi - emulate Wait-For-Interrupt behavior
6406109c5a6SSean Christopherson  * @vcpu:	The VCPU pointer
6416109c5a6SSean Christopherson  *
6426109c5a6SSean Christopherson  * Suspend execution of a vCPU until a valid wake event is detected, i.e. until
6436109c5a6SSean Christopherson  * the vCPU is runnable.  The vCPU may or may not be scheduled out, depending
6446109c5a6SSean Christopherson  * on when a wake event arrives, e.g. there may already be a pending wake event.
6456109c5a6SSean Christopherson  */
6466109c5a6SSean Christopherson void kvm_vcpu_wfi(struct kvm_vcpu *vcpu)
6476109c5a6SSean Christopherson {
6486109c5a6SSean Christopherson 	/*
6496109c5a6SSean Christopherson 	 * Sync back the state of the GIC CPU interface so that we have
6506109c5a6SSean Christopherson 	 * the latest PMR and group enables. This ensures that
6516109c5a6SSean Christopherson 	 * kvm_arch_vcpu_runnable has up-to-date data to decide whether
6526109c5a6SSean Christopherson 	 * we have pending interrupts, e.g. when determining if the
6536109c5a6SSean Christopherson 	 * vCPU should block.
6546109c5a6SSean Christopherson 	 *
6556109c5a6SSean Christopherson 	 * For the same reason, we want to tell GICv4 that we need
6566109c5a6SSean Christopherson 	 * doorbells to be signalled, should an interrupt become pending.
6576109c5a6SSean Christopherson 	 */
6586109c5a6SSean Christopherson 	preempt_disable();
6596109c5a6SSean Christopherson 	kvm_vgic_vmcr_sync(vcpu);
6606109c5a6SSean Christopherson 	vgic_v4_put(vcpu, true);
6616109c5a6SSean Christopherson 	preempt_enable();
6626109c5a6SSean Christopherson 
66391b99ea7SSean Christopherson 	kvm_vcpu_halt(vcpu);
6646109c5a6SSean Christopherson 	kvm_clear_request(KVM_REQ_UNHALT, vcpu);
6656109c5a6SSean Christopherson 
6666109c5a6SSean Christopherson 	preempt_disable();
6676109c5a6SSean Christopherson 	vgic_v4_load(vcpu);
6686109c5a6SSean Christopherson 	preempt_enable();
6696109c5a6SSean Christopherson }
6706109c5a6SSean Christopherson 
6717b33a09dSOliver Upton static int kvm_vcpu_suspend(struct kvm_vcpu *vcpu)
6727b33a09dSOliver Upton {
6737b33a09dSOliver Upton 	if (!kvm_arm_vcpu_suspended(vcpu))
6747b33a09dSOliver Upton 		return 1;
6757b33a09dSOliver Upton 
6767b33a09dSOliver Upton 	kvm_vcpu_wfi(vcpu);
6777b33a09dSOliver Upton 
6787b33a09dSOliver Upton 	/*
6797b33a09dSOliver Upton 	 * The suspend state is sticky; we do not leave it until userspace
6807b33a09dSOliver Upton 	 * explicitly marks the vCPU as runnable. Request that we suspend again
6817b33a09dSOliver Upton 	 * later.
6827b33a09dSOliver Upton 	 */
6837b33a09dSOliver Upton 	kvm_make_request(KVM_REQ_SUSPEND, vcpu);
6847b33a09dSOliver Upton 
6857b33a09dSOliver Upton 	/*
6867b33a09dSOliver Upton 	 * Check to make sure the vCPU is actually runnable. If so, exit to
6877b33a09dSOliver Upton 	 * userspace informing it of the wakeup condition.
6887b33a09dSOliver Upton 	 */
6897b33a09dSOliver Upton 	if (kvm_arch_vcpu_runnable(vcpu)) {
6907b33a09dSOliver Upton 		memset(&vcpu->run->system_event, 0, sizeof(vcpu->run->system_event));
6917b33a09dSOliver Upton 		vcpu->run->system_event.type = KVM_SYSTEM_EVENT_WAKEUP;
6927b33a09dSOliver Upton 		vcpu->run->exit_reason = KVM_EXIT_SYSTEM_EVENT;
6937b33a09dSOliver Upton 		return 0;
6947b33a09dSOliver Upton 	}
6957b33a09dSOliver Upton 
6967b33a09dSOliver Upton 	/*
6977b33a09dSOliver Upton 	 * Otherwise, we were unblocked to process a different event, such as a
6987b33a09dSOliver Upton 	 * pending signal. Return 1 and allow kvm_arch_vcpu_ioctl_run() to
6997b33a09dSOliver Upton 	 * process the event.
7007b33a09dSOliver Upton 	 */
7017b33a09dSOliver Upton 	return 1;
7027b33a09dSOliver Upton }
7037b33a09dSOliver Upton 
7043fdd0459SOliver Upton /**
7053fdd0459SOliver Upton  * check_vcpu_requests - check and handle pending vCPU requests
7063fdd0459SOliver Upton  * @vcpu:	the VCPU pointer
7073fdd0459SOliver Upton  *
7083fdd0459SOliver Upton  * Return: 1 if we should enter the guest
7093fdd0459SOliver Upton  *	   0 if we should exit to userspace
7103fdd0459SOliver Upton  *	   < 0 if we should exit to userspace, where the return value indicates
7113fdd0459SOliver Upton  *	   an error
7123fdd0459SOliver Upton  */
7133fdd0459SOliver Upton static int check_vcpu_requests(struct kvm_vcpu *vcpu)
7149ed24f4bSMarc Zyngier {
7159ed24f4bSMarc Zyngier 	if (kvm_request_pending(vcpu)) {
7169ed24f4bSMarc Zyngier 		if (kvm_check_request(KVM_REQ_SLEEP, vcpu))
7171c6219e3SOliver Upton 			kvm_vcpu_sleep(vcpu);
7189ed24f4bSMarc Zyngier 
7199ed24f4bSMarc Zyngier 		if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu))
7209ed24f4bSMarc Zyngier 			kvm_reset_vcpu(vcpu);
7219ed24f4bSMarc Zyngier 
7229ed24f4bSMarc Zyngier 		/*
7239ed24f4bSMarc Zyngier 		 * Clear IRQ_PENDING requests that were made to guarantee
7249ed24f4bSMarc Zyngier 		 * that a VCPU sees new virtual interrupts.
7259ed24f4bSMarc Zyngier 		 */
7269ed24f4bSMarc Zyngier 		kvm_check_request(KVM_REQ_IRQ_PENDING, vcpu);
7279ed24f4bSMarc Zyngier 
7289ed24f4bSMarc Zyngier 		if (kvm_check_request(KVM_REQ_RECORD_STEAL, vcpu))
7299ed24f4bSMarc Zyngier 			kvm_update_stolen_time(vcpu);
7309ed24f4bSMarc Zyngier 
7319ed24f4bSMarc Zyngier 		if (kvm_check_request(KVM_REQ_RELOAD_GICv4, vcpu)) {
7329ed24f4bSMarc Zyngier 			/* The distributor enable bits were changed */
7339ed24f4bSMarc Zyngier 			preempt_disable();
7349ed24f4bSMarc Zyngier 			vgic_v4_put(vcpu, false);
7359ed24f4bSMarc Zyngier 			vgic_v4_load(vcpu);
7369ed24f4bSMarc Zyngier 			preempt_enable();
7379ed24f4bSMarc Zyngier 		}
738d0c94c49SMarc Zyngier 
739d0c94c49SMarc Zyngier 		if (kvm_check_request(KVM_REQ_RELOAD_PMU, vcpu))
740d0c94c49SMarc Zyngier 			kvm_pmu_handle_pmcr(vcpu,
741d0c94c49SMarc Zyngier 					    __vcpu_sys_reg(vcpu, PMCR_EL0));
7427b33a09dSOliver Upton 
7437b33a09dSOliver Upton 		if (kvm_check_request(KVM_REQ_SUSPEND, vcpu))
7447b33a09dSOliver Upton 			return kvm_vcpu_suspend(vcpu);
7459ed24f4bSMarc Zyngier 	}
7463fdd0459SOliver Upton 
7473fdd0459SOliver Upton 	return 1;
7489ed24f4bSMarc Zyngier }
7499ed24f4bSMarc Zyngier 
7502f6a49bbSWill Deacon static bool vcpu_mode_is_bad_32bit(struct kvm_vcpu *vcpu)
7512f6a49bbSWill Deacon {
7522f6a49bbSWill Deacon 	if (likely(!vcpu_mode_is_32bit(vcpu)))
7532f6a49bbSWill Deacon 		return false;
7542f6a49bbSWill Deacon 
7552f6a49bbSWill Deacon 	return !system_supports_32bit_el0() ||
7562f6a49bbSWill Deacon 		static_branch_unlikely(&arm64_mismatched_32bit_el0);
7572f6a49bbSWill Deacon }
7582f6a49bbSWill Deacon 
7599ed24f4bSMarc Zyngier /**
7606caa5812SOliver Upton  * kvm_vcpu_exit_request - returns true if the VCPU should *not* enter the guest
7616caa5812SOliver Upton  * @vcpu:	The VCPU pointer
7626caa5812SOliver Upton  * @ret:	Pointer to write optional return code
7636caa5812SOliver Upton  *
7646caa5812SOliver Upton  * Returns: true if the VCPU needs to return to a preemptible + interruptible
7656caa5812SOliver Upton  *	    and skip guest entry.
7666caa5812SOliver Upton  *
7676caa5812SOliver Upton  * This function disambiguates between two different types of exits: exits to a
7686caa5812SOliver Upton  * preemptible + interruptible kernel context and exits to userspace. For an
7696caa5812SOliver Upton  * exit to userspace, this function will write the return code to ret and return
7706caa5812SOliver Upton  * true. For an exit to preemptible + interruptible kernel context (i.e. check
7716caa5812SOliver Upton  * for pending work and re-enter), return true without writing to ret.
7726caa5812SOliver Upton  */
7736caa5812SOliver Upton static bool kvm_vcpu_exit_request(struct kvm_vcpu *vcpu, int *ret)
7746caa5812SOliver Upton {
7756caa5812SOliver Upton 	struct kvm_run *run = vcpu->run;
7766caa5812SOliver Upton 
7776caa5812SOliver Upton 	/*
7786caa5812SOliver Upton 	 * If we're using a userspace irqchip, then check if we need
7796caa5812SOliver Upton 	 * to tell a userspace irqchip about timer or PMU level
7806caa5812SOliver Upton 	 * changes and if so, exit to userspace (the actual level
7816caa5812SOliver Upton 	 * state gets updated in kvm_timer_update_run and
7826caa5812SOliver Upton 	 * kvm_pmu_update_run below).
7836caa5812SOliver Upton 	 */
7846caa5812SOliver Upton 	if (static_branch_unlikely(&userspace_irqchip_in_use)) {
7856caa5812SOliver Upton 		if (kvm_timer_should_notify_user(vcpu) ||
7866caa5812SOliver Upton 		    kvm_pmu_should_notify_user(vcpu)) {
7876caa5812SOliver Upton 			*ret = -EINTR;
7886caa5812SOliver Upton 			run->exit_reason = KVM_EXIT_INTR;
7896caa5812SOliver Upton 			return true;
7906caa5812SOliver Upton 		}
7916caa5812SOliver Upton 	}
7926caa5812SOliver Upton 
793583cda1bSAlexandru Elisei 	if (unlikely(vcpu_on_unsupported_cpu(vcpu))) {
794583cda1bSAlexandru Elisei 		run->exit_reason = KVM_EXIT_FAIL_ENTRY;
795583cda1bSAlexandru Elisei 		run->fail_entry.hardware_entry_failure_reason = KVM_EXIT_FAIL_ENTRY_CPU_UNSUPPORTED;
796583cda1bSAlexandru Elisei 		run->fail_entry.cpu = smp_processor_id();
797583cda1bSAlexandru Elisei 		*ret = 0;
798583cda1bSAlexandru Elisei 		return true;
799583cda1bSAlexandru Elisei 	}
800583cda1bSAlexandru Elisei 
8016caa5812SOliver Upton 	return kvm_request_pending(vcpu) ||
8026caa5812SOliver Upton 			xfer_to_guest_mode_work_pending();
8036caa5812SOliver Upton }
8046caa5812SOliver Upton 
8058cfe148aSMark Rutland /*
8068cfe148aSMark Rutland  * Actually run the vCPU, entering an RCU extended quiescent state (EQS) while
8078cfe148aSMark Rutland  * the vCPU is running.
8088cfe148aSMark Rutland  *
8098cfe148aSMark Rutland  * This must be noinstr as instrumentation may make use of RCU, and this is not
8108cfe148aSMark Rutland  * safe during the EQS.
8118cfe148aSMark Rutland  */
8128cfe148aSMark Rutland static int noinstr kvm_arm_vcpu_enter_exit(struct kvm_vcpu *vcpu)
8138cfe148aSMark Rutland {
8148cfe148aSMark Rutland 	int ret;
8158cfe148aSMark Rutland 
8168cfe148aSMark Rutland 	guest_state_enter_irqoff();
8178cfe148aSMark Rutland 	ret = kvm_call_hyp_ret(__kvm_vcpu_run, vcpu);
8188cfe148aSMark Rutland 	guest_state_exit_irqoff();
8198cfe148aSMark Rutland 
8208cfe148aSMark Rutland 	return ret;
8218cfe148aSMark Rutland }
8228cfe148aSMark Rutland 
8236caa5812SOliver Upton /**
8249ed24f4bSMarc Zyngier  * kvm_arch_vcpu_ioctl_run - the main VCPU run function to execute guest code
8259ed24f4bSMarc Zyngier  * @vcpu:	The VCPU pointer
8269ed24f4bSMarc Zyngier  *
8279ed24f4bSMarc Zyngier  * This function is called through the VCPU_RUN ioctl called from user space. It
8289ed24f4bSMarc Zyngier  * will execute VM code in a loop until the time slice for the process is used
8299ed24f4bSMarc Zyngier  * or some emulation is needed from user space in which case the function will
8309ed24f4bSMarc Zyngier  * return with return value 0 and with the kvm_run structure filled in with the
8319ed24f4bSMarc Zyngier  * required data for the requested emulation.
8329ed24f4bSMarc Zyngier  */
83338060944SPaolo Bonzini int kvm_arch_vcpu_ioctl_run(struct kvm_vcpu *vcpu)
8349ed24f4bSMarc Zyngier {
83538060944SPaolo Bonzini 	struct kvm_run *run = vcpu->run;
8369ed24f4bSMarc Zyngier 	int ret;
8379ed24f4bSMarc Zyngier 
8389ed24f4bSMarc Zyngier 	if (run->exit_reason == KVM_EXIT_MMIO) {
83974cc7e0cSTianjia Zhang 		ret = kvm_handle_mmio_return(vcpu);
8409ed24f4bSMarc Zyngier 		if (ret)
8419ed24f4bSMarc Zyngier 			return ret;
8429ed24f4bSMarc Zyngier 	}
8439ed24f4bSMarc Zyngier 
8449ed24f4bSMarc Zyngier 	vcpu_load(vcpu);
8459ed24f4bSMarc Zyngier 
846e3e880bbSZenghui Yu 	if (run->immediate_exit) {
847e3e880bbSZenghui Yu 		ret = -EINTR;
848e3e880bbSZenghui Yu 		goto out;
849e3e880bbSZenghui Yu 	}
850e3e880bbSZenghui Yu 
8519ed24f4bSMarc Zyngier 	kvm_sigset_activate(vcpu);
8529ed24f4bSMarc Zyngier 
8539ed24f4bSMarc Zyngier 	ret = 1;
8549ed24f4bSMarc Zyngier 	run->exit_reason = KVM_EXIT_UNKNOWN;
8559ed24f4bSMarc Zyngier 	while (ret > 0) {
8569ed24f4bSMarc Zyngier 		/*
8579ed24f4bSMarc Zyngier 		 * Check conditions before entering the guest
8589ed24f4bSMarc Zyngier 		 */
8596caa5812SOliver Upton 		ret = xfer_to_guest_mode_handle_work(vcpu);
8606caa5812SOliver Upton 		if (!ret)
8616caa5812SOliver Upton 			ret = 1;
8629ed24f4bSMarc Zyngier 
8633fdd0459SOliver Upton 		if (ret > 0)
8643fdd0459SOliver Upton 			ret = check_vcpu_requests(vcpu);
8659ed24f4bSMarc Zyngier 
8669ed24f4bSMarc Zyngier 		/*
8679ed24f4bSMarc Zyngier 		 * Preparing the interrupts to be injected also
8689ed24f4bSMarc Zyngier 		 * involves poking the GIC, which must be done in a
8699ed24f4bSMarc Zyngier 		 * non-preemptible context.
8709ed24f4bSMarc Zyngier 		 */
8719ed24f4bSMarc Zyngier 		preempt_disable();
8729ed24f4bSMarc Zyngier 
8733248136bSJulien Grall 		/*
8743248136bSJulien Grall 		 * The VMID allocator only tracks active VMIDs per
8753248136bSJulien Grall 		 * physical CPU, and therefore the VMID allocated may not be
8763248136bSJulien Grall 		 * preserved on VMID roll-over if the task was preempted,
8773248136bSJulien Grall 		 * making a thread's VMID inactive. So we need to call
8783248136bSJulien Grall 		 * kvm_arm_vmid_update() in non-premptible context.
8793248136bSJulien Grall 		 */
8803248136bSJulien Grall 		kvm_arm_vmid_update(&vcpu->arch.hw_mmu->vmid);
8813248136bSJulien Grall 
8829ed24f4bSMarc Zyngier 		kvm_pmu_flush_hwstate(vcpu);
8839ed24f4bSMarc Zyngier 
8849ed24f4bSMarc Zyngier 		local_irq_disable();
8859ed24f4bSMarc Zyngier 
8869ed24f4bSMarc Zyngier 		kvm_vgic_flush_hwstate(vcpu);
8879ed24f4bSMarc Zyngier 
8889ed24f4bSMarc Zyngier 		/*
8899ed24f4bSMarc Zyngier 		 * Ensure we set mode to IN_GUEST_MODE after we disable
8909ed24f4bSMarc Zyngier 		 * interrupts and before the final VCPU requests check.
8919ed24f4bSMarc Zyngier 		 * See the comment in kvm_vcpu_exiting_guest_mode() and
8929ed24f4bSMarc Zyngier 		 * Documentation/virt/kvm/vcpu-requests.rst
8939ed24f4bSMarc Zyngier 		 */
8949ed24f4bSMarc Zyngier 		smp_store_mb(vcpu->mode, IN_GUEST_MODE);
8959ed24f4bSMarc Zyngier 
8966caa5812SOliver Upton 		if (ret <= 0 || kvm_vcpu_exit_request(vcpu, &ret)) {
8979ed24f4bSMarc Zyngier 			vcpu->mode = OUTSIDE_GUEST_MODE;
8989ed24f4bSMarc Zyngier 			isb(); /* Ensure work in x_flush_hwstate is committed */
8999ed24f4bSMarc Zyngier 			kvm_pmu_sync_hwstate(vcpu);
9009ed24f4bSMarc Zyngier 			if (static_branch_unlikely(&userspace_irqchip_in_use))
9013c5ff0c6SMarc Zyngier 				kvm_timer_sync_user(vcpu);
9029ed24f4bSMarc Zyngier 			kvm_vgic_sync_hwstate(vcpu);
9039ed24f4bSMarc Zyngier 			local_irq_enable();
9049ed24f4bSMarc Zyngier 			preempt_enable();
9059ed24f4bSMarc Zyngier 			continue;
9069ed24f4bSMarc Zyngier 		}
9079ed24f4bSMarc Zyngier 
9089ed24f4bSMarc Zyngier 		kvm_arm_setup_debug(vcpu);
909af9a0e21SMarc Zyngier 		kvm_arch_vcpu_ctxflush_fp(vcpu);
9109ed24f4bSMarc Zyngier 
9119ed24f4bSMarc Zyngier 		/**************************************************************
9129ed24f4bSMarc Zyngier 		 * Enter the guest
9139ed24f4bSMarc Zyngier 		 */
9149ed24f4bSMarc Zyngier 		trace_kvm_entry(*vcpu_pc(vcpu));
9158cfe148aSMark Rutland 		guest_timing_enter_irqoff();
9169ed24f4bSMarc Zyngier 
9178cfe148aSMark Rutland 		ret = kvm_arm_vcpu_enter_exit(vcpu);
9189ed24f4bSMarc Zyngier 
9199ed24f4bSMarc Zyngier 		vcpu->mode = OUTSIDE_GUEST_MODE;
9209ed24f4bSMarc Zyngier 		vcpu->stat.exits++;
9219ed24f4bSMarc Zyngier 		/*
9229ed24f4bSMarc Zyngier 		 * Back from guest
9239ed24f4bSMarc Zyngier 		 *************************************************************/
9249ed24f4bSMarc Zyngier 
9259ed24f4bSMarc Zyngier 		kvm_arm_clear_debug(vcpu);
9269ed24f4bSMarc Zyngier 
9279ed24f4bSMarc Zyngier 		/*
9289ed24f4bSMarc Zyngier 		 * We must sync the PMU state before the vgic state so
9299ed24f4bSMarc Zyngier 		 * that the vgic can properly sample the updated state of the
9309ed24f4bSMarc Zyngier 		 * interrupt line.
9319ed24f4bSMarc Zyngier 		 */
9329ed24f4bSMarc Zyngier 		kvm_pmu_sync_hwstate(vcpu);
9339ed24f4bSMarc Zyngier 
9349ed24f4bSMarc Zyngier 		/*
9359ed24f4bSMarc Zyngier 		 * Sync the vgic state before syncing the timer state because
9369ed24f4bSMarc Zyngier 		 * the timer code needs to know if the virtual timer
9379ed24f4bSMarc Zyngier 		 * interrupts are active.
9389ed24f4bSMarc Zyngier 		 */
9399ed24f4bSMarc Zyngier 		kvm_vgic_sync_hwstate(vcpu);
9409ed24f4bSMarc Zyngier 
9419ed24f4bSMarc Zyngier 		/*
9429ed24f4bSMarc Zyngier 		 * Sync the timer hardware state before enabling interrupts as
9439ed24f4bSMarc Zyngier 		 * we don't want vtimer interrupts to race with syncing the
9449ed24f4bSMarc Zyngier 		 * timer virtual interrupt state.
9459ed24f4bSMarc Zyngier 		 */
9469ed24f4bSMarc Zyngier 		if (static_branch_unlikely(&userspace_irqchip_in_use))
9473c5ff0c6SMarc Zyngier 			kvm_timer_sync_user(vcpu);
9489ed24f4bSMarc Zyngier 
9499ed24f4bSMarc Zyngier 		kvm_arch_vcpu_ctxsync_fp(vcpu);
9509ed24f4bSMarc Zyngier 
9519ed24f4bSMarc Zyngier 		/*
9528cfe148aSMark Rutland 		 * We must ensure that any pending interrupts are taken before
9538cfe148aSMark Rutland 		 * we exit guest timing so that timer ticks are accounted as
9548cfe148aSMark Rutland 		 * guest time. Transiently unmask interrupts so that any
9558cfe148aSMark Rutland 		 * pending interrupts are taken.
9569ed24f4bSMarc Zyngier 		 *
9578cfe148aSMark Rutland 		 * Per ARM DDI 0487G.b section D1.13.4, an ISB (or other
9588cfe148aSMark Rutland 		 * context synchronization event) is necessary to ensure that
9598cfe148aSMark Rutland 		 * pending interrupts are taken.
9609ed24f4bSMarc Zyngier 		 */
961f7659f8bSMarc Zyngier 		if (ARM_EXCEPTION_CODE(ret) == ARM_EXCEPTION_IRQ) {
9629ed24f4bSMarc Zyngier 			local_irq_enable();
9638cfe148aSMark Rutland 			isb();
9648cfe148aSMark Rutland 			local_irq_disable();
965f7659f8bSMarc Zyngier 		}
9669ed24f4bSMarc Zyngier 
9678cfe148aSMark Rutland 		guest_timing_exit_irqoff();
9688cfe148aSMark Rutland 
9698cfe148aSMark Rutland 		local_irq_enable();
9708cfe148aSMark Rutland 
9719ed24f4bSMarc Zyngier 		trace_kvm_exit(ret, kvm_vcpu_trap_get_class(vcpu), *vcpu_pc(vcpu));
9729ed24f4bSMarc Zyngier 
9739ed24f4bSMarc Zyngier 		/* Exit types that need handling before we can be preempted */
97474cc7e0cSTianjia Zhang 		handle_exit_early(vcpu, ret);
9759ed24f4bSMarc Zyngier 
9769ed24f4bSMarc Zyngier 		preempt_enable();
9779ed24f4bSMarc Zyngier 
97822f55384SQais Yousef 		/*
97922f55384SQais Yousef 		 * The ARMv8 architecture doesn't give the hypervisor
98022f55384SQais Yousef 		 * a mechanism to prevent a guest from dropping to AArch32 EL0
98122f55384SQais Yousef 		 * if implemented by the CPU. If we spot the guest in such
98222f55384SQais Yousef 		 * state and that we decided it wasn't supposed to do so (like
98322f55384SQais Yousef 		 * with the asymmetric AArch32 case), return to userspace with
98422f55384SQais Yousef 		 * a fatal error.
98522f55384SQais Yousef 		 */
9862f6a49bbSWill Deacon 		if (vcpu_mode_is_bad_32bit(vcpu)) {
98722f55384SQais Yousef 			/*
98822f55384SQais Yousef 			 * As we have caught the guest red-handed, decide that
98922f55384SQais Yousef 			 * it isn't fit for purpose anymore by making the vcpu
99022f55384SQais Yousef 			 * invalid. The VMM can try and fix it by issuing  a
99122f55384SQais Yousef 			 * KVM_ARM_VCPU_INIT if it really wants to.
99222f55384SQais Yousef 			 */
99322f55384SQais Yousef 			vcpu->arch.target = -1;
99422f55384SQais Yousef 			ret = ARM_EXCEPTION_IL;
99522f55384SQais Yousef 		}
99622f55384SQais Yousef 
99774cc7e0cSTianjia Zhang 		ret = handle_exit(vcpu, ret);
9989ed24f4bSMarc Zyngier 	}
9999ed24f4bSMarc Zyngier 
10009ed24f4bSMarc Zyngier 	/* Tell userspace about in-kernel device output levels */
10019ed24f4bSMarc Zyngier 	if (unlikely(!irqchip_in_kernel(vcpu->kvm))) {
10029ed24f4bSMarc Zyngier 		kvm_timer_update_run(vcpu);
10039ed24f4bSMarc Zyngier 		kvm_pmu_update_run(vcpu);
10049ed24f4bSMarc Zyngier 	}
10059ed24f4bSMarc Zyngier 
10069ed24f4bSMarc Zyngier 	kvm_sigset_deactivate(vcpu);
10079ed24f4bSMarc Zyngier 
1008e3e880bbSZenghui Yu out:
100926778aaaSMarc Zyngier 	/*
101026778aaaSMarc Zyngier 	 * In the unlikely event that we are returning to userspace
101126778aaaSMarc Zyngier 	 * with pending exceptions or PC adjustment, commit these
101226778aaaSMarc Zyngier 	 * adjustments in order to give userspace a consistent view of
101326778aaaSMarc Zyngier 	 * the vcpu state. Note that this relies on __kvm_adjust_pc()
101426778aaaSMarc Zyngier 	 * being preempt-safe on VHE.
101526778aaaSMarc Zyngier 	 */
101626778aaaSMarc Zyngier 	if (unlikely(vcpu->arch.flags & (KVM_ARM64_PENDING_EXCEPTION |
101726778aaaSMarc Zyngier 					 KVM_ARM64_INCREMENT_PC)))
101826778aaaSMarc Zyngier 		kvm_call_hyp(__kvm_adjust_pc, vcpu);
101926778aaaSMarc Zyngier 
10209ed24f4bSMarc Zyngier 	vcpu_put(vcpu);
10219ed24f4bSMarc Zyngier 	return ret;
10229ed24f4bSMarc Zyngier }
10239ed24f4bSMarc Zyngier 
10249ed24f4bSMarc Zyngier static int vcpu_interrupt_line(struct kvm_vcpu *vcpu, int number, bool level)
10259ed24f4bSMarc Zyngier {
10269ed24f4bSMarc Zyngier 	int bit_index;
10279ed24f4bSMarc Zyngier 	bool set;
10289ed24f4bSMarc Zyngier 	unsigned long *hcr;
10299ed24f4bSMarc Zyngier 
10309ed24f4bSMarc Zyngier 	if (number == KVM_ARM_IRQ_CPU_IRQ)
10319ed24f4bSMarc Zyngier 		bit_index = __ffs(HCR_VI);
10329ed24f4bSMarc Zyngier 	else /* KVM_ARM_IRQ_CPU_FIQ */
10339ed24f4bSMarc Zyngier 		bit_index = __ffs(HCR_VF);
10349ed24f4bSMarc Zyngier 
10359ed24f4bSMarc Zyngier 	hcr = vcpu_hcr(vcpu);
10369ed24f4bSMarc Zyngier 	if (level)
10379ed24f4bSMarc Zyngier 		set = test_and_set_bit(bit_index, hcr);
10389ed24f4bSMarc Zyngier 	else
10399ed24f4bSMarc Zyngier 		set = test_and_clear_bit(bit_index, hcr);
10409ed24f4bSMarc Zyngier 
10419ed24f4bSMarc Zyngier 	/*
10429ed24f4bSMarc Zyngier 	 * If we didn't change anything, no need to wake up or kick other CPUs
10439ed24f4bSMarc Zyngier 	 */
10449ed24f4bSMarc Zyngier 	if (set == level)
10459ed24f4bSMarc Zyngier 		return 0;
10469ed24f4bSMarc Zyngier 
10479ed24f4bSMarc Zyngier 	/*
10489ed24f4bSMarc Zyngier 	 * The vcpu irq_lines field was updated, wake up sleeping VCPUs and
10499ed24f4bSMarc Zyngier 	 * trigger a world-switch round on the running physical CPU to set the
10509ed24f4bSMarc Zyngier 	 * virtual IRQ/FIQ fields in the HCR appropriately.
10519ed24f4bSMarc Zyngier 	 */
10529ed24f4bSMarc Zyngier 	kvm_make_request(KVM_REQ_IRQ_PENDING, vcpu);
10539ed24f4bSMarc Zyngier 	kvm_vcpu_kick(vcpu);
10549ed24f4bSMarc Zyngier 
10559ed24f4bSMarc Zyngier 	return 0;
10569ed24f4bSMarc Zyngier }
10579ed24f4bSMarc Zyngier 
10589ed24f4bSMarc Zyngier int kvm_vm_ioctl_irq_line(struct kvm *kvm, struct kvm_irq_level *irq_level,
10599ed24f4bSMarc Zyngier 			  bool line_status)
10609ed24f4bSMarc Zyngier {
10619ed24f4bSMarc Zyngier 	u32 irq = irq_level->irq;
10629ed24f4bSMarc Zyngier 	unsigned int irq_type, vcpu_idx, irq_num;
10639ed24f4bSMarc Zyngier 	int nrcpus = atomic_read(&kvm->online_vcpus);
10649ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu = NULL;
10659ed24f4bSMarc Zyngier 	bool level = irq_level->level;
10669ed24f4bSMarc Zyngier 
10679ed24f4bSMarc Zyngier 	irq_type = (irq >> KVM_ARM_IRQ_TYPE_SHIFT) & KVM_ARM_IRQ_TYPE_MASK;
10689ed24f4bSMarc Zyngier 	vcpu_idx = (irq >> KVM_ARM_IRQ_VCPU_SHIFT) & KVM_ARM_IRQ_VCPU_MASK;
10699ed24f4bSMarc Zyngier 	vcpu_idx += ((irq >> KVM_ARM_IRQ_VCPU2_SHIFT) & KVM_ARM_IRQ_VCPU2_MASK) * (KVM_ARM_IRQ_VCPU_MASK + 1);
10709ed24f4bSMarc Zyngier 	irq_num = (irq >> KVM_ARM_IRQ_NUM_SHIFT) & KVM_ARM_IRQ_NUM_MASK;
10719ed24f4bSMarc Zyngier 
10729ed24f4bSMarc Zyngier 	trace_kvm_irq_line(irq_type, vcpu_idx, irq_num, irq_level->level);
10739ed24f4bSMarc Zyngier 
10749ed24f4bSMarc Zyngier 	switch (irq_type) {
10759ed24f4bSMarc Zyngier 	case KVM_ARM_IRQ_TYPE_CPU:
10769ed24f4bSMarc Zyngier 		if (irqchip_in_kernel(kvm))
10779ed24f4bSMarc Zyngier 			return -ENXIO;
10789ed24f4bSMarc Zyngier 
10799ed24f4bSMarc Zyngier 		if (vcpu_idx >= nrcpus)
10809ed24f4bSMarc Zyngier 			return -EINVAL;
10819ed24f4bSMarc Zyngier 
10829ed24f4bSMarc Zyngier 		vcpu = kvm_get_vcpu(kvm, vcpu_idx);
10839ed24f4bSMarc Zyngier 		if (!vcpu)
10849ed24f4bSMarc Zyngier 			return -EINVAL;
10859ed24f4bSMarc Zyngier 
10869ed24f4bSMarc Zyngier 		if (irq_num > KVM_ARM_IRQ_CPU_FIQ)
10879ed24f4bSMarc Zyngier 			return -EINVAL;
10889ed24f4bSMarc Zyngier 
10899ed24f4bSMarc Zyngier 		return vcpu_interrupt_line(vcpu, irq_num, level);
10909ed24f4bSMarc Zyngier 	case KVM_ARM_IRQ_TYPE_PPI:
10919ed24f4bSMarc Zyngier 		if (!irqchip_in_kernel(kvm))
10929ed24f4bSMarc Zyngier 			return -ENXIO;
10939ed24f4bSMarc Zyngier 
10949ed24f4bSMarc Zyngier 		if (vcpu_idx >= nrcpus)
10959ed24f4bSMarc Zyngier 			return -EINVAL;
10969ed24f4bSMarc Zyngier 
10979ed24f4bSMarc Zyngier 		vcpu = kvm_get_vcpu(kvm, vcpu_idx);
10989ed24f4bSMarc Zyngier 		if (!vcpu)
10999ed24f4bSMarc Zyngier 			return -EINVAL;
11009ed24f4bSMarc Zyngier 
11019ed24f4bSMarc Zyngier 		if (irq_num < VGIC_NR_SGIS || irq_num >= VGIC_NR_PRIVATE_IRQS)
11029ed24f4bSMarc Zyngier 			return -EINVAL;
11039ed24f4bSMarc Zyngier 
11049ed24f4bSMarc Zyngier 		return kvm_vgic_inject_irq(kvm, vcpu->vcpu_id, irq_num, level, NULL);
11059ed24f4bSMarc Zyngier 	case KVM_ARM_IRQ_TYPE_SPI:
11069ed24f4bSMarc Zyngier 		if (!irqchip_in_kernel(kvm))
11079ed24f4bSMarc Zyngier 			return -ENXIO;
11089ed24f4bSMarc Zyngier 
11099ed24f4bSMarc Zyngier 		if (irq_num < VGIC_NR_PRIVATE_IRQS)
11109ed24f4bSMarc Zyngier 			return -EINVAL;
11119ed24f4bSMarc Zyngier 
11129ed24f4bSMarc Zyngier 		return kvm_vgic_inject_irq(kvm, 0, irq_num, level, NULL);
11139ed24f4bSMarc Zyngier 	}
11149ed24f4bSMarc Zyngier 
11159ed24f4bSMarc Zyngier 	return -EINVAL;
11169ed24f4bSMarc Zyngier }
11179ed24f4bSMarc Zyngier 
11189ed24f4bSMarc Zyngier static int kvm_vcpu_set_target(struct kvm_vcpu *vcpu,
11199ed24f4bSMarc Zyngier 			       const struct kvm_vcpu_init *init)
11209ed24f4bSMarc Zyngier {
11219ed24f4bSMarc Zyngier 	unsigned int i, ret;
11226b7982feSAnshuman Khandual 	u32 phys_target = kvm_target_cpu();
11239ed24f4bSMarc Zyngier 
11249ed24f4bSMarc Zyngier 	if (init->target != phys_target)
11259ed24f4bSMarc Zyngier 		return -EINVAL;
11269ed24f4bSMarc Zyngier 
11279ed24f4bSMarc Zyngier 	/*
11289ed24f4bSMarc Zyngier 	 * Secondary and subsequent calls to KVM_ARM_VCPU_INIT must
11299ed24f4bSMarc Zyngier 	 * use the same target.
11309ed24f4bSMarc Zyngier 	 */
11319ed24f4bSMarc Zyngier 	if (vcpu->arch.target != -1 && vcpu->arch.target != init->target)
11329ed24f4bSMarc Zyngier 		return -EINVAL;
11339ed24f4bSMarc Zyngier 
11349ed24f4bSMarc Zyngier 	/* -ENOENT for unknown features, -EINVAL for invalid combinations. */
11359ed24f4bSMarc Zyngier 	for (i = 0; i < sizeof(init->features) * 8; i++) {
11369ed24f4bSMarc Zyngier 		bool set = (init->features[i / 32] & (1 << (i % 32)));
11379ed24f4bSMarc Zyngier 
11389ed24f4bSMarc Zyngier 		if (set && i >= KVM_VCPU_MAX_FEATURES)
11399ed24f4bSMarc Zyngier 			return -ENOENT;
11409ed24f4bSMarc Zyngier 
11419ed24f4bSMarc Zyngier 		/*
11429ed24f4bSMarc Zyngier 		 * Secondary and subsequent calls to KVM_ARM_VCPU_INIT must
11439ed24f4bSMarc Zyngier 		 * use the same feature set.
11449ed24f4bSMarc Zyngier 		 */
11459ed24f4bSMarc Zyngier 		if (vcpu->arch.target != -1 && i < KVM_VCPU_MAX_FEATURES &&
11469ed24f4bSMarc Zyngier 		    test_bit(i, vcpu->arch.features) != set)
11479ed24f4bSMarc Zyngier 			return -EINVAL;
11489ed24f4bSMarc Zyngier 
11499ed24f4bSMarc Zyngier 		if (set)
11509ed24f4bSMarc Zyngier 			set_bit(i, vcpu->arch.features);
11519ed24f4bSMarc Zyngier 	}
11529ed24f4bSMarc Zyngier 
11539ed24f4bSMarc Zyngier 	vcpu->arch.target = phys_target;
11549ed24f4bSMarc Zyngier 
11559ed24f4bSMarc Zyngier 	/* Now we know what it is, we can reset it. */
11569ed24f4bSMarc Zyngier 	ret = kvm_reset_vcpu(vcpu);
11579ed24f4bSMarc Zyngier 	if (ret) {
11589ed24f4bSMarc Zyngier 		vcpu->arch.target = -1;
11599ed24f4bSMarc Zyngier 		bitmap_zero(vcpu->arch.features, KVM_VCPU_MAX_FEATURES);
11609ed24f4bSMarc Zyngier 	}
11619ed24f4bSMarc Zyngier 
11629ed24f4bSMarc Zyngier 	return ret;
11639ed24f4bSMarc Zyngier }
11649ed24f4bSMarc Zyngier 
11659ed24f4bSMarc Zyngier static int kvm_arch_vcpu_ioctl_vcpu_init(struct kvm_vcpu *vcpu,
11669ed24f4bSMarc Zyngier 					 struct kvm_vcpu_init *init)
11679ed24f4bSMarc Zyngier {
11689ed24f4bSMarc Zyngier 	int ret;
11699ed24f4bSMarc Zyngier 
11709ed24f4bSMarc Zyngier 	ret = kvm_vcpu_set_target(vcpu, init);
11719ed24f4bSMarc Zyngier 	if (ret)
11729ed24f4bSMarc Zyngier 		return ret;
11739ed24f4bSMarc Zyngier 
11749ed24f4bSMarc Zyngier 	/*
11759ed24f4bSMarc Zyngier 	 * Ensure a rebooted VM will fault in RAM pages and detect if the
11769ed24f4bSMarc Zyngier 	 * guest MMU is turned off and flush the caches as needed.
1177892713e9SZenghui Yu 	 *
11787ae2f3dbSMarc Zyngier 	 * S2FWB enforces all memory accesses to RAM being cacheable,
11797ae2f3dbSMarc Zyngier 	 * ensuring that the data side is always coherent. We still
11807ae2f3dbSMarc Zyngier 	 * need to invalidate the I-cache though, as FWB does *not*
11817ae2f3dbSMarc Zyngier 	 * imply CTR_EL0.DIC.
11829ed24f4bSMarc Zyngier 	 */
1183cc5705fbSMarc Zyngier 	if (vcpu_has_run_once(vcpu)) {
11847ae2f3dbSMarc Zyngier 		if (!cpus_have_final_cap(ARM64_HAS_STAGE2_FWB))
11859ed24f4bSMarc Zyngier 			stage2_unmap_vm(vcpu->kvm);
11867ae2f3dbSMarc Zyngier 		else
1187fade9c2cSFuad Tabba 			icache_inval_all_pou();
11887ae2f3dbSMarc Zyngier 	}
11899ed24f4bSMarc Zyngier 
11909ed24f4bSMarc Zyngier 	vcpu_reset_hcr(vcpu);
1191cd496228SFuad Tabba 	vcpu->arch.cptr_el2 = CPTR_EL2_DEFAULT;
11929ed24f4bSMarc Zyngier 
11939ed24f4bSMarc Zyngier 	/*
11949ed24f4bSMarc Zyngier 	 * Handle the "start in power-off" case.
11959ed24f4bSMarc Zyngier 	 */
11969ed24f4bSMarc Zyngier 	if (test_bit(KVM_ARM_VCPU_POWER_OFF, vcpu->arch.features))
11971e579429SOliver Upton 		kvm_arm_vcpu_power_off(vcpu);
11989ed24f4bSMarc Zyngier 	else
1199b171f9bbSOliver Upton 		vcpu->arch.mp_state.mp_state = KVM_MP_STATE_RUNNABLE;
12009ed24f4bSMarc Zyngier 
12019ed24f4bSMarc Zyngier 	return 0;
12029ed24f4bSMarc Zyngier }
12039ed24f4bSMarc Zyngier 
12049ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_attr(struct kvm_vcpu *vcpu,
12059ed24f4bSMarc Zyngier 				 struct kvm_device_attr *attr)
12069ed24f4bSMarc Zyngier {
12079ed24f4bSMarc Zyngier 	int ret = -ENXIO;
12089ed24f4bSMarc Zyngier 
12099ed24f4bSMarc Zyngier 	switch (attr->group) {
12109ed24f4bSMarc Zyngier 	default:
12119ed24f4bSMarc Zyngier 		ret = kvm_arm_vcpu_arch_set_attr(vcpu, attr);
12129ed24f4bSMarc Zyngier 		break;
12139ed24f4bSMarc Zyngier 	}
12149ed24f4bSMarc Zyngier 
12159ed24f4bSMarc Zyngier 	return ret;
12169ed24f4bSMarc Zyngier }
12179ed24f4bSMarc Zyngier 
12189ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_attr(struct kvm_vcpu *vcpu,
12199ed24f4bSMarc Zyngier 				 struct kvm_device_attr *attr)
12209ed24f4bSMarc Zyngier {
12219ed24f4bSMarc Zyngier 	int ret = -ENXIO;
12229ed24f4bSMarc Zyngier 
12239ed24f4bSMarc Zyngier 	switch (attr->group) {
12249ed24f4bSMarc Zyngier 	default:
12259ed24f4bSMarc Zyngier 		ret = kvm_arm_vcpu_arch_get_attr(vcpu, attr);
12269ed24f4bSMarc Zyngier 		break;
12279ed24f4bSMarc Zyngier 	}
12289ed24f4bSMarc Zyngier 
12299ed24f4bSMarc Zyngier 	return ret;
12309ed24f4bSMarc Zyngier }
12319ed24f4bSMarc Zyngier 
12329ed24f4bSMarc Zyngier static int kvm_arm_vcpu_has_attr(struct kvm_vcpu *vcpu,
12339ed24f4bSMarc Zyngier 				 struct kvm_device_attr *attr)
12349ed24f4bSMarc Zyngier {
12359ed24f4bSMarc Zyngier 	int ret = -ENXIO;
12369ed24f4bSMarc Zyngier 
12379ed24f4bSMarc Zyngier 	switch (attr->group) {
12389ed24f4bSMarc Zyngier 	default:
12399ed24f4bSMarc Zyngier 		ret = kvm_arm_vcpu_arch_has_attr(vcpu, attr);
12409ed24f4bSMarc Zyngier 		break;
12419ed24f4bSMarc Zyngier 	}
12429ed24f4bSMarc Zyngier 
12439ed24f4bSMarc Zyngier 	return ret;
12449ed24f4bSMarc Zyngier }
12459ed24f4bSMarc Zyngier 
12469ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_events(struct kvm_vcpu *vcpu,
12479ed24f4bSMarc Zyngier 				   struct kvm_vcpu_events *events)
12489ed24f4bSMarc Zyngier {
12499ed24f4bSMarc Zyngier 	memset(events, 0, sizeof(*events));
12509ed24f4bSMarc Zyngier 
12519ed24f4bSMarc Zyngier 	return __kvm_arm_vcpu_get_events(vcpu, events);
12529ed24f4bSMarc Zyngier }
12539ed24f4bSMarc Zyngier 
12549ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_events(struct kvm_vcpu *vcpu,
12559ed24f4bSMarc Zyngier 				   struct kvm_vcpu_events *events)
12569ed24f4bSMarc Zyngier {
12579ed24f4bSMarc Zyngier 	int i;
12589ed24f4bSMarc Zyngier 
12599ed24f4bSMarc Zyngier 	/* check whether the reserved field is zero */
12609ed24f4bSMarc Zyngier 	for (i = 0; i < ARRAY_SIZE(events->reserved); i++)
12619ed24f4bSMarc Zyngier 		if (events->reserved[i])
12629ed24f4bSMarc Zyngier 			return -EINVAL;
12639ed24f4bSMarc Zyngier 
12649ed24f4bSMarc Zyngier 	/* check whether the pad field is zero */
12659ed24f4bSMarc Zyngier 	for (i = 0; i < ARRAY_SIZE(events->exception.pad); i++)
12669ed24f4bSMarc Zyngier 		if (events->exception.pad[i])
12679ed24f4bSMarc Zyngier 			return -EINVAL;
12689ed24f4bSMarc Zyngier 
12699ed24f4bSMarc Zyngier 	return __kvm_arm_vcpu_set_events(vcpu, events);
12709ed24f4bSMarc Zyngier }
12719ed24f4bSMarc Zyngier 
12729ed24f4bSMarc Zyngier long kvm_arch_vcpu_ioctl(struct file *filp,
12739ed24f4bSMarc Zyngier 			 unsigned int ioctl, unsigned long arg)
12749ed24f4bSMarc Zyngier {
12759ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu = filp->private_data;
12769ed24f4bSMarc Zyngier 	void __user *argp = (void __user *)arg;
12779ed24f4bSMarc Zyngier 	struct kvm_device_attr attr;
12789ed24f4bSMarc Zyngier 	long r;
12799ed24f4bSMarc Zyngier 
12809ed24f4bSMarc Zyngier 	switch (ioctl) {
12819ed24f4bSMarc Zyngier 	case KVM_ARM_VCPU_INIT: {
12829ed24f4bSMarc Zyngier 		struct kvm_vcpu_init init;
12839ed24f4bSMarc Zyngier 
12849ed24f4bSMarc Zyngier 		r = -EFAULT;
12859ed24f4bSMarc Zyngier 		if (copy_from_user(&init, argp, sizeof(init)))
12869ed24f4bSMarc Zyngier 			break;
12879ed24f4bSMarc Zyngier 
12889ed24f4bSMarc Zyngier 		r = kvm_arch_vcpu_ioctl_vcpu_init(vcpu, &init);
12899ed24f4bSMarc Zyngier 		break;
12909ed24f4bSMarc Zyngier 	}
12919ed24f4bSMarc Zyngier 	case KVM_SET_ONE_REG:
12929ed24f4bSMarc Zyngier 	case KVM_GET_ONE_REG: {
12939ed24f4bSMarc Zyngier 		struct kvm_one_reg reg;
12949ed24f4bSMarc Zyngier 
12959ed24f4bSMarc Zyngier 		r = -ENOEXEC;
12969ed24f4bSMarc Zyngier 		if (unlikely(!kvm_vcpu_initialized(vcpu)))
12979ed24f4bSMarc Zyngier 			break;
12989ed24f4bSMarc Zyngier 
12999ed24f4bSMarc Zyngier 		r = -EFAULT;
13009ed24f4bSMarc Zyngier 		if (copy_from_user(&reg, argp, sizeof(reg)))
13019ed24f4bSMarc Zyngier 			break;
13029ed24f4bSMarc Zyngier 
13036826c684SOliver Upton 		/*
13046826c684SOliver Upton 		 * We could owe a reset due to PSCI. Handle the pending reset
13056826c684SOliver Upton 		 * here to ensure userspace register accesses are ordered after
13066826c684SOliver Upton 		 * the reset.
13076826c684SOliver Upton 		 */
13086826c684SOliver Upton 		if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu))
13096826c684SOliver Upton 			kvm_reset_vcpu(vcpu);
13106826c684SOliver Upton 
13119ed24f4bSMarc Zyngier 		if (ioctl == KVM_SET_ONE_REG)
13129ed24f4bSMarc Zyngier 			r = kvm_arm_set_reg(vcpu, &reg);
13139ed24f4bSMarc Zyngier 		else
13149ed24f4bSMarc Zyngier 			r = kvm_arm_get_reg(vcpu, &reg);
13159ed24f4bSMarc Zyngier 		break;
13169ed24f4bSMarc Zyngier 	}
13179ed24f4bSMarc Zyngier 	case KVM_GET_REG_LIST: {
13189ed24f4bSMarc Zyngier 		struct kvm_reg_list __user *user_list = argp;
13199ed24f4bSMarc Zyngier 		struct kvm_reg_list reg_list;
13209ed24f4bSMarc Zyngier 		unsigned n;
13219ed24f4bSMarc Zyngier 
13229ed24f4bSMarc Zyngier 		r = -ENOEXEC;
13239ed24f4bSMarc Zyngier 		if (unlikely(!kvm_vcpu_initialized(vcpu)))
13249ed24f4bSMarc Zyngier 			break;
13259ed24f4bSMarc Zyngier 
13269ed24f4bSMarc Zyngier 		r = -EPERM;
13279ed24f4bSMarc Zyngier 		if (!kvm_arm_vcpu_is_finalized(vcpu))
13289ed24f4bSMarc Zyngier 			break;
13299ed24f4bSMarc Zyngier 
13309ed24f4bSMarc Zyngier 		r = -EFAULT;
13319ed24f4bSMarc Zyngier 		if (copy_from_user(&reg_list, user_list, sizeof(reg_list)))
13329ed24f4bSMarc Zyngier 			break;
13339ed24f4bSMarc Zyngier 		n = reg_list.n;
13349ed24f4bSMarc Zyngier 		reg_list.n = kvm_arm_num_regs(vcpu);
13359ed24f4bSMarc Zyngier 		if (copy_to_user(user_list, &reg_list, sizeof(reg_list)))
13369ed24f4bSMarc Zyngier 			break;
13379ed24f4bSMarc Zyngier 		r = -E2BIG;
13389ed24f4bSMarc Zyngier 		if (n < reg_list.n)
13399ed24f4bSMarc Zyngier 			break;
13409ed24f4bSMarc Zyngier 		r = kvm_arm_copy_reg_indices(vcpu, user_list->reg);
13419ed24f4bSMarc Zyngier 		break;
13429ed24f4bSMarc Zyngier 	}
13439ed24f4bSMarc Zyngier 	case KVM_SET_DEVICE_ATTR: {
13449ed24f4bSMarc Zyngier 		r = -EFAULT;
13459ed24f4bSMarc Zyngier 		if (copy_from_user(&attr, argp, sizeof(attr)))
13469ed24f4bSMarc Zyngier 			break;
13479ed24f4bSMarc Zyngier 		r = kvm_arm_vcpu_set_attr(vcpu, &attr);
13489ed24f4bSMarc Zyngier 		break;
13499ed24f4bSMarc Zyngier 	}
13509ed24f4bSMarc Zyngier 	case KVM_GET_DEVICE_ATTR: {
13519ed24f4bSMarc Zyngier 		r = -EFAULT;
13529ed24f4bSMarc Zyngier 		if (copy_from_user(&attr, argp, sizeof(attr)))
13539ed24f4bSMarc Zyngier 			break;
13549ed24f4bSMarc Zyngier 		r = kvm_arm_vcpu_get_attr(vcpu, &attr);
13559ed24f4bSMarc Zyngier 		break;
13569ed24f4bSMarc Zyngier 	}
13579ed24f4bSMarc Zyngier 	case KVM_HAS_DEVICE_ATTR: {
13589ed24f4bSMarc Zyngier 		r = -EFAULT;
13599ed24f4bSMarc Zyngier 		if (copy_from_user(&attr, argp, sizeof(attr)))
13609ed24f4bSMarc Zyngier 			break;
13619ed24f4bSMarc Zyngier 		r = kvm_arm_vcpu_has_attr(vcpu, &attr);
13629ed24f4bSMarc Zyngier 		break;
13639ed24f4bSMarc Zyngier 	}
13649ed24f4bSMarc Zyngier 	case KVM_GET_VCPU_EVENTS: {
13659ed24f4bSMarc Zyngier 		struct kvm_vcpu_events events;
13669ed24f4bSMarc Zyngier 
13679ed24f4bSMarc Zyngier 		if (kvm_arm_vcpu_get_events(vcpu, &events))
13689ed24f4bSMarc Zyngier 			return -EINVAL;
13699ed24f4bSMarc Zyngier 
13709ed24f4bSMarc Zyngier 		if (copy_to_user(argp, &events, sizeof(events)))
13719ed24f4bSMarc Zyngier 			return -EFAULT;
13729ed24f4bSMarc Zyngier 
13739ed24f4bSMarc Zyngier 		return 0;
13749ed24f4bSMarc Zyngier 	}
13759ed24f4bSMarc Zyngier 	case KVM_SET_VCPU_EVENTS: {
13769ed24f4bSMarc Zyngier 		struct kvm_vcpu_events events;
13779ed24f4bSMarc Zyngier 
13789ed24f4bSMarc Zyngier 		if (copy_from_user(&events, argp, sizeof(events)))
13799ed24f4bSMarc Zyngier 			return -EFAULT;
13809ed24f4bSMarc Zyngier 
13819ed24f4bSMarc Zyngier 		return kvm_arm_vcpu_set_events(vcpu, &events);
13829ed24f4bSMarc Zyngier 	}
13839ed24f4bSMarc Zyngier 	case KVM_ARM_VCPU_FINALIZE: {
13849ed24f4bSMarc Zyngier 		int what;
13859ed24f4bSMarc Zyngier 
13869ed24f4bSMarc Zyngier 		if (!kvm_vcpu_initialized(vcpu))
13879ed24f4bSMarc Zyngier 			return -ENOEXEC;
13889ed24f4bSMarc Zyngier 
13899ed24f4bSMarc Zyngier 		if (get_user(what, (const int __user *)argp))
13909ed24f4bSMarc Zyngier 			return -EFAULT;
13919ed24f4bSMarc Zyngier 
13929ed24f4bSMarc Zyngier 		return kvm_arm_vcpu_finalize(vcpu, what);
13939ed24f4bSMarc Zyngier 	}
13949ed24f4bSMarc Zyngier 	default:
13959ed24f4bSMarc Zyngier 		r = -EINVAL;
13969ed24f4bSMarc Zyngier 	}
13979ed24f4bSMarc Zyngier 
13989ed24f4bSMarc Zyngier 	return r;
13999ed24f4bSMarc Zyngier }
14009ed24f4bSMarc Zyngier 
14019ed24f4bSMarc Zyngier void kvm_arch_sync_dirty_log(struct kvm *kvm, struct kvm_memory_slot *memslot)
14029ed24f4bSMarc Zyngier {
14039ed24f4bSMarc Zyngier 
14049ed24f4bSMarc Zyngier }
14059ed24f4bSMarc Zyngier 
14069ed24f4bSMarc Zyngier void kvm_arch_flush_remote_tlbs_memslot(struct kvm *kvm,
14076c9dd6d2SPaolo Bonzini 					const struct kvm_memory_slot *memslot)
14089ed24f4bSMarc Zyngier {
14099ed24f4bSMarc Zyngier 	kvm_flush_remote_tlbs(kvm);
14109ed24f4bSMarc Zyngier }
14119ed24f4bSMarc Zyngier 
14129ed24f4bSMarc Zyngier static int kvm_vm_ioctl_set_device_addr(struct kvm *kvm,
14139ed24f4bSMarc Zyngier 					struct kvm_arm_device_addr *dev_addr)
14149ed24f4bSMarc Zyngier {
14159ed24f4bSMarc Zyngier 	unsigned long dev_id, type;
14169ed24f4bSMarc Zyngier 
14179ed24f4bSMarc Zyngier 	dev_id = (dev_addr->id & KVM_ARM_DEVICE_ID_MASK) >>
14189ed24f4bSMarc Zyngier 		KVM_ARM_DEVICE_ID_SHIFT;
14199ed24f4bSMarc Zyngier 	type = (dev_addr->id & KVM_ARM_DEVICE_TYPE_MASK) >>
14209ed24f4bSMarc Zyngier 		KVM_ARM_DEVICE_TYPE_SHIFT;
14219ed24f4bSMarc Zyngier 
14229ed24f4bSMarc Zyngier 	switch (dev_id) {
14239ed24f4bSMarc Zyngier 	case KVM_ARM_DEVICE_VGIC_V2:
14249ed24f4bSMarc Zyngier 		if (!vgic_present)
14259ed24f4bSMarc Zyngier 			return -ENXIO;
14269ed24f4bSMarc Zyngier 		return kvm_vgic_addr(kvm, type, &dev_addr->addr, true);
14279ed24f4bSMarc Zyngier 	default:
14289ed24f4bSMarc Zyngier 		return -ENODEV;
14299ed24f4bSMarc Zyngier 	}
14309ed24f4bSMarc Zyngier }
14319ed24f4bSMarc Zyngier 
14329ed24f4bSMarc Zyngier long kvm_arch_vm_ioctl(struct file *filp,
14339ed24f4bSMarc Zyngier 		       unsigned int ioctl, unsigned long arg)
14349ed24f4bSMarc Zyngier {
14359ed24f4bSMarc Zyngier 	struct kvm *kvm = filp->private_data;
14369ed24f4bSMarc Zyngier 	void __user *argp = (void __user *)arg;
14379ed24f4bSMarc Zyngier 
14389ed24f4bSMarc Zyngier 	switch (ioctl) {
14399ed24f4bSMarc Zyngier 	case KVM_CREATE_IRQCHIP: {
14409ed24f4bSMarc Zyngier 		int ret;
14419ed24f4bSMarc Zyngier 		if (!vgic_present)
14429ed24f4bSMarc Zyngier 			return -ENXIO;
14439ed24f4bSMarc Zyngier 		mutex_lock(&kvm->lock);
14449ed24f4bSMarc Zyngier 		ret = kvm_vgic_create(kvm, KVM_DEV_TYPE_ARM_VGIC_V2);
14459ed24f4bSMarc Zyngier 		mutex_unlock(&kvm->lock);
14469ed24f4bSMarc Zyngier 		return ret;
14479ed24f4bSMarc Zyngier 	}
14489ed24f4bSMarc Zyngier 	case KVM_ARM_SET_DEVICE_ADDR: {
14499ed24f4bSMarc Zyngier 		struct kvm_arm_device_addr dev_addr;
14509ed24f4bSMarc Zyngier 
14519ed24f4bSMarc Zyngier 		if (copy_from_user(&dev_addr, argp, sizeof(dev_addr)))
14529ed24f4bSMarc Zyngier 			return -EFAULT;
14539ed24f4bSMarc Zyngier 		return kvm_vm_ioctl_set_device_addr(kvm, &dev_addr);
14549ed24f4bSMarc Zyngier 	}
14559ed24f4bSMarc Zyngier 	case KVM_ARM_PREFERRED_TARGET: {
14569ed24f4bSMarc Zyngier 		struct kvm_vcpu_init init;
14579ed24f4bSMarc Zyngier 
145808e873cbSYueHaibing 		kvm_vcpu_preferred_target(&init);
14599ed24f4bSMarc Zyngier 
14609ed24f4bSMarc Zyngier 		if (copy_to_user(argp, &init, sizeof(init)))
14619ed24f4bSMarc Zyngier 			return -EFAULT;
14629ed24f4bSMarc Zyngier 
14639ed24f4bSMarc Zyngier 		return 0;
14649ed24f4bSMarc Zyngier 	}
1465f0376edbSSteven Price 	case KVM_ARM_MTE_COPY_TAGS: {
1466f0376edbSSteven Price 		struct kvm_arm_copy_mte_tags copy_tags;
1467f0376edbSSteven Price 
1468f0376edbSSteven Price 		if (copy_from_user(&copy_tags, argp, sizeof(copy_tags)))
1469f0376edbSSteven Price 			return -EFAULT;
1470f0376edbSSteven Price 		return kvm_vm_ioctl_mte_copy_tags(kvm, &copy_tags);
1471f0376edbSSteven Price 	}
14729ed24f4bSMarc Zyngier 	default:
14739ed24f4bSMarc Zyngier 		return -EINVAL;
14749ed24f4bSMarc Zyngier 	}
14759ed24f4bSMarc Zyngier }
14769ed24f4bSMarc Zyngier 
147730c95391SDavid Brazdil static unsigned long nvhe_percpu_size(void)
147830c95391SDavid Brazdil {
147930c95391SDavid Brazdil 	return (unsigned long)CHOOSE_NVHE_SYM(__per_cpu_end) -
148030c95391SDavid Brazdil 		(unsigned long)CHOOSE_NVHE_SYM(__per_cpu_start);
148130c95391SDavid Brazdil }
148230c95391SDavid Brazdil 
148330c95391SDavid Brazdil static unsigned long nvhe_percpu_order(void)
148430c95391SDavid Brazdil {
148530c95391SDavid Brazdil 	unsigned long size = nvhe_percpu_size();
148630c95391SDavid Brazdil 
148730c95391SDavid Brazdil 	return size ? get_order(size) : 0;
148830c95391SDavid Brazdil }
148930c95391SDavid Brazdil 
1490b881cdceSWill Deacon /* A lookup table holding the hypervisor VA for each vector slot */
1491b881cdceSWill Deacon static void *hyp_spectre_vector_selector[BP_HARDEN_EL2_SLOTS];
1492de5bcdb4SWill Deacon 
1493b881cdceSWill Deacon static void kvm_init_vector_slot(void *base, enum arm64_hyp_spectre_vector slot)
1494b881cdceSWill Deacon {
1495bc1d2892SQuentin Perret 	hyp_spectre_vector_selector[slot] = __kvm_vector_slot2addr(base, slot);
14969ef2b48bSWill Deacon }
14979ef2b48bSWill Deacon 
1498b881cdceSWill Deacon static int kvm_init_vector_slots(void)
1499b881cdceSWill Deacon {
1500b881cdceSWill Deacon 	int err;
1501b881cdceSWill Deacon 	void *base;
1502b881cdceSWill Deacon 
1503b881cdceSWill Deacon 	base = kern_hyp_va(kvm_ksym_ref(__kvm_hyp_vector));
1504b881cdceSWill Deacon 	kvm_init_vector_slot(base, HYP_VECTOR_DIRECT);
1505b881cdceSWill Deacon 
1506b881cdceSWill Deacon 	base = kern_hyp_va(kvm_ksym_ref(__bp_harden_hyp_vecs));
1507b881cdceSWill Deacon 	kvm_init_vector_slot(base, HYP_VECTOR_SPECTRE_DIRECT);
1508b881cdceSWill Deacon 
15095bdf3437SJames Morse 	if (kvm_system_needs_idmapped_vectors() && !has_vhe()) {
1510b881cdceSWill Deacon 		err = create_hyp_exec_mappings(__pa_symbol(__bp_harden_hyp_vecs),
1511b881cdceSWill Deacon 					       __BP_HARDEN_HYP_VECS_SZ, &base);
1512b881cdceSWill Deacon 		if (err)
1513b881cdceSWill Deacon 			return err;
1514b881cdceSWill Deacon 	}
15159ef2b48bSWill Deacon 
1516b881cdceSWill Deacon 	kvm_init_vector_slot(base, HYP_VECTOR_INDIRECT);
1517b881cdceSWill Deacon 	kvm_init_vector_slot(base, HYP_VECTOR_SPECTRE_INDIRECT);
15189ef2b48bSWill Deacon 	return 0;
15199ef2b48bSWill Deacon }
15209ef2b48bSWill Deacon 
15219cc77581SQuentin Perret static void cpu_prepare_hyp_mode(int cpu)
15229ed24f4bSMarc Zyngier {
15239cc77581SQuentin Perret 	struct kvm_nvhe_init_params *params = per_cpu_ptr_nvhe_sym(kvm_init_params, cpu);
1524d3e1086cSDavid Brazdil 	unsigned long tcr;
15259ed24f4bSMarc Zyngier 
152671b3ec5fSDavid Brazdil 	/*
152771b3ec5fSDavid Brazdil 	 * Calculate the raw per-cpu offset without a translation from the
152871b3ec5fSDavid Brazdil 	 * kernel's mapping to the linear mapping, and store it in tpidr_el2
152971b3ec5fSDavid Brazdil 	 * so that we can use adr_l to access per-cpu variables in EL2.
1530e1663372SSteven Price 	 * Also drop the KASAN tag which gets in the way...
153171b3ec5fSDavid Brazdil 	 */
15329cc77581SQuentin Perret 	params->tpidr_el2 = (unsigned long)kasan_reset_tag(per_cpu_ptr_nvhe_sym(__per_cpu_start, cpu)) -
153330c95391SDavid Brazdil 			    (unsigned long)kvm_ksym_ref(CHOOSE_NVHE_SYM(__per_cpu_start));
153471b3ec5fSDavid Brazdil 
1535d3e1086cSDavid Brazdil 	params->mair_el2 = read_sysreg(mair_el1);
1536d3e1086cSDavid Brazdil 
1537d3e1086cSDavid Brazdil 	/*
1538d3e1086cSDavid Brazdil 	 * The ID map may be configured to use an extended virtual address
1539d3e1086cSDavid Brazdil 	 * range. This is only the case if system RAM is out of range for the
1540d3e1086cSDavid Brazdil 	 * currently configured page size and VA_BITS, in which case we will
1541d3e1086cSDavid Brazdil 	 * also need the extended virtual range for the HYP ID map, or we won't
1542d3e1086cSDavid Brazdil 	 * be able to enable the EL2 MMU.
1543d3e1086cSDavid Brazdil 	 *
1544d3e1086cSDavid Brazdil 	 * However, at EL2, there is only one TTBR register, and we can't switch
1545d3e1086cSDavid Brazdil 	 * between translation tables *and* update TCR_EL2.T0SZ at the same
1546d3e1086cSDavid Brazdil 	 * time. Bottom line: we need to use the extended range with *both* our
1547d3e1086cSDavid Brazdil 	 * translation tables.
1548d3e1086cSDavid Brazdil 	 *
1549d3e1086cSDavid Brazdil 	 * So use the same T0SZ value we use for the ID map.
1550d3e1086cSDavid Brazdil 	 */
1551d3e1086cSDavid Brazdil 	tcr = (read_sysreg(tcr_el1) & TCR_EL2_MASK) | TCR_EL2_RES1;
1552d3e1086cSDavid Brazdil 	tcr &= ~TCR_T0SZ_MASK;
1553d3e1086cSDavid Brazdil 	tcr |= (idmap_t0sz & GENMASK(TCR_TxSZ_WIDTH - 1, 0)) << TCR_T0SZ_OFFSET;
1554d3e1086cSDavid Brazdil 	params->tcr_el2 = tcr;
1555d3e1086cSDavid Brazdil 
15569cc77581SQuentin Perret 	params->stack_hyp_va = kern_hyp_va(per_cpu(kvm_arm_hyp_stack_page, cpu) + PAGE_SIZE);
155763fec243SDavid Brazdil 	params->pgd_pa = kvm_mmu_get_httbr();
1558734864c1SQuentin Perret 	if (is_protected_kvm_enabled())
1559734864c1SQuentin Perret 		params->hcr_el2 = HCR_HOST_NVHE_PROTECTED_FLAGS;
1560734864c1SQuentin Perret 	else
1561734864c1SQuentin Perret 		params->hcr_el2 = HCR_HOST_NVHE_FLAGS;
1562734864c1SQuentin Perret 	params->vttbr = params->vtcr = 0;
156363fec243SDavid Brazdil 
156463fec243SDavid Brazdil 	/*
156563fec243SDavid Brazdil 	 * Flush the init params from the data cache because the struct will
156663fec243SDavid Brazdil 	 * be read while the MMU is off.
156763fec243SDavid Brazdil 	 */
156863fec243SDavid Brazdil 	kvm_flush_dcache_to_poc(params, sizeof(*params));
15699cc77581SQuentin Perret }
15709cc77581SQuentin Perret 
1571bfa79a80SQuentin Perret static void hyp_install_host_vector(void)
15729cc77581SQuentin Perret {
15739cc77581SQuentin Perret 	struct kvm_nvhe_init_params *params;
15749cc77581SQuentin Perret 	struct arm_smccc_res res;
15759cc77581SQuentin Perret 
15769cc77581SQuentin Perret 	/* Switch from the HYP stub to our own HYP init vector */
15779cc77581SQuentin Perret 	__hyp_set_vectors(kvm_get_idmap_vector());
15789ed24f4bSMarc Zyngier 
157971b3ec5fSDavid Brazdil 	/*
158071b3ec5fSDavid Brazdil 	 * Call initialization code, and switch to the full blown HYP code.
158171b3ec5fSDavid Brazdil 	 * If the cpucaps haven't been finalized yet, something has gone very
158271b3ec5fSDavid Brazdil 	 * wrong, and hyp will crash and burn when it uses any
158371b3ec5fSDavid Brazdil 	 * cpus_have_const_cap() wrapper.
158471b3ec5fSDavid Brazdil 	 */
158571b3ec5fSDavid Brazdil 	BUG_ON(!system_capabilities_finalized());
15869cc77581SQuentin Perret 	params = this_cpu_ptr_nvhe_sym(kvm_init_params);
158763fec243SDavid Brazdil 	arm_smccc_1_1_hvc(KVM_HOST_SMCCC_FUNC(__kvm_hyp_init), virt_to_phys(params), &res);
158804e4caa8SAndrew Scull 	WARN_ON(res.a0 != SMCCC_RET_SUCCESS);
1589bfa79a80SQuentin Perret }
1590bfa79a80SQuentin Perret 
1591bfa79a80SQuentin Perret static void cpu_init_hyp_mode(void)
1592bfa79a80SQuentin Perret {
1593bfa79a80SQuentin Perret 	hyp_install_host_vector();
159471b3ec5fSDavid Brazdil 
159571b3ec5fSDavid Brazdil 	/*
159671b3ec5fSDavid Brazdil 	 * Disabling SSBD on a non-VHE system requires us to enable SSBS
159771b3ec5fSDavid Brazdil 	 * at EL2.
159871b3ec5fSDavid Brazdil 	 */
159971b3ec5fSDavid Brazdil 	if (this_cpu_has_cap(ARM64_SSBS) &&
1600d63d975aSMarc Zyngier 	    arm64_get_spectre_v4_state() == SPECTRE_VULNERABLE) {
160113aeb9b4SDavid Brazdil 		kvm_call_hyp_nvhe(__kvm_enable_ssbs);
160271b3ec5fSDavid Brazdil 	}
16039ed24f4bSMarc Zyngier }
16049ed24f4bSMarc Zyngier 
16059ed24f4bSMarc Zyngier static void cpu_hyp_reset(void)
16069ed24f4bSMarc Zyngier {
16079ed24f4bSMarc Zyngier 	if (!is_kernel_in_hyp_mode())
16089ed24f4bSMarc Zyngier 		__hyp_reset_vectors();
16099ed24f4bSMarc Zyngier }
16109ed24f4bSMarc Zyngier 
1611042c76a9SWill Deacon /*
1612042c76a9SWill Deacon  * EL2 vectors can be mapped and rerouted in a number of ways,
1613042c76a9SWill Deacon  * depending on the kernel configuration and CPU present:
1614042c76a9SWill Deacon  *
1615042c76a9SWill Deacon  * - If the CPU is affected by Spectre-v2, the hardening sequence is
1616042c76a9SWill Deacon  *   placed in one of the vector slots, which is executed before jumping
1617042c76a9SWill Deacon  *   to the real vectors.
1618042c76a9SWill Deacon  *
1619c4792b6dSWill Deacon  * - If the CPU also has the ARM64_SPECTRE_V3A cap, the slot
1620042c76a9SWill Deacon  *   containing the hardening sequence is mapped next to the idmap page,
1621042c76a9SWill Deacon  *   and executed before jumping to the real vectors.
1622042c76a9SWill Deacon  *
1623c4792b6dSWill Deacon  * - If the CPU only has the ARM64_SPECTRE_V3A cap, then an
1624042c76a9SWill Deacon  *   empty slot is selected, mapped next to the idmap page, and
1625042c76a9SWill Deacon  *   executed before jumping to the real vectors.
1626042c76a9SWill Deacon  *
1627c4792b6dSWill Deacon  * Note that ARM64_SPECTRE_V3A is somewhat incompatible with
1628042c76a9SWill Deacon  * VHE, as we don't have hypervisor-specific mappings. If the system
1629042c76a9SWill Deacon  * is VHE and yet selects this capability, it will be ignored.
1630042c76a9SWill Deacon  */
1631042c76a9SWill Deacon static void cpu_set_hyp_vector(void)
1632042c76a9SWill Deacon {
16336279017eSWill Deacon 	struct bp_hardening_data *data = this_cpu_ptr(&bp_hardening_data);
1634b881cdceSWill Deacon 	void *vector = hyp_spectre_vector_selector[data->slot];
1635042c76a9SWill Deacon 
1636bfa79a80SQuentin Perret 	if (!is_protected_kvm_enabled())
1637b881cdceSWill Deacon 		*this_cpu_ptr_hyp_sym(kvm_hyp_vector) = (unsigned long)vector;
1638bfa79a80SQuentin Perret 	else
1639bfa79a80SQuentin Perret 		kvm_call_hyp_nvhe(__pkvm_cpu_set_vector, data->slot);
1640042c76a9SWill Deacon }
1641042c76a9SWill Deacon 
16428579a185SWill Deacon static void cpu_hyp_init_context(void)
16439ed24f4bSMarc Zyngier {
16442a1198c9SDavid Brazdil 	kvm_init_host_cpu_context(&this_cpu_ptr_hyp_sym(kvm_host_data)->host_ctxt);
16459ed24f4bSMarc Zyngier 
16468579a185SWill Deacon 	if (!is_kernel_in_hyp_mode())
16478579a185SWill Deacon 		cpu_init_hyp_mode();
16488579a185SWill Deacon }
16498579a185SWill Deacon 
16508579a185SWill Deacon static void cpu_hyp_init_features(void)
16518579a185SWill Deacon {
16528579a185SWill Deacon 	cpu_set_hyp_vector();
16538579a185SWill Deacon 	kvm_arm_init_debug();
1654a0e47952SAndrew Scull 
16559ed24f4bSMarc Zyngier 	if (is_kernel_in_hyp_mode())
16569ed24f4bSMarc Zyngier 		kvm_timer_init_vhe();
16579ed24f4bSMarc Zyngier 
16589ed24f4bSMarc Zyngier 	if (vgic_present)
16599ed24f4bSMarc Zyngier 		kvm_vgic_init_cpu_hardware();
16609ed24f4bSMarc Zyngier }
16619ed24f4bSMarc Zyngier 
16628579a185SWill Deacon static void cpu_hyp_reinit(void)
16638579a185SWill Deacon {
16648579a185SWill Deacon 	cpu_hyp_reset();
16658579a185SWill Deacon 	cpu_hyp_init_context();
16668579a185SWill Deacon 	cpu_hyp_init_features();
16678579a185SWill Deacon }
16688579a185SWill Deacon 
16699ed24f4bSMarc Zyngier static void _kvm_arch_hardware_enable(void *discard)
16709ed24f4bSMarc Zyngier {
16719ed24f4bSMarc Zyngier 	if (!__this_cpu_read(kvm_arm_hardware_enabled)) {
16729ed24f4bSMarc Zyngier 		cpu_hyp_reinit();
16739ed24f4bSMarc Zyngier 		__this_cpu_write(kvm_arm_hardware_enabled, 1);
16749ed24f4bSMarc Zyngier 	}
16759ed24f4bSMarc Zyngier }
16769ed24f4bSMarc Zyngier 
16779ed24f4bSMarc Zyngier int kvm_arch_hardware_enable(void)
16789ed24f4bSMarc Zyngier {
16799ed24f4bSMarc Zyngier 	_kvm_arch_hardware_enable(NULL);
16809ed24f4bSMarc Zyngier 	return 0;
16819ed24f4bSMarc Zyngier }
16829ed24f4bSMarc Zyngier 
16839ed24f4bSMarc Zyngier static void _kvm_arch_hardware_disable(void *discard)
16849ed24f4bSMarc Zyngier {
16859ed24f4bSMarc Zyngier 	if (__this_cpu_read(kvm_arm_hardware_enabled)) {
16869ed24f4bSMarc Zyngier 		cpu_hyp_reset();
16879ed24f4bSMarc Zyngier 		__this_cpu_write(kvm_arm_hardware_enabled, 0);
16889ed24f4bSMarc Zyngier 	}
16899ed24f4bSMarc Zyngier }
16909ed24f4bSMarc Zyngier 
16919ed24f4bSMarc Zyngier void kvm_arch_hardware_disable(void)
16929ed24f4bSMarc Zyngier {
1693fa8c3d65SDavid Brazdil 	if (!is_protected_kvm_enabled())
16949ed24f4bSMarc Zyngier 		_kvm_arch_hardware_disable(NULL);
16959ed24f4bSMarc Zyngier }
16969ed24f4bSMarc Zyngier 
16979ed24f4bSMarc Zyngier #ifdef CONFIG_CPU_PM
16989ed24f4bSMarc Zyngier static int hyp_init_cpu_pm_notifier(struct notifier_block *self,
16999ed24f4bSMarc Zyngier 				    unsigned long cmd,
17009ed24f4bSMarc Zyngier 				    void *v)
17019ed24f4bSMarc Zyngier {
17029ed24f4bSMarc Zyngier 	/*
17039ed24f4bSMarc Zyngier 	 * kvm_arm_hardware_enabled is left with its old value over
17049ed24f4bSMarc Zyngier 	 * PM_ENTER->PM_EXIT. It is used to indicate PM_EXIT should
17059ed24f4bSMarc Zyngier 	 * re-enable hyp.
17069ed24f4bSMarc Zyngier 	 */
17079ed24f4bSMarc Zyngier 	switch (cmd) {
17089ed24f4bSMarc Zyngier 	case CPU_PM_ENTER:
17099ed24f4bSMarc Zyngier 		if (__this_cpu_read(kvm_arm_hardware_enabled))
17109ed24f4bSMarc Zyngier 			/*
17119ed24f4bSMarc Zyngier 			 * don't update kvm_arm_hardware_enabled here
17129ed24f4bSMarc Zyngier 			 * so that the hardware will be re-enabled
17139ed24f4bSMarc Zyngier 			 * when we resume. See below.
17149ed24f4bSMarc Zyngier 			 */
17159ed24f4bSMarc Zyngier 			cpu_hyp_reset();
17169ed24f4bSMarc Zyngier 
17179ed24f4bSMarc Zyngier 		return NOTIFY_OK;
17189ed24f4bSMarc Zyngier 	case CPU_PM_ENTER_FAILED:
17199ed24f4bSMarc Zyngier 	case CPU_PM_EXIT:
17209ed24f4bSMarc Zyngier 		if (__this_cpu_read(kvm_arm_hardware_enabled))
17219ed24f4bSMarc Zyngier 			/* The hardware was enabled before suspend. */
17229ed24f4bSMarc Zyngier 			cpu_hyp_reinit();
17239ed24f4bSMarc Zyngier 
17249ed24f4bSMarc Zyngier 		return NOTIFY_OK;
17259ed24f4bSMarc Zyngier 
17269ed24f4bSMarc Zyngier 	default:
17279ed24f4bSMarc Zyngier 		return NOTIFY_DONE;
17289ed24f4bSMarc Zyngier 	}
17299ed24f4bSMarc Zyngier }
17309ed24f4bSMarc Zyngier 
17319ed24f4bSMarc Zyngier static struct notifier_block hyp_init_cpu_pm_nb = {
17329ed24f4bSMarc Zyngier 	.notifier_call = hyp_init_cpu_pm_notifier,
17339ed24f4bSMarc Zyngier };
17349ed24f4bSMarc Zyngier 
173544362a3cSMarc Zyngier static void hyp_cpu_pm_init(void)
17369ed24f4bSMarc Zyngier {
1737fa8c3d65SDavid Brazdil 	if (!is_protected_kvm_enabled())
17389ed24f4bSMarc Zyngier 		cpu_pm_register_notifier(&hyp_init_cpu_pm_nb);
17399ed24f4bSMarc Zyngier }
174044362a3cSMarc Zyngier static void hyp_cpu_pm_exit(void)
17419ed24f4bSMarc Zyngier {
1742fa8c3d65SDavid Brazdil 	if (!is_protected_kvm_enabled())
17439ed24f4bSMarc Zyngier 		cpu_pm_unregister_notifier(&hyp_init_cpu_pm_nb);
17449ed24f4bSMarc Zyngier }
17459ed24f4bSMarc Zyngier #else
17469ed24f4bSMarc Zyngier static inline void hyp_cpu_pm_init(void)
17479ed24f4bSMarc Zyngier {
17489ed24f4bSMarc Zyngier }
17499ed24f4bSMarc Zyngier static inline void hyp_cpu_pm_exit(void)
17509ed24f4bSMarc Zyngier {
17519ed24f4bSMarc Zyngier }
17529ed24f4bSMarc Zyngier #endif
17539ed24f4bSMarc Zyngier 
175494f5e8a4SDavid Brazdil static void init_cpu_logical_map(void)
175594f5e8a4SDavid Brazdil {
175694f5e8a4SDavid Brazdil 	unsigned int cpu;
175794f5e8a4SDavid Brazdil 
175894f5e8a4SDavid Brazdil 	/*
175994f5e8a4SDavid Brazdil 	 * Copy the MPIDR <-> logical CPU ID mapping to hyp.
176021ea4578SJulia Lawall 	 * Only copy the set of online CPUs whose features have been checked
176194f5e8a4SDavid Brazdil 	 * against the finalized system capabilities. The hypervisor will not
176294f5e8a4SDavid Brazdil 	 * allow any other CPUs from the `possible` set to boot.
176394f5e8a4SDavid Brazdil 	 */
176494f5e8a4SDavid Brazdil 	for_each_online_cpu(cpu)
176561fe0c37SDavid Brazdil 		hyp_cpu_logical_map[cpu] = cpu_logical_map(cpu);
176694f5e8a4SDavid Brazdil }
176794f5e8a4SDavid Brazdil 
1768767c973fSMarc Zyngier #define init_psci_0_1_impl_state(config, what)	\
1769767c973fSMarc Zyngier 	config.psci_0_1_ ## what ## _implemented = psci_ops.what
1770767c973fSMarc Zyngier 
1771eeeee719SDavid Brazdil static bool init_psci_relay(void)
1772eeeee719SDavid Brazdil {
1773eeeee719SDavid Brazdil 	/*
1774eeeee719SDavid Brazdil 	 * If PSCI has not been initialized, protected KVM cannot install
1775eeeee719SDavid Brazdil 	 * itself on newly booted CPUs.
1776eeeee719SDavid Brazdil 	 */
1777eeeee719SDavid Brazdil 	if (!psci_ops.get_version) {
1778eeeee719SDavid Brazdil 		kvm_err("Cannot initialize protected mode without PSCI\n");
1779eeeee719SDavid Brazdil 		return false;
1780eeeee719SDavid Brazdil 	}
1781eeeee719SDavid Brazdil 
1782ff367fe4SDavid Brazdil 	kvm_host_psci_config.version = psci_ops.get_version();
1783ff367fe4SDavid Brazdil 
1784ff367fe4SDavid Brazdil 	if (kvm_host_psci_config.version == PSCI_VERSION(0, 1)) {
1785ff367fe4SDavid Brazdil 		kvm_host_psci_config.function_ids_0_1 = get_psci_0_1_function_ids();
1786767c973fSMarc Zyngier 		init_psci_0_1_impl_state(kvm_host_psci_config, cpu_suspend);
1787767c973fSMarc Zyngier 		init_psci_0_1_impl_state(kvm_host_psci_config, cpu_on);
1788767c973fSMarc Zyngier 		init_psci_0_1_impl_state(kvm_host_psci_config, cpu_off);
1789767c973fSMarc Zyngier 		init_psci_0_1_impl_state(kvm_host_psci_config, migrate);
1790ff367fe4SDavid Brazdil 	}
1791eeeee719SDavid Brazdil 	return true;
1792eeeee719SDavid Brazdil }
1793eeeee719SDavid Brazdil 
17949ed24f4bSMarc Zyngier static int init_subsystems(void)
17959ed24f4bSMarc Zyngier {
17969ed24f4bSMarc Zyngier 	int err = 0;
17979ed24f4bSMarc Zyngier 
17989ed24f4bSMarc Zyngier 	/*
17999ed24f4bSMarc Zyngier 	 * Enable hardware so that subsystem initialisation can access EL2.
18009ed24f4bSMarc Zyngier 	 */
18019ed24f4bSMarc Zyngier 	on_each_cpu(_kvm_arch_hardware_enable, NULL, 1);
18029ed24f4bSMarc Zyngier 
18039ed24f4bSMarc Zyngier 	/*
18049ed24f4bSMarc Zyngier 	 * Register CPU lower-power notifier
18059ed24f4bSMarc Zyngier 	 */
18069ed24f4bSMarc Zyngier 	hyp_cpu_pm_init();
18079ed24f4bSMarc Zyngier 
18089ed24f4bSMarc Zyngier 	/*
18099ed24f4bSMarc Zyngier 	 * Init HYP view of VGIC
18109ed24f4bSMarc Zyngier 	 */
18119ed24f4bSMarc Zyngier 	err = kvm_vgic_hyp_init();
18129ed24f4bSMarc Zyngier 	switch (err) {
18139ed24f4bSMarc Zyngier 	case 0:
18149ed24f4bSMarc Zyngier 		vgic_present = true;
18159ed24f4bSMarc Zyngier 		break;
18169ed24f4bSMarc Zyngier 	case -ENODEV:
18179ed24f4bSMarc Zyngier 	case -ENXIO:
18189ed24f4bSMarc Zyngier 		vgic_present = false;
18199ed24f4bSMarc Zyngier 		err = 0;
18209ed24f4bSMarc Zyngier 		break;
18219ed24f4bSMarc Zyngier 	default:
18229ed24f4bSMarc Zyngier 		goto out;
18239ed24f4bSMarc Zyngier 	}
18249ed24f4bSMarc Zyngier 
18259ed24f4bSMarc Zyngier 	/*
18269ed24f4bSMarc Zyngier 	 * Init HYP architected timer support
18279ed24f4bSMarc Zyngier 	 */
18289ed24f4bSMarc Zyngier 	err = kvm_timer_hyp_init(vgic_present);
18299ed24f4bSMarc Zyngier 	if (err)
18309ed24f4bSMarc Zyngier 		goto out;
18319ed24f4bSMarc Zyngier 
183217ed14ebSSean Christopherson 	kvm_register_perf_callbacks(NULL);
183317ed14ebSSean Christopherson 
18346ac4a5acSMarc Zyngier 	kvm_sys_reg_table_init();
18359ed24f4bSMarc Zyngier 
18369ed24f4bSMarc Zyngier out:
1837fa8c3d65SDavid Brazdil 	if (err || !is_protected_kvm_enabled())
18389ed24f4bSMarc Zyngier 		on_each_cpu(_kvm_arch_hardware_disable, NULL, 1);
18399ed24f4bSMarc Zyngier 
18409ed24f4bSMarc Zyngier 	return err;
18419ed24f4bSMarc Zyngier }
18429ed24f4bSMarc Zyngier 
18439ed24f4bSMarc Zyngier static void teardown_hyp_mode(void)
18449ed24f4bSMarc Zyngier {
18459ed24f4bSMarc Zyngier 	int cpu;
18469ed24f4bSMarc Zyngier 
18479ed24f4bSMarc Zyngier 	free_hyp_pgds();
184830c95391SDavid Brazdil 	for_each_possible_cpu(cpu) {
18499ed24f4bSMarc Zyngier 		free_page(per_cpu(kvm_arm_hyp_stack_page, cpu));
185030c95391SDavid Brazdil 		free_pages(kvm_arm_hyp_percpu_base[cpu], nvhe_percpu_order());
185130c95391SDavid Brazdil 	}
18529ed24f4bSMarc Zyngier }
18539ed24f4bSMarc Zyngier 
1854bfa79a80SQuentin Perret static int do_pkvm_init(u32 hyp_va_bits)
1855bfa79a80SQuentin Perret {
1856bfa79a80SQuentin Perret 	void *per_cpu_base = kvm_ksym_ref(kvm_arm_hyp_percpu_base);
1857bfa79a80SQuentin Perret 	int ret;
1858bfa79a80SQuentin Perret 
1859bfa79a80SQuentin Perret 	preempt_disable();
18608579a185SWill Deacon 	cpu_hyp_init_context();
1861bfa79a80SQuentin Perret 	ret = kvm_call_hyp_nvhe(__pkvm_init, hyp_mem_base, hyp_mem_size,
1862bfa79a80SQuentin Perret 				num_possible_cpus(), kern_hyp_va(per_cpu_base),
1863bfa79a80SQuentin Perret 				hyp_va_bits);
18648579a185SWill Deacon 	cpu_hyp_init_features();
18658579a185SWill Deacon 
18668579a185SWill Deacon 	/*
18678579a185SWill Deacon 	 * The stub hypercalls are now disabled, so set our local flag to
18688579a185SWill Deacon 	 * prevent a later re-init attempt in kvm_arch_hardware_enable().
18698579a185SWill Deacon 	 */
18708579a185SWill Deacon 	__this_cpu_write(kvm_arm_hardware_enabled, 1);
1871bfa79a80SQuentin Perret 	preempt_enable();
1872bfa79a80SQuentin Perret 
1873bfa79a80SQuentin Perret 	return ret;
1874bfa79a80SQuentin Perret }
1875bfa79a80SQuentin Perret 
1876bfa79a80SQuentin Perret static int kvm_hyp_init_protection(u32 hyp_va_bits)
1877bfa79a80SQuentin Perret {
1878bfa79a80SQuentin Perret 	void *addr = phys_to_virt(hyp_mem_base);
1879bfa79a80SQuentin Perret 	int ret;
1880bfa79a80SQuentin Perret 
18816c30bfb1SFuad Tabba 	kvm_nvhe_sym(id_aa64pfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64PFR0_EL1);
18826c30bfb1SFuad Tabba 	kvm_nvhe_sym(id_aa64pfr1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64PFR1_EL1);
18836c30bfb1SFuad Tabba 	kvm_nvhe_sym(id_aa64isar0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR0_EL1);
18846c30bfb1SFuad Tabba 	kvm_nvhe_sym(id_aa64isar1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR1_EL1);
1885def8c222SVladimir Murzin 	kvm_nvhe_sym(id_aa64isar2_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64ISAR2_EL1);
18867c419937SMarc Zyngier 	kvm_nvhe_sym(id_aa64mmfr0_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR0_EL1);
18877c419937SMarc Zyngier 	kvm_nvhe_sym(id_aa64mmfr1_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR1_EL1);
18886c30bfb1SFuad Tabba 	kvm_nvhe_sym(id_aa64mmfr2_el1_sys_val) = read_sanitised_ftr_reg(SYS_ID_AA64MMFR2_EL1);
18897c419937SMarc Zyngier 
1890bfa79a80SQuentin Perret 	ret = create_hyp_mappings(addr, addr + hyp_mem_size, PAGE_HYP);
1891bfa79a80SQuentin Perret 	if (ret)
1892bfa79a80SQuentin Perret 		return ret;
1893bfa79a80SQuentin Perret 
1894bfa79a80SQuentin Perret 	ret = do_pkvm_init(hyp_va_bits);
1895bfa79a80SQuentin Perret 	if (ret)
1896bfa79a80SQuentin Perret 		return ret;
1897bfa79a80SQuentin Perret 
1898bfa79a80SQuentin Perret 	free_hyp_pgds();
1899bfa79a80SQuentin Perret 
1900bfa79a80SQuentin Perret 	return 0;
1901bfa79a80SQuentin Perret }
1902bfa79a80SQuentin Perret 
19039ed24f4bSMarc Zyngier /**
19049ed24f4bSMarc Zyngier  * Inits Hyp-mode on all online CPUs
19059ed24f4bSMarc Zyngier  */
19069ed24f4bSMarc Zyngier static int init_hyp_mode(void)
19079ed24f4bSMarc Zyngier {
1908bfa79a80SQuentin Perret 	u32 hyp_va_bits;
19099ed24f4bSMarc Zyngier 	int cpu;
1910bfa79a80SQuentin Perret 	int err = -ENOMEM;
1911bfa79a80SQuentin Perret 
1912bfa79a80SQuentin Perret 	/*
1913bfa79a80SQuentin Perret 	 * The protected Hyp-mode cannot be initialized if the memory pool
1914bfa79a80SQuentin Perret 	 * allocation has failed.
1915bfa79a80SQuentin Perret 	 */
1916bfa79a80SQuentin Perret 	if (is_protected_kvm_enabled() && !hyp_mem_base)
1917bfa79a80SQuentin Perret 		goto out_err;
19189ed24f4bSMarc Zyngier 
19199ed24f4bSMarc Zyngier 	/*
19209ed24f4bSMarc Zyngier 	 * Allocate Hyp PGD and setup Hyp identity mapping
19219ed24f4bSMarc Zyngier 	 */
1922bfa79a80SQuentin Perret 	err = kvm_mmu_init(&hyp_va_bits);
19239ed24f4bSMarc Zyngier 	if (err)
19249ed24f4bSMarc Zyngier 		goto out_err;
19259ed24f4bSMarc Zyngier 
19269ed24f4bSMarc Zyngier 	/*
19279ed24f4bSMarc Zyngier 	 * Allocate stack pages for Hypervisor-mode
19289ed24f4bSMarc Zyngier 	 */
19299ed24f4bSMarc Zyngier 	for_each_possible_cpu(cpu) {
19309ed24f4bSMarc Zyngier 		unsigned long stack_page;
19319ed24f4bSMarc Zyngier 
19329ed24f4bSMarc Zyngier 		stack_page = __get_free_page(GFP_KERNEL);
19339ed24f4bSMarc Zyngier 		if (!stack_page) {
19349ed24f4bSMarc Zyngier 			err = -ENOMEM;
19359ed24f4bSMarc Zyngier 			goto out_err;
19369ed24f4bSMarc Zyngier 		}
19379ed24f4bSMarc Zyngier 
19389ed24f4bSMarc Zyngier 		per_cpu(kvm_arm_hyp_stack_page, cpu) = stack_page;
19399ed24f4bSMarc Zyngier 	}
19409ed24f4bSMarc Zyngier 
19419ed24f4bSMarc Zyngier 	/*
194230c95391SDavid Brazdil 	 * Allocate and initialize pages for Hypervisor-mode percpu regions.
194330c95391SDavid Brazdil 	 */
194430c95391SDavid Brazdil 	for_each_possible_cpu(cpu) {
194530c95391SDavid Brazdil 		struct page *page;
194630c95391SDavid Brazdil 		void *page_addr;
194730c95391SDavid Brazdil 
194830c95391SDavid Brazdil 		page = alloc_pages(GFP_KERNEL, nvhe_percpu_order());
194930c95391SDavid Brazdil 		if (!page) {
195030c95391SDavid Brazdil 			err = -ENOMEM;
195130c95391SDavid Brazdil 			goto out_err;
195230c95391SDavid Brazdil 		}
195330c95391SDavid Brazdil 
195430c95391SDavid Brazdil 		page_addr = page_address(page);
195530c95391SDavid Brazdil 		memcpy(page_addr, CHOOSE_NVHE_SYM(__per_cpu_start), nvhe_percpu_size());
195630c95391SDavid Brazdil 		kvm_arm_hyp_percpu_base[cpu] = (unsigned long)page_addr;
195730c95391SDavid Brazdil 	}
195830c95391SDavid Brazdil 
195930c95391SDavid Brazdil 	/*
19609ed24f4bSMarc Zyngier 	 * Map the Hyp-code called directly from the host
19619ed24f4bSMarc Zyngier 	 */
19629ed24f4bSMarc Zyngier 	err = create_hyp_mappings(kvm_ksym_ref(__hyp_text_start),
19639ed24f4bSMarc Zyngier 				  kvm_ksym_ref(__hyp_text_end), PAGE_HYP_EXEC);
19649ed24f4bSMarc Zyngier 	if (err) {
19659ed24f4bSMarc Zyngier 		kvm_err("Cannot map world-switch code\n");
19669ed24f4bSMarc Zyngier 		goto out_err;
19679ed24f4bSMarc Zyngier 	}
19689ed24f4bSMarc Zyngier 
196916174eeaSDavid Brazdil 	err = create_hyp_mappings(kvm_ksym_ref(__hyp_rodata_start),
197016174eeaSDavid Brazdil 				  kvm_ksym_ref(__hyp_rodata_end), PAGE_HYP_RO);
19712d7bf218SDavid Brazdil 	if (err) {
197216174eeaSDavid Brazdil 		kvm_err("Cannot map .hyp.rodata section\n");
19732d7bf218SDavid Brazdil 		goto out_err;
19742d7bf218SDavid Brazdil 	}
19752d7bf218SDavid Brazdil 
19769ed24f4bSMarc Zyngier 	err = create_hyp_mappings(kvm_ksym_ref(__start_rodata),
19779ed24f4bSMarc Zyngier 				  kvm_ksym_ref(__end_rodata), PAGE_HYP_RO);
19789ed24f4bSMarc Zyngier 	if (err) {
19799ed24f4bSMarc Zyngier 		kvm_err("Cannot map rodata section\n");
19809ed24f4bSMarc Zyngier 		goto out_err;
19819ed24f4bSMarc Zyngier 	}
19829ed24f4bSMarc Zyngier 
1983380e18adSQuentin Perret 	/*
1984380e18adSQuentin Perret 	 * .hyp.bss is guaranteed to be placed at the beginning of the .bss
1985380e18adSQuentin Perret 	 * section thanks to an assertion in the linker script. Map it RW and
1986380e18adSQuentin Perret 	 * the rest of .bss RO.
1987380e18adSQuentin Perret 	 */
1988380e18adSQuentin Perret 	err = create_hyp_mappings(kvm_ksym_ref(__hyp_bss_start),
1989380e18adSQuentin Perret 				  kvm_ksym_ref(__hyp_bss_end), PAGE_HYP);
1990380e18adSQuentin Perret 	if (err) {
1991380e18adSQuentin Perret 		kvm_err("Cannot map hyp bss section: %d\n", err);
1992380e18adSQuentin Perret 		goto out_err;
1993380e18adSQuentin Perret 	}
1994380e18adSQuentin Perret 
1995380e18adSQuentin Perret 	err = create_hyp_mappings(kvm_ksym_ref(__hyp_bss_end),
19969ed24f4bSMarc Zyngier 				  kvm_ksym_ref(__bss_stop), PAGE_HYP_RO);
19979ed24f4bSMarc Zyngier 	if (err) {
19989ed24f4bSMarc Zyngier 		kvm_err("Cannot map bss section\n");
19999ed24f4bSMarc Zyngier 		goto out_err;
20009ed24f4bSMarc Zyngier 	}
20019ed24f4bSMarc Zyngier 
20029ed24f4bSMarc Zyngier 	/*
20039ed24f4bSMarc Zyngier 	 * Map the Hyp stack pages
20049ed24f4bSMarc Zyngier 	 */
20059ed24f4bSMarc Zyngier 	for_each_possible_cpu(cpu) {
20069ed24f4bSMarc Zyngier 		char *stack_page = (char *)per_cpu(kvm_arm_hyp_stack_page, cpu);
20079ed24f4bSMarc Zyngier 		err = create_hyp_mappings(stack_page, stack_page + PAGE_SIZE,
20089ed24f4bSMarc Zyngier 					  PAGE_HYP);
20099ed24f4bSMarc Zyngier 
20109ed24f4bSMarc Zyngier 		if (err) {
20119ed24f4bSMarc Zyngier 			kvm_err("Cannot map hyp stack\n");
20129ed24f4bSMarc Zyngier 			goto out_err;
20139ed24f4bSMarc Zyngier 		}
20149ed24f4bSMarc Zyngier 	}
20159ed24f4bSMarc Zyngier 
20169ed24f4bSMarc Zyngier 	for_each_possible_cpu(cpu) {
201730c95391SDavid Brazdil 		char *percpu_begin = (char *)kvm_arm_hyp_percpu_base[cpu];
201830c95391SDavid Brazdil 		char *percpu_end = percpu_begin + nvhe_percpu_size();
20199ed24f4bSMarc Zyngier 
20209cc77581SQuentin Perret 		/* Map Hyp percpu pages */
202130c95391SDavid Brazdil 		err = create_hyp_mappings(percpu_begin, percpu_end, PAGE_HYP);
20229ed24f4bSMarc Zyngier 		if (err) {
202330c95391SDavid Brazdil 			kvm_err("Cannot map hyp percpu region\n");
20246e3bfbb2SAndrew Scull 			goto out_err;
20256e3bfbb2SAndrew Scull 		}
20269cc77581SQuentin Perret 
20279cc77581SQuentin Perret 		/* Prepare the CPU initialization parameters */
20289cc77581SQuentin Perret 		cpu_prepare_hyp_mode(cpu);
20299ed24f4bSMarc Zyngier 	}
20309ed24f4bSMarc Zyngier 
2031eeeee719SDavid Brazdil 	if (is_protected_kvm_enabled()) {
203294f5e8a4SDavid Brazdil 		init_cpu_logical_map();
203394f5e8a4SDavid Brazdil 
203452b9e265SWang Wensheng 		if (!init_psci_relay()) {
203552b9e265SWang Wensheng 			err = -ENODEV;
2036eeeee719SDavid Brazdil 			goto out_err;
2037eeeee719SDavid Brazdil 		}
203852b9e265SWang Wensheng 	}
2039eeeee719SDavid Brazdil 
2040bfa79a80SQuentin Perret 	if (is_protected_kvm_enabled()) {
2041bfa79a80SQuentin Perret 		err = kvm_hyp_init_protection(hyp_va_bits);
2042bfa79a80SQuentin Perret 		if (err) {
2043bfa79a80SQuentin Perret 			kvm_err("Failed to init hyp memory protection\n");
2044bfa79a80SQuentin Perret 			goto out_err;
2045bfa79a80SQuentin Perret 		}
2046bfa79a80SQuentin Perret 	}
20479ed24f4bSMarc Zyngier 
20489ed24f4bSMarc Zyngier 	return 0;
20499ed24f4bSMarc Zyngier 
20509ed24f4bSMarc Zyngier out_err:
20519ed24f4bSMarc Zyngier 	teardown_hyp_mode();
20529ed24f4bSMarc Zyngier 	kvm_err("error initializing Hyp mode: %d\n", err);
20539ed24f4bSMarc Zyngier 	return err;
20549ed24f4bSMarc Zyngier }
20559ed24f4bSMarc Zyngier 
20562f2e1a50SWill Deacon static void _kvm_host_prot_finalize(void *arg)
20571025c8c0SQuentin Perret {
20582f2e1a50SWill Deacon 	int *err = arg;
20592f2e1a50SWill Deacon 
20602f2e1a50SWill Deacon 	if (WARN_ON(kvm_call_hyp_nvhe(__pkvm_prot_finalize)))
20612f2e1a50SWill Deacon 		WRITE_ONCE(*err, -EINVAL);
20622f2e1a50SWill Deacon }
20632f2e1a50SWill Deacon 
20642f2e1a50SWill Deacon static int pkvm_drop_host_privileges(void)
20652f2e1a50SWill Deacon {
20662f2e1a50SWill Deacon 	int ret = 0;
20672f2e1a50SWill Deacon 
20682f2e1a50SWill Deacon 	/*
20692f2e1a50SWill Deacon 	 * Flip the static key upfront as that may no longer be possible
20702f2e1a50SWill Deacon 	 * once the host stage 2 is installed.
20712f2e1a50SWill Deacon 	 */
20722f2e1a50SWill Deacon 	static_branch_enable(&kvm_protected_mode_initialized);
20732f2e1a50SWill Deacon 	on_each_cpu(_kvm_host_prot_finalize, &ret, 1);
20742f2e1a50SWill Deacon 	return ret;
20751025c8c0SQuentin Perret }
20761025c8c0SQuentin Perret 
2077bfa79a80SQuentin Perret static int finalize_hyp_mode(void)
2078bfa79a80SQuentin Perret {
2079bfa79a80SQuentin Perret 	if (!is_protected_kvm_enabled())
2080bfa79a80SQuentin Perret 		return 0;
2081bfa79a80SQuentin Perret 
208247e6223cSMarc Zyngier 	/*
208347e6223cSMarc Zyngier 	 * Exclude HYP BSS from kmemleak so that it doesn't get peeked
208447e6223cSMarc Zyngier 	 * at, which would end badly once the section is inaccessible.
208547e6223cSMarc Zyngier 	 * None of other sections should ever be introspected.
208647e6223cSMarc Zyngier 	 */
208747e6223cSMarc Zyngier 	kmemleak_free_part(__hyp_bss_start, __hyp_bss_end - __hyp_bss_start);
20882f2e1a50SWill Deacon 	return pkvm_drop_host_privileges();
2089bfa79a80SQuentin Perret }
2090bfa79a80SQuentin Perret 
20919ed24f4bSMarc Zyngier struct kvm_vcpu *kvm_mpidr_to_vcpu(struct kvm *kvm, unsigned long mpidr)
20929ed24f4bSMarc Zyngier {
20939ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu;
209446808a4cSMarc Zyngier 	unsigned long i;
20959ed24f4bSMarc Zyngier 
20969ed24f4bSMarc Zyngier 	mpidr &= MPIDR_HWID_BITMASK;
20979ed24f4bSMarc Zyngier 	kvm_for_each_vcpu(i, vcpu, kvm) {
20989ed24f4bSMarc Zyngier 		if (mpidr == kvm_vcpu_get_mpidr_aff(vcpu))
20999ed24f4bSMarc Zyngier 			return vcpu;
21009ed24f4bSMarc Zyngier 	}
21019ed24f4bSMarc Zyngier 	return NULL;
21029ed24f4bSMarc Zyngier }
21039ed24f4bSMarc Zyngier 
21049ed24f4bSMarc Zyngier bool kvm_arch_has_irq_bypass(void)
21059ed24f4bSMarc Zyngier {
21069ed24f4bSMarc Zyngier 	return true;
21079ed24f4bSMarc Zyngier }
21089ed24f4bSMarc Zyngier 
21099ed24f4bSMarc Zyngier int kvm_arch_irq_bypass_add_producer(struct irq_bypass_consumer *cons,
21109ed24f4bSMarc Zyngier 				      struct irq_bypass_producer *prod)
21119ed24f4bSMarc Zyngier {
21129ed24f4bSMarc Zyngier 	struct kvm_kernel_irqfd *irqfd =
21139ed24f4bSMarc Zyngier 		container_of(cons, struct kvm_kernel_irqfd, consumer);
21149ed24f4bSMarc Zyngier 
21159ed24f4bSMarc Zyngier 	return kvm_vgic_v4_set_forwarding(irqfd->kvm, prod->irq,
21169ed24f4bSMarc Zyngier 					  &irqfd->irq_entry);
21179ed24f4bSMarc Zyngier }
21189ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_del_producer(struct irq_bypass_consumer *cons,
21199ed24f4bSMarc Zyngier 				      struct irq_bypass_producer *prod)
21209ed24f4bSMarc Zyngier {
21219ed24f4bSMarc Zyngier 	struct kvm_kernel_irqfd *irqfd =
21229ed24f4bSMarc Zyngier 		container_of(cons, struct kvm_kernel_irqfd, consumer);
21239ed24f4bSMarc Zyngier 
21249ed24f4bSMarc Zyngier 	kvm_vgic_v4_unset_forwarding(irqfd->kvm, prod->irq,
21259ed24f4bSMarc Zyngier 				     &irqfd->irq_entry);
21269ed24f4bSMarc Zyngier }
21279ed24f4bSMarc Zyngier 
21289ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_stop(struct irq_bypass_consumer *cons)
21299ed24f4bSMarc Zyngier {
21309ed24f4bSMarc Zyngier 	struct kvm_kernel_irqfd *irqfd =
21319ed24f4bSMarc Zyngier 		container_of(cons, struct kvm_kernel_irqfd, consumer);
21329ed24f4bSMarc Zyngier 
21339ed24f4bSMarc Zyngier 	kvm_arm_halt_guest(irqfd->kvm);
21349ed24f4bSMarc Zyngier }
21359ed24f4bSMarc Zyngier 
21369ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_start(struct irq_bypass_consumer *cons)
21379ed24f4bSMarc Zyngier {
21389ed24f4bSMarc Zyngier 	struct kvm_kernel_irqfd *irqfd =
21399ed24f4bSMarc Zyngier 		container_of(cons, struct kvm_kernel_irqfd, consumer);
21409ed24f4bSMarc Zyngier 
21419ed24f4bSMarc Zyngier 	kvm_arm_resume_guest(irqfd->kvm);
21429ed24f4bSMarc Zyngier }
21439ed24f4bSMarc Zyngier 
21449ed24f4bSMarc Zyngier /**
21459ed24f4bSMarc Zyngier  * Initialize Hyp-mode and memory mappings on all CPUs.
21469ed24f4bSMarc Zyngier  */
21479ed24f4bSMarc Zyngier int kvm_arch_init(void *opaque)
21489ed24f4bSMarc Zyngier {
21499ed24f4bSMarc Zyngier 	int err;
21509ed24f4bSMarc Zyngier 	bool in_hyp_mode;
21519ed24f4bSMarc Zyngier 
21529ed24f4bSMarc Zyngier 	if (!is_hyp_mode_available()) {
21539ed24f4bSMarc Zyngier 		kvm_info("HYP mode not available\n");
21549ed24f4bSMarc Zyngier 		return -ENODEV;
21559ed24f4bSMarc Zyngier 	}
21569ed24f4bSMarc Zyngier 
2157b6a68b97SMarc Zyngier 	if (kvm_get_mode() == KVM_MODE_NONE) {
2158b6a68b97SMarc Zyngier 		kvm_info("KVM disabled from command line\n");
2159b6a68b97SMarc Zyngier 		return -ENODEV;
2160b6a68b97SMarc Zyngier 	}
2161b6a68b97SMarc Zyngier 
21629ed24f4bSMarc Zyngier 	in_hyp_mode = is_kernel_in_hyp_mode();
21639ed24f4bSMarc Zyngier 
216496d389caSRob Herring 	if (cpus_have_final_cap(ARM64_WORKAROUND_DEVICE_LOAD_ACQUIRE) ||
216596d389caSRob Herring 	    cpus_have_final_cap(ARM64_WORKAROUND_1508412))
2166abf532ccSRob Herring 		kvm_info("Guests without required CPU erratum workarounds can deadlock system!\n" \
2167abf532ccSRob Herring 			 "Only trusted guests should be used on this system.\n");
2168abf532ccSRob Herring 
2169bf249d9eSAnshuman Khandual 	err = kvm_set_ipa_limit();
21709ed24f4bSMarc Zyngier 	if (err)
21719ed24f4bSMarc Zyngier 		return err;
21729ed24f4bSMarc Zyngier 
21739ed24f4bSMarc Zyngier 	err = kvm_arm_init_sve();
21749ed24f4bSMarc Zyngier 	if (err)
21759ed24f4bSMarc Zyngier 		return err;
21769ed24f4bSMarc Zyngier 
21773248136bSJulien Grall 	err = kvm_arm_vmid_alloc_init();
21783248136bSJulien Grall 	if (err) {
21793248136bSJulien Grall 		kvm_err("Failed to initialize VMID allocator.\n");
21803248136bSJulien Grall 		return err;
21813248136bSJulien Grall 	}
21823248136bSJulien Grall 
21839ed24f4bSMarc Zyngier 	if (!in_hyp_mode) {
21849ed24f4bSMarc Zyngier 		err = init_hyp_mode();
21859ed24f4bSMarc Zyngier 		if (err)
21869ed24f4bSMarc Zyngier 			goto out_err;
21879ed24f4bSMarc Zyngier 	}
21889ed24f4bSMarc Zyngier 
2189b881cdceSWill Deacon 	err = kvm_init_vector_slots();
2190b881cdceSWill Deacon 	if (err) {
2191b881cdceSWill Deacon 		kvm_err("Cannot initialise vector slots\n");
2192b881cdceSWill Deacon 		goto out_err;
2193b881cdceSWill Deacon 	}
2194b881cdceSWill Deacon 
21959ed24f4bSMarc Zyngier 	err = init_subsystems();
21969ed24f4bSMarc Zyngier 	if (err)
21979ed24f4bSMarc Zyngier 		goto out_hyp;
21989ed24f4bSMarc Zyngier 
2199bfa79a80SQuentin Perret 	if (!in_hyp_mode) {
2200bfa79a80SQuentin Perret 		err = finalize_hyp_mode();
2201bfa79a80SQuentin Perret 		if (err) {
2202bfa79a80SQuentin Perret 			kvm_err("Failed to finalize Hyp protection\n");
2203bfa79a80SQuentin Perret 			goto out_hyp;
2204bfa79a80SQuentin Perret 		}
2205bfa79a80SQuentin Perret 	}
2206bfa79a80SQuentin Perret 
2207f19f6644SDavid Brazdil 	if (is_protected_kvm_enabled()) {
22083eb681fbSDavid Brazdil 		kvm_info("Protected nVHE mode initialized successfully\n");
2209f19f6644SDavid Brazdil 	} else if (in_hyp_mode) {
22109ed24f4bSMarc Zyngier 		kvm_info("VHE mode initialized successfully\n");
2211f19f6644SDavid Brazdil 	} else {
22129ed24f4bSMarc Zyngier 		kvm_info("Hyp mode initialized successfully\n");
2213f19f6644SDavid Brazdil 	}
22149ed24f4bSMarc Zyngier 
22159ed24f4bSMarc Zyngier 	return 0;
22169ed24f4bSMarc Zyngier 
22179ed24f4bSMarc Zyngier out_hyp:
22189ed24f4bSMarc Zyngier 	hyp_cpu_pm_exit();
22199ed24f4bSMarc Zyngier 	if (!in_hyp_mode)
22209ed24f4bSMarc Zyngier 		teardown_hyp_mode();
22219ed24f4bSMarc Zyngier out_err:
22223248136bSJulien Grall 	kvm_arm_vmid_alloc_free();
22239ed24f4bSMarc Zyngier 	return err;
22249ed24f4bSMarc Zyngier }
22259ed24f4bSMarc Zyngier 
22269ed24f4bSMarc Zyngier /* NOP: Compiling as a module not supported */
22279ed24f4bSMarc Zyngier void kvm_arch_exit(void)
22289ed24f4bSMarc Zyngier {
222917ed14ebSSean Christopherson 	kvm_unregister_perf_callbacks();
22309ed24f4bSMarc Zyngier }
22319ed24f4bSMarc Zyngier 
2232d8b369c4SDavid Brazdil static int __init early_kvm_mode_cfg(char *arg)
2233d8b369c4SDavid Brazdil {
2234d8b369c4SDavid Brazdil 	if (!arg)
2235d8b369c4SDavid Brazdil 		return -EINVAL;
2236d8b369c4SDavid Brazdil 
2237d8b369c4SDavid Brazdil 	if (strcmp(arg, "protected") == 0) {
2238d8b369c4SDavid Brazdil 		kvm_mode = KVM_MODE_PROTECTED;
2239d8b369c4SDavid Brazdil 		return 0;
2240d8b369c4SDavid Brazdil 	}
2241d8b369c4SDavid Brazdil 
2242b6a68b97SMarc Zyngier 	if (strcmp(arg, "nvhe") == 0 && !WARN_ON(is_kernel_in_hyp_mode())) {
2243b6a68b97SMarc Zyngier 		kvm_mode = KVM_MODE_DEFAULT;
22441945a067SMarc Zyngier 		return 0;
2245b6a68b97SMarc Zyngier 	}
2246b6a68b97SMarc Zyngier 
2247b6a68b97SMarc Zyngier 	if (strcmp(arg, "none") == 0) {
2248b6a68b97SMarc Zyngier 		kvm_mode = KVM_MODE_NONE;
2249b6a68b97SMarc Zyngier 		return 0;
2250b6a68b97SMarc Zyngier 	}
22511945a067SMarc Zyngier 
2252d8b369c4SDavid Brazdil 	return -EINVAL;
2253d8b369c4SDavid Brazdil }
2254d8b369c4SDavid Brazdil early_param("kvm-arm.mode", early_kvm_mode_cfg);
2255d8b369c4SDavid Brazdil 
22563eb681fbSDavid Brazdil enum kvm_mode kvm_get_mode(void)
22573eb681fbSDavid Brazdil {
22583eb681fbSDavid Brazdil 	return kvm_mode;
22593eb681fbSDavid Brazdil }
22603eb681fbSDavid Brazdil 
22619ed24f4bSMarc Zyngier static int arm_init(void)
22629ed24f4bSMarc Zyngier {
22639ed24f4bSMarc Zyngier 	int rc = kvm_init(NULL, sizeof(struct kvm_vcpu), 0, THIS_MODULE);
22649ed24f4bSMarc Zyngier 	return rc;
22659ed24f4bSMarc Zyngier }
22669ed24f4bSMarc Zyngier 
22679ed24f4bSMarc Zyngier module_init(arm_init);
2268