Commit | Line | Data |
---|---|---|
7741909b AG |
1 | /* |
2 | * Copyright (C) 2010 SUSE Linux Products GmbH. All rights reserved. | |
3 | * | |
4 | * Authors: | |
5 | * Alexander Graf <agraf@suse.de> | |
6 | * | |
7 | * This program is free software; you can redistribute it and/or modify | |
8 | * it under the terms of the GNU General Public License, version 2, as | |
9 | * published by the Free Software Foundation. | |
10 | * | |
11 | * This program is distributed in the hope that it will be useful, | |
12 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
13 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
14 | * GNU General Public License for more details. | |
15 | * | |
16 | * You should have received a copy of the GNU General Public License | |
17 | * along with this program; if not, write to the Free Software | |
18 | * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. | |
19 | */ | |
20 | ||
21 | #include <linux/kvm_host.h> | |
22 | #include <linux/hash.h> | |
23 | #include <linux/slab.h> | |
4c4eea77 | 24 | #include "trace.h" |
7741909b AG |
25 | |
26 | #include <asm/kvm_ppc.h> | |
27 | #include <asm/kvm_book3s.h> | |
28 | #include <asm/machdep.h> | |
29 | #include <asm/mmu_context.h> | |
30 | #include <asm/hw_irq.h> | |
31 | ||
32 | #define PTE_SIZE 12 | |
33 | ||
7741909b AG |
34 | static struct kmem_cache *hpte_cache; |
35 | ||
36 | static inline u64 kvmppc_mmu_hash_pte(u64 eaddr) | |
37 | { | |
38 | return hash_64(eaddr >> PTE_SIZE, HPTEG_HASH_BITS_PTE); | |
39 | } | |
40 | ||
2d27fc5e AG |
41 | static inline u64 kvmppc_mmu_hash_pte_long(u64 eaddr) |
42 | { | |
43 | return hash_64((eaddr & 0x0ffff000) >> PTE_SIZE, | |
44 | HPTEG_HASH_BITS_PTE_LONG); | |
45 | } | |
46 | ||
7741909b AG |
47 | static inline u64 kvmppc_mmu_hash_vpte(u64 vpage) |
48 | { | |
49 | return hash_64(vpage & 0xfffffffffULL, HPTEG_HASH_BITS_VPTE); | |
50 | } | |
51 | ||
52 | static inline u64 kvmppc_mmu_hash_vpte_long(u64 vpage) | |
53 | { | |
54 | return hash_64((vpage & 0xffffff000ULL) >> 12, | |
55 | HPTEG_HASH_BITS_VPTE_LONG); | |
56 | } | |
57 | ||
58 | void kvmppc_mmu_hpte_cache_map(struct kvm_vcpu *vcpu, struct hpte_cache *pte) | |
59 | { | |
60 | u64 index; | |
61 | ||
4c4eea77 AG |
62 | trace_kvm_book3s_mmu_map(pte); |
63 | ||
2e0908af AG |
64 | spin_lock(&vcpu->arch.mmu_lock); |
65 | ||
7741909b AG |
66 | /* Add to ePTE list */ |
67 | index = kvmppc_mmu_hash_pte(pte->pte.eaddr); | |
2e0908af | 68 | hlist_add_head_rcu(&pte->list_pte, &vcpu->arch.hpte_hash_pte[index]); |
7741909b | 69 | |
2d27fc5e AG |
70 | /* Add to ePTE_long list */ |
71 | index = kvmppc_mmu_hash_pte_long(pte->pte.eaddr); | |
72 | hlist_add_head_rcu(&pte->list_pte_long, | |
73 | &vcpu->arch.hpte_hash_pte_long[index]); | |
74 | ||
7741909b AG |
75 | /* Add to vPTE list */ |
76 | index = kvmppc_mmu_hash_vpte(pte->pte.vpage); | |
2e0908af | 77 | hlist_add_head_rcu(&pte->list_vpte, &vcpu->arch.hpte_hash_vpte[index]); |
7741909b AG |
78 | |
79 | /* Add to vPTE_long list */ | |
80 | index = kvmppc_mmu_hash_vpte_long(pte->pte.vpage); | |
2e0908af AG |
81 | hlist_add_head_rcu(&pte->list_vpte_long, |
82 | &vcpu->arch.hpte_hash_vpte_long[index]); | |
83 | ||
84 | spin_unlock(&vcpu->arch.mmu_lock); | |
85 | } | |
86 | ||
87 | static void free_pte_rcu(struct rcu_head *head) | |
88 | { | |
89 | struct hpte_cache *pte = container_of(head, struct hpte_cache, rcu_head); | |
90 | kmem_cache_free(hpte_cache, pte); | |
7741909b AG |
91 | } |
92 | ||
93 | static void invalidate_pte(struct kvm_vcpu *vcpu, struct hpte_cache *pte) | |
94 | { | |
8696ee43 | 95 | trace_kvm_book3s_mmu_invalidate(pte); |
7741909b AG |
96 | |
97 | /* Different for 32 and 64 bit */ | |
98 | kvmppc_mmu_invalidate_pte(vcpu, pte); | |
99 | ||
2e0908af AG |
100 | spin_lock(&vcpu->arch.mmu_lock); |
101 | ||
e7c1d14e AG |
102 | /* pte already invalidated in between? */ |
103 | if (hlist_unhashed(&pte->list_pte)) { | |
104 | spin_unlock(&vcpu->arch.mmu_lock); | |
105 | return; | |
106 | } | |
107 | ||
2e0908af | 108 | hlist_del_init_rcu(&pte->list_pte); |
2d27fc5e | 109 | hlist_del_init_rcu(&pte->list_pte_long); |
2e0908af AG |
110 | hlist_del_init_rcu(&pte->list_vpte); |
111 | hlist_del_init_rcu(&pte->list_vpte_long); | |
112 | ||
7741909b AG |
113 | if (pte->pte.may_write) |
114 | kvm_release_pfn_dirty(pte->pfn); | |
115 | else | |
116 | kvm_release_pfn_clean(pte->pfn); | |
117 | ||
e7c1d14e AG |
118 | spin_unlock(&vcpu->arch.mmu_lock); |
119 | ||
7741909b | 120 | vcpu->arch.hpte_cache_count--; |
2e0908af | 121 | call_rcu(&pte->rcu_head, free_pte_rcu); |
7741909b AG |
122 | } |
123 | ||
124 | static void kvmppc_mmu_pte_flush_all(struct kvm_vcpu *vcpu) | |
125 | { | |
126 | struct hpte_cache *pte; | |
2e0908af | 127 | struct hlist_node *node; |
7741909b AG |
128 | int i; |
129 | ||
2e0908af AG |
130 | rcu_read_lock(); |
131 | ||
7741909b AG |
132 | for (i = 0; i < HPTEG_HASH_NUM_VPTE_LONG; i++) { |
133 | struct hlist_head *list = &vcpu->arch.hpte_hash_vpte_long[i]; | |
134 | ||
2e0908af | 135 | hlist_for_each_entry_rcu(pte, node, list, list_vpte_long) |
7741909b AG |
136 | invalidate_pte(vcpu, pte); |
137 | } | |
2e0908af AG |
138 | |
139 | rcu_read_unlock(); | |
7741909b AG |
140 | } |
141 | ||
142 | static void kvmppc_mmu_pte_flush_page(struct kvm_vcpu *vcpu, ulong guest_ea) | |
143 | { | |
144 | struct hlist_head *list; | |
2e0908af | 145 | struct hlist_node *node; |
7741909b AG |
146 | struct hpte_cache *pte; |
147 | ||
148 | /* Find the list of entries in the map */ | |
149 | list = &vcpu->arch.hpte_hash_pte[kvmppc_mmu_hash_pte(guest_ea)]; | |
150 | ||
2e0908af AG |
151 | rcu_read_lock(); |
152 | ||
7741909b | 153 | /* Check the list for matching entries and invalidate */ |
2e0908af | 154 | hlist_for_each_entry_rcu(pte, node, list, list_pte) |
7741909b AG |
155 | if ((pte->pte.eaddr & ~0xfffUL) == guest_ea) |
156 | invalidate_pte(vcpu, pte); | |
2e0908af AG |
157 | |
158 | rcu_read_unlock(); | |
7741909b AG |
159 | } |
160 | ||
2d27fc5e | 161 | static void kvmppc_mmu_pte_flush_long(struct kvm_vcpu *vcpu, ulong guest_ea) |
7741909b | 162 | { |
2d27fc5e AG |
163 | struct hlist_head *list; |
164 | struct hlist_node *node; | |
165 | struct hpte_cache *pte; | |
166 | ||
167 | /* Find the list of entries in the map */ | |
168 | list = &vcpu->arch.hpte_hash_pte_long[ | |
169 | kvmppc_mmu_hash_pte_long(guest_ea)]; | |
7741909b | 170 | |
2d27fc5e AG |
171 | rcu_read_lock(); |
172 | ||
173 | /* Check the list for matching entries and invalidate */ | |
174 | hlist_for_each_entry_rcu(pte, node, list, list_pte_long) | |
175 | if ((pte->pte.eaddr & 0x0ffff000UL) == guest_ea) | |
176 | invalidate_pte(vcpu, pte); | |
177 | ||
178 | rcu_read_unlock(); | |
179 | } | |
180 | ||
181 | void kvmppc_mmu_pte_flush(struct kvm_vcpu *vcpu, ulong guest_ea, ulong ea_mask) | |
182 | { | |
c60b4cf7 | 183 | trace_kvm_book3s_mmu_flush("", vcpu, guest_ea, ea_mask); |
7741909b AG |
184 | guest_ea &= ea_mask; |
185 | ||
186 | switch (ea_mask) { | |
187 | case ~0xfffUL: | |
188 | kvmppc_mmu_pte_flush_page(vcpu, guest_ea); | |
189 | break; | |
190 | case 0x0ffff000: | |
2d27fc5e | 191 | kvmppc_mmu_pte_flush_long(vcpu, guest_ea); |
7741909b AG |
192 | break; |
193 | case 0: | |
194 | /* Doing a complete flush -> start from scratch */ | |
195 | kvmppc_mmu_pte_flush_all(vcpu); | |
196 | break; | |
197 | default: | |
198 | WARN_ON(1); | |
199 | break; | |
200 | } | |
201 | } | |
202 | ||
203 | /* Flush with mask 0xfffffffff */ | |
204 | static void kvmppc_mmu_pte_vflush_short(struct kvm_vcpu *vcpu, u64 guest_vp) | |
205 | { | |
206 | struct hlist_head *list; | |
2e0908af | 207 | struct hlist_node *node; |
7741909b AG |
208 | struct hpte_cache *pte; |
209 | u64 vp_mask = 0xfffffffffULL; | |
210 | ||
211 | list = &vcpu->arch.hpte_hash_vpte[kvmppc_mmu_hash_vpte(guest_vp)]; | |
212 | ||
2e0908af AG |
213 | rcu_read_lock(); |
214 | ||
7741909b | 215 | /* Check the list for matching entries and invalidate */ |
2e0908af | 216 | hlist_for_each_entry_rcu(pte, node, list, list_vpte) |
7741909b AG |
217 | if ((pte->pte.vpage & vp_mask) == guest_vp) |
218 | invalidate_pte(vcpu, pte); | |
2e0908af AG |
219 | |
220 | rcu_read_unlock(); | |
7741909b AG |
221 | } |
222 | ||
223 | /* Flush with mask 0xffffff000 */ | |
224 | static void kvmppc_mmu_pte_vflush_long(struct kvm_vcpu *vcpu, u64 guest_vp) | |
225 | { | |
226 | struct hlist_head *list; | |
2e0908af | 227 | struct hlist_node *node; |
7741909b AG |
228 | struct hpte_cache *pte; |
229 | u64 vp_mask = 0xffffff000ULL; | |
230 | ||
231 | list = &vcpu->arch.hpte_hash_vpte_long[ | |
232 | kvmppc_mmu_hash_vpte_long(guest_vp)]; | |
233 | ||
2e0908af AG |
234 | rcu_read_lock(); |
235 | ||
7741909b | 236 | /* Check the list for matching entries and invalidate */ |
2e0908af | 237 | hlist_for_each_entry_rcu(pte, node, list, list_vpte_long) |
7741909b AG |
238 | if ((pte->pte.vpage & vp_mask) == guest_vp) |
239 | invalidate_pte(vcpu, pte); | |
2e0908af AG |
240 | |
241 | rcu_read_unlock(); | |
7741909b AG |
242 | } |
243 | ||
244 | void kvmppc_mmu_pte_vflush(struct kvm_vcpu *vcpu, u64 guest_vp, u64 vp_mask) | |
245 | { | |
c60b4cf7 | 246 | trace_kvm_book3s_mmu_flush("v", vcpu, guest_vp, vp_mask); |
7741909b AG |
247 | guest_vp &= vp_mask; |
248 | ||
249 | switch(vp_mask) { | |
250 | case 0xfffffffffULL: | |
251 | kvmppc_mmu_pte_vflush_short(vcpu, guest_vp); | |
252 | break; | |
253 | case 0xffffff000ULL: | |
254 | kvmppc_mmu_pte_vflush_long(vcpu, guest_vp); | |
255 | break; | |
256 | default: | |
257 | WARN_ON(1); | |
258 | return; | |
259 | } | |
260 | } | |
261 | ||
262 | void kvmppc_mmu_pte_pflush(struct kvm_vcpu *vcpu, ulong pa_start, ulong pa_end) | |
263 | { | |
2e0908af | 264 | struct hlist_node *node; |
7741909b AG |
265 | struct hpte_cache *pte; |
266 | int i; | |
267 | ||
c60b4cf7 | 268 | trace_kvm_book3s_mmu_flush("p", vcpu, pa_start, pa_end); |
7741909b | 269 | |
2e0908af AG |
270 | rcu_read_lock(); |
271 | ||
7741909b AG |
272 | for (i = 0; i < HPTEG_HASH_NUM_VPTE_LONG; i++) { |
273 | struct hlist_head *list = &vcpu->arch.hpte_hash_vpte_long[i]; | |
274 | ||
2e0908af | 275 | hlist_for_each_entry_rcu(pte, node, list, list_vpte_long) |
7741909b AG |
276 | if ((pte->pte.raddr >= pa_start) && |
277 | (pte->pte.raddr < pa_end)) | |
278 | invalidate_pte(vcpu, pte); | |
279 | } | |
2e0908af AG |
280 | |
281 | rcu_read_unlock(); | |
7741909b AG |
282 | } |
283 | ||
284 | struct hpte_cache *kvmppc_mmu_hpte_cache_next(struct kvm_vcpu *vcpu) | |
285 | { | |
286 | struct hpte_cache *pte; | |
287 | ||
288 | pte = kmem_cache_zalloc(hpte_cache, GFP_KERNEL); | |
289 | vcpu->arch.hpte_cache_count++; | |
290 | ||
291 | if (vcpu->arch.hpte_cache_count == HPTEG_CACHE_NUM) | |
292 | kvmppc_mmu_pte_flush_all(vcpu); | |
293 | ||
294 | return pte; | |
295 | } | |
296 | ||
297 | void kvmppc_mmu_hpte_destroy(struct kvm_vcpu *vcpu) | |
298 | { | |
299 | kvmppc_mmu_pte_flush(vcpu, 0, 0); | |
300 | } | |
301 | ||
302 | static void kvmppc_mmu_hpte_init_hash(struct hlist_head *hash_list, int len) | |
303 | { | |
304 | int i; | |
305 | ||
306 | for (i = 0; i < len; i++) | |
307 | INIT_HLIST_HEAD(&hash_list[i]); | |
308 | } | |
309 | ||
310 | int kvmppc_mmu_hpte_init(struct kvm_vcpu *vcpu) | |
311 | { | |
312 | /* init hpte lookup hashes */ | |
313 | kvmppc_mmu_hpte_init_hash(vcpu->arch.hpte_hash_pte, | |
314 | ARRAY_SIZE(vcpu->arch.hpte_hash_pte)); | |
2d27fc5e AG |
315 | kvmppc_mmu_hpte_init_hash(vcpu->arch.hpte_hash_pte_long, |
316 | ARRAY_SIZE(vcpu->arch.hpte_hash_pte_long)); | |
7741909b AG |
317 | kvmppc_mmu_hpte_init_hash(vcpu->arch.hpte_hash_vpte, |
318 | ARRAY_SIZE(vcpu->arch.hpte_hash_vpte)); | |
319 | kvmppc_mmu_hpte_init_hash(vcpu->arch.hpte_hash_vpte_long, | |
320 | ARRAY_SIZE(vcpu->arch.hpte_hash_vpte_long)); | |
321 | ||
2e0908af AG |
322 | spin_lock_init(&vcpu->arch.mmu_lock); |
323 | ||
7741909b AG |
324 | return 0; |
325 | } | |
326 | ||
327 | int kvmppc_mmu_hpte_sysinit(void) | |
328 | { | |
329 | /* init hpte slab cache */ | |
330 | hpte_cache = kmem_cache_create("kvm-spt", sizeof(struct hpte_cache), | |
331 | sizeof(struct hpte_cache), 0, NULL); | |
332 | ||
333 | return 0; | |
334 | } | |
335 | ||
336 | void kvmppc_mmu_hpte_sysexit(void) | |
337 | { | |
338 | kmem_cache_destroy(hpte_cache); | |
339 | } |