342 строки
8.5 KiB
C
342 строки
8.5 KiB
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);
|
|
|
|
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;
|
|
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, 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 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, 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 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, 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 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, 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 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, 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 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, 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);
|
|
}
|