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