Commit | Line | Data |
---|---|---|
5b3e5e5b CD |
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 | ||
f1d67d4a | 40 | bool is_64bit; |
5b3e5e5b CD |
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 | ||
fb32a52a | 50 | /* Index into vcpu_cp15(vcpu, ...), or 0 if we don't need to save it. */ |
5b3e5e5b CD |
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) { | |
46c214dd MZ |
61 | kvm_pr_unimpl(" { CRm64(%2lu), Op1(%2lu), is64, func_%s },\n", |
62 | p->CRn, p->Op1, p->is_write ? "write" : "read"); | |
5b3e5e5b CD |
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 | { | |
db730d8d | 87 | kvm_debug("CP15 write to read-only register at: %08lx\n", |
5b3e5e5b CD |
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 | { | |
db730d8d | 96 | kvm_debug("CP15 read to write-only register at: %08lx\n", |
5b3e5e5b CD |
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); | |
fb32a52a MZ |
107 | BUG_ON(r->reg >= ARRAY_SIZE(vcpu->arch.ctxt.cp15)); |
108 | vcpu_cp15(vcpu, r->reg) = 0xdecafbad; | |
5b3e5e5b CD |
109 | } |
110 | ||
111 | static inline void reset_val(struct kvm_vcpu *vcpu, const struct coproc_reg *r) | |
112 | { | |
113 | BUG_ON(!r->reg); | |
fb32a52a MZ |
114 | BUG_ON(r->reg >= ARRAY_SIZE(vcpu->arch.ctxt.cp15)); |
115 | vcpu_cp15(vcpu, r->reg) = r->val; | |
5b3e5e5b CD |
116 | } |
117 | ||
118 | static inline void reset_unknown64(struct kvm_vcpu *vcpu, | |
119 | const struct coproc_reg *r) | |
120 | { | |
121 | BUG_ON(!r->reg); | |
fb32a52a | 122 | BUG_ON(r->reg + 1 >= ARRAY_SIZE(vcpu->arch.ctxt.cp15)); |
5b3e5e5b | 123 | |
fb32a52a MZ |
124 | vcpu_cp15(vcpu, r->reg) = 0xdecafbad; |
125 | vcpu_cp15(vcpu, r->reg+1) = 0xd0c0ffee; | |
5b3e5e5b CD |
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; | |
547f7813 MZ |
142 | if (i1->Op2 != i2->Op2) |
143 | return i1->Op2 - i2->Op2; | |
f1d67d4a | 144 | return i2->is_64bit - i1->is_64bit; |
5b3e5e5b CD |
145 | } |
146 | ||
147 | ||
148 | #define CRn(_x) .CRn = _x | |
149 | #define CRm(_x) .CRm = _x | |
240e99cb | 150 | #define CRm64(_x) .CRn = _x, .CRm = 0 |
5b3e5e5b CD |
151 | #define Op1(_x) .Op1 = _x |
152 | #define Op2(_x) .Op2 = _x | |
f1d67d4a MZ |
153 | #define is64 .is_64bit = true |
154 | #define is32 .is_64bit = false | |
5b3e5e5b | 155 | |
3c1e7165 MZ |
156 | bool access_vm_reg(struct kvm_vcpu *vcpu, |
157 | const struct coproc_params *p, | |
158 | const struct coproc_reg *r); | |
8034699a | 159 | |
5b3e5e5b | 160 | #endif /* __ARM_KVM_COPROC_LOCAL_H__ */ |