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 = ¤t->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