GNU Linux-libre 5.15.72-gnu
[releases.git] / arch / powerpc / kvm / book3s_mmu_hpte.c
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3  * Copyright (C) 2010 SUSE Linux Products GmbH. All rights reserved.
4  *
5  * Authors:
6  *     Alexander Graf <agraf@suse.de>
7  */
8
9 #include <linux/kvm_host.h>
10 #include <linux/hash.h>
11 #include <linux/slab.h>
12 #include <linux/rculist.h>
13
14 #include <asm/kvm_ppc.h>
15 #include <asm/kvm_book3s.h>
16 #include <asm/machdep.h>
17 #include <asm/mmu_context.h>
18 #include <asm/hw_irq.h>
19
20 #include "trace_pr.h"
21
22 #define PTE_SIZE        12
23
24 static struct kmem_cache *hpte_cache;
25
26 static inline u64 kvmppc_mmu_hash_pte(u64 eaddr)
27 {
28         return hash_64(eaddr >> PTE_SIZE, HPTEG_HASH_BITS_PTE);
29 }
30
31 static inline u64 kvmppc_mmu_hash_pte_long(u64 eaddr)
32 {
33         return hash_64((eaddr & 0x0ffff000) >> PTE_SIZE,
34                        HPTEG_HASH_BITS_PTE_LONG);
35 }
36
37 static inline u64 kvmppc_mmu_hash_vpte(u64 vpage)
38 {
39         return hash_64(vpage & 0xfffffffffULL, HPTEG_HASH_BITS_VPTE);
40 }
41
42 static inline u64 kvmppc_mmu_hash_vpte_long(u64 vpage)
43 {
44         return hash_64((vpage & 0xffffff000ULL) >> 12,
45                        HPTEG_HASH_BITS_VPTE_LONG);
46 }
47
48 #ifdef CONFIG_PPC_BOOK3S_64
49 static inline u64 kvmppc_mmu_hash_vpte_64k(u64 vpage)
50 {
51         return hash_64((vpage & 0xffffffff0ULL) >> 4,
52                        HPTEG_HASH_BITS_VPTE_64K);
53 }
54 #endif
55
56 void kvmppc_mmu_hpte_cache_map(struct kvm_vcpu *vcpu, struct hpte_cache *pte)
57 {
58         u64 index;
59         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
60
61         trace_kvm_book3s_mmu_map(pte);
62
63         spin_lock(&vcpu3s->mmu_lock);
64
65         /* Add to ePTE list */
66         index = kvmppc_mmu_hash_pte(pte->pte.eaddr);
67         hlist_add_head_rcu(&pte->list_pte, &vcpu3s->hpte_hash_pte[index]);
68
69         /* Add to ePTE_long list */
70         index = kvmppc_mmu_hash_pte_long(pte->pte.eaddr);
71         hlist_add_head_rcu(&pte->list_pte_long,
72                            &vcpu3s->hpte_hash_pte_long[index]);
73
74         /* Add to vPTE list */
75         index = kvmppc_mmu_hash_vpte(pte->pte.vpage);
76         hlist_add_head_rcu(&pte->list_vpte, &vcpu3s->hpte_hash_vpte[index]);
77
78         /* Add to vPTE_long list */
79         index = kvmppc_mmu_hash_vpte_long(pte->pte.vpage);
80         hlist_add_head_rcu(&pte->list_vpte_long,
81                            &vcpu3s->hpte_hash_vpte_long[index]);
82
83 #ifdef CONFIG_PPC_BOOK3S_64
84         /* Add to vPTE_64k list */
85         index = kvmppc_mmu_hash_vpte_64k(pte->pte.vpage);
86         hlist_add_head_rcu(&pte->list_vpte_64k,
87                            &vcpu3s->hpte_hash_vpte_64k[index]);
88 #endif
89
90         vcpu3s->hpte_cache_count++;
91
92         spin_unlock(&vcpu3s->mmu_lock);
93 }
94
95 static void free_pte_rcu(struct rcu_head *head)
96 {
97         struct hpte_cache *pte = container_of(head, struct hpte_cache, rcu_head);
98         kmem_cache_free(hpte_cache, pte);
99 }
100
101 static void invalidate_pte(struct kvm_vcpu *vcpu, struct hpte_cache *pte)
102 {
103         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
104
105         trace_kvm_book3s_mmu_invalidate(pte);
106
107         /* Different for 32 and 64 bit */
108         kvmppc_mmu_invalidate_pte(vcpu, pte);
109
110         spin_lock(&vcpu3s->mmu_lock);
111
112         /* pte already invalidated in between? */
113         if (hlist_unhashed(&pte->list_pte)) {
114                 spin_unlock(&vcpu3s->mmu_lock);
115                 return;
116         }
117
118         hlist_del_init_rcu(&pte->list_pte);
119         hlist_del_init_rcu(&pte->list_pte_long);
120         hlist_del_init_rcu(&pte->list_vpte);
121         hlist_del_init_rcu(&pte->list_vpte_long);
122 #ifdef CONFIG_PPC_BOOK3S_64
123         hlist_del_init_rcu(&pte->list_vpte_64k);
124 #endif
125         vcpu3s->hpte_cache_count--;
126
127         spin_unlock(&vcpu3s->mmu_lock);
128
129         call_rcu(&pte->rcu_head, free_pte_rcu);
130 }
131
132 static void kvmppc_mmu_pte_flush_all(struct kvm_vcpu *vcpu)
133 {
134         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
135         struct hpte_cache *pte;
136         int i;
137
138         rcu_read_lock();
139
140         for (i = 0; i < HPTEG_HASH_NUM_VPTE_LONG; i++) {
141                 struct hlist_head *list = &vcpu3s->hpte_hash_vpte_long[i];
142
143                 hlist_for_each_entry_rcu(pte, list, list_vpte_long)
144                         invalidate_pte(vcpu, pte);
145         }
146
147         rcu_read_unlock();
148 }
149
150 static void kvmppc_mmu_pte_flush_page(struct kvm_vcpu *vcpu, ulong guest_ea)
151 {
152         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
153         struct hlist_head *list;
154         struct hpte_cache *pte;
155
156         /* Find the list of entries in the map */
157         list = &vcpu3s->hpte_hash_pte[kvmppc_mmu_hash_pte(guest_ea)];
158
159         rcu_read_lock();
160
161         /* Check the list for matching entries and invalidate */
162         hlist_for_each_entry_rcu(pte, list, list_pte)
163                 if ((pte->pte.eaddr & ~0xfffUL) == guest_ea)
164                         invalidate_pte(vcpu, pte);
165
166         rcu_read_unlock();
167 }
168
169 static void kvmppc_mmu_pte_flush_long(struct kvm_vcpu *vcpu, ulong guest_ea)
170 {
171         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
172         struct hlist_head *list;
173         struct hpte_cache *pte;
174
175         /* Find the list of entries in the map */
176         list = &vcpu3s->hpte_hash_pte_long[
177                         kvmppc_mmu_hash_pte_long(guest_ea)];
178
179         rcu_read_lock();
180
181         /* Check the list for matching entries and invalidate */
182         hlist_for_each_entry_rcu(pte, list, list_pte_long)
183                 if ((pte->pte.eaddr & 0x0ffff000UL) == guest_ea)
184                         invalidate_pte(vcpu, pte);
185
186         rcu_read_unlock();
187 }
188
189 void kvmppc_mmu_pte_flush(struct kvm_vcpu *vcpu, ulong guest_ea, ulong ea_mask)
190 {
191         trace_kvm_book3s_mmu_flush("", vcpu, guest_ea, ea_mask);
192         guest_ea &= ea_mask;
193
194         switch (ea_mask) {
195         case ~0xfffUL:
196                 kvmppc_mmu_pte_flush_page(vcpu, guest_ea);
197                 break;
198         case 0x0ffff000:
199                 kvmppc_mmu_pte_flush_long(vcpu, guest_ea);
200                 break;
201         case 0:
202                 /* Doing a complete flush -> start from scratch */
203                 kvmppc_mmu_pte_flush_all(vcpu);
204                 break;
205         default:
206                 WARN_ON(1);
207                 break;
208         }
209 }
210
211 /* Flush with mask 0xfffffffff */
212 static void kvmppc_mmu_pte_vflush_short(struct kvm_vcpu *vcpu, u64 guest_vp)
213 {
214         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
215         struct hlist_head *list;
216         struct hpte_cache *pte;
217         u64 vp_mask = 0xfffffffffULL;
218
219         list = &vcpu3s->hpte_hash_vpte[kvmppc_mmu_hash_vpte(guest_vp)];
220
221         rcu_read_lock();
222
223         /* Check the list for matching entries and invalidate */
224         hlist_for_each_entry_rcu(pte, list, list_vpte)
225                 if ((pte->pte.vpage & vp_mask) == guest_vp)
226                         invalidate_pte(vcpu, pte);
227
228         rcu_read_unlock();
229 }
230
231 #ifdef CONFIG_PPC_BOOK3S_64
232 /* Flush with mask 0xffffffff0 */
233 static void kvmppc_mmu_pte_vflush_64k(struct kvm_vcpu *vcpu, u64 guest_vp)
234 {
235         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
236         struct hlist_head *list;
237         struct hpte_cache *pte;
238         u64 vp_mask = 0xffffffff0ULL;
239
240         list = &vcpu3s->hpte_hash_vpte_64k[
241                 kvmppc_mmu_hash_vpte_64k(guest_vp)];
242
243         rcu_read_lock();
244
245         /* Check the list for matching entries and invalidate */
246         hlist_for_each_entry_rcu(pte, list, list_vpte_64k)
247                 if ((pte->pte.vpage & vp_mask) == guest_vp)
248                         invalidate_pte(vcpu, pte);
249
250         rcu_read_unlock();
251 }
252 #endif
253
254 /* Flush with mask 0xffffff000 */
255 static void kvmppc_mmu_pte_vflush_long(struct kvm_vcpu *vcpu, u64 guest_vp)
256 {
257         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
258         struct hlist_head *list;
259         struct hpte_cache *pte;
260         u64 vp_mask = 0xffffff000ULL;
261
262         list = &vcpu3s->hpte_hash_vpte_long[
263                 kvmppc_mmu_hash_vpte_long(guest_vp)];
264
265         rcu_read_lock();
266
267         /* Check the list for matching entries and invalidate */
268         hlist_for_each_entry_rcu(pte, list, list_vpte_long)
269                 if ((pte->pte.vpage & vp_mask) == guest_vp)
270                         invalidate_pte(vcpu, pte);
271
272         rcu_read_unlock();
273 }
274
275 void kvmppc_mmu_pte_vflush(struct kvm_vcpu *vcpu, u64 guest_vp, u64 vp_mask)
276 {
277         trace_kvm_book3s_mmu_flush("v", vcpu, guest_vp, vp_mask);
278         guest_vp &= vp_mask;
279
280         switch(vp_mask) {
281         case 0xfffffffffULL:
282                 kvmppc_mmu_pte_vflush_short(vcpu, guest_vp);
283                 break;
284 #ifdef CONFIG_PPC_BOOK3S_64
285         case 0xffffffff0ULL:
286                 kvmppc_mmu_pte_vflush_64k(vcpu, guest_vp);
287                 break;
288 #endif
289         case 0xffffff000ULL:
290                 kvmppc_mmu_pte_vflush_long(vcpu, guest_vp);
291                 break;
292         default:
293                 WARN_ON(1);
294                 return;
295         }
296 }
297
298 void kvmppc_mmu_pte_pflush(struct kvm_vcpu *vcpu, ulong pa_start, ulong pa_end)
299 {
300         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
301         struct hpte_cache *pte;
302         int i;
303
304         trace_kvm_book3s_mmu_flush("p", vcpu, pa_start, pa_end);
305
306         rcu_read_lock();
307
308         for (i = 0; i < HPTEG_HASH_NUM_VPTE_LONG; i++) {
309                 struct hlist_head *list = &vcpu3s->hpte_hash_vpte_long[i];
310
311                 hlist_for_each_entry_rcu(pte, list, list_vpte_long)
312                         if ((pte->pte.raddr >= pa_start) &&
313                             (pte->pte.raddr < pa_end))
314                                 invalidate_pte(vcpu, pte);
315         }
316
317         rcu_read_unlock();
318 }
319
320 struct hpte_cache *kvmppc_mmu_hpte_cache_next(struct kvm_vcpu *vcpu)
321 {
322         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
323         struct hpte_cache *pte;
324
325         if (vcpu3s->hpte_cache_count == HPTEG_CACHE_NUM)
326                 kvmppc_mmu_pte_flush_all(vcpu);
327
328         pte = kmem_cache_zalloc(hpte_cache, GFP_KERNEL);
329
330         return pte;
331 }
332
333 void kvmppc_mmu_hpte_cache_free(struct hpte_cache *pte)
334 {
335         kmem_cache_free(hpte_cache, pte);
336 }
337
338 void kvmppc_mmu_hpte_destroy(struct kvm_vcpu *vcpu)
339 {
340         kvmppc_mmu_pte_flush(vcpu, 0, 0);
341 }
342
343 static void kvmppc_mmu_hpte_init_hash(struct hlist_head *hash_list, int len)
344 {
345         int i;
346
347         for (i = 0; i < len; i++)
348                 INIT_HLIST_HEAD(&hash_list[i]);
349 }
350
351 int kvmppc_mmu_hpte_init(struct kvm_vcpu *vcpu)
352 {
353         struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
354
355         /* init hpte lookup hashes */
356         kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_pte,
357                                   ARRAY_SIZE(vcpu3s->hpte_hash_pte));
358         kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_pte_long,
359                                   ARRAY_SIZE(vcpu3s->hpte_hash_pte_long));
360         kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_vpte,
361                                   ARRAY_SIZE(vcpu3s->hpte_hash_vpte));
362         kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_vpte_long,
363                                   ARRAY_SIZE(vcpu3s->hpte_hash_vpte_long));
364 #ifdef CONFIG_PPC_BOOK3S_64
365         kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_vpte_64k,
366                                   ARRAY_SIZE(vcpu3s->hpte_hash_vpte_64k));
367 #endif
368
369         spin_lock_init(&vcpu3s->mmu_lock);
370
371         return 0;
372 }
373
374 int kvmppc_mmu_hpte_sysinit(void)
375 {
376         /* init hpte slab cache */
377         hpte_cache = kmem_cache_create("kvm-spt", sizeof(struct hpte_cache),
378                                        sizeof(struct hpte_cache), 0, NULL);
379
380         return 0;
381 }
382
383 void kvmppc_mmu_hpte_sysexit(void)
384 {
385         kmem_cache_destroy(hpte_cache);
386 }