Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 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> |
Christoffer Dall | 45e96ea | 2013-01-20 18:43:58 -0500 | [diff] [blame] | 24 | #include <asm/kvm_mmio.h> |
Marc Zyngier | 7393b59 | 2012-09-17 19:27:09 +0100 | [diff] [blame] | 25 | #include <asm/kvm_arm.h> |
Andre Przywara | 4429fc6 | 2014-06-02 15:37:13 +0200 | [diff] [blame] | 26 | #include <asm/cputype.h> |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 27 | |
Marc Zyngier | db730d8 | 2012-10-03 11:17:02 +0100 | [diff] [blame] | 28 | unsigned long *vcpu_reg(struct kvm_vcpu *vcpu, u8 reg_num); |
| 29 | unsigned long *vcpu_spsr(struct kvm_vcpu *vcpu); |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 30 | |
Pavel Fedin | bc45a51 | 2015-12-04 15:03:11 +0300 | [diff] [blame] | 31 | static inline unsigned long vcpu_get_reg(struct kvm_vcpu *vcpu, |
| 32 | u8 reg_num) |
| 33 | { |
| 34 | return *vcpu_reg(vcpu, reg_num); |
| 35 | } |
| 36 | |
| 37 | static inline void vcpu_set_reg(struct kvm_vcpu *vcpu, u8 reg_num, |
| 38 | unsigned long val) |
| 39 | { |
| 40 | *vcpu_reg(vcpu, reg_num) = val; |
| 41 | } |
| 42 | |
Marc Zyngier | 3aedd5c | 2016-09-06 09:28:43 +0100 | [diff] [blame] | 43 | bool kvm_condition_valid32(const struct kvm_vcpu *vcpu); |
| 44 | void kvm_skip_instr32(struct kvm_vcpu *vcpu, bool is_wide_instr); |
Christoffer Dall | 5b3e5e5 | 2013-01-20 18:28:09 -0500 | [diff] [blame] | 45 | void kvm_inject_undefined(struct kvm_vcpu *vcpu); |
Marc Zyngier | bfb78b5 | 2016-09-06 14:02:09 +0100 | [diff] [blame] | 46 | void kvm_inject_vabt(struct kvm_vcpu *vcpu); |
Christoffer Dall | 5b3e5e5 | 2013-01-20 18:28:09 -0500 | [diff] [blame] | 47 | void kvm_inject_dabt(struct kvm_vcpu *vcpu, unsigned long addr); |
| 48 | void kvm_inject_pabt(struct kvm_vcpu *vcpu, unsigned long addr); |
| 49 | |
Marc Zyngier | 3aedd5c | 2016-09-06 09:28:43 +0100 | [diff] [blame] | 50 | static inline bool kvm_condition_valid(const struct kvm_vcpu *vcpu) |
| 51 | { |
| 52 | return kvm_condition_valid32(vcpu); |
| 53 | } |
| 54 | |
| 55 | static inline void kvm_skip_instr(struct kvm_vcpu *vcpu, bool is_wide_instr) |
| 56 | { |
| 57 | kvm_skip_instr32(vcpu, is_wide_instr); |
| 58 | } |
| 59 | |
Christoffer Dall | b856a59 | 2014-10-16 17:21:16 +0200 | [diff] [blame] | 60 | static inline void vcpu_reset_hcr(struct kvm_vcpu *vcpu) |
| 61 | { |
| 62 | vcpu->arch.hcr = HCR_GUEST_MASK; |
| 63 | } |
| 64 | |
Marc Zyngier | 3aedd5c | 2016-09-06 09:28:43 +0100 | [diff] [blame] | 65 | static inline unsigned long vcpu_get_hcr(const struct kvm_vcpu *vcpu) |
Marc Zyngier | 3c1e716 | 2014-12-19 16:05:31 +0000 | [diff] [blame] | 66 | { |
| 67 | return vcpu->arch.hcr; |
| 68 | } |
| 69 | |
| 70 | static inline void vcpu_set_hcr(struct kvm_vcpu *vcpu, unsigned long hcr) |
| 71 | { |
| 72 | vcpu->arch.hcr = hcr; |
| 73 | } |
| 74 | |
Marc Zyngier | 3aedd5c | 2016-09-06 09:28:43 +0100 | [diff] [blame] | 75 | static inline bool vcpu_mode_is_32bit(const struct kvm_vcpu *vcpu) |
Marc Zyngier | aa024c2f | 2013-01-20 18:28:13 -0500 | [diff] [blame] | 76 | { |
| 77 | return 1; |
| 78 | } |
| 79 | |
Marc Zyngier | db730d8 | 2012-10-03 11:17:02 +0100 | [diff] [blame] | 80 | static inline unsigned long *vcpu_pc(struct kvm_vcpu *vcpu) |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 81 | { |
Marc Zyngier | c2a8dab507 | 2016-01-03 11:26:01 +0000 | [diff] [blame] | 82 | return &vcpu->arch.ctxt.gp_regs.usr_regs.ARM_pc; |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 83 | } |
| 84 | |
Marc Zyngier | 3aedd5c | 2016-09-06 09:28:43 +0100 | [diff] [blame] | 85 | static inline unsigned long *vcpu_cpsr(const struct kvm_vcpu *vcpu) |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 86 | { |
Marc Zyngier | 3aedd5c | 2016-09-06 09:28:43 +0100 | [diff] [blame] | 87 | return (unsigned long *)&vcpu->arch.ctxt.gp_regs.usr_regs.ARM_cpsr; |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 88 | } |
| 89 | |
Marc Zyngier | aa024c2f | 2013-01-20 18:28:13 -0500 | [diff] [blame] | 90 | static inline void vcpu_set_thumb(struct kvm_vcpu *vcpu) |
| 91 | { |
| 92 | *vcpu_cpsr(vcpu) |= PSR_T_BIT; |
| 93 | } |
| 94 | |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 95 | static inline bool mode_has_spsr(struct kvm_vcpu *vcpu) |
| 96 | { |
Marc Zyngier | c2a8dab507 | 2016-01-03 11:26:01 +0000 | [diff] [blame] | 97 | unsigned long cpsr_mode = vcpu->arch.ctxt.gp_regs.usr_regs.ARM_cpsr & MODE_MASK; |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 98 | return (cpsr_mode > USR_MODE && cpsr_mode < SYSTEM_MODE); |
| 99 | } |
| 100 | |
| 101 | static inline bool vcpu_mode_priv(struct kvm_vcpu *vcpu) |
| 102 | { |
Marc Zyngier | c2a8dab507 | 2016-01-03 11:26:01 +0000 | [diff] [blame] | 103 | unsigned long cpsr_mode = vcpu->arch.ctxt.gp_regs.usr_regs.ARM_cpsr & MODE_MASK; |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 104 | return cpsr_mode > USR_MODE;; |
| 105 | } |
| 106 | |
Marc Zyngier | 3aedd5c | 2016-09-06 09:28:43 +0100 | [diff] [blame] | 107 | static inline u32 kvm_vcpu_get_hsr(const struct kvm_vcpu *vcpu) |
Marc Zyngier | 7393b59 | 2012-09-17 19:27:09 +0100 | [diff] [blame] | 108 | { |
| 109 | return vcpu->arch.fault.hsr; |
| 110 | } |
| 111 | |
Marc Zyngier | 3aedd5c | 2016-09-06 09:28:43 +0100 | [diff] [blame] | 112 | static inline int kvm_vcpu_get_condition(const struct kvm_vcpu *vcpu) |
| 113 | { |
| 114 | u32 hsr = kvm_vcpu_get_hsr(vcpu); |
| 115 | |
| 116 | if (hsr & HSR_CV) |
| 117 | return (hsr & HSR_COND) >> HSR_COND_SHIFT; |
| 118 | |
| 119 | return -1; |
| 120 | } |
| 121 | |
Marc Zyngier | 7393b59 | 2012-09-17 19:27:09 +0100 | [diff] [blame] | 122 | static inline unsigned long kvm_vcpu_get_hfar(struct kvm_vcpu *vcpu) |
| 123 | { |
| 124 | return vcpu->arch.fault.hxfar; |
| 125 | } |
| 126 | |
| 127 | static inline phys_addr_t kvm_vcpu_get_fault_ipa(struct kvm_vcpu *vcpu) |
| 128 | { |
| 129 | return ((phys_addr_t)vcpu->arch.fault.hpfar & HPFAR_MASK) << 8; |
| 130 | } |
| 131 | |
Marc Zyngier | 4a1df28 | 2012-09-18 11:06:23 +0100 | [diff] [blame] | 132 | static inline bool kvm_vcpu_dabt_isvalid(struct kvm_vcpu *vcpu) |
| 133 | { |
| 134 | return kvm_vcpu_get_hsr(vcpu) & HSR_ISV; |
| 135 | } |
| 136 | |
Marc Zyngier | 023cc96 | 2012-09-18 11:12:26 +0100 | [diff] [blame] | 137 | static inline bool kvm_vcpu_dabt_iswrite(struct kvm_vcpu *vcpu) |
| 138 | { |
| 139 | return kvm_vcpu_get_hsr(vcpu) & HSR_WNR; |
| 140 | } |
| 141 | |
Marc Zyngier | 7c511b8 | 2012-09-18 11:23:02 +0100 | [diff] [blame] | 142 | static inline bool kvm_vcpu_dabt_issext(struct kvm_vcpu *vcpu) |
| 143 | { |
| 144 | return kvm_vcpu_get_hsr(vcpu) & HSR_SSE; |
| 145 | } |
| 146 | |
Marc Zyngier | d0adf74 | 2012-09-18 11:28:57 +0100 | [diff] [blame] | 147 | static inline int kvm_vcpu_dabt_get_rd(struct kvm_vcpu *vcpu) |
| 148 | { |
| 149 | return (kvm_vcpu_get_hsr(vcpu) & HSR_SRT_MASK) >> HSR_SRT_SHIFT; |
| 150 | } |
| 151 | |
Marc Zyngier | 78abfcd | 2012-09-18 11:36:16 +0100 | [diff] [blame] | 152 | static inline bool kvm_vcpu_dabt_isextabt(struct kvm_vcpu *vcpu) |
| 153 | { |
| 154 | return kvm_vcpu_get_hsr(vcpu) & HSR_DABT_EA; |
| 155 | } |
| 156 | |
Marc Zyngier | b37670b | 2012-09-18 11:37:28 +0100 | [diff] [blame] | 157 | static inline bool kvm_vcpu_dabt_iss1tw(struct kvm_vcpu *vcpu) |
| 158 | { |
| 159 | return kvm_vcpu_get_hsr(vcpu) & HSR_DABT_S1PTW; |
| 160 | } |
| 161 | |
Marc Zyngier | 57c841f | 2016-01-29 15:01:28 +0000 | [diff] [blame] | 162 | static inline bool kvm_vcpu_dabt_is_cm(struct kvm_vcpu *vcpu) |
| 163 | { |
| 164 | return !!(kvm_vcpu_get_hsr(vcpu) & HSR_DABT_CM); |
| 165 | } |
| 166 | |
Marc Zyngier | a712337 | 2012-09-18 11:43:30 +0100 | [diff] [blame] | 167 | /* Get Access Size from a data abort */ |
| 168 | static inline int kvm_vcpu_dabt_get_as(struct kvm_vcpu *vcpu) |
| 169 | { |
| 170 | switch ((kvm_vcpu_get_hsr(vcpu) >> 22) & 0x3) { |
| 171 | case 0: |
| 172 | return 1; |
| 173 | case 1: |
| 174 | return 2; |
| 175 | case 2: |
| 176 | return 4; |
| 177 | default: |
| 178 | kvm_err("Hardware is weird: SAS 0b11 is reserved\n"); |
| 179 | return -EFAULT; |
| 180 | } |
| 181 | } |
| 182 | |
Marc Zyngier | 23b415d | 2012-09-18 12:07:06 +0100 | [diff] [blame] | 183 | /* This one is not specific to Data Abort */ |
| 184 | static inline bool kvm_vcpu_trap_il_is32bit(struct kvm_vcpu *vcpu) |
| 185 | { |
| 186 | return kvm_vcpu_get_hsr(vcpu) & HSR_IL; |
| 187 | } |
| 188 | |
Marc Zyngier | 4926d44 | 2012-09-18 14:09:58 +0100 | [diff] [blame] | 189 | static inline u8 kvm_vcpu_trap_get_class(struct kvm_vcpu *vcpu) |
| 190 | { |
| 191 | return kvm_vcpu_get_hsr(vcpu) >> HSR_EC_SHIFT; |
| 192 | } |
| 193 | |
Marc Zyngier | 52d1dba | 2012-10-15 10:33:38 +0100 | [diff] [blame] | 194 | static inline bool kvm_vcpu_trap_is_iabt(struct kvm_vcpu *vcpu) |
| 195 | { |
| 196 | return kvm_vcpu_trap_get_class(vcpu) == HSR_EC_IABT; |
| 197 | } |
| 198 | |
Marc Zyngier | 1cc287d | 2012-09-18 14:14:35 +0100 | [diff] [blame] | 199 | static inline u8 kvm_vcpu_trap_get_fault(struct kvm_vcpu *vcpu) |
| 200 | { |
Christoffer Dall | 0496daa5 | 2014-09-26 12:29:34 +0200 | [diff] [blame] | 201 | return kvm_vcpu_get_hsr(vcpu) & HSR_FSC; |
| 202 | } |
| 203 | |
| 204 | static inline u8 kvm_vcpu_trap_get_fault_type(struct kvm_vcpu *vcpu) |
| 205 | { |
Marc Zyngier | 1cc287d | 2012-09-18 14:14:35 +0100 | [diff] [blame] | 206 | return kvm_vcpu_get_hsr(vcpu) & HSR_FSC_TYPE; |
| 207 | } |
| 208 | |
Christoffer Dall | c088f8f | 2013-02-21 11:26:10 -0800 | [diff] [blame] | 209 | static inline u32 kvm_vcpu_hvc_get_imm(struct kvm_vcpu *vcpu) |
| 210 | { |
| 211 | return kvm_vcpu_get_hsr(vcpu) & HSR_HVC_IMM_MASK; |
| 212 | } |
| 213 | |
Andre Przywara | 4429fc6 | 2014-06-02 15:37:13 +0200 | [diff] [blame] | 214 | static inline unsigned long kvm_vcpu_get_mpidr_aff(struct kvm_vcpu *vcpu) |
Marc Zyngier | 79c6488 | 2013-10-18 18:19:03 +0100 | [diff] [blame] | 215 | { |
Marc Zyngier | fb32a52 | 2016-01-03 11:26:01 +0000 | [diff] [blame] | 216 | return vcpu_cp15(vcpu, c0_MPIDR) & MPIDR_HWID_BITMASK; |
Marc Zyngier | 79c6488 | 2013-10-18 18:19:03 +0100 | [diff] [blame] | 217 | } |
| 218 | |
Marc Zyngier | ce94fe9 | 2013-11-05 14:12:15 +0000 | [diff] [blame] | 219 | static inline void kvm_vcpu_set_be(struct kvm_vcpu *vcpu) |
| 220 | { |
| 221 | *vcpu_cpsr(vcpu) |= PSR_E_BIT; |
| 222 | } |
| 223 | |
Marc Zyngier | 6d89d2d | 2013-02-12 12:40:22 +0000 | [diff] [blame] | 224 | static inline bool kvm_vcpu_is_be(struct kvm_vcpu *vcpu) |
| 225 | { |
| 226 | return !!(*vcpu_cpsr(vcpu) & PSR_E_BIT); |
| 227 | } |
| 228 | |
| 229 | static inline unsigned long vcpu_data_guest_to_host(struct kvm_vcpu *vcpu, |
| 230 | unsigned long data, |
| 231 | unsigned int len) |
| 232 | { |
| 233 | if (kvm_vcpu_is_be(vcpu)) { |
| 234 | switch (len) { |
| 235 | case 1: |
| 236 | return data & 0xff; |
| 237 | case 2: |
| 238 | return be16_to_cpu(data & 0xffff); |
| 239 | default: |
| 240 | return be32_to_cpu(data); |
| 241 | } |
Victor Kamensky | 27f194f | 2014-06-12 09:30:05 -0700 | [diff] [blame] | 242 | } else { |
| 243 | switch (len) { |
| 244 | case 1: |
| 245 | return data & 0xff; |
| 246 | case 2: |
| 247 | return le16_to_cpu(data & 0xffff); |
| 248 | default: |
| 249 | return le32_to_cpu(data); |
| 250 | } |
Marc Zyngier | 6d89d2d | 2013-02-12 12:40:22 +0000 | [diff] [blame] | 251 | } |
Marc Zyngier | 6d89d2d | 2013-02-12 12:40:22 +0000 | [diff] [blame] | 252 | } |
| 253 | |
| 254 | static inline unsigned long vcpu_data_host_to_guest(struct kvm_vcpu *vcpu, |
| 255 | unsigned long data, |
| 256 | unsigned int len) |
| 257 | { |
| 258 | if (kvm_vcpu_is_be(vcpu)) { |
| 259 | switch (len) { |
| 260 | case 1: |
| 261 | return data & 0xff; |
| 262 | case 2: |
| 263 | return cpu_to_be16(data & 0xffff); |
| 264 | default: |
| 265 | return cpu_to_be32(data); |
| 266 | } |
Victor Kamensky | 27f194f | 2014-06-12 09:30:05 -0700 | [diff] [blame] | 267 | } else { |
| 268 | switch (len) { |
| 269 | case 1: |
| 270 | return data & 0xff; |
| 271 | case 2: |
| 272 | return cpu_to_le16(data & 0xffff); |
| 273 | default: |
| 274 | return cpu_to_le32(data); |
| 275 | } |
Marc Zyngier | 6d89d2d | 2013-02-12 12:40:22 +0000 | [diff] [blame] | 276 | } |
Marc Zyngier | 6d89d2d | 2013-02-12 12:40:22 +0000 | [diff] [blame] | 277 | } |
| 278 | |
Christoffer Dall | 749cf76c | 2013-01-20 18:28:06 -0500 | [diff] [blame] | 279 | #endif /* __ARM_KVM_EMULATE_H__ */ |