Fix for KVMFORNFV-23(Fuel installed KVM kernel blank screens on boot).
[kvmfornfv.git] / kernel / 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(" { CRm64(%2lu), Op1(%2lu), is64, func_%s },\n",
62                               p->CRn, 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         if (i1->Op2 != i2->Op2)
143                 return i1->Op2 - i2->Op2;
144         return i2->is_64 - i1->is_64;
145 }
146
147
148 #define CRn(_x)         .CRn = _x
149 #define CRm(_x)         .CRm = _x
150 #define CRm64(_x)       .CRn = _x, .CRm = 0
151 #define Op1(_x)         .Op1 = _x
152 #define Op2(_x)         .Op2 = _x
153 #define is64            .is_64 = true
154 #define is32            .is_64 = false
155
156 bool access_vm_reg(struct kvm_vcpu *vcpu,
157                    const struct coproc_params *p,
158                    const struct coproc_reg *r);
159
160 #endif /* __ARM_KVM_COPROC_LOCAL_H__ */