183a49794SMarc Zyngier /*
283a49794SMarc Zyngier  * Copyright (C) 2012,2013 - ARM Ltd
383a49794SMarc Zyngier  * Author: Marc Zyngier <marc.zyngier@arm.com>
483a49794SMarc Zyngier  *
583a49794SMarc Zyngier  * Derived from arch/arm/include/kvm_emulate.h
683a49794SMarc Zyngier  * Copyright (C) 2012 - Virtual Open Systems and Columbia University
783a49794SMarc Zyngier  * Author: Christoffer Dall <c.dall@virtualopensystems.com>
883a49794SMarc Zyngier  *
983a49794SMarc Zyngier  * This program is free software; you can redistribute it and/or modify
1083a49794SMarc Zyngier  * it under the terms of the GNU General Public License version 2 as
1183a49794SMarc Zyngier  * published by the Free Software Foundation.
1283a49794SMarc Zyngier  *
1383a49794SMarc Zyngier  * This program is distributed in the hope that it will be useful,
1483a49794SMarc Zyngier  * but WITHOUT ANY WARRANTY; without even the implied warranty of
1583a49794SMarc Zyngier  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
1683a49794SMarc Zyngier  * GNU General Public License for more details.
1783a49794SMarc Zyngier  *
1883a49794SMarc Zyngier  * You should have received a copy of the GNU General Public License
1983a49794SMarc Zyngier  * along with this program.  If not, see <http://www.gnu.org/licenses/>.
2083a49794SMarc Zyngier  */
2183a49794SMarc Zyngier 
2283a49794SMarc Zyngier #ifndef __ARM64_KVM_EMULATE_H__
2383a49794SMarc Zyngier #define __ARM64_KVM_EMULATE_H__
2483a49794SMarc Zyngier 
2583a49794SMarc Zyngier #include <linux/kvm_host.h>
2683a49794SMarc Zyngier #include <asm/kvm_asm.h>
2783a49794SMarc Zyngier #include <asm/kvm_arm.h>
2883a49794SMarc Zyngier #include <asm/kvm_mmio.h>
2983a49794SMarc Zyngier #include <asm/ptrace.h>
3083a49794SMarc Zyngier 
31b547631fSMarc Zyngier unsigned long *vcpu_reg32(const struct kvm_vcpu *vcpu, u8 reg_num);
32b547631fSMarc Zyngier unsigned long *vcpu_spsr32(const struct kvm_vcpu *vcpu);
33b547631fSMarc Zyngier 
3483a49794SMarc Zyngier void kvm_inject_undefined(struct kvm_vcpu *vcpu);
3583a49794SMarc Zyngier void kvm_inject_dabt(struct kvm_vcpu *vcpu, unsigned long addr);
3683a49794SMarc Zyngier void kvm_inject_pabt(struct kvm_vcpu *vcpu, unsigned long addr);
3783a49794SMarc Zyngier 
3883a49794SMarc Zyngier static inline unsigned long *vcpu_pc(const struct kvm_vcpu *vcpu)
3983a49794SMarc Zyngier {
4083a49794SMarc Zyngier 	return (unsigned long *)&vcpu_gp_regs(vcpu)->regs.pc;
4183a49794SMarc Zyngier }
4283a49794SMarc Zyngier 
4383a49794SMarc Zyngier static inline unsigned long *vcpu_elr_el1(const struct kvm_vcpu *vcpu)
4483a49794SMarc Zyngier {
4583a49794SMarc Zyngier 	return (unsigned long *)&vcpu_gp_regs(vcpu)->elr_el1;
4683a49794SMarc Zyngier }
4783a49794SMarc Zyngier 
4883a49794SMarc Zyngier static inline unsigned long *vcpu_cpsr(const struct kvm_vcpu *vcpu)
4983a49794SMarc Zyngier {
5083a49794SMarc Zyngier 	return (unsigned long *)&vcpu_gp_regs(vcpu)->regs.pstate;
5183a49794SMarc Zyngier }
5283a49794SMarc Zyngier 
5383a49794SMarc Zyngier static inline bool vcpu_mode_is_32bit(const struct kvm_vcpu *vcpu)
5483a49794SMarc Zyngier {
55b547631fSMarc Zyngier 	return !!(*vcpu_cpsr(vcpu) & PSR_MODE32_BIT);
5683a49794SMarc Zyngier }
5783a49794SMarc Zyngier 
5883a49794SMarc Zyngier static inline bool kvm_condition_valid(const struct kvm_vcpu *vcpu)
5983a49794SMarc Zyngier {
6083a49794SMarc Zyngier 	return true;	/* No conditionals on arm64 */
6183a49794SMarc Zyngier }
6283a49794SMarc Zyngier 
6383a49794SMarc Zyngier static inline void kvm_skip_instr(struct kvm_vcpu *vcpu, bool is_wide_instr)
6483a49794SMarc Zyngier {
6583a49794SMarc Zyngier 	*vcpu_pc(vcpu) += 4;
6683a49794SMarc Zyngier }
6783a49794SMarc Zyngier 
6883a49794SMarc Zyngier static inline void vcpu_set_thumb(struct kvm_vcpu *vcpu)
6983a49794SMarc Zyngier {
70b547631fSMarc Zyngier 	*vcpu_cpsr(vcpu) |= COMPAT_PSR_T_BIT;
7183a49794SMarc Zyngier }
7283a49794SMarc Zyngier 
7383a49794SMarc Zyngier static inline unsigned long *vcpu_reg(const struct kvm_vcpu *vcpu, u8 reg_num)
7483a49794SMarc Zyngier {
75b547631fSMarc Zyngier 	if (vcpu_mode_is_32bit(vcpu))
76b547631fSMarc Zyngier 		return vcpu_reg32(vcpu, reg_num);
77b547631fSMarc Zyngier 
7883a49794SMarc Zyngier 	return (unsigned long *)&vcpu_gp_regs(vcpu)->regs.regs[reg_num];
7983a49794SMarc Zyngier }
8083a49794SMarc Zyngier 
8183a49794SMarc Zyngier /* Get vcpu SPSR for current mode */
8283a49794SMarc Zyngier static inline unsigned long *vcpu_spsr(const struct kvm_vcpu *vcpu)
8383a49794SMarc Zyngier {
84b547631fSMarc Zyngier 	if (vcpu_mode_is_32bit(vcpu))
85b547631fSMarc Zyngier 		return vcpu_spsr32(vcpu);
86b547631fSMarc Zyngier 
8783a49794SMarc Zyngier 	return (unsigned long *)&vcpu_gp_regs(vcpu)->spsr[KVM_SPSR_EL1];
8883a49794SMarc Zyngier }
8983a49794SMarc Zyngier 
9083a49794SMarc Zyngier static inline bool vcpu_mode_priv(const struct kvm_vcpu *vcpu)
9183a49794SMarc Zyngier {
9283a49794SMarc Zyngier 	u32 mode = *vcpu_cpsr(vcpu) & PSR_MODE_MASK;
9383a49794SMarc Zyngier 
94b547631fSMarc Zyngier 	if (vcpu_mode_is_32bit(vcpu))
95b547631fSMarc Zyngier 		return mode > COMPAT_PSR_MODE_USR;
96b547631fSMarc Zyngier 
9783a49794SMarc Zyngier 	return mode != PSR_MODE_EL0t;
9883a49794SMarc Zyngier }
9983a49794SMarc Zyngier 
10083a49794SMarc Zyngier static inline u32 kvm_vcpu_get_hsr(const struct kvm_vcpu *vcpu)
10183a49794SMarc Zyngier {
10283a49794SMarc Zyngier 	return vcpu->arch.fault.esr_el2;
10383a49794SMarc Zyngier }
10483a49794SMarc Zyngier 
10583a49794SMarc Zyngier static inline unsigned long kvm_vcpu_get_hfar(const struct kvm_vcpu *vcpu)
10683a49794SMarc Zyngier {
10783a49794SMarc Zyngier 	return vcpu->arch.fault.far_el2;
10883a49794SMarc Zyngier }
10983a49794SMarc Zyngier 
11083a49794SMarc Zyngier static inline phys_addr_t kvm_vcpu_get_fault_ipa(const struct kvm_vcpu *vcpu)
11183a49794SMarc Zyngier {
11283a49794SMarc Zyngier 	return ((phys_addr_t)vcpu->arch.fault.hpfar_el2 & HPFAR_MASK) << 8;
11383a49794SMarc Zyngier }
11483a49794SMarc Zyngier 
11583a49794SMarc Zyngier static inline bool kvm_vcpu_dabt_isvalid(const struct kvm_vcpu *vcpu)
11683a49794SMarc Zyngier {
11783a49794SMarc Zyngier 	return !!(kvm_vcpu_get_hsr(vcpu) & ESR_EL2_ISV);
11883a49794SMarc Zyngier }
11983a49794SMarc Zyngier 
12083a49794SMarc Zyngier static inline bool kvm_vcpu_dabt_iswrite(const struct kvm_vcpu *vcpu)
12183a49794SMarc Zyngier {
12283a49794SMarc Zyngier 	return !!(kvm_vcpu_get_hsr(vcpu) & ESR_EL2_WNR);
12383a49794SMarc Zyngier }
12483a49794SMarc Zyngier 
12583a49794SMarc Zyngier static inline bool kvm_vcpu_dabt_issext(const struct kvm_vcpu *vcpu)
12683a49794SMarc Zyngier {
12783a49794SMarc Zyngier 	return !!(kvm_vcpu_get_hsr(vcpu) & ESR_EL2_SSE);
12883a49794SMarc Zyngier }
12983a49794SMarc Zyngier 
13083a49794SMarc Zyngier static inline int kvm_vcpu_dabt_get_rd(const struct kvm_vcpu *vcpu)
13183a49794SMarc Zyngier {
13283a49794SMarc Zyngier 	return (kvm_vcpu_get_hsr(vcpu) & ESR_EL2_SRT_MASK) >> ESR_EL2_SRT_SHIFT;
13383a49794SMarc Zyngier }
13483a49794SMarc Zyngier 
13583a49794SMarc Zyngier static inline bool kvm_vcpu_dabt_isextabt(const struct kvm_vcpu *vcpu)
13683a49794SMarc Zyngier {
13783a49794SMarc Zyngier 	return !!(kvm_vcpu_get_hsr(vcpu) & ESR_EL2_EA);
13883a49794SMarc Zyngier }
13983a49794SMarc Zyngier 
14083a49794SMarc Zyngier static inline bool kvm_vcpu_dabt_iss1tw(const struct kvm_vcpu *vcpu)
14183a49794SMarc Zyngier {
14283a49794SMarc Zyngier 	return !!(kvm_vcpu_get_hsr(vcpu) & ESR_EL2_S1PTW);
14383a49794SMarc Zyngier }
14483a49794SMarc Zyngier 
14583a49794SMarc Zyngier static inline int kvm_vcpu_dabt_get_as(const struct kvm_vcpu *vcpu)
14683a49794SMarc Zyngier {
14783a49794SMarc Zyngier 	return 1 << ((kvm_vcpu_get_hsr(vcpu) & ESR_EL2_SAS) >> ESR_EL2_SAS_SHIFT);
14883a49794SMarc Zyngier }
14983a49794SMarc Zyngier 
15083a49794SMarc Zyngier /* This one is not specific to Data Abort */
15183a49794SMarc Zyngier static inline bool kvm_vcpu_trap_il_is32bit(const struct kvm_vcpu *vcpu)
15283a49794SMarc Zyngier {
15383a49794SMarc Zyngier 	return !!(kvm_vcpu_get_hsr(vcpu) & ESR_EL2_IL);
15483a49794SMarc Zyngier }
15583a49794SMarc Zyngier 
15683a49794SMarc Zyngier static inline u8 kvm_vcpu_trap_get_class(const struct kvm_vcpu *vcpu)
15783a49794SMarc Zyngier {
15883a49794SMarc Zyngier 	return kvm_vcpu_get_hsr(vcpu) >> ESR_EL2_EC_SHIFT;
15983a49794SMarc Zyngier }
16083a49794SMarc Zyngier 
16183a49794SMarc Zyngier static inline bool kvm_vcpu_trap_is_iabt(const struct kvm_vcpu *vcpu)
16283a49794SMarc Zyngier {
16383a49794SMarc Zyngier 	return kvm_vcpu_trap_get_class(vcpu) == ESR_EL2_EC_IABT;
16483a49794SMarc Zyngier }
16583a49794SMarc Zyngier 
16683a49794SMarc Zyngier static inline u8 kvm_vcpu_trap_get_fault(const struct kvm_vcpu *vcpu)
16783a49794SMarc Zyngier {
16883a49794SMarc Zyngier 	return kvm_vcpu_get_hsr(vcpu) & ESR_EL2_FSC_TYPE;
16983a49794SMarc Zyngier }
17083a49794SMarc Zyngier 
17183a49794SMarc Zyngier #endif /* __ARM64_KVM_EMULATE_H__ */
172