162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * arch/arm64/kvm/fpsimd.c: Guest/host FPSIMD context coordination helpers
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Copyright 2018 Arm Limited
662306a36Sopenharmony_ci * Author: Dave Martin <Dave.Martin@arm.com>
762306a36Sopenharmony_ci */
862306a36Sopenharmony_ci#include <linux/irqflags.h>
962306a36Sopenharmony_ci#include <linux/sched.h>
1062306a36Sopenharmony_ci#include <linux/kvm_host.h>
1162306a36Sopenharmony_ci#include <asm/fpsimd.h>
1262306a36Sopenharmony_ci#include <asm/kvm_asm.h>
1362306a36Sopenharmony_ci#include <asm/kvm_hyp.h>
1462306a36Sopenharmony_ci#include <asm/kvm_mmu.h>
1562306a36Sopenharmony_ci#include <asm/sysreg.h>
1662306a36Sopenharmony_ci
1762306a36Sopenharmony_civoid kvm_vcpu_unshare_task_fp(struct kvm_vcpu *vcpu)
1862306a36Sopenharmony_ci{
1962306a36Sopenharmony_ci	struct task_struct *p = vcpu->arch.parent_task;
2062306a36Sopenharmony_ci	struct user_fpsimd_state *fpsimd;
2162306a36Sopenharmony_ci
2262306a36Sopenharmony_ci	if (!is_protected_kvm_enabled() || !p)
2362306a36Sopenharmony_ci		return;
2462306a36Sopenharmony_ci
2562306a36Sopenharmony_ci	fpsimd = &p->thread.uw.fpsimd_state;
2662306a36Sopenharmony_ci	kvm_unshare_hyp(fpsimd, fpsimd + 1);
2762306a36Sopenharmony_ci	put_task_struct(p);
2862306a36Sopenharmony_ci}
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_ci/*
3162306a36Sopenharmony_ci * Called on entry to KVM_RUN unless this vcpu previously ran at least
3262306a36Sopenharmony_ci * once and the most recent prior KVM_RUN for this vcpu was called from
3362306a36Sopenharmony_ci * the same task as current (highly likely).
3462306a36Sopenharmony_ci *
3562306a36Sopenharmony_ci * This is guaranteed to execute before kvm_arch_vcpu_load_fp(vcpu),
3662306a36Sopenharmony_ci * such that on entering hyp the relevant parts of current are already
3762306a36Sopenharmony_ci * mapped.
3862306a36Sopenharmony_ci */
3962306a36Sopenharmony_ciint kvm_arch_vcpu_run_map_fp(struct kvm_vcpu *vcpu)
4062306a36Sopenharmony_ci{
4162306a36Sopenharmony_ci	int ret;
4262306a36Sopenharmony_ci
4362306a36Sopenharmony_ci	struct user_fpsimd_state *fpsimd = &current->thread.uw.fpsimd_state;
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_ci	kvm_vcpu_unshare_task_fp(vcpu);
4662306a36Sopenharmony_ci
4762306a36Sopenharmony_ci	/* Make sure the host task fpsimd state is visible to hyp: */
4862306a36Sopenharmony_ci	ret = kvm_share_hyp(fpsimd, fpsimd + 1);
4962306a36Sopenharmony_ci	if (ret)
5062306a36Sopenharmony_ci		return ret;
5162306a36Sopenharmony_ci
5262306a36Sopenharmony_ci	vcpu->arch.host_fpsimd_state = kern_hyp_va(fpsimd);
5362306a36Sopenharmony_ci
5462306a36Sopenharmony_ci	/*
5562306a36Sopenharmony_ci	 * We need to keep current's task_struct pinned until its data has been
5662306a36Sopenharmony_ci	 * unshared with the hypervisor to make sure it is not re-used by the
5762306a36Sopenharmony_ci	 * kernel and donated to someone else while already shared -- see
5862306a36Sopenharmony_ci	 * kvm_vcpu_unshare_task_fp() for the matching put_task_struct().
5962306a36Sopenharmony_ci	 */
6062306a36Sopenharmony_ci	if (is_protected_kvm_enabled()) {
6162306a36Sopenharmony_ci		get_task_struct(current);
6262306a36Sopenharmony_ci		vcpu->arch.parent_task = current;
6362306a36Sopenharmony_ci	}
6462306a36Sopenharmony_ci
6562306a36Sopenharmony_ci	return 0;
6662306a36Sopenharmony_ci}
6762306a36Sopenharmony_ci
6862306a36Sopenharmony_ci/*
6962306a36Sopenharmony_ci * Prepare vcpu for saving the host's FPSIMD state and loading the guest's.
7062306a36Sopenharmony_ci * The actual loading is done by the FPSIMD access trap taken to hyp.
7162306a36Sopenharmony_ci *
7262306a36Sopenharmony_ci * Here, we just set the correct metadata to indicate that the FPSIMD
7362306a36Sopenharmony_ci * state in the cpu regs (if any) belongs to current on the host.
7462306a36Sopenharmony_ci */
7562306a36Sopenharmony_civoid kvm_arch_vcpu_load_fp(struct kvm_vcpu *vcpu)
7662306a36Sopenharmony_ci{
7762306a36Sopenharmony_ci	BUG_ON(!current->mm);
7862306a36Sopenharmony_ci
7962306a36Sopenharmony_ci	if (!system_supports_fpsimd())
8062306a36Sopenharmony_ci		return;
8162306a36Sopenharmony_ci
8262306a36Sopenharmony_ci	fpsimd_kvm_prepare();
8362306a36Sopenharmony_ci
8462306a36Sopenharmony_ci	/*
8562306a36Sopenharmony_ci	 * We will check TIF_FOREIGN_FPSTATE just before entering the
8662306a36Sopenharmony_ci	 * guest in kvm_arch_vcpu_ctxflush_fp() and override this to
8762306a36Sopenharmony_ci	 * FP_STATE_FREE if the flag set.
8862306a36Sopenharmony_ci	 */
8962306a36Sopenharmony_ci	vcpu->arch.fp_state = FP_STATE_HOST_OWNED;
9062306a36Sopenharmony_ci
9162306a36Sopenharmony_ci	vcpu_clear_flag(vcpu, HOST_SVE_ENABLED);
9262306a36Sopenharmony_ci	if (read_sysreg(cpacr_el1) & CPACR_EL1_ZEN_EL0EN)
9362306a36Sopenharmony_ci		vcpu_set_flag(vcpu, HOST_SVE_ENABLED);
9462306a36Sopenharmony_ci
9562306a36Sopenharmony_ci	if (system_supports_sme()) {
9662306a36Sopenharmony_ci		vcpu_clear_flag(vcpu, HOST_SME_ENABLED);
9762306a36Sopenharmony_ci		if (read_sysreg(cpacr_el1) & CPACR_EL1_SMEN_EL0EN)
9862306a36Sopenharmony_ci			vcpu_set_flag(vcpu, HOST_SME_ENABLED);
9962306a36Sopenharmony_ci
10062306a36Sopenharmony_ci		/*
10162306a36Sopenharmony_ci		 * If PSTATE.SM is enabled then save any pending FP
10262306a36Sopenharmony_ci		 * state and disable PSTATE.SM. If we leave PSTATE.SM
10362306a36Sopenharmony_ci		 * enabled and the guest does not enable SME via
10462306a36Sopenharmony_ci		 * CPACR_EL1.SMEN then operations that should be valid
10562306a36Sopenharmony_ci		 * may generate SME traps from EL1 to EL1 which we
10662306a36Sopenharmony_ci		 * can't intercept and which would confuse the guest.
10762306a36Sopenharmony_ci		 *
10862306a36Sopenharmony_ci		 * Do the same for PSTATE.ZA in the case where there
10962306a36Sopenharmony_ci		 * is state in the registers which has not already
11062306a36Sopenharmony_ci		 * been saved, this is very unlikely to happen.
11162306a36Sopenharmony_ci		 */
11262306a36Sopenharmony_ci		if (read_sysreg_s(SYS_SVCR) & (SVCR_SM_MASK | SVCR_ZA_MASK)) {
11362306a36Sopenharmony_ci			vcpu->arch.fp_state = FP_STATE_FREE;
11462306a36Sopenharmony_ci			fpsimd_save_and_flush_cpu_state();
11562306a36Sopenharmony_ci		}
11662306a36Sopenharmony_ci	}
11762306a36Sopenharmony_ci}
11862306a36Sopenharmony_ci
11962306a36Sopenharmony_ci/*
12062306a36Sopenharmony_ci * Called just before entering the guest once we are no longer preemptable
12162306a36Sopenharmony_ci * and interrupts are disabled. If we have managed to run anything using
12262306a36Sopenharmony_ci * FP while we were preemptible (such as off the back of an interrupt),
12362306a36Sopenharmony_ci * then neither the host nor the guest own the FP hardware (and it was the
12462306a36Sopenharmony_ci * responsibility of the code that used FP to save the existing state).
12562306a36Sopenharmony_ci */
12662306a36Sopenharmony_civoid kvm_arch_vcpu_ctxflush_fp(struct kvm_vcpu *vcpu)
12762306a36Sopenharmony_ci{
12862306a36Sopenharmony_ci	if (test_thread_flag(TIF_FOREIGN_FPSTATE))
12962306a36Sopenharmony_ci		vcpu->arch.fp_state = FP_STATE_FREE;
13062306a36Sopenharmony_ci}
13162306a36Sopenharmony_ci
13262306a36Sopenharmony_ci/*
13362306a36Sopenharmony_ci * Called just after exiting the guest. If the guest FPSIMD state
13462306a36Sopenharmony_ci * was loaded, update the host's context tracking data mark the CPU
13562306a36Sopenharmony_ci * FPSIMD regs as dirty and belonging to vcpu so that they will be
13662306a36Sopenharmony_ci * written back if the kernel clobbers them due to kernel-mode NEON
13762306a36Sopenharmony_ci * before re-entry into the guest.
13862306a36Sopenharmony_ci */
13962306a36Sopenharmony_civoid kvm_arch_vcpu_ctxsync_fp(struct kvm_vcpu *vcpu)
14062306a36Sopenharmony_ci{
14162306a36Sopenharmony_ci	struct cpu_fp_state fp_state;
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_ci	WARN_ON_ONCE(!irqs_disabled());
14462306a36Sopenharmony_ci
14562306a36Sopenharmony_ci	if (vcpu->arch.fp_state == FP_STATE_GUEST_OWNED) {
14662306a36Sopenharmony_ci
14762306a36Sopenharmony_ci		/*
14862306a36Sopenharmony_ci		 * Currently we do not support SME guests so SVCR is
14962306a36Sopenharmony_ci		 * always 0 and we just need a variable to point to.
15062306a36Sopenharmony_ci		 */
15162306a36Sopenharmony_ci		fp_state.st = &vcpu->arch.ctxt.fp_regs;
15262306a36Sopenharmony_ci		fp_state.sve_state = vcpu->arch.sve_state;
15362306a36Sopenharmony_ci		fp_state.sve_vl = vcpu->arch.sve_max_vl;
15462306a36Sopenharmony_ci		fp_state.sme_state = NULL;
15562306a36Sopenharmony_ci		fp_state.svcr = &vcpu->arch.svcr;
15662306a36Sopenharmony_ci		fp_state.fp_type = &vcpu->arch.fp_type;
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci		if (vcpu_has_sve(vcpu))
15962306a36Sopenharmony_ci			fp_state.to_save = FP_STATE_SVE;
16062306a36Sopenharmony_ci		else
16162306a36Sopenharmony_ci			fp_state.to_save = FP_STATE_FPSIMD;
16262306a36Sopenharmony_ci
16362306a36Sopenharmony_ci		fpsimd_bind_state_to_cpu(&fp_state);
16462306a36Sopenharmony_ci
16562306a36Sopenharmony_ci		clear_thread_flag(TIF_FOREIGN_FPSTATE);
16662306a36Sopenharmony_ci	}
16762306a36Sopenharmony_ci}
16862306a36Sopenharmony_ci
16962306a36Sopenharmony_ci/*
17062306a36Sopenharmony_ci * Write back the vcpu FPSIMD regs if they are dirty, and invalidate the
17162306a36Sopenharmony_ci * cpu FPSIMD regs so that they can't be spuriously reused if this vcpu
17262306a36Sopenharmony_ci * disappears and another task or vcpu appears that recycles the same
17362306a36Sopenharmony_ci * struct fpsimd_state.
17462306a36Sopenharmony_ci */
17562306a36Sopenharmony_civoid kvm_arch_vcpu_put_fp(struct kvm_vcpu *vcpu)
17662306a36Sopenharmony_ci{
17762306a36Sopenharmony_ci	unsigned long flags;
17862306a36Sopenharmony_ci
17962306a36Sopenharmony_ci	local_irq_save(flags);
18062306a36Sopenharmony_ci
18162306a36Sopenharmony_ci	/*
18262306a36Sopenharmony_ci	 * If we have VHE then the Hyp code will reset CPACR_EL1 to
18362306a36Sopenharmony_ci	 * the default value and we need to reenable SME.
18462306a36Sopenharmony_ci	 */
18562306a36Sopenharmony_ci	if (has_vhe() && system_supports_sme()) {
18662306a36Sopenharmony_ci		/* Also restore EL0 state seen on entry */
18762306a36Sopenharmony_ci		if (vcpu_get_flag(vcpu, HOST_SME_ENABLED))
18862306a36Sopenharmony_ci			sysreg_clear_set(CPACR_EL1, 0,
18962306a36Sopenharmony_ci					 CPACR_EL1_SMEN_EL0EN |
19062306a36Sopenharmony_ci					 CPACR_EL1_SMEN_EL1EN);
19162306a36Sopenharmony_ci		else
19262306a36Sopenharmony_ci			sysreg_clear_set(CPACR_EL1,
19362306a36Sopenharmony_ci					 CPACR_EL1_SMEN_EL0EN,
19462306a36Sopenharmony_ci					 CPACR_EL1_SMEN_EL1EN);
19562306a36Sopenharmony_ci		isb();
19662306a36Sopenharmony_ci	}
19762306a36Sopenharmony_ci
19862306a36Sopenharmony_ci	if (vcpu->arch.fp_state == FP_STATE_GUEST_OWNED) {
19962306a36Sopenharmony_ci		if (vcpu_has_sve(vcpu)) {
20062306a36Sopenharmony_ci			__vcpu_sys_reg(vcpu, ZCR_EL1) = read_sysreg_el1(SYS_ZCR);
20162306a36Sopenharmony_ci
20262306a36Sopenharmony_ci			/* Restore the VL that was saved when bound to the CPU */
20362306a36Sopenharmony_ci			if (!has_vhe())
20462306a36Sopenharmony_ci				sve_cond_update_zcr_vq(vcpu_sve_max_vq(vcpu) - 1,
20562306a36Sopenharmony_ci						       SYS_ZCR_EL1);
20662306a36Sopenharmony_ci		}
20762306a36Sopenharmony_ci
20862306a36Sopenharmony_ci		fpsimd_save_and_flush_cpu_state();
20962306a36Sopenharmony_ci	} else if (has_vhe() && system_supports_sve()) {
21062306a36Sopenharmony_ci		/*
21162306a36Sopenharmony_ci		 * The FPSIMD/SVE state in the CPU has not been touched, and we
21262306a36Sopenharmony_ci		 * have SVE (and VHE): CPACR_EL1 (alias CPTR_EL2) has been
21362306a36Sopenharmony_ci		 * reset by kvm_reset_cptr_el2() in the Hyp code, disabling SVE
21462306a36Sopenharmony_ci		 * for EL0.  To avoid spurious traps, restore the trap state
21562306a36Sopenharmony_ci		 * seen by kvm_arch_vcpu_load_fp():
21662306a36Sopenharmony_ci		 */
21762306a36Sopenharmony_ci		if (vcpu_get_flag(vcpu, HOST_SVE_ENABLED))
21862306a36Sopenharmony_ci			sysreg_clear_set(CPACR_EL1, 0, CPACR_EL1_ZEN_EL0EN);
21962306a36Sopenharmony_ci		else
22062306a36Sopenharmony_ci			sysreg_clear_set(CPACR_EL1, CPACR_EL1_ZEN_EL0EN, 0);
22162306a36Sopenharmony_ci	}
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_ci	local_irq_restore(flags);
22462306a36Sopenharmony_ci}
225