1 /*
2 * Copyright (C) 2012 - Virtual Open Systems and Columbia University
3 * Author: Christoffer Dall <c.dall@virtualopensystems.com>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License, version 2, as
7 * published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
17 */
18
19 #ifndef __ARM_KVM_EMULATE_H__
20 #define __ARM_KVM_EMULATE_H__
21
22 #include <linux/kvm_host.h>
23 #include <asm/kvm_asm.h>
24 #include <asm/kvm_mmio.h>
25 #include <asm/kvm_arm.h>
26
27 unsigned long *vcpu_reg(struct kvm_vcpu *vcpu, u8 reg_num);
28 unsigned long *vcpu_spsr(struct kvm_vcpu *vcpu);
29
30 bool kvm_condition_valid(struct kvm_vcpu *vcpu);
31 void kvm_skip_instr(struct kvm_vcpu *vcpu, bool is_wide_instr);
32 void kvm_inject_undefined(struct kvm_vcpu *vcpu);
33 void kvm_inject_dabt(struct kvm_vcpu *vcpu, unsigned long addr);
34 void kvm_inject_pabt(struct kvm_vcpu *vcpu, unsigned long addr);
35
vcpu_reset_hcr(struct kvm_vcpu * vcpu)36 static inline void vcpu_reset_hcr(struct kvm_vcpu *vcpu)
37 {
38 vcpu->arch.hcr = HCR_GUEST_MASK;
39 }
40
vcpu_get_hcr(struct kvm_vcpu * vcpu)41 static inline unsigned long vcpu_get_hcr(struct kvm_vcpu *vcpu)
42 {
43 return vcpu->arch.hcr;
44 }
45
vcpu_set_hcr(struct kvm_vcpu * vcpu,unsigned long hcr)46 static inline void vcpu_set_hcr(struct kvm_vcpu *vcpu, unsigned long hcr)
47 {
48 vcpu->arch.hcr = hcr;
49 }
50
vcpu_mode_is_32bit(struct kvm_vcpu * vcpu)51 static inline bool vcpu_mode_is_32bit(struct kvm_vcpu *vcpu)
52 {
53 return 1;
54 }
55
vcpu_pc(struct kvm_vcpu * vcpu)56 static inline unsigned long *vcpu_pc(struct kvm_vcpu *vcpu)
57 {
58 return &vcpu->arch.regs.usr_regs.ARM_pc;
59 }
60
vcpu_cpsr(struct kvm_vcpu * vcpu)61 static inline unsigned long *vcpu_cpsr(struct kvm_vcpu *vcpu)
62 {
63 return &vcpu->arch.regs.usr_regs.ARM_cpsr;
64 }
65
vcpu_set_thumb(struct kvm_vcpu * vcpu)66 static inline void vcpu_set_thumb(struct kvm_vcpu *vcpu)
67 {
68 *vcpu_cpsr(vcpu) |= PSR_T_BIT;
69 }
70
mode_has_spsr(struct kvm_vcpu * vcpu)71 static inline bool mode_has_spsr(struct kvm_vcpu *vcpu)
72 {
73 unsigned long cpsr_mode = vcpu->arch.regs.usr_regs.ARM_cpsr & MODE_MASK;
74 return (cpsr_mode > USR_MODE && cpsr_mode < SYSTEM_MODE);
75 }
76
vcpu_mode_priv(struct kvm_vcpu * vcpu)77 static inline bool vcpu_mode_priv(struct kvm_vcpu *vcpu)
78 {
79 unsigned long cpsr_mode = vcpu->arch.regs.usr_regs.ARM_cpsr & MODE_MASK;
80 return cpsr_mode > USR_MODE;;
81 }
82
kvm_vcpu_get_hsr(struct kvm_vcpu * vcpu)83 static inline u32 kvm_vcpu_get_hsr(struct kvm_vcpu *vcpu)
84 {
85 return vcpu->arch.fault.hsr;
86 }
87
kvm_vcpu_get_hfar(struct kvm_vcpu * vcpu)88 static inline unsigned long kvm_vcpu_get_hfar(struct kvm_vcpu *vcpu)
89 {
90 return vcpu->arch.fault.hxfar;
91 }
92
kvm_vcpu_get_fault_ipa(struct kvm_vcpu * vcpu)93 static inline phys_addr_t kvm_vcpu_get_fault_ipa(struct kvm_vcpu *vcpu)
94 {
95 return ((phys_addr_t)vcpu->arch.fault.hpfar & HPFAR_MASK) << 8;
96 }
97
kvm_vcpu_get_hyp_pc(struct kvm_vcpu * vcpu)98 static inline unsigned long kvm_vcpu_get_hyp_pc(struct kvm_vcpu *vcpu)
99 {
100 return vcpu->arch.fault.hyp_pc;
101 }
102
kvm_vcpu_dabt_isvalid(struct kvm_vcpu * vcpu)103 static inline bool kvm_vcpu_dabt_isvalid(struct kvm_vcpu *vcpu)
104 {
105 return kvm_vcpu_get_hsr(vcpu) & HSR_ISV;
106 }
107
kvm_vcpu_dabt_iswrite(struct kvm_vcpu * vcpu)108 static inline bool kvm_vcpu_dabt_iswrite(struct kvm_vcpu *vcpu)
109 {
110 return kvm_vcpu_get_hsr(vcpu) & HSR_WNR;
111 }
112
kvm_vcpu_dabt_issext(struct kvm_vcpu * vcpu)113 static inline bool kvm_vcpu_dabt_issext(struct kvm_vcpu *vcpu)
114 {
115 return kvm_vcpu_get_hsr(vcpu) & HSR_SSE;
116 }
117
kvm_vcpu_dabt_get_rd(struct kvm_vcpu * vcpu)118 static inline int kvm_vcpu_dabt_get_rd(struct kvm_vcpu *vcpu)
119 {
120 return (kvm_vcpu_get_hsr(vcpu) & HSR_SRT_MASK) >> HSR_SRT_SHIFT;
121 }
122
kvm_vcpu_dabt_isextabt(struct kvm_vcpu * vcpu)123 static inline bool kvm_vcpu_dabt_isextabt(struct kvm_vcpu *vcpu)
124 {
125 return kvm_vcpu_get_hsr(vcpu) & HSR_DABT_EA;
126 }
127
kvm_vcpu_dabt_iss1tw(struct kvm_vcpu * vcpu)128 static inline bool kvm_vcpu_dabt_iss1tw(struct kvm_vcpu *vcpu)
129 {
130 return kvm_vcpu_get_hsr(vcpu) & HSR_DABT_S1PTW;
131 }
132
133 /* Get Access Size from a data abort */
kvm_vcpu_dabt_get_as(struct kvm_vcpu * vcpu)134 static inline int kvm_vcpu_dabt_get_as(struct kvm_vcpu *vcpu)
135 {
136 switch ((kvm_vcpu_get_hsr(vcpu) >> 22) & 0x3) {
137 case 0:
138 return 1;
139 case 1:
140 return 2;
141 case 2:
142 return 4;
143 default:
144 kvm_err("Hardware is weird: SAS 0b11 is reserved\n");
145 return -EFAULT;
146 }
147 }
148
149 /* This one is not specific to Data Abort */
kvm_vcpu_trap_il_is32bit(struct kvm_vcpu * vcpu)150 static inline bool kvm_vcpu_trap_il_is32bit(struct kvm_vcpu *vcpu)
151 {
152 return kvm_vcpu_get_hsr(vcpu) & HSR_IL;
153 }
154
kvm_vcpu_trap_get_class(struct kvm_vcpu * vcpu)155 static inline u8 kvm_vcpu_trap_get_class(struct kvm_vcpu *vcpu)
156 {
157 return kvm_vcpu_get_hsr(vcpu) >> HSR_EC_SHIFT;
158 }
159
kvm_vcpu_trap_is_iabt(struct kvm_vcpu * vcpu)160 static inline bool kvm_vcpu_trap_is_iabt(struct kvm_vcpu *vcpu)
161 {
162 return kvm_vcpu_trap_get_class(vcpu) == HSR_EC_IABT;
163 }
164
kvm_vcpu_trap_get_fault(struct kvm_vcpu * vcpu)165 static inline u8 kvm_vcpu_trap_get_fault(struct kvm_vcpu *vcpu)
166 {
167 return kvm_vcpu_get_hsr(vcpu) & HSR_FSC;
168 }
169
kvm_vcpu_trap_get_fault_type(struct kvm_vcpu * vcpu)170 static inline u8 kvm_vcpu_trap_get_fault_type(struct kvm_vcpu *vcpu)
171 {
172 return kvm_vcpu_get_hsr(vcpu) & HSR_FSC_TYPE;
173 }
174
kvm_vcpu_hvc_get_imm(struct kvm_vcpu * vcpu)175 static inline u32 kvm_vcpu_hvc_get_imm(struct kvm_vcpu *vcpu)
176 {
177 return kvm_vcpu_get_hsr(vcpu) & HSR_HVC_IMM_MASK;
178 }
179
kvm_vcpu_get_mpidr(struct kvm_vcpu * vcpu)180 static inline unsigned long kvm_vcpu_get_mpidr(struct kvm_vcpu *vcpu)
181 {
182 return vcpu->arch.cp15[c0_MPIDR];
183 }
184
kvm_vcpu_set_be(struct kvm_vcpu * vcpu)185 static inline void kvm_vcpu_set_be(struct kvm_vcpu *vcpu)
186 {
187 *vcpu_cpsr(vcpu) |= PSR_E_BIT;
188 }
189
kvm_vcpu_is_be(struct kvm_vcpu * vcpu)190 static inline bool kvm_vcpu_is_be(struct kvm_vcpu *vcpu)
191 {
192 return !!(*vcpu_cpsr(vcpu) & PSR_E_BIT);
193 }
194
vcpu_data_guest_to_host(struct kvm_vcpu * vcpu,unsigned long data,unsigned int len)195 static inline unsigned long vcpu_data_guest_to_host(struct kvm_vcpu *vcpu,
196 unsigned long data,
197 unsigned int len)
198 {
199 if (kvm_vcpu_is_be(vcpu)) {
200 switch (len) {
201 case 1:
202 return data & 0xff;
203 case 2:
204 return be16_to_cpu(data & 0xffff);
205 default:
206 return be32_to_cpu(data);
207 }
208 } else {
209 switch (len) {
210 case 1:
211 return data & 0xff;
212 case 2:
213 return le16_to_cpu(data & 0xffff);
214 default:
215 return le32_to_cpu(data);
216 }
217 }
218 }
219
vcpu_data_host_to_guest(struct kvm_vcpu * vcpu,unsigned long data,unsigned int len)220 static inline unsigned long vcpu_data_host_to_guest(struct kvm_vcpu *vcpu,
221 unsigned long data,
222 unsigned int len)
223 {
224 if (kvm_vcpu_is_be(vcpu)) {
225 switch (len) {
226 case 1:
227 return data & 0xff;
228 case 2:
229 return cpu_to_be16(data & 0xffff);
230 default:
231 return cpu_to_be32(data);
232 }
233 } else {
234 switch (len) {
235 case 1:
236 return data & 0xff;
237 case 2:
238 return cpu_to_le16(data & 0xffff);
239 default:
240 return cpu_to_le32(data);
241 }
242 }
243 }
244
245 #endif /* __ARM_KVM_EMULATE_H__ */
246