[linux-2.6-block.git] / arch / powerpc / kvm / book3s_mmu_hpte.c

/*
 * Copyright (C) 2010 SUSE Linux Products GmbH. All rights reserved.
 *
 * Authors:
 *     Alexander Graf <agraf@suse.de>
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License, version 2, as
 * published by the Free Software Foundation.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 */

#include <linux/kvm_host.h>
#include <linux/hash.h>
#include <linux/slab.h>

#include <asm/kvm_ppc.h>
#include <asm/kvm_book3s.h>
#include <asm/machdep.h>
#include <asm/mmu_context.h>
#include <asm/hw_irq.h>

#include "trace.h"

#define PTE_SIZE	12

static struct kmem_cache *hpte_cache;

static inline u64 kvmppc_mmu_hash_pte(u64 eaddr)
{
	return hash_64(eaddr >> PTE_SIZE, HPTEG_HASH_BITS_PTE);
}

static inline u64 kvmppc_mmu_hash_pte_long(u64 eaddr)
{
	return hash_64((eaddr & 0x0ffff000) >> PTE_SIZE,
		       HPTEG_HASH_BITS_PTE_LONG);
}

static inline u64 kvmppc_mmu_hash_vpte(u64 vpage)
{
	return hash_64(vpage & 0xfffffffffULL, HPTEG_HASH_BITS_VPTE);
}

static inline u64 kvmppc_mmu_hash_vpte_long(u64 vpage)
{
	return hash_64((vpage & 0xffffff000ULL) >> 12,
		       HPTEG_HASH_BITS_VPTE_LONG);
}

void kvmppc_mmu_hpte_cache_map(struct kvm_vcpu *vcpu, struct hpte_cache *pte)
{
	u64 index;
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);

	trace_kvm_book3s_mmu_map(pte);

	spin_lock(&vcpu3s->mmu_lock);

	/* Add to ePTE list */
	index = kvmppc_mmu_hash_pte(pte->pte.eaddr);
	hlist_add_head_rcu(&pte->list_pte, &vcpu3s->hpte_hash_pte[index]);

	/* Add to ePTE_long list */
	index = kvmppc_mmu_hash_pte_long(pte->pte.eaddr);
	hlist_add_head_rcu(&pte->list_pte_long,
			   &vcpu3s->hpte_hash_pte_long[index]);

	/* Add to vPTE list */
	index = kvmppc_mmu_hash_vpte(pte->pte.vpage);
	hlist_add_head_rcu(&pte->list_vpte, &vcpu3s->hpte_hash_vpte[index]);

	/* Add to vPTE_long list */
	index = kvmppc_mmu_hash_vpte_long(pte->pte.vpage);
	hlist_add_head_rcu(&pte->list_vpte_long,
			   &vcpu3s->hpte_hash_vpte_long[index]);

	spin_unlock(&vcpu3s->mmu_lock);
}

static void free_pte_rcu(struct rcu_head *head)
{
	struct hpte_cache *pte = container_of(head, struct hpte_cache, rcu_head);
	kmem_cache_free(hpte_cache, pte);
}

static void invalidate_pte(struct kvm_vcpu *vcpu, struct hpte_cache *pte)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);

	trace_kvm_book3s_mmu_invalidate(pte);

	/* Different for 32 and 64 bit */
	kvmppc_mmu_invalidate_pte(vcpu, pte);

	spin_lock(&vcpu3s->mmu_lock);

	/* pte already invalidated in between? */
	if (hlist_unhashed(&pte->list_pte)) {
		spin_unlock(&vcpu3s->mmu_lock);
		return;
	}

	hlist_del_init_rcu(&pte->list_pte);
	hlist_del_init_rcu(&pte->list_pte_long);
	hlist_del_init_rcu(&pte->list_vpte);
	hlist_del_init_rcu(&pte->list_vpte_long);

	if (pte->pte.may_write)
		kvm_release_pfn_dirty(pte->pfn);
	else
		kvm_release_pfn_clean(pte->pfn);

	spin_unlock(&vcpu3s->mmu_lock);

	vcpu3s->hpte_cache_count--;
	call_rcu(&pte->rcu_head, free_pte_rcu);
}

static void kvmppc_mmu_pte_flush_all(struct kvm_vcpu *vcpu)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
	struct hpte_cache *pte;
	struct hlist_node *node;
	int i;

	rcu_read_lock();

	for (i = 0; i < HPTEG_HASH_NUM_VPTE_LONG; i++) {
		struct hlist_head *list = &vcpu3s->hpte_hash_vpte_long[i];

		hlist_for_each_entry_rcu(pte, node, list, list_vpte_long)
			invalidate_pte(vcpu, pte);
	}

	rcu_read_unlock();
}

static void kvmppc_mmu_pte_flush_page(struct kvm_vcpu *vcpu, ulong guest_ea)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
	struct hlist_head *list;
	struct hlist_node *node;
	struct hpte_cache *pte;

	/* Find the list of entries in the map */
	list = &vcpu3s->hpte_hash_pte[kvmppc_mmu_hash_pte(guest_ea)];

	rcu_read_lock();

	/* Check the list for matching entries and invalidate */
	hlist_for_each_entry_rcu(pte, node, list, list_pte)
		if ((pte->pte.eaddr & ~0xfffUL) == guest_ea)
			invalidate_pte(vcpu, pte);

	rcu_read_unlock();
}

static void kvmppc_mmu_pte_flush_long(struct kvm_vcpu *vcpu, ulong guest_ea)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
	struct hlist_head *list;
	struct hlist_node *node;
	struct hpte_cache *pte;

	/* Find the list of entries in the map */
	list = &vcpu3s->hpte_hash_pte_long[
			kvmppc_mmu_hash_pte_long(guest_ea)];

	rcu_read_lock();

	/* Check the list for matching entries and invalidate */
	hlist_for_each_entry_rcu(pte, node, list, list_pte_long)
		if ((pte->pte.eaddr & 0x0ffff000UL) == guest_ea)
			invalidate_pte(vcpu, pte);

	rcu_read_unlock();
}

void kvmppc_mmu_pte_flush(struct kvm_vcpu *vcpu, ulong guest_ea, ulong ea_mask)
{
	trace_kvm_book3s_mmu_flush("", vcpu, guest_ea, ea_mask);
	guest_ea &= ea_mask;

	switch (ea_mask) {
	case ~0xfffUL:
		kvmppc_mmu_pte_flush_page(vcpu, guest_ea);
		break;
	case 0x0ffff000:
		kvmppc_mmu_pte_flush_long(vcpu, guest_ea);
		break;
	case 0:
		/* Doing a complete flush -> start from scratch */
		kvmppc_mmu_pte_flush_all(vcpu);
		break;
	default:
		WARN_ON(1);
		break;
	}
}

/* Flush with mask 0xfffffffff */
static void kvmppc_mmu_pte_vflush_short(struct kvm_vcpu *vcpu, u64 guest_vp)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
	struct hlist_head *list;
	struct hlist_node *node;
	struct hpte_cache *pte;
	u64 vp_mask = 0xfffffffffULL;

	list = &vcpu3s->hpte_hash_vpte[kvmppc_mmu_hash_vpte(guest_vp)];

	rcu_read_lock();

	/* Check the list for matching entries and invalidate */
	hlist_for_each_entry_rcu(pte, node, list, list_vpte)
		if ((pte->pte.vpage & vp_mask) == guest_vp)
			invalidate_pte(vcpu, pte);

	rcu_read_unlock();
}

/* Flush with mask 0xffffff000 */
static void kvmppc_mmu_pte_vflush_long(struct kvm_vcpu *vcpu, u64 guest_vp)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
	struct hlist_head *list;
	struct hlist_node *node;
	struct hpte_cache *pte;
	u64 vp_mask = 0xffffff000ULL;

	list = &vcpu3s->hpte_hash_vpte_long[
		kvmppc_mmu_hash_vpte_long(guest_vp)];

	rcu_read_lock();

	/* Check the list for matching entries and invalidate */
	hlist_for_each_entry_rcu(pte, node, list, list_vpte_long)
		if ((pte->pte.vpage & vp_mask) == guest_vp)
			invalidate_pte(vcpu, pte);

	rcu_read_unlock();
}

void kvmppc_mmu_pte_vflush(struct kvm_vcpu *vcpu, u64 guest_vp, u64 vp_mask)
{
	trace_kvm_book3s_mmu_flush("v", vcpu, guest_vp, vp_mask);
	guest_vp &= vp_mask;

	switch(vp_mask) {
	case 0xfffffffffULL:
		kvmppc_mmu_pte_vflush_short(vcpu, guest_vp);
		break;
	case 0xffffff000ULL:
		kvmppc_mmu_pte_vflush_long(vcpu, guest_vp);
		break;
	default:
		WARN_ON(1);
		return;
	}
}

void kvmppc_mmu_pte_pflush(struct kvm_vcpu *vcpu, ulong pa_start, ulong pa_end)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
	struct hlist_node *node;
	struct hpte_cache *pte;
	int i;

	trace_kvm_book3s_mmu_flush("p", vcpu, pa_start, pa_end);

	rcu_read_lock();

	for (i = 0; i < HPTEG_HASH_NUM_VPTE_LONG; i++) {
		struct hlist_head *list = &vcpu3s->hpte_hash_vpte_long[i];

		hlist_for_each_entry_rcu(pte, node, list, list_vpte_long)
			if ((pte->pte.raddr >= pa_start) &&
			    (pte->pte.raddr < pa_end))
				invalidate_pte(vcpu, pte);
	}

	rcu_read_unlock();
}

struct hpte_cache *kvmppc_mmu_hpte_cache_next(struct kvm_vcpu *vcpu)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);
	struct hpte_cache *pte;

	pte = kmem_cache_zalloc(hpte_cache, GFP_KERNEL);
	vcpu3s->hpte_cache_count++;

	if (vcpu3s->hpte_cache_count == HPTEG_CACHE_NUM)
		kvmppc_mmu_pte_flush_all(vcpu);

	return pte;
}

void kvmppc_mmu_hpte_destroy(struct kvm_vcpu *vcpu)
{
	kvmppc_mmu_pte_flush(vcpu, 0, 0);
}

static void kvmppc_mmu_hpte_init_hash(struct hlist_head *hash_list, int len)
{
	int i;

	for (i = 0; i < len; i++)
		INIT_HLIST_HEAD(&hash_list[i]);
}

int kvmppc_mmu_hpte_init(struct kvm_vcpu *vcpu)
{
	struct kvmppc_vcpu_book3s *vcpu3s = to_book3s(vcpu);

	/* init hpte lookup hashes */
	kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_pte,
				  ARRAY_SIZE(vcpu3s->hpte_hash_pte));
	kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_pte_long,
				  ARRAY_SIZE(vcpu3s->hpte_hash_pte_long));
	kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_vpte,
				  ARRAY_SIZE(vcpu3s->hpte_hash_vpte));
	kvmppc_mmu_hpte_init_hash(vcpu3s->hpte_hash_vpte_long,
				  ARRAY_SIZE(vcpu3s->hpte_hash_vpte_long));

	spin_lock_init(&vcpu3s->mmu_lock);

	return 0;
}

int kvmppc_mmu_hpte_sysinit(void)
{
	/* init hpte slab cache */
	hpte_cache = kmem_cache_create("kvm-spt", sizeof(struct hpte_cache),
				       sizeof(struct hpte_cache), 0, NULL);

	return 0;
}

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