hc
2023-12-11 d2ccde1c8e90d38cee87a1b0309ad2827f3fd30d
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
// SPDX-License-Identifier: GPL-2.0-only
/*
 * Guest PC manipulation helpers
 *
 * Copyright (C) 2012,2013 - ARM Ltd
 * Copyright (C) 2020 - Google LLC
 * Author: Marc Zyngier <maz@kernel.org>
 */
 
#ifndef __ARM64_KVM_HYP_ADJUST_PC_H__
#define __ARM64_KVM_HYP_ADJUST_PC_H__
 
#include <asm/kvm_emulate.h>
#include <asm/kvm_host.h>
 
void kvm_inject_exception(struct kvm_vcpu *vcpu);
 
static inline void kvm_skip_instr(struct kvm_vcpu *vcpu)
{
   if (vcpu_mode_is_32bit(vcpu)) {
       kvm_skip_instr32(vcpu);
   } else {
       *vcpu_pc(vcpu) += 4;
       *vcpu_cpsr(vcpu) &= ~PSR_BTYPE_MASK;
   }
 
   /* advance the singlestep state machine */
   *vcpu_cpsr(vcpu) &= ~DBG_SPSR_SS;
}
 
/*
 * Skip an instruction which has been emulated at hyp while most guest sysregs
 * are live.
 */
static inline void __kvm_skip_instr(struct kvm_vcpu *vcpu)
{
   *vcpu_pc(vcpu) = read_sysreg_el2(SYS_ELR);
   vcpu_gp_regs(vcpu)->pstate = read_sysreg_el2(SYS_SPSR);
 
   kvm_skip_instr(vcpu);
 
   write_sysreg_el2(vcpu_gp_regs(vcpu)->pstate, SYS_SPSR);
   write_sysreg_el2(*vcpu_pc(vcpu), SYS_ELR);
}
 
/*
 * Adjust the guest PC on entry, depending on flags provided by EL1
 * for the purpose of emulation (MMIO, sysreg) or exception injection.
 */
static inline void __adjust_pc(struct kvm_vcpu *vcpu)
{
   if (vcpu->arch.flags & KVM_ARM64_PENDING_EXCEPTION) {
       kvm_inject_exception(vcpu);
       vcpu->arch.flags &= ~(KVM_ARM64_PENDING_EXCEPTION |
                     KVM_ARM64_EXCEPT_MASK);
   } else     if (vcpu->arch.flags & KVM_ARM64_INCREMENT_PC) {
       kvm_skip_instr(vcpu);
       vcpu->arch.flags &= ~KVM_ARM64_INCREMENT_PC;
   }
}
 
/*
 * Skip an instruction while host sysregs are live.
 * Assumes host is always 64-bit.
 */
static inline void kvm_skip_host_instr(void)
{
   write_sysreg_el2(read_sysreg_el2(SYS_ELR) + 4, SYS_ELR);
}
 
#endif