arch/arm/include/asm/kvm_emulate.h

   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
  36 static inline void vcpu_reset_hcr(struct kvm_vcpu *vcpu)
  37 {
  38         vcpu->arch.hcr = HCR_GUEST_MASK;
  39 }
  40
  41 static inline unsigned long vcpu_get_hcr(struct kvm_vcpu *vcpu)
  42 {
  43         return vcpu->arch.hcr;
  44 }
  45
  46 static inline void vcpu_set_hcr(struct kvm_vcpu *vcpu, unsigned long hcr)
  47 {
  48         vcpu->arch.hcr = hcr;
  49 }
  50
  51 static inline bool vcpu_mode_is_32bit(struct kvm_vcpu *vcpu)
  52 {
  53         return 1;
  54 }
  55
  56 static inline unsigned long *vcpu_pc(struct kvm_vcpu *vcpu)
  57 {
  58         return &vcpu->arch.regs.usr_regs.ARM_pc;
  59 }
  60
  61 static inline unsigned long *vcpu_cpsr(struct kvm_vcpu *vcpu)
  62 {
  63         return &vcpu->arch.regs.usr_regs.ARM_cpsr;
  64 }
  65
  66 static inline void vcpu_set_thumb(struct kvm_vcpu *vcpu)
  67 {
  68         *vcpu_cpsr(vcpu) |= PSR_T_BIT;
  69 }
  70
  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
  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
  83 static inline u32 kvm_vcpu_get_hsr(struct kvm_vcpu *vcpu)
  84 {
  85         return vcpu->arch.fault.hsr;
  86 }
  87
  88 static inline unsigned long kvm_vcpu_get_hfar(struct kvm_vcpu *vcpu)
  89 {
  90         return vcpu->arch.fault.hxfar;
  91 }
  92
  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
  98 static inline unsigned long kvm_vcpu_get_hyp_pc(struct kvm_vcpu *vcpu)
  99 {
 100         return vcpu->arch.fault.hyp_pc;
 101 }
 102
 103 static inline bool kvm_vcpu_dabt_isvalid(struct kvm_vcpu *vcpu)
 104 {
 105         return kvm_vcpu_get_hsr(vcpu) & HSR_ISV;
 106 }
 107
 108 static inline bool kvm_vcpu_dabt_iswrite(struct kvm_vcpu *vcpu)
 109 {
 110         return kvm_vcpu_get_hsr(vcpu) & HSR_WNR;
 111 }
 112
 113 static inline bool kvm_vcpu_dabt_issext(struct kvm_vcpu *vcpu)
 114 {
 115         return kvm_vcpu_get_hsr(vcpu) & HSR_SSE;
 116 }
 117
 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
 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
 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 */
 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 */
 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
 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
 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
 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
 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
 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
 180 static inline unsigned long kvm_vcpu_get_mpidr(struct kvm_vcpu *vcpu)
 181 {
 182         return vcpu->arch.cp15[c0_MPIDR];
 183 }
 184
 185 static inline void kvm_vcpu_set_be(struct kvm_vcpu *vcpu)
 186 {
 187         *vcpu_cpsr(vcpu) |= PSR_E_BIT;
 188 }
 189
 190 static inline bool kvm_vcpu_is_be(struct kvm_vcpu *vcpu)
 191 {
 192         return !!(*vcpu_cpsr(vcpu) & PSR_E_BIT);
 193 }
 194
 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
 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__ */