xref: /linux/arch/arm64/kvm/arm.c (revision 09cf57eba304246141367b95c89801fd2047ac96)
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>
99ed24f4bSMarc Zyngier #include <linux/errno.h>
109ed24f4bSMarc Zyngier #include <linux/err.h>
119ed24f4bSMarc Zyngier #include <linux/kvm_host.h>
129ed24f4bSMarc Zyngier #include <linux/list.h>
139ed24f4bSMarc Zyngier #include <linux/module.h>
149ed24f4bSMarc Zyngier #include <linux/vmalloc.h>
159ed24f4bSMarc Zyngier #include <linux/fs.h>
169ed24f4bSMarc Zyngier #include <linux/mman.h>
179ed24f4bSMarc Zyngier #include <linux/sched.h>
189ed24f4bSMarc Zyngier #include <linux/kvm.h>
199ed24f4bSMarc Zyngier #include <linux/kvm_irqfd.h>
209ed24f4bSMarc Zyngier #include <linux/irqbypass.h>
219ed24f4bSMarc Zyngier #include <linux/sched/stat.h>
229ed24f4bSMarc Zyngier #include <trace/events/kvm.h>
239ed24f4bSMarc Zyngier 
249ed24f4bSMarc Zyngier #define CREATE_TRACE_POINTS
259ed24f4bSMarc Zyngier #include "trace_arm.h"
269ed24f4bSMarc Zyngier 
279ed24f4bSMarc Zyngier #include <linux/uaccess.h>
289ed24f4bSMarc Zyngier #include <asm/ptrace.h>
299ed24f4bSMarc Zyngier #include <asm/mman.h>
309ed24f4bSMarc Zyngier #include <asm/tlbflush.h>
319ed24f4bSMarc Zyngier #include <asm/cacheflush.h>
329ed24f4bSMarc Zyngier #include <asm/cpufeature.h>
339ed24f4bSMarc Zyngier #include <asm/virt.h>
349ed24f4bSMarc Zyngier #include <asm/kvm_arm.h>
359ed24f4bSMarc Zyngier #include <asm/kvm_asm.h>
369ed24f4bSMarc Zyngier #include <asm/kvm_mmu.h>
379ed24f4bSMarc Zyngier #include <asm/kvm_emulate.h>
389ed24f4bSMarc Zyngier #include <asm/kvm_coproc.h>
399ed24f4bSMarc Zyngier #include <asm/sections.h>
409ed24f4bSMarc Zyngier 
419ed24f4bSMarc Zyngier #include <kvm/arm_hypercalls.h>
429ed24f4bSMarc Zyngier #include <kvm/arm_pmu.h>
439ed24f4bSMarc Zyngier #include <kvm/arm_psci.h>
449ed24f4bSMarc Zyngier 
459ed24f4bSMarc Zyngier #ifdef REQUIRES_VIRT
469ed24f4bSMarc Zyngier __asm__(".arch_extension	virt");
479ed24f4bSMarc Zyngier #endif
489ed24f4bSMarc Zyngier 
499ed24f4bSMarc Zyngier DEFINE_PER_CPU(kvm_host_data_t, kvm_host_data);
509ed24f4bSMarc Zyngier static DEFINE_PER_CPU(unsigned long, kvm_arm_hyp_stack_page);
519ed24f4bSMarc Zyngier 
529ed24f4bSMarc Zyngier /* The VMID used in the VTTBR */
539ed24f4bSMarc Zyngier static atomic64_t kvm_vmid_gen = ATOMIC64_INIT(1);
549ed24f4bSMarc Zyngier static u32 kvm_next_vmid;
559ed24f4bSMarc Zyngier static DEFINE_SPINLOCK(kvm_vmid_lock);
569ed24f4bSMarc Zyngier 
579ed24f4bSMarc Zyngier static bool vgic_present;
589ed24f4bSMarc Zyngier 
599ed24f4bSMarc Zyngier static DEFINE_PER_CPU(unsigned char, kvm_arm_hardware_enabled);
609ed24f4bSMarc Zyngier DEFINE_STATIC_KEY_FALSE(userspace_irqchip_in_use);
619ed24f4bSMarc Zyngier 
629ed24f4bSMarc Zyngier int kvm_arch_vcpu_should_kick(struct kvm_vcpu *vcpu)
639ed24f4bSMarc Zyngier {
649ed24f4bSMarc Zyngier 	return kvm_vcpu_exiting_guest_mode(vcpu) == IN_GUEST_MODE;
659ed24f4bSMarc Zyngier }
669ed24f4bSMarc Zyngier 
679ed24f4bSMarc Zyngier int kvm_arch_hardware_setup(void *opaque)
689ed24f4bSMarc Zyngier {
699ed24f4bSMarc Zyngier 	return 0;
709ed24f4bSMarc Zyngier }
719ed24f4bSMarc Zyngier 
729ed24f4bSMarc Zyngier int kvm_arch_check_processor_compat(void *opaque)
739ed24f4bSMarc Zyngier {
749ed24f4bSMarc Zyngier 	return 0;
759ed24f4bSMarc Zyngier }
769ed24f4bSMarc Zyngier 
779ed24f4bSMarc Zyngier int kvm_vm_ioctl_enable_cap(struct kvm *kvm,
789ed24f4bSMarc Zyngier 			    struct kvm_enable_cap *cap)
799ed24f4bSMarc Zyngier {
809ed24f4bSMarc Zyngier 	int r;
819ed24f4bSMarc Zyngier 
829ed24f4bSMarc Zyngier 	if (cap->flags)
839ed24f4bSMarc Zyngier 		return -EINVAL;
849ed24f4bSMarc Zyngier 
859ed24f4bSMarc Zyngier 	switch (cap->cap) {
869ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_NISV_TO_USER:
879ed24f4bSMarc Zyngier 		r = 0;
889ed24f4bSMarc Zyngier 		kvm->arch.return_nisv_io_abort_to_user = true;
899ed24f4bSMarc Zyngier 		break;
909ed24f4bSMarc Zyngier 	default:
919ed24f4bSMarc Zyngier 		r = -EINVAL;
929ed24f4bSMarc Zyngier 		break;
939ed24f4bSMarc Zyngier 	}
949ed24f4bSMarc Zyngier 
959ed24f4bSMarc Zyngier 	return r;
969ed24f4bSMarc Zyngier }
979ed24f4bSMarc Zyngier 
985107000fSMarc Zyngier static int kvm_arm_default_max_vcpus(void)
995107000fSMarc Zyngier {
1005107000fSMarc Zyngier 	return vgic_present ? kvm_vgic_get_max_vcpus() : KVM_MAX_VCPUS;
1015107000fSMarc Zyngier }
1025107000fSMarc Zyngier 
1039ed24f4bSMarc Zyngier /**
1049ed24f4bSMarc Zyngier  * kvm_arch_init_vm - initializes a VM data structure
1059ed24f4bSMarc Zyngier  * @kvm:	pointer to the KVM struct
1069ed24f4bSMarc Zyngier  */
1079ed24f4bSMarc Zyngier int kvm_arch_init_vm(struct kvm *kvm, unsigned long type)
1089ed24f4bSMarc Zyngier {
1099ed24f4bSMarc Zyngier 	int ret, cpu;
1109ed24f4bSMarc Zyngier 
1119ed24f4bSMarc Zyngier 	ret = kvm_arm_setup_stage2(kvm, type);
1129ed24f4bSMarc Zyngier 	if (ret)
1139ed24f4bSMarc Zyngier 		return ret;
1149ed24f4bSMarc Zyngier 
1159ed24f4bSMarc Zyngier 	kvm->arch.last_vcpu_ran = alloc_percpu(typeof(*kvm->arch.last_vcpu_ran));
1169ed24f4bSMarc Zyngier 	if (!kvm->arch.last_vcpu_ran)
1179ed24f4bSMarc Zyngier 		return -ENOMEM;
1189ed24f4bSMarc Zyngier 
1199ed24f4bSMarc Zyngier 	for_each_possible_cpu(cpu)
1209ed24f4bSMarc Zyngier 		*per_cpu_ptr(kvm->arch.last_vcpu_ran, cpu) = -1;
1219ed24f4bSMarc Zyngier 
1229ed24f4bSMarc Zyngier 	ret = kvm_alloc_stage2_pgd(kvm);
1239ed24f4bSMarc Zyngier 	if (ret)
1249ed24f4bSMarc Zyngier 		goto out_fail_alloc;
1259ed24f4bSMarc Zyngier 
1269ed24f4bSMarc Zyngier 	ret = create_hyp_mappings(kvm, kvm + 1, PAGE_HYP);
1279ed24f4bSMarc Zyngier 	if (ret)
1289ed24f4bSMarc Zyngier 		goto out_free_stage2_pgd;
1299ed24f4bSMarc Zyngier 
1309ed24f4bSMarc Zyngier 	kvm_vgic_early_init(kvm);
1319ed24f4bSMarc Zyngier 
1329ed24f4bSMarc Zyngier 	/* Mark the initial VMID generation invalid */
1339ed24f4bSMarc Zyngier 	kvm->arch.vmid.vmid_gen = 0;
1349ed24f4bSMarc Zyngier 
1359ed24f4bSMarc Zyngier 	/* The maximum number of VCPUs is limited by the host's GIC model */
1365107000fSMarc Zyngier 	kvm->arch.max_vcpus = kvm_arm_default_max_vcpus();
1379ed24f4bSMarc Zyngier 
1389ed24f4bSMarc Zyngier 	return ret;
1399ed24f4bSMarc Zyngier out_free_stage2_pgd:
1409ed24f4bSMarc Zyngier 	kvm_free_stage2_pgd(kvm);
1419ed24f4bSMarc Zyngier out_fail_alloc:
1429ed24f4bSMarc Zyngier 	free_percpu(kvm->arch.last_vcpu_ran);
1439ed24f4bSMarc Zyngier 	kvm->arch.last_vcpu_ran = NULL;
1449ed24f4bSMarc Zyngier 	return ret;
1459ed24f4bSMarc Zyngier }
1469ed24f4bSMarc Zyngier 
1479ed24f4bSMarc Zyngier vm_fault_t kvm_arch_vcpu_fault(struct kvm_vcpu *vcpu, struct vm_fault *vmf)
1489ed24f4bSMarc Zyngier {
1499ed24f4bSMarc Zyngier 	return VM_FAULT_SIGBUS;
1509ed24f4bSMarc Zyngier }
1519ed24f4bSMarc Zyngier 
1529ed24f4bSMarc Zyngier 
1539ed24f4bSMarc Zyngier /**
1549ed24f4bSMarc Zyngier  * kvm_arch_destroy_vm - destroy the VM data structure
1559ed24f4bSMarc Zyngier  * @kvm:	pointer to the KVM struct
1569ed24f4bSMarc Zyngier  */
1579ed24f4bSMarc Zyngier void kvm_arch_destroy_vm(struct kvm *kvm)
1589ed24f4bSMarc Zyngier {
1599ed24f4bSMarc Zyngier 	int i;
1609ed24f4bSMarc Zyngier 
1619ed24f4bSMarc Zyngier 	kvm_vgic_destroy(kvm);
1629ed24f4bSMarc Zyngier 
1639ed24f4bSMarc Zyngier 	free_percpu(kvm->arch.last_vcpu_ran);
1649ed24f4bSMarc Zyngier 	kvm->arch.last_vcpu_ran = NULL;
1659ed24f4bSMarc Zyngier 
1669ed24f4bSMarc Zyngier 	for (i = 0; i < KVM_MAX_VCPUS; ++i) {
1679ed24f4bSMarc Zyngier 		if (kvm->vcpus[i]) {
1689ed24f4bSMarc Zyngier 			kvm_vcpu_destroy(kvm->vcpus[i]);
1699ed24f4bSMarc Zyngier 			kvm->vcpus[i] = NULL;
1709ed24f4bSMarc Zyngier 		}
1719ed24f4bSMarc Zyngier 	}
1729ed24f4bSMarc Zyngier 	atomic_set(&kvm->online_vcpus, 0);
1739ed24f4bSMarc Zyngier }
1749ed24f4bSMarc Zyngier 
1759ed24f4bSMarc Zyngier int kvm_vm_ioctl_check_extension(struct kvm *kvm, long ext)
1769ed24f4bSMarc Zyngier {
1779ed24f4bSMarc Zyngier 	int r;
1789ed24f4bSMarc Zyngier 	switch (ext) {
1799ed24f4bSMarc Zyngier 	case KVM_CAP_IRQCHIP:
1809ed24f4bSMarc Zyngier 		r = vgic_present;
1819ed24f4bSMarc Zyngier 		break;
1829ed24f4bSMarc Zyngier 	case KVM_CAP_IOEVENTFD:
1839ed24f4bSMarc Zyngier 	case KVM_CAP_DEVICE_CTRL:
1849ed24f4bSMarc Zyngier 	case KVM_CAP_USER_MEMORY:
1859ed24f4bSMarc Zyngier 	case KVM_CAP_SYNC_MMU:
1869ed24f4bSMarc Zyngier 	case KVM_CAP_DESTROY_MEMORY_REGION_WORKS:
1879ed24f4bSMarc Zyngier 	case KVM_CAP_ONE_REG:
1889ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_PSCI:
1899ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_PSCI_0_2:
1909ed24f4bSMarc Zyngier 	case KVM_CAP_READONLY_MEM:
1919ed24f4bSMarc Zyngier 	case KVM_CAP_MP_STATE:
1929ed24f4bSMarc Zyngier 	case KVM_CAP_IMMEDIATE_EXIT:
1939ed24f4bSMarc Zyngier 	case KVM_CAP_VCPU_EVENTS:
1949ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_IRQ_LINE_LAYOUT_2:
1959ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_NISV_TO_USER:
1969ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_INJECT_EXT_DABT:
1979ed24f4bSMarc Zyngier 		r = 1;
1989ed24f4bSMarc Zyngier 		break;
1999ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_SET_DEVICE_ADDR:
2009ed24f4bSMarc Zyngier 		r = 1;
2019ed24f4bSMarc Zyngier 		break;
2029ed24f4bSMarc Zyngier 	case KVM_CAP_NR_VCPUS:
2039ed24f4bSMarc Zyngier 		r = num_online_cpus();
2049ed24f4bSMarc Zyngier 		break;
2059ed24f4bSMarc Zyngier 	case KVM_CAP_MAX_VCPUS:
2069ed24f4bSMarc Zyngier 	case KVM_CAP_MAX_VCPU_ID:
2075107000fSMarc Zyngier 		if (kvm)
2085107000fSMarc Zyngier 			r = kvm->arch.max_vcpus;
2095107000fSMarc Zyngier 		else
2105107000fSMarc Zyngier 			r = kvm_arm_default_max_vcpus();
2119ed24f4bSMarc Zyngier 		break;
2129ed24f4bSMarc Zyngier 	case KVM_CAP_MSI_DEVID:
2139ed24f4bSMarc Zyngier 		if (!kvm)
2149ed24f4bSMarc Zyngier 			r = -EINVAL;
2159ed24f4bSMarc Zyngier 		else
2169ed24f4bSMarc Zyngier 			r = kvm->arch.vgic.msis_require_devid;
2179ed24f4bSMarc Zyngier 		break;
2189ed24f4bSMarc Zyngier 	case KVM_CAP_ARM_USER_IRQ:
2199ed24f4bSMarc Zyngier 		/*
2209ed24f4bSMarc Zyngier 		 * 1: EL1_VTIMER, EL1_PTIMER, and PMU.
2219ed24f4bSMarc Zyngier 		 * (bump this number if adding more devices)
2229ed24f4bSMarc Zyngier 		 */
2239ed24f4bSMarc Zyngier 		r = 1;
2249ed24f4bSMarc Zyngier 		break;
2259ed24f4bSMarc Zyngier 	default:
2269ed24f4bSMarc Zyngier 		r = kvm_arch_vm_ioctl_check_extension(kvm, ext);
2279ed24f4bSMarc Zyngier 		break;
2289ed24f4bSMarc Zyngier 	}
2299ed24f4bSMarc Zyngier 	return r;
2309ed24f4bSMarc Zyngier }
2319ed24f4bSMarc Zyngier 
2329ed24f4bSMarc Zyngier long kvm_arch_dev_ioctl(struct file *filp,
2339ed24f4bSMarc Zyngier 			unsigned int ioctl, unsigned long arg)
2349ed24f4bSMarc Zyngier {
2359ed24f4bSMarc Zyngier 	return -EINVAL;
2369ed24f4bSMarc Zyngier }
2379ed24f4bSMarc Zyngier 
2389ed24f4bSMarc Zyngier struct kvm *kvm_arch_alloc_vm(void)
2399ed24f4bSMarc Zyngier {
2409ed24f4bSMarc Zyngier 	if (!has_vhe())
2419ed24f4bSMarc Zyngier 		return kzalloc(sizeof(struct kvm), GFP_KERNEL);
2429ed24f4bSMarc Zyngier 
2439ed24f4bSMarc Zyngier 	return vzalloc(sizeof(struct kvm));
2449ed24f4bSMarc Zyngier }
2459ed24f4bSMarc Zyngier 
2469ed24f4bSMarc Zyngier void kvm_arch_free_vm(struct kvm *kvm)
2479ed24f4bSMarc Zyngier {
2489ed24f4bSMarc Zyngier 	if (!has_vhe())
2499ed24f4bSMarc Zyngier 		kfree(kvm);
2509ed24f4bSMarc Zyngier 	else
2519ed24f4bSMarc Zyngier 		vfree(kvm);
2529ed24f4bSMarc Zyngier }
2539ed24f4bSMarc Zyngier 
2549ed24f4bSMarc Zyngier int kvm_arch_vcpu_precreate(struct kvm *kvm, unsigned int id)
2559ed24f4bSMarc Zyngier {
2569ed24f4bSMarc Zyngier 	if (irqchip_in_kernel(kvm) && vgic_initialized(kvm))
2579ed24f4bSMarc Zyngier 		return -EBUSY;
2589ed24f4bSMarc Zyngier 
2599ed24f4bSMarc Zyngier 	if (id >= kvm->arch.max_vcpus)
2609ed24f4bSMarc Zyngier 		return -EINVAL;
2619ed24f4bSMarc Zyngier 
2629ed24f4bSMarc Zyngier 	return 0;
2639ed24f4bSMarc Zyngier }
2649ed24f4bSMarc Zyngier 
2659ed24f4bSMarc Zyngier int kvm_arch_vcpu_create(struct kvm_vcpu *vcpu)
2669ed24f4bSMarc Zyngier {
2679ed24f4bSMarc Zyngier 	int err;
2689ed24f4bSMarc Zyngier 
2699ed24f4bSMarc Zyngier 	/* Force users to call KVM_ARM_VCPU_INIT */
2709ed24f4bSMarc Zyngier 	vcpu->arch.target = -1;
2719ed24f4bSMarc Zyngier 	bitmap_zero(vcpu->arch.features, KVM_VCPU_MAX_FEATURES);
2729ed24f4bSMarc Zyngier 
2739ed24f4bSMarc Zyngier 	/* Set up the timer */
2749ed24f4bSMarc Zyngier 	kvm_timer_vcpu_init(vcpu);
2759ed24f4bSMarc Zyngier 
2769ed24f4bSMarc Zyngier 	kvm_pmu_vcpu_init(vcpu);
2779ed24f4bSMarc Zyngier 
2789ed24f4bSMarc Zyngier 	kvm_arm_reset_debug_ptr(vcpu);
2799ed24f4bSMarc Zyngier 
2809ed24f4bSMarc Zyngier 	kvm_arm_pvtime_vcpu_init(&vcpu->arch);
2819ed24f4bSMarc Zyngier 
2829ed24f4bSMarc Zyngier 	err = kvm_vgic_vcpu_init(vcpu);
2839ed24f4bSMarc Zyngier 	if (err)
2849ed24f4bSMarc Zyngier 		return err;
2859ed24f4bSMarc Zyngier 
2869ed24f4bSMarc Zyngier 	return create_hyp_mappings(vcpu, vcpu + 1, PAGE_HYP);
2879ed24f4bSMarc Zyngier }
2889ed24f4bSMarc Zyngier 
2899ed24f4bSMarc Zyngier void kvm_arch_vcpu_postcreate(struct kvm_vcpu *vcpu)
2909ed24f4bSMarc Zyngier {
2919ed24f4bSMarc Zyngier }
2929ed24f4bSMarc Zyngier 
2939ed24f4bSMarc Zyngier void kvm_arch_vcpu_destroy(struct kvm_vcpu *vcpu)
2949ed24f4bSMarc Zyngier {
2959ed24f4bSMarc Zyngier 	if (vcpu->arch.has_run_once && unlikely(!irqchip_in_kernel(vcpu->kvm)))
2969ed24f4bSMarc Zyngier 		static_branch_dec(&userspace_irqchip_in_use);
2979ed24f4bSMarc Zyngier 
2989ed24f4bSMarc Zyngier 	kvm_mmu_free_memory_caches(vcpu);
2999ed24f4bSMarc Zyngier 	kvm_timer_vcpu_terminate(vcpu);
3009ed24f4bSMarc Zyngier 	kvm_pmu_vcpu_destroy(vcpu);
3019ed24f4bSMarc Zyngier 
3029ed24f4bSMarc Zyngier 	kvm_arm_vcpu_destroy(vcpu);
3039ed24f4bSMarc Zyngier }
3049ed24f4bSMarc Zyngier 
3059ed24f4bSMarc Zyngier int kvm_cpu_has_pending_timer(struct kvm_vcpu *vcpu)
3069ed24f4bSMarc Zyngier {
3079ed24f4bSMarc Zyngier 	return kvm_timer_is_pending(vcpu);
3089ed24f4bSMarc Zyngier }
3099ed24f4bSMarc Zyngier 
3109ed24f4bSMarc Zyngier void kvm_arch_vcpu_blocking(struct kvm_vcpu *vcpu)
3119ed24f4bSMarc Zyngier {
3129ed24f4bSMarc Zyngier 	/*
3139ed24f4bSMarc Zyngier 	 * If we're about to block (most likely because we've just hit a
3149ed24f4bSMarc Zyngier 	 * WFI), we need to sync back the state of the GIC CPU interface
3159ed24f4bSMarc Zyngier 	 * so that we have the latest PMR and group enables. This ensures
3169ed24f4bSMarc Zyngier 	 * that kvm_arch_vcpu_runnable has up-to-date data to decide
3179ed24f4bSMarc Zyngier 	 * whether we have pending interrupts.
3189ed24f4bSMarc Zyngier 	 *
3199ed24f4bSMarc Zyngier 	 * For the same reason, we want to tell GICv4 that we need
3209ed24f4bSMarc Zyngier 	 * doorbells to be signalled, should an interrupt become pending.
3219ed24f4bSMarc Zyngier 	 */
3229ed24f4bSMarc Zyngier 	preempt_disable();
3239ed24f4bSMarc Zyngier 	kvm_vgic_vmcr_sync(vcpu);
3249ed24f4bSMarc Zyngier 	vgic_v4_put(vcpu, true);
3259ed24f4bSMarc Zyngier 	preempt_enable();
3269ed24f4bSMarc Zyngier }
3279ed24f4bSMarc Zyngier 
3289ed24f4bSMarc Zyngier void kvm_arch_vcpu_unblocking(struct kvm_vcpu *vcpu)
3299ed24f4bSMarc Zyngier {
3309ed24f4bSMarc Zyngier 	preempt_disable();
3319ed24f4bSMarc Zyngier 	vgic_v4_load(vcpu);
3329ed24f4bSMarc Zyngier 	preempt_enable();
3339ed24f4bSMarc Zyngier }
3349ed24f4bSMarc Zyngier 
3359ed24f4bSMarc Zyngier void kvm_arch_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
3369ed24f4bSMarc Zyngier {
3379ed24f4bSMarc Zyngier 	int *last_ran;
3389ed24f4bSMarc Zyngier 
3399ed24f4bSMarc Zyngier 	last_ran = this_cpu_ptr(vcpu->kvm->arch.last_vcpu_ran);
3409ed24f4bSMarc Zyngier 
3419ed24f4bSMarc Zyngier 	/*
3429ed24f4bSMarc Zyngier 	 * We might get preempted before the vCPU actually runs, but
3439ed24f4bSMarc Zyngier 	 * over-invalidation doesn't affect correctness.
3449ed24f4bSMarc Zyngier 	 */
3459ed24f4bSMarc Zyngier 	if (*last_ran != vcpu->vcpu_id) {
3469ed24f4bSMarc Zyngier 		kvm_call_hyp(__kvm_tlb_flush_local_vmid, vcpu);
3479ed24f4bSMarc Zyngier 		*last_ran = vcpu->vcpu_id;
3489ed24f4bSMarc Zyngier 	}
3499ed24f4bSMarc Zyngier 
3509ed24f4bSMarc Zyngier 	vcpu->cpu = cpu;
3519ed24f4bSMarc Zyngier 
3529ed24f4bSMarc Zyngier 	kvm_vgic_load(vcpu);
3539ed24f4bSMarc Zyngier 	kvm_timer_vcpu_load(vcpu);
3549ed24f4bSMarc Zyngier 	kvm_vcpu_load_sysregs(vcpu);
3559ed24f4bSMarc Zyngier 	kvm_arch_vcpu_load_fp(vcpu);
3569ed24f4bSMarc Zyngier 	kvm_vcpu_pmu_restore_guest(vcpu);
3579ed24f4bSMarc Zyngier 	if (kvm_arm_is_pvtime_enabled(&vcpu->arch))
3589ed24f4bSMarc Zyngier 		kvm_make_request(KVM_REQ_RECORD_STEAL, vcpu);
3599ed24f4bSMarc Zyngier 
3609ed24f4bSMarc Zyngier 	if (single_task_running())
3619ed24f4bSMarc Zyngier 		vcpu_clear_wfx_traps(vcpu);
3629ed24f4bSMarc Zyngier 	else
3639ed24f4bSMarc Zyngier 		vcpu_set_wfx_traps(vcpu);
3649ed24f4bSMarc Zyngier 
36529eb5a3cSMarc Zyngier 	if (vcpu_has_ptrauth(vcpu))
366ef3e40a7SMarc Zyngier 		vcpu_ptrauth_disable(vcpu);
3679ed24f4bSMarc Zyngier }
3689ed24f4bSMarc Zyngier 
3699ed24f4bSMarc Zyngier void kvm_arch_vcpu_put(struct kvm_vcpu *vcpu)
3709ed24f4bSMarc Zyngier {
3719ed24f4bSMarc Zyngier 	kvm_arch_vcpu_put_fp(vcpu);
3729ed24f4bSMarc Zyngier 	kvm_vcpu_put_sysregs(vcpu);
3739ed24f4bSMarc Zyngier 	kvm_timer_vcpu_put(vcpu);
3749ed24f4bSMarc Zyngier 	kvm_vgic_put(vcpu);
3759ed24f4bSMarc Zyngier 	kvm_vcpu_pmu_restore_host(vcpu);
3769ed24f4bSMarc Zyngier 
3779ed24f4bSMarc Zyngier 	vcpu->cpu = -1;
3789ed24f4bSMarc Zyngier }
3799ed24f4bSMarc Zyngier 
3809ed24f4bSMarc Zyngier static void vcpu_power_off(struct kvm_vcpu *vcpu)
3819ed24f4bSMarc Zyngier {
3829ed24f4bSMarc Zyngier 	vcpu->arch.power_off = true;
3839ed24f4bSMarc Zyngier 	kvm_make_request(KVM_REQ_SLEEP, vcpu);
3849ed24f4bSMarc Zyngier 	kvm_vcpu_kick(vcpu);
3859ed24f4bSMarc Zyngier }
3869ed24f4bSMarc Zyngier 
3879ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_get_mpstate(struct kvm_vcpu *vcpu,
3889ed24f4bSMarc Zyngier 				    struct kvm_mp_state *mp_state)
3899ed24f4bSMarc Zyngier {
3909ed24f4bSMarc Zyngier 	if (vcpu->arch.power_off)
3919ed24f4bSMarc Zyngier 		mp_state->mp_state = KVM_MP_STATE_STOPPED;
3929ed24f4bSMarc Zyngier 	else
3939ed24f4bSMarc Zyngier 		mp_state->mp_state = KVM_MP_STATE_RUNNABLE;
3949ed24f4bSMarc Zyngier 
3959ed24f4bSMarc Zyngier 	return 0;
3969ed24f4bSMarc Zyngier }
3979ed24f4bSMarc Zyngier 
3989ed24f4bSMarc Zyngier int kvm_arch_vcpu_ioctl_set_mpstate(struct kvm_vcpu *vcpu,
3999ed24f4bSMarc Zyngier 				    struct kvm_mp_state *mp_state)
4009ed24f4bSMarc Zyngier {
4019ed24f4bSMarc Zyngier 	int ret = 0;
4029ed24f4bSMarc Zyngier 
4039ed24f4bSMarc Zyngier 	switch (mp_state->mp_state) {
4049ed24f4bSMarc Zyngier 	case KVM_MP_STATE_RUNNABLE:
4059ed24f4bSMarc Zyngier 		vcpu->arch.power_off = false;
4069ed24f4bSMarc Zyngier 		break;
4079ed24f4bSMarc Zyngier 	case KVM_MP_STATE_STOPPED:
4089ed24f4bSMarc Zyngier 		vcpu_power_off(vcpu);
4099ed24f4bSMarc Zyngier 		break;
4109ed24f4bSMarc Zyngier 	default:
4119ed24f4bSMarc Zyngier 		ret = -EINVAL;
4129ed24f4bSMarc Zyngier 	}
4139ed24f4bSMarc Zyngier 
4149ed24f4bSMarc Zyngier 	return ret;
4159ed24f4bSMarc Zyngier }
4169ed24f4bSMarc Zyngier 
4179ed24f4bSMarc Zyngier /**
4189ed24f4bSMarc Zyngier  * kvm_arch_vcpu_runnable - determine if the vcpu can be scheduled
4199ed24f4bSMarc Zyngier  * @v:		The VCPU pointer
4209ed24f4bSMarc Zyngier  *
4219ed24f4bSMarc Zyngier  * If the guest CPU is not waiting for interrupts or an interrupt line is
4229ed24f4bSMarc Zyngier  * asserted, the CPU is by definition runnable.
4239ed24f4bSMarc Zyngier  */
4249ed24f4bSMarc Zyngier int kvm_arch_vcpu_runnable(struct kvm_vcpu *v)
4259ed24f4bSMarc Zyngier {
4269ed24f4bSMarc Zyngier 	bool irq_lines = *vcpu_hcr(v) & (HCR_VI | HCR_VF);
4279ed24f4bSMarc Zyngier 	return ((irq_lines || kvm_vgic_vcpu_pending_irq(v))
4289ed24f4bSMarc Zyngier 		&& !v->arch.power_off && !v->arch.pause);
4299ed24f4bSMarc Zyngier }
4309ed24f4bSMarc Zyngier 
4319ed24f4bSMarc Zyngier bool kvm_arch_vcpu_in_kernel(struct kvm_vcpu *vcpu)
4329ed24f4bSMarc Zyngier {
4339ed24f4bSMarc Zyngier 	return vcpu_mode_priv(vcpu);
4349ed24f4bSMarc Zyngier }
4359ed24f4bSMarc Zyngier 
4369ed24f4bSMarc Zyngier /* Just ensure a guest exit from a particular CPU */
4379ed24f4bSMarc Zyngier static void exit_vm_noop(void *info)
4389ed24f4bSMarc Zyngier {
4399ed24f4bSMarc Zyngier }
4409ed24f4bSMarc Zyngier 
4419ed24f4bSMarc Zyngier void force_vm_exit(const cpumask_t *mask)
4429ed24f4bSMarc Zyngier {
4439ed24f4bSMarc Zyngier 	preempt_disable();
4449ed24f4bSMarc Zyngier 	smp_call_function_many(mask, exit_vm_noop, NULL, true);
4459ed24f4bSMarc Zyngier 	preempt_enable();
4469ed24f4bSMarc Zyngier }
4479ed24f4bSMarc Zyngier 
4489ed24f4bSMarc Zyngier /**
4499ed24f4bSMarc Zyngier  * need_new_vmid_gen - check that the VMID is still valid
4509ed24f4bSMarc Zyngier  * @vmid: The VMID to check
4519ed24f4bSMarc Zyngier  *
4529ed24f4bSMarc Zyngier  * return true if there is a new generation of VMIDs being used
4539ed24f4bSMarc Zyngier  *
4549ed24f4bSMarc Zyngier  * The hardware supports a limited set of values with the value zero reserved
4559ed24f4bSMarc Zyngier  * for the host, so we check if an assigned value belongs to a previous
456656012c7SFuad Tabba  * generation, which requires us to assign a new value. If we're the first to
457656012c7SFuad Tabba  * use a VMID for the new generation, we must flush necessary caches and TLBs
458656012c7SFuad Tabba  * on all CPUs.
4599ed24f4bSMarc Zyngier  */
4609ed24f4bSMarc Zyngier static bool need_new_vmid_gen(struct kvm_vmid *vmid)
4619ed24f4bSMarc Zyngier {
4629ed24f4bSMarc Zyngier 	u64 current_vmid_gen = atomic64_read(&kvm_vmid_gen);
4639ed24f4bSMarc Zyngier 	smp_rmb(); /* Orders read of kvm_vmid_gen and kvm->arch.vmid */
4649ed24f4bSMarc Zyngier 	return unlikely(READ_ONCE(vmid->vmid_gen) != current_vmid_gen);
4659ed24f4bSMarc Zyngier }
4669ed24f4bSMarc Zyngier 
4679ed24f4bSMarc Zyngier /**
4689ed24f4bSMarc Zyngier  * update_vmid - Update the vmid with a valid VMID for the current generation
4699ed24f4bSMarc Zyngier  * @kvm: The guest that struct vmid belongs to
4709ed24f4bSMarc Zyngier  * @vmid: The stage-2 VMID information struct
4719ed24f4bSMarc Zyngier  */
4729ed24f4bSMarc Zyngier static void update_vmid(struct kvm_vmid *vmid)
4739ed24f4bSMarc Zyngier {
4749ed24f4bSMarc Zyngier 	if (!need_new_vmid_gen(vmid))
4759ed24f4bSMarc Zyngier 		return;
4769ed24f4bSMarc Zyngier 
4779ed24f4bSMarc Zyngier 	spin_lock(&kvm_vmid_lock);
4789ed24f4bSMarc Zyngier 
4799ed24f4bSMarc Zyngier 	/*
4809ed24f4bSMarc Zyngier 	 * We need to re-check the vmid_gen here to ensure that if another vcpu
4819ed24f4bSMarc Zyngier 	 * already allocated a valid vmid for this vm, then this vcpu should
4829ed24f4bSMarc Zyngier 	 * use the same vmid.
4839ed24f4bSMarc Zyngier 	 */
4849ed24f4bSMarc Zyngier 	if (!need_new_vmid_gen(vmid)) {
4859ed24f4bSMarc Zyngier 		spin_unlock(&kvm_vmid_lock);
4869ed24f4bSMarc Zyngier 		return;
4879ed24f4bSMarc Zyngier 	}
4889ed24f4bSMarc Zyngier 
4899ed24f4bSMarc Zyngier 	/* First user of a new VMID generation? */
4909ed24f4bSMarc Zyngier 	if (unlikely(kvm_next_vmid == 0)) {
4919ed24f4bSMarc Zyngier 		atomic64_inc(&kvm_vmid_gen);
4929ed24f4bSMarc Zyngier 		kvm_next_vmid = 1;
4939ed24f4bSMarc Zyngier 
4949ed24f4bSMarc Zyngier 		/*
4959ed24f4bSMarc Zyngier 		 * On SMP we know no other CPUs can use this CPU's or each
4969ed24f4bSMarc Zyngier 		 * other's VMID after force_vm_exit returns since the
4979ed24f4bSMarc Zyngier 		 * kvm_vmid_lock blocks them from reentry to the guest.
4989ed24f4bSMarc Zyngier 		 */
4999ed24f4bSMarc Zyngier 		force_vm_exit(cpu_all_mask);
5009ed24f4bSMarc Zyngier 		/*
5019ed24f4bSMarc Zyngier 		 * Now broadcast TLB + ICACHE invalidation over the inner
5029ed24f4bSMarc Zyngier 		 * shareable domain to make sure all data structures are
5039ed24f4bSMarc Zyngier 		 * clean.
5049ed24f4bSMarc Zyngier 		 */
5059ed24f4bSMarc Zyngier 		kvm_call_hyp(__kvm_flush_vm_context);
5069ed24f4bSMarc Zyngier 	}
5079ed24f4bSMarc Zyngier 
5089ed24f4bSMarc Zyngier 	vmid->vmid = kvm_next_vmid;
5099ed24f4bSMarc Zyngier 	kvm_next_vmid++;
5109ed24f4bSMarc Zyngier 	kvm_next_vmid &= (1 << kvm_get_vmid_bits()) - 1;
5119ed24f4bSMarc Zyngier 
5129ed24f4bSMarc Zyngier 	smp_wmb();
5139ed24f4bSMarc Zyngier 	WRITE_ONCE(vmid->vmid_gen, atomic64_read(&kvm_vmid_gen));
5149ed24f4bSMarc Zyngier 
5159ed24f4bSMarc Zyngier 	spin_unlock(&kvm_vmid_lock);
5169ed24f4bSMarc Zyngier }
5179ed24f4bSMarc Zyngier 
5189ed24f4bSMarc Zyngier static int kvm_vcpu_first_run_init(struct kvm_vcpu *vcpu)
5199ed24f4bSMarc Zyngier {
5209ed24f4bSMarc Zyngier 	struct kvm *kvm = vcpu->kvm;
5219ed24f4bSMarc Zyngier 	int ret = 0;
5229ed24f4bSMarc Zyngier 
5239ed24f4bSMarc Zyngier 	if (likely(vcpu->arch.has_run_once))
5249ed24f4bSMarc Zyngier 		return 0;
5259ed24f4bSMarc Zyngier 
5269ed24f4bSMarc Zyngier 	if (!kvm_arm_vcpu_is_finalized(vcpu))
5279ed24f4bSMarc Zyngier 		return -EPERM;
5289ed24f4bSMarc Zyngier 
5299ed24f4bSMarc Zyngier 	vcpu->arch.has_run_once = true;
5309ed24f4bSMarc Zyngier 
5319ed24f4bSMarc Zyngier 	if (likely(irqchip_in_kernel(kvm))) {
5329ed24f4bSMarc Zyngier 		/*
5339ed24f4bSMarc Zyngier 		 * Map the VGIC hardware resources before running a vcpu the
5349ed24f4bSMarc Zyngier 		 * first time on this VM.
5359ed24f4bSMarc Zyngier 		 */
5369ed24f4bSMarc Zyngier 		if (unlikely(!vgic_ready(kvm))) {
5379ed24f4bSMarc Zyngier 			ret = kvm_vgic_map_resources(kvm);
5389ed24f4bSMarc Zyngier 			if (ret)
5399ed24f4bSMarc Zyngier 				return ret;
5409ed24f4bSMarc Zyngier 		}
5419ed24f4bSMarc Zyngier 	} else {
5429ed24f4bSMarc Zyngier 		/*
5439ed24f4bSMarc Zyngier 		 * Tell the rest of the code that there are userspace irqchip
5449ed24f4bSMarc Zyngier 		 * VMs in the wild.
5459ed24f4bSMarc Zyngier 		 */
5469ed24f4bSMarc Zyngier 		static_branch_inc(&userspace_irqchip_in_use);
5479ed24f4bSMarc Zyngier 	}
5489ed24f4bSMarc Zyngier 
5499ed24f4bSMarc Zyngier 	ret = kvm_timer_enable(vcpu);
5509ed24f4bSMarc Zyngier 	if (ret)
5519ed24f4bSMarc Zyngier 		return ret;
5529ed24f4bSMarc Zyngier 
5539ed24f4bSMarc Zyngier 	ret = kvm_arm_pmu_v3_enable(vcpu);
5549ed24f4bSMarc Zyngier 
5559ed24f4bSMarc Zyngier 	return ret;
5569ed24f4bSMarc Zyngier }
5579ed24f4bSMarc Zyngier 
5589ed24f4bSMarc Zyngier bool kvm_arch_intc_initialized(struct kvm *kvm)
5599ed24f4bSMarc Zyngier {
5609ed24f4bSMarc Zyngier 	return vgic_initialized(kvm);
5619ed24f4bSMarc Zyngier }
5629ed24f4bSMarc Zyngier 
5639ed24f4bSMarc Zyngier void kvm_arm_halt_guest(struct kvm *kvm)
5649ed24f4bSMarc Zyngier {
5659ed24f4bSMarc Zyngier 	int i;
5669ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu;
5679ed24f4bSMarc Zyngier 
5689ed24f4bSMarc Zyngier 	kvm_for_each_vcpu(i, vcpu, kvm)
5699ed24f4bSMarc Zyngier 		vcpu->arch.pause = true;
5709ed24f4bSMarc Zyngier 	kvm_make_all_cpus_request(kvm, KVM_REQ_SLEEP);
5719ed24f4bSMarc Zyngier }
5729ed24f4bSMarc Zyngier 
5739ed24f4bSMarc Zyngier void kvm_arm_resume_guest(struct kvm *kvm)
5749ed24f4bSMarc Zyngier {
5759ed24f4bSMarc Zyngier 	int i;
5769ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu;
5779ed24f4bSMarc Zyngier 
5789ed24f4bSMarc Zyngier 	kvm_for_each_vcpu(i, vcpu, kvm) {
5799ed24f4bSMarc Zyngier 		vcpu->arch.pause = false;
58038060944SPaolo Bonzini 		rcuwait_wake_up(kvm_arch_vcpu_get_wait(vcpu));
5819ed24f4bSMarc Zyngier 	}
5829ed24f4bSMarc Zyngier }
5839ed24f4bSMarc Zyngier 
5849ed24f4bSMarc Zyngier static void vcpu_req_sleep(struct kvm_vcpu *vcpu)
5859ed24f4bSMarc Zyngier {
58638060944SPaolo Bonzini 	struct rcuwait *wait = kvm_arch_vcpu_get_wait(vcpu);
5879ed24f4bSMarc Zyngier 
58838060944SPaolo Bonzini 	rcuwait_wait_event(wait,
58938060944SPaolo Bonzini 			   (!vcpu->arch.power_off) &&(!vcpu->arch.pause),
59038060944SPaolo Bonzini 			   TASK_INTERRUPTIBLE);
5919ed24f4bSMarc Zyngier 
5929ed24f4bSMarc Zyngier 	if (vcpu->arch.power_off || vcpu->arch.pause) {
5939ed24f4bSMarc Zyngier 		/* Awaken to handle a signal, request we sleep again later. */
5949ed24f4bSMarc Zyngier 		kvm_make_request(KVM_REQ_SLEEP, vcpu);
5959ed24f4bSMarc Zyngier 	}
5969ed24f4bSMarc Zyngier 
5979ed24f4bSMarc Zyngier 	/*
5989ed24f4bSMarc Zyngier 	 * Make sure we will observe a potential reset request if we've
5999ed24f4bSMarc Zyngier 	 * observed a change to the power state. Pairs with the smp_wmb() in
6009ed24f4bSMarc Zyngier 	 * kvm_psci_vcpu_on().
6019ed24f4bSMarc Zyngier 	 */
6029ed24f4bSMarc Zyngier 	smp_rmb();
6039ed24f4bSMarc Zyngier }
6049ed24f4bSMarc Zyngier 
6059ed24f4bSMarc Zyngier static int kvm_vcpu_initialized(struct kvm_vcpu *vcpu)
6069ed24f4bSMarc Zyngier {
6079ed24f4bSMarc Zyngier 	return vcpu->arch.target >= 0;
6089ed24f4bSMarc Zyngier }
6099ed24f4bSMarc Zyngier 
6109ed24f4bSMarc Zyngier static void check_vcpu_requests(struct kvm_vcpu *vcpu)
6119ed24f4bSMarc Zyngier {
6129ed24f4bSMarc Zyngier 	if (kvm_request_pending(vcpu)) {
6139ed24f4bSMarc Zyngier 		if (kvm_check_request(KVM_REQ_SLEEP, vcpu))
6149ed24f4bSMarc Zyngier 			vcpu_req_sleep(vcpu);
6159ed24f4bSMarc Zyngier 
6169ed24f4bSMarc Zyngier 		if (kvm_check_request(KVM_REQ_VCPU_RESET, vcpu))
6179ed24f4bSMarc Zyngier 			kvm_reset_vcpu(vcpu);
6189ed24f4bSMarc Zyngier 
6199ed24f4bSMarc Zyngier 		/*
6209ed24f4bSMarc Zyngier 		 * Clear IRQ_PENDING requests that were made to guarantee
6219ed24f4bSMarc Zyngier 		 * that a VCPU sees new virtual interrupts.
6229ed24f4bSMarc Zyngier 		 */
6239ed24f4bSMarc Zyngier 		kvm_check_request(KVM_REQ_IRQ_PENDING, vcpu);
6249ed24f4bSMarc Zyngier 
6259ed24f4bSMarc Zyngier 		if (kvm_check_request(KVM_REQ_RECORD_STEAL, vcpu))
6269ed24f4bSMarc Zyngier 			kvm_update_stolen_time(vcpu);
6279ed24f4bSMarc Zyngier 
6289ed24f4bSMarc Zyngier 		if (kvm_check_request(KVM_REQ_RELOAD_GICv4, vcpu)) {
6299ed24f4bSMarc Zyngier 			/* The distributor enable bits were changed */
6309ed24f4bSMarc Zyngier 			preempt_disable();
6319ed24f4bSMarc Zyngier 			vgic_v4_put(vcpu, false);
6329ed24f4bSMarc Zyngier 			vgic_v4_load(vcpu);
6339ed24f4bSMarc Zyngier 			preempt_enable();
6349ed24f4bSMarc Zyngier 		}
6359ed24f4bSMarc Zyngier 	}
6369ed24f4bSMarc Zyngier }
6379ed24f4bSMarc Zyngier 
6389ed24f4bSMarc Zyngier /**
6399ed24f4bSMarc Zyngier  * kvm_arch_vcpu_ioctl_run - the main VCPU run function to execute guest code
6409ed24f4bSMarc Zyngier  * @vcpu:	The VCPU pointer
6419ed24f4bSMarc Zyngier  *
6429ed24f4bSMarc Zyngier  * This function is called through the VCPU_RUN ioctl called from user space. It
6439ed24f4bSMarc Zyngier  * will execute VM code in a loop until the time slice for the process is used
6449ed24f4bSMarc Zyngier  * or some emulation is needed from user space in which case the function will
6459ed24f4bSMarc Zyngier  * return with return value 0 and with the kvm_run structure filled in with the
6469ed24f4bSMarc Zyngier  * required data for the requested emulation.
6479ed24f4bSMarc Zyngier  */
64838060944SPaolo Bonzini int kvm_arch_vcpu_ioctl_run(struct kvm_vcpu *vcpu)
6499ed24f4bSMarc Zyngier {
65038060944SPaolo Bonzini 	struct kvm_run *run = vcpu->run;
6519ed24f4bSMarc Zyngier 	int ret;
6529ed24f4bSMarc Zyngier 
6539ed24f4bSMarc Zyngier 	if (unlikely(!kvm_vcpu_initialized(vcpu)))
6549ed24f4bSMarc Zyngier 		return -ENOEXEC;
6559ed24f4bSMarc Zyngier 
6569ed24f4bSMarc Zyngier 	ret = kvm_vcpu_first_run_init(vcpu);
6579ed24f4bSMarc Zyngier 	if (ret)
6589ed24f4bSMarc Zyngier 		return ret;
6599ed24f4bSMarc Zyngier 
6609ed24f4bSMarc Zyngier 	if (run->exit_reason == KVM_EXIT_MMIO) {
66138060944SPaolo Bonzini 		ret = kvm_handle_mmio_return(vcpu, run);
6629ed24f4bSMarc Zyngier 		if (ret)
6639ed24f4bSMarc Zyngier 			return ret;
6649ed24f4bSMarc Zyngier 	}
6659ed24f4bSMarc Zyngier 
6669ed24f4bSMarc Zyngier 	if (run->immediate_exit)
6679ed24f4bSMarc Zyngier 		return -EINTR;
6689ed24f4bSMarc Zyngier 
6699ed24f4bSMarc Zyngier 	vcpu_load(vcpu);
6709ed24f4bSMarc Zyngier 
6719ed24f4bSMarc Zyngier 	kvm_sigset_activate(vcpu);
6729ed24f4bSMarc Zyngier 
6739ed24f4bSMarc Zyngier 	ret = 1;
6749ed24f4bSMarc Zyngier 	run->exit_reason = KVM_EXIT_UNKNOWN;
6759ed24f4bSMarc Zyngier 	while (ret > 0) {
6769ed24f4bSMarc Zyngier 		/*
6779ed24f4bSMarc Zyngier 		 * Check conditions before entering the guest
6789ed24f4bSMarc Zyngier 		 */
6799ed24f4bSMarc Zyngier 		cond_resched();
6809ed24f4bSMarc Zyngier 
6819ed24f4bSMarc Zyngier 		update_vmid(&vcpu->kvm->arch.vmid);
6829ed24f4bSMarc Zyngier 
6839ed24f4bSMarc Zyngier 		check_vcpu_requests(vcpu);
6849ed24f4bSMarc Zyngier 
6859ed24f4bSMarc Zyngier 		/*
6869ed24f4bSMarc Zyngier 		 * Preparing the interrupts to be injected also
6879ed24f4bSMarc Zyngier 		 * involves poking the GIC, which must be done in a
6889ed24f4bSMarc Zyngier 		 * non-preemptible context.
6899ed24f4bSMarc Zyngier 		 */
6909ed24f4bSMarc Zyngier 		preempt_disable();
6919ed24f4bSMarc Zyngier 
6929ed24f4bSMarc Zyngier 		kvm_pmu_flush_hwstate(vcpu);
6939ed24f4bSMarc Zyngier 
6949ed24f4bSMarc Zyngier 		local_irq_disable();
6959ed24f4bSMarc Zyngier 
6969ed24f4bSMarc Zyngier 		kvm_vgic_flush_hwstate(vcpu);
6979ed24f4bSMarc Zyngier 
6989ed24f4bSMarc Zyngier 		/*
6999ed24f4bSMarc Zyngier 		 * Exit if we have a signal pending so that we can deliver the
7009ed24f4bSMarc Zyngier 		 * signal to user space.
7019ed24f4bSMarc Zyngier 		 */
7029ed24f4bSMarc Zyngier 		if (signal_pending(current)) {
7039ed24f4bSMarc Zyngier 			ret = -EINTR;
7049ed24f4bSMarc Zyngier 			run->exit_reason = KVM_EXIT_INTR;
7059ed24f4bSMarc Zyngier 		}
7069ed24f4bSMarc Zyngier 
7079ed24f4bSMarc Zyngier 		/*
7089ed24f4bSMarc Zyngier 		 * If we're using a userspace irqchip, then check if we need
7099ed24f4bSMarc Zyngier 		 * to tell a userspace irqchip about timer or PMU level
7109ed24f4bSMarc Zyngier 		 * changes and if so, exit to userspace (the actual level
7119ed24f4bSMarc Zyngier 		 * state gets updated in kvm_timer_update_run and
7129ed24f4bSMarc Zyngier 		 * kvm_pmu_update_run below).
7139ed24f4bSMarc Zyngier 		 */
7149ed24f4bSMarc Zyngier 		if (static_branch_unlikely(&userspace_irqchip_in_use)) {
7159ed24f4bSMarc Zyngier 			if (kvm_timer_should_notify_user(vcpu) ||
7169ed24f4bSMarc Zyngier 			    kvm_pmu_should_notify_user(vcpu)) {
7179ed24f4bSMarc Zyngier 				ret = -EINTR;
7189ed24f4bSMarc Zyngier 				run->exit_reason = KVM_EXIT_INTR;
7199ed24f4bSMarc Zyngier 			}
7209ed24f4bSMarc Zyngier 		}
7219ed24f4bSMarc Zyngier 
7229ed24f4bSMarc Zyngier 		/*
7239ed24f4bSMarc Zyngier 		 * Ensure we set mode to IN_GUEST_MODE after we disable
7249ed24f4bSMarc Zyngier 		 * interrupts and before the final VCPU requests check.
7259ed24f4bSMarc Zyngier 		 * See the comment in kvm_vcpu_exiting_guest_mode() and
7269ed24f4bSMarc Zyngier 		 * Documentation/virt/kvm/vcpu-requests.rst
7279ed24f4bSMarc Zyngier 		 */
7289ed24f4bSMarc Zyngier 		smp_store_mb(vcpu->mode, IN_GUEST_MODE);
7299ed24f4bSMarc Zyngier 
7309ed24f4bSMarc Zyngier 		if (ret <= 0 || need_new_vmid_gen(&vcpu->kvm->arch.vmid) ||
7319ed24f4bSMarc Zyngier 		    kvm_request_pending(vcpu)) {
7329ed24f4bSMarc Zyngier 			vcpu->mode = OUTSIDE_GUEST_MODE;
7339ed24f4bSMarc Zyngier 			isb(); /* Ensure work in x_flush_hwstate is committed */
7349ed24f4bSMarc Zyngier 			kvm_pmu_sync_hwstate(vcpu);
7359ed24f4bSMarc Zyngier 			if (static_branch_unlikely(&userspace_irqchip_in_use))
7369ed24f4bSMarc Zyngier 				kvm_timer_sync_hwstate(vcpu);
7379ed24f4bSMarc Zyngier 			kvm_vgic_sync_hwstate(vcpu);
7389ed24f4bSMarc Zyngier 			local_irq_enable();
7399ed24f4bSMarc Zyngier 			preempt_enable();
7409ed24f4bSMarc Zyngier 			continue;
7419ed24f4bSMarc Zyngier 		}
7429ed24f4bSMarc Zyngier 
7439ed24f4bSMarc Zyngier 		kvm_arm_setup_debug(vcpu);
7449ed24f4bSMarc Zyngier 
7459ed24f4bSMarc Zyngier 		/**************************************************************
7469ed24f4bSMarc Zyngier 		 * Enter the guest
7479ed24f4bSMarc Zyngier 		 */
7489ed24f4bSMarc Zyngier 		trace_kvm_entry(*vcpu_pc(vcpu));
7499ed24f4bSMarc Zyngier 		guest_enter_irqoff();
7509ed24f4bSMarc Zyngier 
751*09cf57ebSDavid Brazdil 		ret = kvm_call_hyp_ret(__kvm_vcpu_run, vcpu);
7529ed24f4bSMarc Zyngier 
7539ed24f4bSMarc Zyngier 		vcpu->mode = OUTSIDE_GUEST_MODE;
7549ed24f4bSMarc Zyngier 		vcpu->stat.exits++;
7559ed24f4bSMarc Zyngier 		/*
7569ed24f4bSMarc Zyngier 		 * Back from guest
7579ed24f4bSMarc Zyngier 		 *************************************************************/
7589ed24f4bSMarc Zyngier 
7599ed24f4bSMarc Zyngier 		kvm_arm_clear_debug(vcpu);
7609ed24f4bSMarc Zyngier 
7619ed24f4bSMarc Zyngier 		/*
7629ed24f4bSMarc Zyngier 		 * We must sync the PMU state before the vgic state so
7639ed24f4bSMarc Zyngier 		 * that the vgic can properly sample the updated state of the
7649ed24f4bSMarc Zyngier 		 * interrupt line.
7659ed24f4bSMarc Zyngier 		 */
7669ed24f4bSMarc Zyngier 		kvm_pmu_sync_hwstate(vcpu);
7679ed24f4bSMarc Zyngier 
7689ed24f4bSMarc Zyngier 		/*
7699ed24f4bSMarc Zyngier 		 * Sync the vgic state before syncing the timer state because
7709ed24f4bSMarc Zyngier 		 * the timer code needs to know if the virtual timer
7719ed24f4bSMarc Zyngier 		 * interrupts are active.
7729ed24f4bSMarc Zyngier 		 */
7739ed24f4bSMarc Zyngier 		kvm_vgic_sync_hwstate(vcpu);
7749ed24f4bSMarc Zyngier 
7759ed24f4bSMarc Zyngier 		/*
7769ed24f4bSMarc Zyngier 		 * Sync the timer hardware state before enabling interrupts as
7779ed24f4bSMarc Zyngier 		 * we don't want vtimer interrupts to race with syncing the
7789ed24f4bSMarc Zyngier 		 * timer virtual interrupt state.
7799ed24f4bSMarc Zyngier 		 */
7809ed24f4bSMarc Zyngier 		if (static_branch_unlikely(&userspace_irqchip_in_use))
7819ed24f4bSMarc Zyngier 			kvm_timer_sync_hwstate(vcpu);
7829ed24f4bSMarc Zyngier 
7839ed24f4bSMarc Zyngier 		kvm_arch_vcpu_ctxsync_fp(vcpu);
7849ed24f4bSMarc Zyngier 
7859ed24f4bSMarc Zyngier 		/*
7869ed24f4bSMarc Zyngier 		 * We may have taken a host interrupt in HYP mode (ie
7879ed24f4bSMarc Zyngier 		 * while executing the guest). This interrupt is still
7889ed24f4bSMarc Zyngier 		 * pending, as we haven't serviced it yet!
7899ed24f4bSMarc Zyngier 		 *
7909ed24f4bSMarc Zyngier 		 * We're now back in SVC mode, with interrupts
7919ed24f4bSMarc Zyngier 		 * disabled.  Enabling the interrupts now will have
7929ed24f4bSMarc Zyngier 		 * the effect of taking the interrupt again, in SVC
7939ed24f4bSMarc Zyngier 		 * mode this time.
7949ed24f4bSMarc Zyngier 		 */
7959ed24f4bSMarc Zyngier 		local_irq_enable();
7969ed24f4bSMarc Zyngier 
7979ed24f4bSMarc Zyngier 		/*
7989ed24f4bSMarc Zyngier 		 * We do local_irq_enable() before calling guest_exit() so
7999ed24f4bSMarc Zyngier 		 * that if a timer interrupt hits while running the guest we
8009ed24f4bSMarc Zyngier 		 * account that tick as being spent in the guest.  We enable
8019ed24f4bSMarc Zyngier 		 * preemption after calling guest_exit() so that if we get
8029ed24f4bSMarc Zyngier 		 * preempted we make sure ticks after that is not counted as
8039ed24f4bSMarc Zyngier 		 * guest time.
8049ed24f4bSMarc Zyngier 		 */
8059ed24f4bSMarc Zyngier 		guest_exit();
8069ed24f4bSMarc Zyngier 		trace_kvm_exit(ret, kvm_vcpu_trap_get_class(vcpu), *vcpu_pc(vcpu));
8079ed24f4bSMarc Zyngier 
8089ed24f4bSMarc Zyngier 		/* Exit types that need handling before we can be preempted */
8099ed24f4bSMarc Zyngier 		handle_exit_early(vcpu, run, ret);
8109ed24f4bSMarc Zyngier 
8119ed24f4bSMarc Zyngier 		preempt_enable();
8129ed24f4bSMarc Zyngier 
8139ed24f4bSMarc Zyngier 		ret = handle_exit(vcpu, run, ret);
8149ed24f4bSMarc Zyngier 	}
8159ed24f4bSMarc Zyngier 
8169ed24f4bSMarc Zyngier 	/* Tell userspace about in-kernel device output levels */
8179ed24f4bSMarc Zyngier 	if (unlikely(!irqchip_in_kernel(vcpu->kvm))) {
8189ed24f4bSMarc Zyngier 		kvm_timer_update_run(vcpu);
8199ed24f4bSMarc Zyngier 		kvm_pmu_update_run(vcpu);
8209ed24f4bSMarc Zyngier 	}
8219ed24f4bSMarc Zyngier 
8229ed24f4bSMarc Zyngier 	kvm_sigset_deactivate(vcpu);
8239ed24f4bSMarc Zyngier 
8249ed24f4bSMarc Zyngier 	vcpu_put(vcpu);
8259ed24f4bSMarc Zyngier 	return ret;
8269ed24f4bSMarc Zyngier }
8279ed24f4bSMarc Zyngier 
8289ed24f4bSMarc Zyngier static int vcpu_interrupt_line(struct kvm_vcpu *vcpu, int number, bool level)
8299ed24f4bSMarc Zyngier {
8309ed24f4bSMarc Zyngier 	int bit_index;
8319ed24f4bSMarc Zyngier 	bool set;
8329ed24f4bSMarc Zyngier 	unsigned long *hcr;
8339ed24f4bSMarc Zyngier 
8349ed24f4bSMarc Zyngier 	if (number == KVM_ARM_IRQ_CPU_IRQ)
8359ed24f4bSMarc Zyngier 		bit_index = __ffs(HCR_VI);
8369ed24f4bSMarc Zyngier 	else /* KVM_ARM_IRQ_CPU_FIQ */
8379ed24f4bSMarc Zyngier 		bit_index = __ffs(HCR_VF);
8389ed24f4bSMarc Zyngier 
8399ed24f4bSMarc Zyngier 	hcr = vcpu_hcr(vcpu);
8409ed24f4bSMarc Zyngier 	if (level)
8419ed24f4bSMarc Zyngier 		set = test_and_set_bit(bit_index, hcr);
8429ed24f4bSMarc Zyngier 	else
8439ed24f4bSMarc Zyngier 		set = test_and_clear_bit(bit_index, hcr);
8449ed24f4bSMarc Zyngier 
8459ed24f4bSMarc Zyngier 	/*
8469ed24f4bSMarc Zyngier 	 * If we didn't change anything, no need to wake up or kick other CPUs
8479ed24f4bSMarc Zyngier 	 */
8489ed24f4bSMarc Zyngier 	if (set == level)
8499ed24f4bSMarc Zyngier 		return 0;
8509ed24f4bSMarc Zyngier 
8519ed24f4bSMarc Zyngier 	/*
8529ed24f4bSMarc Zyngier 	 * The vcpu irq_lines field was updated, wake up sleeping VCPUs and
8539ed24f4bSMarc Zyngier 	 * trigger a world-switch round on the running physical CPU to set the
8549ed24f4bSMarc Zyngier 	 * virtual IRQ/FIQ fields in the HCR appropriately.
8559ed24f4bSMarc Zyngier 	 */
8569ed24f4bSMarc Zyngier 	kvm_make_request(KVM_REQ_IRQ_PENDING, vcpu);
8579ed24f4bSMarc Zyngier 	kvm_vcpu_kick(vcpu);
8589ed24f4bSMarc Zyngier 
8599ed24f4bSMarc Zyngier 	return 0;
8609ed24f4bSMarc Zyngier }
8619ed24f4bSMarc Zyngier 
8629ed24f4bSMarc Zyngier int kvm_vm_ioctl_irq_line(struct kvm *kvm, struct kvm_irq_level *irq_level,
8639ed24f4bSMarc Zyngier 			  bool line_status)
8649ed24f4bSMarc Zyngier {
8659ed24f4bSMarc Zyngier 	u32 irq = irq_level->irq;
8669ed24f4bSMarc Zyngier 	unsigned int irq_type, vcpu_idx, irq_num;
8679ed24f4bSMarc Zyngier 	int nrcpus = atomic_read(&kvm->online_vcpus);
8689ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu = NULL;
8699ed24f4bSMarc Zyngier 	bool level = irq_level->level;
8709ed24f4bSMarc Zyngier 
8719ed24f4bSMarc Zyngier 	irq_type = (irq >> KVM_ARM_IRQ_TYPE_SHIFT) & KVM_ARM_IRQ_TYPE_MASK;
8729ed24f4bSMarc Zyngier 	vcpu_idx = (irq >> KVM_ARM_IRQ_VCPU_SHIFT) & KVM_ARM_IRQ_VCPU_MASK;
8739ed24f4bSMarc Zyngier 	vcpu_idx += ((irq >> KVM_ARM_IRQ_VCPU2_SHIFT) & KVM_ARM_IRQ_VCPU2_MASK) * (KVM_ARM_IRQ_VCPU_MASK + 1);
8749ed24f4bSMarc Zyngier 	irq_num = (irq >> KVM_ARM_IRQ_NUM_SHIFT) & KVM_ARM_IRQ_NUM_MASK;
8759ed24f4bSMarc Zyngier 
8769ed24f4bSMarc Zyngier 	trace_kvm_irq_line(irq_type, vcpu_idx, irq_num, irq_level->level);
8779ed24f4bSMarc Zyngier 
8789ed24f4bSMarc Zyngier 	switch (irq_type) {
8799ed24f4bSMarc Zyngier 	case KVM_ARM_IRQ_TYPE_CPU:
8809ed24f4bSMarc Zyngier 		if (irqchip_in_kernel(kvm))
8819ed24f4bSMarc Zyngier 			return -ENXIO;
8829ed24f4bSMarc Zyngier 
8839ed24f4bSMarc Zyngier 		if (vcpu_idx >= nrcpus)
8849ed24f4bSMarc Zyngier 			return -EINVAL;
8859ed24f4bSMarc Zyngier 
8869ed24f4bSMarc Zyngier 		vcpu = kvm_get_vcpu(kvm, vcpu_idx);
8879ed24f4bSMarc Zyngier 		if (!vcpu)
8889ed24f4bSMarc Zyngier 			return -EINVAL;
8899ed24f4bSMarc Zyngier 
8909ed24f4bSMarc Zyngier 		if (irq_num > KVM_ARM_IRQ_CPU_FIQ)
8919ed24f4bSMarc Zyngier 			return -EINVAL;
8929ed24f4bSMarc Zyngier 
8939ed24f4bSMarc Zyngier 		return vcpu_interrupt_line(vcpu, irq_num, level);
8949ed24f4bSMarc Zyngier 	case KVM_ARM_IRQ_TYPE_PPI:
8959ed24f4bSMarc Zyngier 		if (!irqchip_in_kernel(kvm))
8969ed24f4bSMarc Zyngier 			return -ENXIO;
8979ed24f4bSMarc Zyngier 
8989ed24f4bSMarc Zyngier 		if (vcpu_idx >= nrcpus)
8999ed24f4bSMarc Zyngier 			return -EINVAL;
9009ed24f4bSMarc Zyngier 
9019ed24f4bSMarc Zyngier 		vcpu = kvm_get_vcpu(kvm, vcpu_idx);
9029ed24f4bSMarc Zyngier 		if (!vcpu)
9039ed24f4bSMarc Zyngier 			return -EINVAL;
9049ed24f4bSMarc Zyngier 
9059ed24f4bSMarc Zyngier 		if (irq_num < VGIC_NR_SGIS || irq_num >= VGIC_NR_PRIVATE_IRQS)
9069ed24f4bSMarc Zyngier 			return -EINVAL;
9079ed24f4bSMarc Zyngier 
9089ed24f4bSMarc Zyngier 		return kvm_vgic_inject_irq(kvm, vcpu->vcpu_id, irq_num, level, NULL);
9099ed24f4bSMarc Zyngier 	case KVM_ARM_IRQ_TYPE_SPI:
9109ed24f4bSMarc Zyngier 		if (!irqchip_in_kernel(kvm))
9119ed24f4bSMarc Zyngier 			return -ENXIO;
9129ed24f4bSMarc Zyngier 
9139ed24f4bSMarc Zyngier 		if (irq_num < VGIC_NR_PRIVATE_IRQS)
9149ed24f4bSMarc Zyngier 			return -EINVAL;
9159ed24f4bSMarc Zyngier 
9169ed24f4bSMarc Zyngier 		return kvm_vgic_inject_irq(kvm, 0, irq_num, level, NULL);
9179ed24f4bSMarc Zyngier 	}
9189ed24f4bSMarc Zyngier 
9199ed24f4bSMarc Zyngier 	return -EINVAL;
9209ed24f4bSMarc Zyngier }
9219ed24f4bSMarc Zyngier 
9229ed24f4bSMarc Zyngier static int kvm_vcpu_set_target(struct kvm_vcpu *vcpu,
9239ed24f4bSMarc Zyngier 			       const struct kvm_vcpu_init *init)
9249ed24f4bSMarc Zyngier {
9259ed24f4bSMarc Zyngier 	unsigned int i, ret;
9269ed24f4bSMarc Zyngier 	int phys_target = kvm_target_cpu();
9279ed24f4bSMarc Zyngier 
9289ed24f4bSMarc Zyngier 	if (init->target != phys_target)
9299ed24f4bSMarc Zyngier 		return -EINVAL;
9309ed24f4bSMarc Zyngier 
9319ed24f4bSMarc Zyngier 	/*
9329ed24f4bSMarc Zyngier 	 * Secondary and subsequent calls to KVM_ARM_VCPU_INIT must
9339ed24f4bSMarc Zyngier 	 * use the same target.
9349ed24f4bSMarc Zyngier 	 */
9359ed24f4bSMarc Zyngier 	if (vcpu->arch.target != -1 && vcpu->arch.target != init->target)
9369ed24f4bSMarc Zyngier 		return -EINVAL;
9379ed24f4bSMarc Zyngier 
9389ed24f4bSMarc Zyngier 	/* -ENOENT for unknown features, -EINVAL for invalid combinations. */
9399ed24f4bSMarc Zyngier 	for (i = 0; i < sizeof(init->features) * 8; i++) {
9409ed24f4bSMarc Zyngier 		bool set = (init->features[i / 32] & (1 << (i % 32)));
9419ed24f4bSMarc Zyngier 
9429ed24f4bSMarc Zyngier 		if (set && i >= KVM_VCPU_MAX_FEATURES)
9439ed24f4bSMarc Zyngier 			return -ENOENT;
9449ed24f4bSMarc Zyngier 
9459ed24f4bSMarc Zyngier 		/*
9469ed24f4bSMarc Zyngier 		 * Secondary and subsequent calls to KVM_ARM_VCPU_INIT must
9479ed24f4bSMarc Zyngier 		 * use the same feature set.
9489ed24f4bSMarc Zyngier 		 */
9499ed24f4bSMarc Zyngier 		if (vcpu->arch.target != -1 && i < KVM_VCPU_MAX_FEATURES &&
9509ed24f4bSMarc Zyngier 		    test_bit(i, vcpu->arch.features) != set)
9519ed24f4bSMarc Zyngier 			return -EINVAL;
9529ed24f4bSMarc Zyngier 
9539ed24f4bSMarc Zyngier 		if (set)
9549ed24f4bSMarc Zyngier 			set_bit(i, vcpu->arch.features);
9559ed24f4bSMarc Zyngier 	}
9569ed24f4bSMarc Zyngier 
9579ed24f4bSMarc Zyngier 	vcpu->arch.target = phys_target;
9589ed24f4bSMarc Zyngier 
9599ed24f4bSMarc Zyngier 	/* Now we know what it is, we can reset it. */
9609ed24f4bSMarc Zyngier 	ret = kvm_reset_vcpu(vcpu);
9619ed24f4bSMarc Zyngier 	if (ret) {
9629ed24f4bSMarc Zyngier 		vcpu->arch.target = -1;
9639ed24f4bSMarc Zyngier 		bitmap_zero(vcpu->arch.features, KVM_VCPU_MAX_FEATURES);
9649ed24f4bSMarc Zyngier 	}
9659ed24f4bSMarc Zyngier 
9669ed24f4bSMarc Zyngier 	return ret;
9679ed24f4bSMarc Zyngier }
9689ed24f4bSMarc Zyngier 
9699ed24f4bSMarc Zyngier static int kvm_arch_vcpu_ioctl_vcpu_init(struct kvm_vcpu *vcpu,
9709ed24f4bSMarc Zyngier 					 struct kvm_vcpu_init *init)
9719ed24f4bSMarc Zyngier {
9729ed24f4bSMarc Zyngier 	int ret;
9739ed24f4bSMarc Zyngier 
9749ed24f4bSMarc Zyngier 	ret = kvm_vcpu_set_target(vcpu, init);
9759ed24f4bSMarc Zyngier 	if (ret)
9769ed24f4bSMarc Zyngier 		return ret;
9779ed24f4bSMarc Zyngier 
9789ed24f4bSMarc Zyngier 	/*
9799ed24f4bSMarc Zyngier 	 * Ensure a rebooted VM will fault in RAM pages and detect if the
9809ed24f4bSMarc Zyngier 	 * guest MMU is turned off and flush the caches as needed.
981892713e9SZenghui Yu 	 *
9827ae2f3dbSMarc Zyngier 	 * S2FWB enforces all memory accesses to RAM being cacheable,
9837ae2f3dbSMarc Zyngier 	 * ensuring that the data side is always coherent. We still
9847ae2f3dbSMarc Zyngier 	 * need to invalidate the I-cache though, as FWB does *not*
9857ae2f3dbSMarc Zyngier 	 * imply CTR_EL0.DIC.
9869ed24f4bSMarc Zyngier 	 */
9877ae2f3dbSMarc Zyngier 	if (vcpu->arch.has_run_once) {
9887ae2f3dbSMarc Zyngier 		if (!cpus_have_final_cap(ARM64_HAS_STAGE2_FWB))
9899ed24f4bSMarc Zyngier 			stage2_unmap_vm(vcpu->kvm);
9907ae2f3dbSMarc Zyngier 		else
9917ae2f3dbSMarc Zyngier 			__flush_icache_all();
9927ae2f3dbSMarc Zyngier 	}
9939ed24f4bSMarc Zyngier 
9949ed24f4bSMarc Zyngier 	vcpu_reset_hcr(vcpu);
9959ed24f4bSMarc Zyngier 
9969ed24f4bSMarc Zyngier 	/*
9979ed24f4bSMarc Zyngier 	 * Handle the "start in power-off" case.
9989ed24f4bSMarc Zyngier 	 */
9999ed24f4bSMarc Zyngier 	if (test_bit(KVM_ARM_VCPU_POWER_OFF, vcpu->arch.features))
10009ed24f4bSMarc Zyngier 		vcpu_power_off(vcpu);
10019ed24f4bSMarc Zyngier 	else
10029ed24f4bSMarc Zyngier 		vcpu->arch.power_off = false;
10039ed24f4bSMarc Zyngier 
10049ed24f4bSMarc Zyngier 	return 0;
10059ed24f4bSMarc Zyngier }
10069ed24f4bSMarc Zyngier 
10079ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_attr(struct kvm_vcpu *vcpu,
10089ed24f4bSMarc Zyngier 				 struct kvm_device_attr *attr)
10099ed24f4bSMarc Zyngier {
10109ed24f4bSMarc Zyngier 	int ret = -ENXIO;
10119ed24f4bSMarc Zyngier 
10129ed24f4bSMarc Zyngier 	switch (attr->group) {
10139ed24f4bSMarc Zyngier 	default:
10149ed24f4bSMarc Zyngier 		ret = kvm_arm_vcpu_arch_set_attr(vcpu, attr);
10159ed24f4bSMarc Zyngier 		break;
10169ed24f4bSMarc Zyngier 	}
10179ed24f4bSMarc Zyngier 
10189ed24f4bSMarc Zyngier 	return ret;
10199ed24f4bSMarc Zyngier }
10209ed24f4bSMarc Zyngier 
10219ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_attr(struct kvm_vcpu *vcpu,
10229ed24f4bSMarc Zyngier 				 struct kvm_device_attr *attr)
10239ed24f4bSMarc Zyngier {
10249ed24f4bSMarc Zyngier 	int ret = -ENXIO;
10259ed24f4bSMarc Zyngier 
10269ed24f4bSMarc Zyngier 	switch (attr->group) {
10279ed24f4bSMarc Zyngier 	default:
10289ed24f4bSMarc Zyngier 		ret = kvm_arm_vcpu_arch_get_attr(vcpu, attr);
10299ed24f4bSMarc Zyngier 		break;
10309ed24f4bSMarc Zyngier 	}
10319ed24f4bSMarc Zyngier 
10329ed24f4bSMarc Zyngier 	return ret;
10339ed24f4bSMarc Zyngier }
10349ed24f4bSMarc Zyngier 
10359ed24f4bSMarc Zyngier static int kvm_arm_vcpu_has_attr(struct kvm_vcpu *vcpu,
10369ed24f4bSMarc Zyngier 				 struct kvm_device_attr *attr)
10379ed24f4bSMarc Zyngier {
10389ed24f4bSMarc Zyngier 	int ret = -ENXIO;
10399ed24f4bSMarc Zyngier 
10409ed24f4bSMarc Zyngier 	switch (attr->group) {
10419ed24f4bSMarc Zyngier 	default:
10429ed24f4bSMarc Zyngier 		ret = kvm_arm_vcpu_arch_has_attr(vcpu, attr);
10439ed24f4bSMarc Zyngier 		break;
10449ed24f4bSMarc Zyngier 	}
10459ed24f4bSMarc Zyngier 
10469ed24f4bSMarc Zyngier 	return ret;
10479ed24f4bSMarc Zyngier }
10489ed24f4bSMarc Zyngier 
10499ed24f4bSMarc Zyngier static int kvm_arm_vcpu_get_events(struct kvm_vcpu *vcpu,
10509ed24f4bSMarc Zyngier 				   struct kvm_vcpu_events *events)
10519ed24f4bSMarc Zyngier {
10529ed24f4bSMarc Zyngier 	memset(events, 0, sizeof(*events));
10539ed24f4bSMarc Zyngier 
10549ed24f4bSMarc Zyngier 	return __kvm_arm_vcpu_get_events(vcpu, events);
10559ed24f4bSMarc Zyngier }
10569ed24f4bSMarc Zyngier 
10579ed24f4bSMarc Zyngier static int kvm_arm_vcpu_set_events(struct kvm_vcpu *vcpu,
10589ed24f4bSMarc Zyngier 				   struct kvm_vcpu_events *events)
10599ed24f4bSMarc Zyngier {
10609ed24f4bSMarc Zyngier 	int i;
10619ed24f4bSMarc Zyngier 
10629ed24f4bSMarc Zyngier 	/* check whether the reserved field is zero */
10639ed24f4bSMarc Zyngier 	for (i = 0; i < ARRAY_SIZE(events->reserved); i++)
10649ed24f4bSMarc Zyngier 		if (events->reserved[i])
10659ed24f4bSMarc Zyngier 			return -EINVAL;
10669ed24f4bSMarc Zyngier 
10679ed24f4bSMarc Zyngier 	/* check whether the pad field is zero */
10689ed24f4bSMarc Zyngier 	for (i = 0; i < ARRAY_SIZE(events->exception.pad); i++)
10699ed24f4bSMarc Zyngier 		if (events->exception.pad[i])
10709ed24f4bSMarc Zyngier 			return -EINVAL;
10719ed24f4bSMarc Zyngier 
10729ed24f4bSMarc Zyngier 	return __kvm_arm_vcpu_set_events(vcpu, events);
10739ed24f4bSMarc Zyngier }
10749ed24f4bSMarc Zyngier 
10759ed24f4bSMarc Zyngier long kvm_arch_vcpu_ioctl(struct file *filp,
10769ed24f4bSMarc Zyngier 			 unsigned int ioctl, unsigned long arg)
10779ed24f4bSMarc Zyngier {
10789ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu = filp->private_data;
10799ed24f4bSMarc Zyngier 	void __user *argp = (void __user *)arg;
10809ed24f4bSMarc Zyngier 	struct kvm_device_attr attr;
10819ed24f4bSMarc Zyngier 	long r;
10829ed24f4bSMarc Zyngier 
10839ed24f4bSMarc Zyngier 	switch (ioctl) {
10849ed24f4bSMarc Zyngier 	case KVM_ARM_VCPU_INIT: {
10859ed24f4bSMarc Zyngier 		struct kvm_vcpu_init init;
10869ed24f4bSMarc Zyngier 
10879ed24f4bSMarc Zyngier 		r = -EFAULT;
10889ed24f4bSMarc Zyngier 		if (copy_from_user(&init, argp, sizeof(init)))
10899ed24f4bSMarc Zyngier 			break;
10909ed24f4bSMarc Zyngier 
10919ed24f4bSMarc Zyngier 		r = kvm_arch_vcpu_ioctl_vcpu_init(vcpu, &init);
10929ed24f4bSMarc Zyngier 		break;
10939ed24f4bSMarc Zyngier 	}
10949ed24f4bSMarc Zyngier 	case KVM_SET_ONE_REG:
10959ed24f4bSMarc Zyngier 	case KVM_GET_ONE_REG: {
10969ed24f4bSMarc Zyngier 		struct kvm_one_reg reg;
10979ed24f4bSMarc Zyngier 
10989ed24f4bSMarc Zyngier 		r = -ENOEXEC;
10999ed24f4bSMarc Zyngier 		if (unlikely(!kvm_vcpu_initialized(vcpu)))
11009ed24f4bSMarc Zyngier 			break;
11019ed24f4bSMarc Zyngier 
11029ed24f4bSMarc Zyngier 		r = -EFAULT;
11039ed24f4bSMarc Zyngier 		if (copy_from_user(&reg, argp, sizeof(reg)))
11049ed24f4bSMarc Zyngier 			break;
11059ed24f4bSMarc Zyngier 
11069ed24f4bSMarc Zyngier 		if (ioctl == KVM_SET_ONE_REG)
11079ed24f4bSMarc Zyngier 			r = kvm_arm_set_reg(vcpu, &reg);
11089ed24f4bSMarc Zyngier 		else
11099ed24f4bSMarc Zyngier 			r = kvm_arm_get_reg(vcpu, &reg);
11109ed24f4bSMarc Zyngier 		break;
11119ed24f4bSMarc Zyngier 	}
11129ed24f4bSMarc Zyngier 	case KVM_GET_REG_LIST: {
11139ed24f4bSMarc Zyngier 		struct kvm_reg_list __user *user_list = argp;
11149ed24f4bSMarc Zyngier 		struct kvm_reg_list reg_list;
11159ed24f4bSMarc Zyngier 		unsigned n;
11169ed24f4bSMarc Zyngier 
11179ed24f4bSMarc Zyngier 		r = -ENOEXEC;
11189ed24f4bSMarc Zyngier 		if (unlikely(!kvm_vcpu_initialized(vcpu)))
11199ed24f4bSMarc Zyngier 			break;
11209ed24f4bSMarc Zyngier 
11219ed24f4bSMarc Zyngier 		r = -EPERM;
11229ed24f4bSMarc Zyngier 		if (!kvm_arm_vcpu_is_finalized(vcpu))
11239ed24f4bSMarc Zyngier 			break;
11249ed24f4bSMarc Zyngier 
11259ed24f4bSMarc Zyngier 		r = -EFAULT;
11269ed24f4bSMarc Zyngier 		if (copy_from_user(&reg_list, user_list, sizeof(reg_list)))
11279ed24f4bSMarc Zyngier 			break;
11289ed24f4bSMarc Zyngier 		n = reg_list.n;
11299ed24f4bSMarc Zyngier 		reg_list.n = kvm_arm_num_regs(vcpu);
11309ed24f4bSMarc Zyngier 		if (copy_to_user(user_list, &reg_list, sizeof(reg_list)))
11319ed24f4bSMarc Zyngier 			break;
11329ed24f4bSMarc Zyngier 		r = -E2BIG;
11339ed24f4bSMarc Zyngier 		if (n < reg_list.n)
11349ed24f4bSMarc Zyngier 			break;
11359ed24f4bSMarc Zyngier 		r = kvm_arm_copy_reg_indices(vcpu, user_list->reg);
11369ed24f4bSMarc Zyngier 		break;
11379ed24f4bSMarc Zyngier 	}
11389ed24f4bSMarc Zyngier 	case KVM_SET_DEVICE_ATTR: {
11399ed24f4bSMarc Zyngier 		r = -EFAULT;
11409ed24f4bSMarc Zyngier 		if (copy_from_user(&attr, argp, sizeof(attr)))
11419ed24f4bSMarc Zyngier 			break;
11429ed24f4bSMarc Zyngier 		r = kvm_arm_vcpu_set_attr(vcpu, &attr);
11439ed24f4bSMarc Zyngier 		break;
11449ed24f4bSMarc Zyngier 	}
11459ed24f4bSMarc Zyngier 	case KVM_GET_DEVICE_ATTR: {
11469ed24f4bSMarc Zyngier 		r = -EFAULT;
11479ed24f4bSMarc Zyngier 		if (copy_from_user(&attr, argp, sizeof(attr)))
11489ed24f4bSMarc Zyngier 			break;
11499ed24f4bSMarc Zyngier 		r = kvm_arm_vcpu_get_attr(vcpu, &attr);
11509ed24f4bSMarc Zyngier 		break;
11519ed24f4bSMarc Zyngier 	}
11529ed24f4bSMarc Zyngier 	case KVM_HAS_DEVICE_ATTR: {
11539ed24f4bSMarc Zyngier 		r = -EFAULT;
11549ed24f4bSMarc Zyngier 		if (copy_from_user(&attr, argp, sizeof(attr)))
11559ed24f4bSMarc Zyngier 			break;
11569ed24f4bSMarc Zyngier 		r = kvm_arm_vcpu_has_attr(vcpu, &attr);
11579ed24f4bSMarc Zyngier 		break;
11589ed24f4bSMarc Zyngier 	}
11599ed24f4bSMarc Zyngier 	case KVM_GET_VCPU_EVENTS: {
11609ed24f4bSMarc Zyngier 		struct kvm_vcpu_events events;
11619ed24f4bSMarc Zyngier 
11629ed24f4bSMarc Zyngier 		if (kvm_arm_vcpu_get_events(vcpu, &events))
11639ed24f4bSMarc Zyngier 			return -EINVAL;
11649ed24f4bSMarc Zyngier 
11659ed24f4bSMarc Zyngier 		if (copy_to_user(argp, &events, sizeof(events)))
11669ed24f4bSMarc Zyngier 			return -EFAULT;
11679ed24f4bSMarc Zyngier 
11689ed24f4bSMarc Zyngier 		return 0;
11699ed24f4bSMarc Zyngier 	}
11709ed24f4bSMarc Zyngier 	case KVM_SET_VCPU_EVENTS: {
11719ed24f4bSMarc Zyngier 		struct kvm_vcpu_events events;
11729ed24f4bSMarc Zyngier 
11739ed24f4bSMarc Zyngier 		if (copy_from_user(&events, argp, sizeof(events)))
11749ed24f4bSMarc Zyngier 			return -EFAULT;
11759ed24f4bSMarc Zyngier 
11769ed24f4bSMarc Zyngier 		return kvm_arm_vcpu_set_events(vcpu, &events);
11779ed24f4bSMarc Zyngier 	}
11789ed24f4bSMarc Zyngier 	case KVM_ARM_VCPU_FINALIZE: {
11799ed24f4bSMarc Zyngier 		int what;
11809ed24f4bSMarc Zyngier 
11819ed24f4bSMarc Zyngier 		if (!kvm_vcpu_initialized(vcpu))
11829ed24f4bSMarc Zyngier 			return -ENOEXEC;
11839ed24f4bSMarc Zyngier 
11849ed24f4bSMarc Zyngier 		if (get_user(what, (const int __user *)argp))
11859ed24f4bSMarc Zyngier 			return -EFAULT;
11869ed24f4bSMarc Zyngier 
11879ed24f4bSMarc Zyngier 		return kvm_arm_vcpu_finalize(vcpu, what);
11889ed24f4bSMarc Zyngier 	}
11899ed24f4bSMarc Zyngier 	default:
11909ed24f4bSMarc Zyngier 		r = -EINVAL;
11919ed24f4bSMarc Zyngier 	}
11929ed24f4bSMarc Zyngier 
11939ed24f4bSMarc Zyngier 	return r;
11949ed24f4bSMarc Zyngier }
11959ed24f4bSMarc Zyngier 
11969ed24f4bSMarc Zyngier void kvm_arch_sync_dirty_log(struct kvm *kvm, struct kvm_memory_slot *memslot)
11979ed24f4bSMarc Zyngier {
11989ed24f4bSMarc Zyngier 
11999ed24f4bSMarc Zyngier }
12009ed24f4bSMarc Zyngier 
12019ed24f4bSMarc Zyngier void kvm_arch_flush_remote_tlbs_memslot(struct kvm *kvm,
12029ed24f4bSMarc Zyngier 					struct kvm_memory_slot *memslot)
12039ed24f4bSMarc Zyngier {
12049ed24f4bSMarc Zyngier 	kvm_flush_remote_tlbs(kvm);
12059ed24f4bSMarc Zyngier }
12069ed24f4bSMarc Zyngier 
12079ed24f4bSMarc Zyngier static int kvm_vm_ioctl_set_device_addr(struct kvm *kvm,
12089ed24f4bSMarc Zyngier 					struct kvm_arm_device_addr *dev_addr)
12099ed24f4bSMarc Zyngier {
12109ed24f4bSMarc Zyngier 	unsigned long dev_id, type;
12119ed24f4bSMarc Zyngier 
12129ed24f4bSMarc Zyngier 	dev_id = (dev_addr->id & KVM_ARM_DEVICE_ID_MASK) >>
12139ed24f4bSMarc Zyngier 		KVM_ARM_DEVICE_ID_SHIFT;
12149ed24f4bSMarc Zyngier 	type = (dev_addr->id & KVM_ARM_DEVICE_TYPE_MASK) >>
12159ed24f4bSMarc Zyngier 		KVM_ARM_DEVICE_TYPE_SHIFT;
12169ed24f4bSMarc Zyngier 
12179ed24f4bSMarc Zyngier 	switch (dev_id) {
12189ed24f4bSMarc Zyngier 	case KVM_ARM_DEVICE_VGIC_V2:
12199ed24f4bSMarc Zyngier 		if (!vgic_present)
12209ed24f4bSMarc Zyngier 			return -ENXIO;
12219ed24f4bSMarc Zyngier 		return kvm_vgic_addr(kvm, type, &dev_addr->addr, true);
12229ed24f4bSMarc Zyngier 	default:
12239ed24f4bSMarc Zyngier 		return -ENODEV;
12249ed24f4bSMarc Zyngier 	}
12259ed24f4bSMarc Zyngier }
12269ed24f4bSMarc Zyngier 
12279ed24f4bSMarc Zyngier long kvm_arch_vm_ioctl(struct file *filp,
12289ed24f4bSMarc Zyngier 		       unsigned int ioctl, unsigned long arg)
12299ed24f4bSMarc Zyngier {
12309ed24f4bSMarc Zyngier 	struct kvm *kvm = filp->private_data;
12319ed24f4bSMarc Zyngier 	void __user *argp = (void __user *)arg;
12329ed24f4bSMarc Zyngier 
12339ed24f4bSMarc Zyngier 	switch (ioctl) {
12349ed24f4bSMarc Zyngier 	case KVM_CREATE_IRQCHIP: {
12359ed24f4bSMarc Zyngier 		int ret;
12369ed24f4bSMarc Zyngier 		if (!vgic_present)
12379ed24f4bSMarc Zyngier 			return -ENXIO;
12389ed24f4bSMarc Zyngier 		mutex_lock(&kvm->lock);
12399ed24f4bSMarc Zyngier 		ret = kvm_vgic_create(kvm, KVM_DEV_TYPE_ARM_VGIC_V2);
12409ed24f4bSMarc Zyngier 		mutex_unlock(&kvm->lock);
12419ed24f4bSMarc Zyngier 		return ret;
12429ed24f4bSMarc Zyngier 	}
12439ed24f4bSMarc Zyngier 	case KVM_ARM_SET_DEVICE_ADDR: {
12449ed24f4bSMarc Zyngier 		struct kvm_arm_device_addr dev_addr;
12459ed24f4bSMarc Zyngier 
12469ed24f4bSMarc Zyngier 		if (copy_from_user(&dev_addr, argp, sizeof(dev_addr)))
12479ed24f4bSMarc Zyngier 			return -EFAULT;
12489ed24f4bSMarc Zyngier 		return kvm_vm_ioctl_set_device_addr(kvm, &dev_addr);
12499ed24f4bSMarc Zyngier 	}
12509ed24f4bSMarc Zyngier 	case KVM_ARM_PREFERRED_TARGET: {
12519ed24f4bSMarc Zyngier 		int err;
12529ed24f4bSMarc Zyngier 		struct kvm_vcpu_init init;
12539ed24f4bSMarc Zyngier 
12549ed24f4bSMarc Zyngier 		err = kvm_vcpu_preferred_target(&init);
12559ed24f4bSMarc Zyngier 		if (err)
12569ed24f4bSMarc Zyngier 			return err;
12579ed24f4bSMarc Zyngier 
12589ed24f4bSMarc Zyngier 		if (copy_to_user(argp, &init, sizeof(init)))
12599ed24f4bSMarc Zyngier 			return -EFAULT;
12609ed24f4bSMarc Zyngier 
12619ed24f4bSMarc Zyngier 		return 0;
12629ed24f4bSMarc Zyngier 	}
12639ed24f4bSMarc Zyngier 	default:
12649ed24f4bSMarc Zyngier 		return -EINVAL;
12659ed24f4bSMarc Zyngier 	}
12669ed24f4bSMarc Zyngier }
12679ed24f4bSMarc Zyngier 
12689ed24f4bSMarc Zyngier static void cpu_init_hyp_mode(void)
12699ed24f4bSMarc Zyngier {
12709ed24f4bSMarc Zyngier 	phys_addr_t pgd_ptr;
12719ed24f4bSMarc Zyngier 	unsigned long hyp_stack_ptr;
12729ed24f4bSMarc Zyngier 	unsigned long vector_ptr;
127371b3ec5fSDavid Brazdil 	unsigned long tpidr_el2;
12749ed24f4bSMarc Zyngier 
12759ed24f4bSMarc Zyngier 	/* Switch from the HYP stub to our own HYP init vector */
12769ed24f4bSMarc Zyngier 	__hyp_set_vectors(kvm_get_idmap_vector());
12779ed24f4bSMarc Zyngier 
127871b3ec5fSDavid Brazdil 	/*
127971b3ec5fSDavid Brazdil 	 * Calculate the raw per-cpu offset without a translation from the
128071b3ec5fSDavid Brazdil 	 * kernel's mapping to the linear mapping, and store it in tpidr_el2
128171b3ec5fSDavid Brazdil 	 * so that we can use adr_l to access per-cpu variables in EL2.
128271b3ec5fSDavid Brazdil 	 */
128371b3ec5fSDavid Brazdil 	tpidr_el2 = ((unsigned long)this_cpu_ptr(&kvm_host_data) -
1284b877e984SDavid Brazdil 		     (unsigned long)kvm_ksym_ref(&kvm_host_data));
128571b3ec5fSDavid Brazdil 
12869ed24f4bSMarc Zyngier 	pgd_ptr = kvm_mmu_get_httbr();
128771b3ec5fSDavid Brazdil 	hyp_stack_ptr = __this_cpu_read(kvm_arm_hyp_stack_page) + PAGE_SIZE;
12889ed24f4bSMarc Zyngier 	vector_ptr = (unsigned long)kvm_get_hyp_vector();
12899ed24f4bSMarc Zyngier 
129071b3ec5fSDavid Brazdil 	/*
129171b3ec5fSDavid Brazdil 	 * Call initialization code, and switch to the full blown HYP code.
129271b3ec5fSDavid Brazdil 	 * If the cpucaps haven't been finalized yet, something has gone very
129371b3ec5fSDavid Brazdil 	 * wrong, and hyp will crash and burn when it uses any
129471b3ec5fSDavid Brazdil 	 * cpus_have_const_cap() wrapper.
129571b3ec5fSDavid Brazdil 	 */
129671b3ec5fSDavid Brazdil 	BUG_ON(!system_capabilities_finalized());
129771b3ec5fSDavid Brazdil 	__kvm_call_hyp((void *)pgd_ptr, hyp_stack_ptr, vector_ptr, tpidr_el2);
129871b3ec5fSDavid Brazdil 
129971b3ec5fSDavid Brazdil 	/*
130071b3ec5fSDavid Brazdil 	 * Disabling SSBD on a non-VHE system requires us to enable SSBS
130171b3ec5fSDavid Brazdil 	 * at EL2.
130271b3ec5fSDavid Brazdil 	 */
130371b3ec5fSDavid Brazdil 	if (this_cpu_has_cap(ARM64_SSBS) &&
130471b3ec5fSDavid Brazdil 	    arm64_get_ssbd_state() == ARM64_SSBD_FORCE_DISABLE) {
130571b3ec5fSDavid Brazdil 		kvm_call_hyp(__kvm_enable_ssbs);
130671b3ec5fSDavid Brazdil 	}
13079ed24f4bSMarc Zyngier }
13089ed24f4bSMarc Zyngier 
13099ed24f4bSMarc Zyngier static void cpu_hyp_reset(void)
13109ed24f4bSMarc Zyngier {
13119ed24f4bSMarc Zyngier 	if (!is_kernel_in_hyp_mode())
13129ed24f4bSMarc Zyngier 		__hyp_reset_vectors();
13139ed24f4bSMarc Zyngier }
13149ed24f4bSMarc Zyngier 
13159ed24f4bSMarc Zyngier static void cpu_hyp_reinit(void)
13169ed24f4bSMarc Zyngier {
13179ed24f4bSMarc Zyngier 	kvm_init_host_cpu_context(&this_cpu_ptr(&kvm_host_data)->host_ctxt);
13189ed24f4bSMarc Zyngier 
13199ed24f4bSMarc Zyngier 	cpu_hyp_reset();
13209ed24f4bSMarc Zyngier 
13219ed24f4bSMarc Zyngier 	if (is_kernel_in_hyp_mode())
13229ed24f4bSMarc Zyngier 		kvm_timer_init_vhe();
13239ed24f4bSMarc Zyngier 	else
13249ed24f4bSMarc Zyngier 		cpu_init_hyp_mode();
13259ed24f4bSMarc Zyngier 
13269ed24f4bSMarc Zyngier 	kvm_arm_init_debug();
13279ed24f4bSMarc Zyngier 
13289ed24f4bSMarc Zyngier 	if (vgic_present)
13299ed24f4bSMarc Zyngier 		kvm_vgic_init_cpu_hardware();
13309ed24f4bSMarc Zyngier }
13319ed24f4bSMarc Zyngier 
13329ed24f4bSMarc Zyngier static void _kvm_arch_hardware_enable(void *discard)
13339ed24f4bSMarc Zyngier {
13349ed24f4bSMarc Zyngier 	if (!__this_cpu_read(kvm_arm_hardware_enabled)) {
13359ed24f4bSMarc Zyngier 		cpu_hyp_reinit();
13369ed24f4bSMarc Zyngier 		__this_cpu_write(kvm_arm_hardware_enabled, 1);
13379ed24f4bSMarc Zyngier 	}
13389ed24f4bSMarc Zyngier }
13399ed24f4bSMarc Zyngier 
13409ed24f4bSMarc Zyngier int kvm_arch_hardware_enable(void)
13419ed24f4bSMarc Zyngier {
13429ed24f4bSMarc Zyngier 	_kvm_arch_hardware_enable(NULL);
13439ed24f4bSMarc Zyngier 	return 0;
13449ed24f4bSMarc Zyngier }
13459ed24f4bSMarc Zyngier 
13469ed24f4bSMarc Zyngier static void _kvm_arch_hardware_disable(void *discard)
13479ed24f4bSMarc Zyngier {
13489ed24f4bSMarc Zyngier 	if (__this_cpu_read(kvm_arm_hardware_enabled)) {
13499ed24f4bSMarc Zyngier 		cpu_hyp_reset();
13509ed24f4bSMarc Zyngier 		__this_cpu_write(kvm_arm_hardware_enabled, 0);
13519ed24f4bSMarc Zyngier 	}
13529ed24f4bSMarc Zyngier }
13539ed24f4bSMarc Zyngier 
13549ed24f4bSMarc Zyngier void kvm_arch_hardware_disable(void)
13559ed24f4bSMarc Zyngier {
13569ed24f4bSMarc Zyngier 	_kvm_arch_hardware_disable(NULL);
13579ed24f4bSMarc Zyngier }
13589ed24f4bSMarc Zyngier 
13599ed24f4bSMarc Zyngier #ifdef CONFIG_CPU_PM
13609ed24f4bSMarc Zyngier static int hyp_init_cpu_pm_notifier(struct notifier_block *self,
13619ed24f4bSMarc Zyngier 				    unsigned long cmd,
13629ed24f4bSMarc Zyngier 				    void *v)
13639ed24f4bSMarc Zyngier {
13649ed24f4bSMarc Zyngier 	/*
13659ed24f4bSMarc Zyngier 	 * kvm_arm_hardware_enabled is left with its old value over
13669ed24f4bSMarc Zyngier 	 * PM_ENTER->PM_EXIT. It is used to indicate PM_EXIT should
13679ed24f4bSMarc Zyngier 	 * re-enable hyp.
13689ed24f4bSMarc Zyngier 	 */
13699ed24f4bSMarc Zyngier 	switch (cmd) {
13709ed24f4bSMarc Zyngier 	case CPU_PM_ENTER:
13719ed24f4bSMarc Zyngier 		if (__this_cpu_read(kvm_arm_hardware_enabled))
13729ed24f4bSMarc Zyngier 			/*
13739ed24f4bSMarc Zyngier 			 * don't update kvm_arm_hardware_enabled here
13749ed24f4bSMarc Zyngier 			 * so that the hardware will be re-enabled
13759ed24f4bSMarc Zyngier 			 * when we resume. See below.
13769ed24f4bSMarc Zyngier 			 */
13779ed24f4bSMarc Zyngier 			cpu_hyp_reset();
13789ed24f4bSMarc Zyngier 
13799ed24f4bSMarc Zyngier 		return NOTIFY_OK;
13809ed24f4bSMarc Zyngier 	case CPU_PM_ENTER_FAILED:
13819ed24f4bSMarc Zyngier 	case CPU_PM_EXIT:
13829ed24f4bSMarc Zyngier 		if (__this_cpu_read(kvm_arm_hardware_enabled))
13839ed24f4bSMarc Zyngier 			/* The hardware was enabled before suspend. */
13849ed24f4bSMarc Zyngier 			cpu_hyp_reinit();
13859ed24f4bSMarc Zyngier 
13869ed24f4bSMarc Zyngier 		return NOTIFY_OK;
13879ed24f4bSMarc Zyngier 
13889ed24f4bSMarc Zyngier 	default:
13899ed24f4bSMarc Zyngier 		return NOTIFY_DONE;
13909ed24f4bSMarc Zyngier 	}
13919ed24f4bSMarc Zyngier }
13929ed24f4bSMarc Zyngier 
13939ed24f4bSMarc Zyngier static struct notifier_block hyp_init_cpu_pm_nb = {
13949ed24f4bSMarc Zyngier 	.notifier_call = hyp_init_cpu_pm_notifier,
13959ed24f4bSMarc Zyngier };
13969ed24f4bSMarc Zyngier 
13979ed24f4bSMarc Zyngier static void __init hyp_cpu_pm_init(void)
13989ed24f4bSMarc Zyngier {
13999ed24f4bSMarc Zyngier 	cpu_pm_register_notifier(&hyp_init_cpu_pm_nb);
14009ed24f4bSMarc Zyngier }
14019ed24f4bSMarc Zyngier static void __init hyp_cpu_pm_exit(void)
14029ed24f4bSMarc Zyngier {
14039ed24f4bSMarc Zyngier 	cpu_pm_unregister_notifier(&hyp_init_cpu_pm_nb);
14049ed24f4bSMarc Zyngier }
14059ed24f4bSMarc Zyngier #else
14069ed24f4bSMarc Zyngier static inline void hyp_cpu_pm_init(void)
14079ed24f4bSMarc Zyngier {
14089ed24f4bSMarc Zyngier }
14099ed24f4bSMarc Zyngier static inline void hyp_cpu_pm_exit(void)
14109ed24f4bSMarc Zyngier {
14119ed24f4bSMarc Zyngier }
14129ed24f4bSMarc Zyngier #endif
14139ed24f4bSMarc Zyngier 
14149ed24f4bSMarc Zyngier static int init_common_resources(void)
14159ed24f4bSMarc Zyngier {
1416039aeb9dSLinus Torvalds 	return kvm_set_ipa_limit();
14179ed24f4bSMarc Zyngier }
14189ed24f4bSMarc Zyngier 
14199ed24f4bSMarc Zyngier static int init_subsystems(void)
14209ed24f4bSMarc Zyngier {
14219ed24f4bSMarc Zyngier 	int err = 0;
14229ed24f4bSMarc Zyngier 
14239ed24f4bSMarc Zyngier 	/*
14249ed24f4bSMarc Zyngier 	 * Enable hardware so that subsystem initialisation can access EL2.
14259ed24f4bSMarc Zyngier 	 */
14269ed24f4bSMarc Zyngier 	on_each_cpu(_kvm_arch_hardware_enable, NULL, 1);
14279ed24f4bSMarc Zyngier 
14289ed24f4bSMarc Zyngier 	/*
14299ed24f4bSMarc Zyngier 	 * Register CPU lower-power notifier
14309ed24f4bSMarc Zyngier 	 */
14319ed24f4bSMarc Zyngier 	hyp_cpu_pm_init();
14329ed24f4bSMarc Zyngier 
14339ed24f4bSMarc Zyngier 	/*
14349ed24f4bSMarc Zyngier 	 * Init HYP view of VGIC
14359ed24f4bSMarc Zyngier 	 */
14369ed24f4bSMarc Zyngier 	err = kvm_vgic_hyp_init();
14379ed24f4bSMarc Zyngier 	switch (err) {
14389ed24f4bSMarc Zyngier 	case 0:
14399ed24f4bSMarc Zyngier 		vgic_present = true;
14409ed24f4bSMarc Zyngier 		break;
14419ed24f4bSMarc Zyngier 	case -ENODEV:
14429ed24f4bSMarc Zyngier 	case -ENXIO:
14439ed24f4bSMarc Zyngier 		vgic_present = false;
14449ed24f4bSMarc Zyngier 		err = 0;
14459ed24f4bSMarc Zyngier 		break;
14469ed24f4bSMarc Zyngier 	default:
14479ed24f4bSMarc Zyngier 		goto out;
14489ed24f4bSMarc Zyngier 	}
14499ed24f4bSMarc Zyngier 
14509ed24f4bSMarc Zyngier 	/*
14519ed24f4bSMarc Zyngier 	 * Init HYP architected timer support
14529ed24f4bSMarc Zyngier 	 */
14539ed24f4bSMarc Zyngier 	err = kvm_timer_hyp_init(vgic_present);
14549ed24f4bSMarc Zyngier 	if (err)
14559ed24f4bSMarc Zyngier 		goto out;
14569ed24f4bSMarc Zyngier 
14579ed24f4bSMarc Zyngier 	kvm_perf_init();
14589ed24f4bSMarc Zyngier 	kvm_coproc_table_init();
14599ed24f4bSMarc Zyngier 
14609ed24f4bSMarc Zyngier out:
14619ed24f4bSMarc Zyngier 	on_each_cpu(_kvm_arch_hardware_disable, NULL, 1);
14629ed24f4bSMarc Zyngier 
14639ed24f4bSMarc Zyngier 	return err;
14649ed24f4bSMarc Zyngier }
14659ed24f4bSMarc Zyngier 
14669ed24f4bSMarc Zyngier static void teardown_hyp_mode(void)
14679ed24f4bSMarc Zyngier {
14689ed24f4bSMarc Zyngier 	int cpu;
14699ed24f4bSMarc Zyngier 
14709ed24f4bSMarc Zyngier 	free_hyp_pgds();
14719ed24f4bSMarc Zyngier 	for_each_possible_cpu(cpu)
14729ed24f4bSMarc Zyngier 		free_page(per_cpu(kvm_arm_hyp_stack_page, cpu));
14739ed24f4bSMarc Zyngier }
14749ed24f4bSMarc Zyngier 
14759ed24f4bSMarc Zyngier /**
14769ed24f4bSMarc Zyngier  * Inits Hyp-mode on all online CPUs
14779ed24f4bSMarc Zyngier  */
14789ed24f4bSMarc Zyngier static int init_hyp_mode(void)
14799ed24f4bSMarc Zyngier {
14809ed24f4bSMarc Zyngier 	int cpu;
14819ed24f4bSMarc Zyngier 	int err = 0;
14829ed24f4bSMarc Zyngier 
14839ed24f4bSMarc Zyngier 	/*
14849ed24f4bSMarc Zyngier 	 * Allocate Hyp PGD and setup Hyp identity mapping
14859ed24f4bSMarc Zyngier 	 */
14869ed24f4bSMarc Zyngier 	err = kvm_mmu_init();
14879ed24f4bSMarc Zyngier 	if (err)
14889ed24f4bSMarc Zyngier 		goto out_err;
14899ed24f4bSMarc Zyngier 
14909ed24f4bSMarc Zyngier 	/*
14919ed24f4bSMarc Zyngier 	 * Allocate stack pages for Hypervisor-mode
14929ed24f4bSMarc Zyngier 	 */
14939ed24f4bSMarc Zyngier 	for_each_possible_cpu(cpu) {
14949ed24f4bSMarc Zyngier 		unsigned long stack_page;
14959ed24f4bSMarc Zyngier 
14969ed24f4bSMarc Zyngier 		stack_page = __get_free_page(GFP_KERNEL);
14979ed24f4bSMarc Zyngier 		if (!stack_page) {
14989ed24f4bSMarc Zyngier 			err = -ENOMEM;
14999ed24f4bSMarc Zyngier 			goto out_err;
15009ed24f4bSMarc Zyngier 		}
15019ed24f4bSMarc Zyngier 
15029ed24f4bSMarc Zyngier 		per_cpu(kvm_arm_hyp_stack_page, cpu) = stack_page;
15039ed24f4bSMarc Zyngier 	}
15049ed24f4bSMarc Zyngier 
15059ed24f4bSMarc Zyngier 	/*
15069ed24f4bSMarc Zyngier 	 * Map the Hyp-code called directly from the host
15079ed24f4bSMarc Zyngier 	 */
15089ed24f4bSMarc Zyngier 	err = create_hyp_mappings(kvm_ksym_ref(__hyp_text_start),
15099ed24f4bSMarc Zyngier 				  kvm_ksym_ref(__hyp_text_end), PAGE_HYP_EXEC);
15109ed24f4bSMarc Zyngier 	if (err) {
15119ed24f4bSMarc Zyngier 		kvm_err("Cannot map world-switch code\n");
15129ed24f4bSMarc Zyngier 		goto out_err;
15139ed24f4bSMarc Zyngier 	}
15149ed24f4bSMarc Zyngier 
15159ed24f4bSMarc Zyngier 	err = create_hyp_mappings(kvm_ksym_ref(__start_rodata),
15169ed24f4bSMarc Zyngier 				  kvm_ksym_ref(__end_rodata), PAGE_HYP_RO);
15179ed24f4bSMarc Zyngier 	if (err) {
15189ed24f4bSMarc Zyngier 		kvm_err("Cannot map rodata section\n");
15199ed24f4bSMarc Zyngier 		goto out_err;
15209ed24f4bSMarc Zyngier 	}
15219ed24f4bSMarc Zyngier 
15229ed24f4bSMarc Zyngier 	err = create_hyp_mappings(kvm_ksym_ref(__bss_start),
15239ed24f4bSMarc Zyngier 				  kvm_ksym_ref(__bss_stop), PAGE_HYP_RO);
15249ed24f4bSMarc Zyngier 	if (err) {
15259ed24f4bSMarc Zyngier 		kvm_err("Cannot map bss section\n");
15269ed24f4bSMarc Zyngier 		goto out_err;
15279ed24f4bSMarc Zyngier 	}
15289ed24f4bSMarc Zyngier 
15299ed24f4bSMarc Zyngier 	err = kvm_map_vectors();
15309ed24f4bSMarc Zyngier 	if (err) {
15319ed24f4bSMarc Zyngier 		kvm_err("Cannot map vectors\n");
15329ed24f4bSMarc Zyngier 		goto out_err;
15339ed24f4bSMarc Zyngier 	}
15349ed24f4bSMarc Zyngier 
15359ed24f4bSMarc Zyngier 	/*
15369ed24f4bSMarc Zyngier 	 * Map the Hyp stack pages
15379ed24f4bSMarc Zyngier 	 */
15389ed24f4bSMarc Zyngier 	for_each_possible_cpu(cpu) {
15399ed24f4bSMarc Zyngier 		char *stack_page = (char *)per_cpu(kvm_arm_hyp_stack_page, cpu);
15409ed24f4bSMarc Zyngier 		err = create_hyp_mappings(stack_page, stack_page + PAGE_SIZE,
15419ed24f4bSMarc Zyngier 					  PAGE_HYP);
15429ed24f4bSMarc Zyngier 
15439ed24f4bSMarc Zyngier 		if (err) {
15449ed24f4bSMarc Zyngier 			kvm_err("Cannot map hyp stack\n");
15459ed24f4bSMarc Zyngier 			goto out_err;
15469ed24f4bSMarc Zyngier 		}
15479ed24f4bSMarc Zyngier 	}
15489ed24f4bSMarc Zyngier 
15499ed24f4bSMarc Zyngier 	for_each_possible_cpu(cpu) {
15509ed24f4bSMarc Zyngier 		kvm_host_data_t *cpu_data;
15519ed24f4bSMarc Zyngier 
15529ed24f4bSMarc Zyngier 		cpu_data = per_cpu_ptr(&kvm_host_data, cpu);
15539ed24f4bSMarc Zyngier 		err = create_hyp_mappings(cpu_data, cpu_data + 1, PAGE_HYP);
15549ed24f4bSMarc Zyngier 
15559ed24f4bSMarc Zyngier 		if (err) {
15569ed24f4bSMarc Zyngier 			kvm_err("Cannot map host CPU state: %d\n", err);
15579ed24f4bSMarc Zyngier 			goto out_err;
15589ed24f4bSMarc Zyngier 		}
15599ed24f4bSMarc Zyngier 	}
15609ed24f4bSMarc Zyngier 
15619ed24f4bSMarc Zyngier 	err = hyp_map_aux_data();
15629ed24f4bSMarc Zyngier 	if (err)
15639ed24f4bSMarc Zyngier 		kvm_err("Cannot map host auxiliary data: %d\n", err);
15649ed24f4bSMarc Zyngier 
15659ed24f4bSMarc Zyngier 	return 0;
15669ed24f4bSMarc Zyngier 
15679ed24f4bSMarc Zyngier out_err:
15689ed24f4bSMarc Zyngier 	teardown_hyp_mode();
15699ed24f4bSMarc Zyngier 	kvm_err("error initializing Hyp mode: %d\n", err);
15709ed24f4bSMarc Zyngier 	return err;
15719ed24f4bSMarc Zyngier }
15729ed24f4bSMarc Zyngier 
15739ed24f4bSMarc Zyngier static void check_kvm_target_cpu(void *ret)
15749ed24f4bSMarc Zyngier {
15759ed24f4bSMarc Zyngier 	*(int *)ret = kvm_target_cpu();
15769ed24f4bSMarc Zyngier }
15779ed24f4bSMarc Zyngier 
15789ed24f4bSMarc Zyngier struct kvm_vcpu *kvm_mpidr_to_vcpu(struct kvm *kvm, unsigned long mpidr)
15799ed24f4bSMarc Zyngier {
15809ed24f4bSMarc Zyngier 	struct kvm_vcpu *vcpu;
15819ed24f4bSMarc Zyngier 	int i;
15829ed24f4bSMarc Zyngier 
15839ed24f4bSMarc Zyngier 	mpidr &= MPIDR_HWID_BITMASK;
15849ed24f4bSMarc Zyngier 	kvm_for_each_vcpu(i, vcpu, kvm) {
15859ed24f4bSMarc Zyngier 		if (mpidr == kvm_vcpu_get_mpidr_aff(vcpu))
15869ed24f4bSMarc Zyngier 			return vcpu;
15879ed24f4bSMarc Zyngier 	}
15889ed24f4bSMarc Zyngier 	return NULL;
15899ed24f4bSMarc Zyngier }
15909ed24f4bSMarc Zyngier 
15919ed24f4bSMarc Zyngier bool kvm_arch_has_irq_bypass(void)
15929ed24f4bSMarc Zyngier {
15939ed24f4bSMarc Zyngier 	return true;
15949ed24f4bSMarc Zyngier }
15959ed24f4bSMarc Zyngier 
15969ed24f4bSMarc Zyngier int kvm_arch_irq_bypass_add_producer(struct irq_bypass_consumer *cons,
15979ed24f4bSMarc Zyngier 				      struct irq_bypass_producer *prod)
15989ed24f4bSMarc Zyngier {
15999ed24f4bSMarc Zyngier 	struct kvm_kernel_irqfd *irqfd =
16009ed24f4bSMarc Zyngier 		container_of(cons, struct kvm_kernel_irqfd, consumer);
16019ed24f4bSMarc Zyngier 
16029ed24f4bSMarc Zyngier 	return kvm_vgic_v4_set_forwarding(irqfd->kvm, prod->irq,
16039ed24f4bSMarc Zyngier 					  &irqfd->irq_entry);
16049ed24f4bSMarc Zyngier }
16059ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_del_producer(struct irq_bypass_consumer *cons,
16069ed24f4bSMarc Zyngier 				      struct irq_bypass_producer *prod)
16079ed24f4bSMarc Zyngier {
16089ed24f4bSMarc Zyngier 	struct kvm_kernel_irqfd *irqfd =
16099ed24f4bSMarc Zyngier 		container_of(cons, struct kvm_kernel_irqfd, consumer);
16109ed24f4bSMarc Zyngier 
16119ed24f4bSMarc Zyngier 	kvm_vgic_v4_unset_forwarding(irqfd->kvm, prod->irq,
16129ed24f4bSMarc Zyngier 				     &irqfd->irq_entry);
16139ed24f4bSMarc Zyngier }
16149ed24f4bSMarc Zyngier 
16159ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_stop(struct irq_bypass_consumer *cons)
16169ed24f4bSMarc Zyngier {
16179ed24f4bSMarc Zyngier 	struct kvm_kernel_irqfd *irqfd =
16189ed24f4bSMarc Zyngier 		container_of(cons, struct kvm_kernel_irqfd, consumer);
16199ed24f4bSMarc Zyngier 
16209ed24f4bSMarc Zyngier 	kvm_arm_halt_guest(irqfd->kvm);
16219ed24f4bSMarc Zyngier }
16229ed24f4bSMarc Zyngier 
16239ed24f4bSMarc Zyngier void kvm_arch_irq_bypass_start(struct irq_bypass_consumer *cons)
16249ed24f4bSMarc Zyngier {
16259ed24f4bSMarc Zyngier 	struct kvm_kernel_irqfd *irqfd =
16269ed24f4bSMarc Zyngier 		container_of(cons, struct kvm_kernel_irqfd, consumer);
16279ed24f4bSMarc Zyngier 
16289ed24f4bSMarc Zyngier 	kvm_arm_resume_guest(irqfd->kvm);
16299ed24f4bSMarc Zyngier }
16309ed24f4bSMarc Zyngier 
16319ed24f4bSMarc Zyngier /**
16329ed24f4bSMarc Zyngier  * Initialize Hyp-mode and memory mappings on all CPUs.
16339ed24f4bSMarc Zyngier  */
16349ed24f4bSMarc Zyngier int kvm_arch_init(void *opaque)
16359ed24f4bSMarc Zyngier {
16369ed24f4bSMarc Zyngier 	int err;
16379ed24f4bSMarc Zyngier 	int ret, cpu;
16389ed24f4bSMarc Zyngier 	bool in_hyp_mode;
16399ed24f4bSMarc Zyngier 
16409ed24f4bSMarc Zyngier 	if (!is_hyp_mode_available()) {
16419ed24f4bSMarc Zyngier 		kvm_info("HYP mode not available\n");
16429ed24f4bSMarc Zyngier 		return -ENODEV;
16439ed24f4bSMarc Zyngier 	}
16449ed24f4bSMarc Zyngier 
16459ed24f4bSMarc Zyngier 	in_hyp_mode = is_kernel_in_hyp_mode();
16469ed24f4bSMarc Zyngier 
16479ed24f4bSMarc Zyngier 	if (!in_hyp_mode && kvm_arch_requires_vhe()) {
16489ed24f4bSMarc Zyngier 		kvm_pr_unimpl("CPU unsupported in non-VHE mode, not initializing\n");
16499ed24f4bSMarc Zyngier 		return -ENODEV;
16509ed24f4bSMarc Zyngier 	}
16519ed24f4bSMarc Zyngier 
16529ed24f4bSMarc Zyngier 	for_each_online_cpu(cpu) {
16539ed24f4bSMarc Zyngier 		smp_call_function_single(cpu, check_kvm_target_cpu, &ret, 1);
16549ed24f4bSMarc Zyngier 		if (ret < 0) {
16559ed24f4bSMarc Zyngier 			kvm_err("Error, CPU %d not supported!\n", cpu);
16569ed24f4bSMarc Zyngier 			return -ENODEV;
16579ed24f4bSMarc Zyngier 		}
16589ed24f4bSMarc Zyngier 	}
16599ed24f4bSMarc Zyngier 
16609ed24f4bSMarc Zyngier 	err = init_common_resources();
16619ed24f4bSMarc Zyngier 	if (err)
16629ed24f4bSMarc Zyngier 		return err;
16639ed24f4bSMarc Zyngier 
16649ed24f4bSMarc Zyngier 	err = kvm_arm_init_sve();
16659ed24f4bSMarc Zyngier 	if (err)
16669ed24f4bSMarc Zyngier 		return err;
16679ed24f4bSMarc Zyngier 
16689ed24f4bSMarc Zyngier 	if (!in_hyp_mode) {
16699ed24f4bSMarc Zyngier 		err = init_hyp_mode();
16709ed24f4bSMarc Zyngier 		if (err)
16719ed24f4bSMarc Zyngier 			goto out_err;
16729ed24f4bSMarc Zyngier 	}
16739ed24f4bSMarc Zyngier 
16749ed24f4bSMarc Zyngier 	err = init_subsystems();
16759ed24f4bSMarc Zyngier 	if (err)
16769ed24f4bSMarc Zyngier 		goto out_hyp;
16779ed24f4bSMarc Zyngier 
16789ed24f4bSMarc Zyngier 	if (in_hyp_mode)
16799ed24f4bSMarc Zyngier 		kvm_info("VHE mode initialized successfully\n");
16809ed24f4bSMarc Zyngier 	else
16819ed24f4bSMarc Zyngier 		kvm_info("Hyp mode initialized successfully\n");
16829ed24f4bSMarc Zyngier 
16839ed24f4bSMarc Zyngier 	return 0;
16849ed24f4bSMarc Zyngier 
16859ed24f4bSMarc Zyngier out_hyp:
16869ed24f4bSMarc Zyngier 	hyp_cpu_pm_exit();
16879ed24f4bSMarc Zyngier 	if (!in_hyp_mode)
16889ed24f4bSMarc Zyngier 		teardown_hyp_mode();
16899ed24f4bSMarc Zyngier out_err:
16909ed24f4bSMarc Zyngier 	return err;
16919ed24f4bSMarc Zyngier }
16929ed24f4bSMarc Zyngier 
16939ed24f4bSMarc Zyngier /* NOP: Compiling as a module not supported */
16949ed24f4bSMarc Zyngier void kvm_arch_exit(void)
16959ed24f4bSMarc Zyngier {
16969ed24f4bSMarc Zyngier 	kvm_perf_teardown();
16979ed24f4bSMarc Zyngier }
16989ed24f4bSMarc Zyngier 
16999ed24f4bSMarc Zyngier static int arm_init(void)
17009ed24f4bSMarc Zyngier {
17019ed24f4bSMarc Zyngier 	int rc = kvm_init(NULL, sizeof(struct kvm_vcpu), 0, THIS_MODULE);
17029ed24f4bSMarc Zyngier 	return rc;
17039ed24f4bSMarc Zyngier }
17049ed24f4bSMarc Zyngier 
17059ed24f4bSMarc Zyngier module_init(arm_init);
1706