arch/arm/kvm/coproc.h

   1 /*
   2  * Copyright (C) 2012 - Virtual Open Systems and Columbia University
   3  * Authors: 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_COPROC_LOCAL_H__
  20 #define __ARM_KVM_COPROC_LOCAL_H__
  21
  22 struct coproc_params {
  23         unsigned long CRn;
  24         unsigned long CRm;
  25         unsigned long Op1;
  26         unsigned long Op2;
  27         unsigned long Rt1;
  28         unsigned long Rt2;
  29         bool is_64bit;
  30         bool is_write;
  31 };
  32
  33 struct coproc_reg {
  34         /* MRC/MCR/MRRC/MCRR instruction which accesses it. */
  35         unsigned long CRn;
  36         unsigned long CRm;
  37         unsigned long Op1;
  38         unsigned long Op2;
  39
  40         bool is_64;
  41
  42         /* Trapped access from guest, if non-NULL. */
  43         bool (*access)(struct kvm_vcpu *,
  44                        const struct coproc_params *,
  45                        const struct coproc_reg *);
  46
  47         /* Initialization for vcpu. */
  48         void (*reset)(struct kvm_vcpu *, const struct coproc_reg *);
  49
  50         /* Index into vcpu->arch.cp15[], or 0 if we don't need to save it. */
  51         unsigned long reg;
  52
  53         /* Value (usually reset value) */
  54         u64 val;
  55 };
  56
  57 static inline void print_cp_instr(const struct coproc_params *p)
  58 {
  59         /* Look, we even formatted it for you to paste into the table! */
  60         if (p->is_64bit) {
  61                 kvm_pr_unimpl(" { CRm(%2lu), Op1(%2lu), is64, func_%s },\n",
  62                               p->CRm, p->Op1, p->is_write ? "write" : "read");
  63         } else {
  64                 kvm_pr_unimpl(" { CRn(%2lu), CRm(%2lu), Op1(%2lu), Op2(%2lu), is32,"
  65                               " func_%s },\n",
  66                               p->CRn, p->CRm, p->Op1, p->Op2,
  67                               p->is_write ? "write" : "read");
  68         }
  69 }
  70
  71 static inline bool ignore_write(struct kvm_vcpu *vcpu,
  72                                 const struct coproc_params *p)
  73 {
  74         return true;
  75 }
  76
  77 static inline bool read_zero(struct kvm_vcpu *vcpu,
  78                              const struct coproc_params *p)
  79 {
  80         *vcpu_reg(vcpu, p->Rt1) = 0;
  81         return true;
  82 }
  83
  84 static inline bool write_to_read_only(struct kvm_vcpu *vcpu,
  85                                       const struct coproc_params *params)
  86 {
  87         kvm_debug("CP15 write to read-only register at: %08lx\n",
  88                   *vcpu_pc(vcpu));
  89         print_cp_instr(params);
  90         return false;
  91 }
  92
  93 static inline bool read_from_write_only(struct kvm_vcpu *vcpu,
  94                                         const struct coproc_params *params)
  95 {
  96         kvm_debug("CP15 read to write-only register at: %08lx\n",
  97                   *vcpu_pc(vcpu));
  98         print_cp_instr(params);
  99         return false;
 100 }
 101
 102 /* Reset functions */
 103 static inline void reset_unknown(struct kvm_vcpu *vcpu,
 104                                  const struct coproc_reg *r)
 105 {
 106         BUG_ON(!r->reg);
 107         BUG_ON(r->reg >= ARRAY_SIZE(vcpu->arch.cp15));
 108         vcpu->arch.cp15[r->reg] = 0xdecafbad;
 109 }
 110
 111 static inline void reset_val(struct kvm_vcpu *vcpu, const struct coproc_reg *r)
 112 {
 113         BUG_ON(!r->reg);
 114         BUG_ON(r->reg >= ARRAY_SIZE(vcpu->arch.cp15));
 115         vcpu->arch.cp15[r->reg] = r->val;
 116 }
 117
 118 static inline void reset_unknown64(struct kvm_vcpu *vcpu,
 119                                    const struct coproc_reg *r)
 120 {
 121         BUG_ON(!r->reg);
 122         BUG_ON(r->reg + 1 >= ARRAY_SIZE(vcpu->arch.cp15));
 123
 124         vcpu->arch.cp15[r->reg] = 0xdecafbad;
 125         vcpu->arch.cp15[r->reg+1] = 0xd0c0ffee;
 126 }
 127
 128 static inline int cmp_reg(const struct coproc_reg *i1,
 129                           const struct coproc_reg *i2)
 130 {
 131         BUG_ON(i1 == i2);
 132         if (!i1)
 133                 return 1;
 134         else if (!i2)
 135                 return -1;
 136         if (i1->CRn != i2->CRn)
 137                 return i1->CRn - i2->CRn;
 138         if (i1->CRm != i2->CRm)
 139                 return i1->CRm - i2->CRm;
 140         if (i1->Op1 != i2->Op1)
 141                 return i1->Op1 - i2->Op1;
 142         return i1->Op2 - i2->Op2;
 143 }
 144
 145
 146 #define CRn(_x)         .CRn = _x
 147 #define CRm(_x)         .CRm = _x
 148 #define Op1(_x)         .Op1 = _x
 149 #define Op2(_x)         .Op2 = _x
 150 #define is64            .is_64 = true
 151 #define is32            .is_64 = false
 152
 153 #endif /* __ARM_KVM_COPROC_LOCAL_H__ */