Due to the earlier check we know that ipte_lock_count must be 0. No need to add a useless if. Let's make clear that we are going to always wakeup when we execute that code. Signed-off-by: Christian Borntraeger <borntraeger@de.ibm.com> Acked-by: Heiko Carstens <heiko.carstens@de.ibm.com>
		
			
				
	
	
		
			725 lines
		
	
	
	
		
			19 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			725 lines
		
	
	
	
		
			19 KiB
			
		
	
	
	
		
			C
		
	
	
	
	
	
/*
 | 
						|
 * guest access functions
 | 
						|
 *
 | 
						|
 * Copyright IBM Corp. 2014
 | 
						|
 *
 | 
						|
 */
 | 
						|
 | 
						|
#include <linux/vmalloc.h>
 | 
						|
#include <linux/err.h>
 | 
						|
#include <asm/pgtable.h>
 | 
						|
#include "kvm-s390.h"
 | 
						|
#include "gaccess.h"
 | 
						|
 | 
						|
union asce {
 | 
						|
	unsigned long val;
 | 
						|
	struct {
 | 
						|
		unsigned long origin : 52; /* Region- or Segment-Table Origin */
 | 
						|
		unsigned long	 : 2;
 | 
						|
		unsigned long g  : 1; /* Subspace Group Control */
 | 
						|
		unsigned long p  : 1; /* Private Space Control */
 | 
						|
		unsigned long s  : 1; /* Storage-Alteration-Event Control */
 | 
						|
		unsigned long x  : 1; /* Space-Switch-Event Control */
 | 
						|
		unsigned long r  : 1; /* Real-Space Control */
 | 
						|
		unsigned long	 : 1;
 | 
						|
		unsigned long dt : 2; /* Designation-Type Control */
 | 
						|
		unsigned long tl : 2; /* Region- or Segment-Table Length */
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
enum {
 | 
						|
	ASCE_TYPE_SEGMENT = 0,
 | 
						|
	ASCE_TYPE_REGION3 = 1,
 | 
						|
	ASCE_TYPE_REGION2 = 2,
 | 
						|
	ASCE_TYPE_REGION1 = 3
 | 
						|
};
 | 
						|
 | 
						|
union region1_table_entry {
 | 
						|
	unsigned long val;
 | 
						|
	struct {
 | 
						|
		unsigned long rto: 52;/* Region-Table Origin */
 | 
						|
		unsigned long	 : 2;
 | 
						|
		unsigned long p  : 1; /* DAT-Protection Bit */
 | 
						|
		unsigned long	 : 1;
 | 
						|
		unsigned long tf : 2; /* Region-Second-Table Offset */
 | 
						|
		unsigned long i  : 1; /* Region-Invalid Bit */
 | 
						|
		unsigned long	 : 1;
 | 
						|
		unsigned long tt : 2; /* Table-Type Bits */
 | 
						|
		unsigned long tl : 2; /* Region-Second-Table Length */
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
union region2_table_entry {
 | 
						|
	unsigned long val;
 | 
						|
	struct {
 | 
						|
		unsigned long rto: 52;/* Region-Table Origin */
 | 
						|
		unsigned long	 : 2;
 | 
						|
		unsigned long p  : 1; /* DAT-Protection Bit */
 | 
						|
		unsigned long	 : 1;
 | 
						|
		unsigned long tf : 2; /* Region-Third-Table Offset */
 | 
						|
		unsigned long i  : 1; /* Region-Invalid Bit */
 | 
						|
		unsigned long	 : 1;
 | 
						|
		unsigned long tt : 2; /* Table-Type Bits */
 | 
						|
		unsigned long tl : 2; /* Region-Third-Table Length */
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
struct region3_table_entry_fc0 {
 | 
						|
	unsigned long sto: 52;/* Segment-Table Origin */
 | 
						|
	unsigned long	 : 1;
 | 
						|
	unsigned long fc : 1; /* Format-Control */
 | 
						|
	unsigned long p  : 1; /* DAT-Protection Bit */
 | 
						|
	unsigned long	 : 1;
 | 
						|
	unsigned long tf : 2; /* Segment-Table Offset */
 | 
						|
	unsigned long i  : 1; /* Region-Invalid Bit */
 | 
						|
	unsigned long cr : 1; /* Common-Region Bit */
 | 
						|
	unsigned long tt : 2; /* Table-Type Bits */
 | 
						|
	unsigned long tl : 2; /* Segment-Table Length */
 | 
						|
};
 | 
						|
 | 
						|
struct region3_table_entry_fc1 {
 | 
						|
	unsigned long rfaa : 33; /* Region-Frame Absolute Address */
 | 
						|
	unsigned long	 : 14;
 | 
						|
	unsigned long av : 1; /* ACCF-Validity Control */
 | 
						|
	unsigned long acc: 4; /* Access-Control Bits */
 | 
						|
	unsigned long f  : 1; /* Fetch-Protection Bit */
 | 
						|
	unsigned long fc : 1; /* Format-Control */
 | 
						|
	unsigned long p  : 1; /* DAT-Protection Bit */
 | 
						|
	unsigned long co : 1; /* Change-Recording Override */
 | 
						|
	unsigned long	 : 2;
 | 
						|
	unsigned long i  : 1; /* Region-Invalid Bit */
 | 
						|
	unsigned long cr : 1; /* Common-Region Bit */
 | 
						|
	unsigned long tt : 2; /* Table-Type Bits */
 | 
						|
	unsigned long	 : 2;
 | 
						|
};
 | 
						|
 | 
						|
union region3_table_entry {
 | 
						|
	unsigned long val;
 | 
						|
	struct region3_table_entry_fc0 fc0;
 | 
						|
	struct region3_table_entry_fc1 fc1;
 | 
						|
	struct {
 | 
						|
		unsigned long	 : 53;
 | 
						|
		unsigned long fc : 1; /* Format-Control */
 | 
						|
		unsigned long	 : 4;
 | 
						|
		unsigned long i  : 1; /* Region-Invalid Bit */
 | 
						|
		unsigned long cr : 1; /* Common-Region Bit */
 | 
						|
		unsigned long tt : 2; /* Table-Type Bits */
 | 
						|
		unsigned long	 : 2;
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
struct segment_entry_fc0 {
 | 
						|
	unsigned long pto: 53;/* Page-Table Origin */
 | 
						|
	unsigned long fc : 1; /* Format-Control */
 | 
						|
	unsigned long p  : 1; /* DAT-Protection Bit */
 | 
						|
	unsigned long	 : 3;
 | 
						|
	unsigned long i  : 1; /* Segment-Invalid Bit */
 | 
						|
	unsigned long cs : 1; /* Common-Segment Bit */
 | 
						|
	unsigned long tt : 2; /* Table-Type Bits */
 | 
						|
	unsigned long	 : 2;
 | 
						|
};
 | 
						|
 | 
						|
struct segment_entry_fc1 {
 | 
						|
	unsigned long sfaa : 44; /* Segment-Frame Absolute Address */
 | 
						|
	unsigned long	 : 3;
 | 
						|
	unsigned long av : 1; /* ACCF-Validity Control */
 | 
						|
	unsigned long acc: 4; /* Access-Control Bits */
 | 
						|
	unsigned long f  : 1; /* Fetch-Protection Bit */
 | 
						|
	unsigned long fc : 1; /* Format-Control */
 | 
						|
	unsigned long p  : 1; /* DAT-Protection Bit */
 | 
						|
	unsigned long co : 1; /* Change-Recording Override */
 | 
						|
	unsigned long	 : 2;
 | 
						|
	unsigned long i  : 1; /* Segment-Invalid Bit */
 | 
						|
	unsigned long cs : 1; /* Common-Segment Bit */
 | 
						|
	unsigned long tt : 2; /* Table-Type Bits */
 | 
						|
	unsigned long	 : 2;
 | 
						|
};
 | 
						|
 | 
						|
union segment_table_entry {
 | 
						|
	unsigned long val;
 | 
						|
	struct segment_entry_fc0 fc0;
 | 
						|
	struct segment_entry_fc1 fc1;
 | 
						|
	struct {
 | 
						|
		unsigned long	 : 53;
 | 
						|
		unsigned long fc : 1; /* Format-Control */
 | 
						|
		unsigned long	 : 4;
 | 
						|
		unsigned long i  : 1; /* Segment-Invalid Bit */
 | 
						|
		unsigned long cs : 1; /* Common-Segment Bit */
 | 
						|
		unsigned long tt : 2; /* Table-Type Bits */
 | 
						|
		unsigned long	 : 2;
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
enum {
 | 
						|
	TABLE_TYPE_SEGMENT = 0,
 | 
						|
	TABLE_TYPE_REGION3 = 1,
 | 
						|
	TABLE_TYPE_REGION2 = 2,
 | 
						|
	TABLE_TYPE_REGION1 = 3
 | 
						|
};
 | 
						|
 | 
						|
union page_table_entry {
 | 
						|
	unsigned long val;
 | 
						|
	struct {
 | 
						|
		unsigned long pfra : 52; /* Page-Frame Real Address */
 | 
						|
		unsigned long z  : 1; /* Zero Bit */
 | 
						|
		unsigned long i  : 1; /* Page-Invalid Bit */
 | 
						|
		unsigned long p  : 1; /* DAT-Protection Bit */
 | 
						|
		unsigned long co : 1; /* Change-Recording Override */
 | 
						|
		unsigned long	 : 8;
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
/*
 | 
						|
 * vaddress union in order to easily decode a virtual address into its
 | 
						|
 * region first index, region second index etc. parts.
 | 
						|
 */
 | 
						|
union vaddress {
 | 
						|
	unsigned long addr;
 | 
						|
	struct {
 | 
						|
		unsigned long rfx : 11;
 | 
						|
		unsigned long rsx : 11;
 | 
						|
		unsigned long rtx : 11;
 | 
						|
		unsigned long sx  : 11;
 | 
						|
		unsigned long px  : 8;
 | 
						|
		unsigned long bx  : 12;
 | 
						|
	};
 | 
						|
	struct {
 | 
						|
		unsigned long rfx01 : 2;
 | 
						|
		unsigned long	    : 9;
 | 
						|
		unsigned long rsx01 : 2;
 | 
						|
		unsigned long	    : 9;
 | 
						|
		unsigned long rtx01 : 2;
 | 
						|
		unsigned long	    : 9;
 | 
						|
		unsigned long sx01  : 2;
 | 
						|
		unsigned long	    : 29;
 | 
						|
	};
 | 
						|
};
 | 
						|
 | 
						|
/*
 | 
						|
 * raddress union which will contain the result (real or absolute address)
 | 
						|
 * after a page table walk. The rfaa, sfaa and pfra members are used to
 | 
						|
 * simply assign them the value of a region, segment or page table entry.
 | 
						|
 */
 | 
						|
union raddress {
 | 
						|
	unsigned long addr;
 | 
						|
	unsigned long rfaa : 33; /* Region-Frame Absolute Address */
 | 
						|
	unsigned long sfaa : 44; /* Segment-Frame Absolute Address */
 | 
						|
	unsigned long pfra : 52; /* Page-Frame Real Address */
 | 
						|
};
 | 
						|
 | 
						|
static int ipte_lock_count;
 | 
						|
static DEFINE_MUTEX(ipte_mutex);
 | 
						|
 | 
						|
int ipte_lock_held(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	union ipte_control *ic = &vcpu->kvm->arch.sca->ipte_control;
 | 
						|
 | 
						|
	if (vcpu->arch.sie_block->eca & 1)
 | 
						|
		return ic->kh != 0;
 | 
						|
	return ipte_lock_count != 0;
 | 
						|
}
 | 
						|
 | 
						|
static void ipte_lock_simple(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	union ipte_control old, new, *ic;
 | 
						|
 | 
						|
	mutex_lock(&ipte_mutex);
 | 
						|
	ipte_lock_count++;
 | 
						|
	if (ipte_lock_count > 1)
 | 
						|
		goto out;
 | 
						|
	ic = &vcpu->kvm->arch.sca->ipte_control;
 | 
						|
	do {
 | 
						|
		old = ACCESS_ONCE(*ic);
 | 
						|
		while (old.k) {
 | 
						|
			cond_resched();
 | 
						|
			old = ACCESS_ONCE(*ic);
 | 
						|
		}
 | 
						|
		new = old;
 | 
						|
		new.k = 1;
 | 
						|
	} while (cmpxchg(&ic->val, old.val, new.val) != old.val);
 | 
						|
out:
 | 
						|
	mutex_unlock(&ipte_mutex);
 | 
						|
}
 | 
						|
 | 
						|
static void ipte_unlock_simple(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	union ipte_control old, new, *ic;
 | 
						|
 | 
						|
	mutex_lock(&ipte_mutex);
 | 
						|
	ipte_lock_count--;
 | 
						|
	if (ipte_lock_count)
 | 
						|
		goto out;
 | 
						|
	ic = &vcpu->kvm->arch.sca->ipte_control;
 | 
						|
	do {
 | 
						|
		new = old = ACCESS_ONCE(*ic);
 | 
						|
		new.k = 0;
 | 
						|
	} while (cmpxchg(&ic->val, old.val, new.val) != old.val);
 | 
						|
	wake_up(&vcpu->kvm->arch.ipte_wq);
 | 
						|
out:
 | 
						|
	mutex_unlock(&ipte_mutex);
 | 
						|
}
 | 
						|
 | 
						|
static void ipte_lock_siif(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	union ipte_control old, new, *ic;
 | 
						|
 | 
						|
	ic = &vcpu->kvm->arch.sca->ipte_control;
 | 
						|
	do {
 | 
						|
		old = ACCESS_ONCE(*ic);
 | 
						|
		while (old.kg) {
 | 
						|
			cond_resched();
 | 
						|
			old = ACCESS_ONCE(*ic);
 | 
						|
		}
 | 
						|
		new = old;
 | 
						|
		new.k = 1;
 | 
						|
		new.kh++;
 | 
						|
	} while (cmpxchg(&ic->val, old.val, new.val) != old.val);
 | 
						|
}
 | 
						|
 | 
						|
static void ipte_unlock_siif(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	union ipte_control old, new, *ic;
 | 
						|
 | 
						|
	ic = &vcpu->kvm->arch.sca->ipte_control;
 | 
						|
	do {
 | 
						|
		new = old = ACCESS_ONCE(*ic);
 | 
						|
		new.kh--;
 | 
						|
		if (!new.kh)
 | 
						|
			new.k = 0;
 | 
						|
	} while (cmpxchg(&ic->val, old.val, new.val) != old.val);
 | 
						|
	if (!new.kh)
 | 
						|
		wake_up(&vcpu->kvm->arch.ipte_wq);
 | 
						|
}
 | 
						|
 | 
						|
void ipte_lock(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	if (vcpu->arch.sie_block->eca & 1)
 | 
						|
		ipte_lock_siif(vcpu);
 | 
						|
	else
 | 
						|
		ipte_lock_simple(vcpu);
 | 
						|
}
 | 
						|
 | 
						|
void ipte_unlock(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	if (vcpu->arch.sie_block->eca & 1)
 | 
						|
		ipte_unlock_siif(vcpu);
 | 
						|
	else
 | 
						|
		ipte_unlock_simple(vcpu);
 | 
						|
}
 | 
						|
 | 
						|
static unsigned long get_vcpu_asce(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	switch (psw_bits(vcpu->arch.sie_block->gpsw).as) {
 | 
						|
	case PSW_AS_PRIMARY:
 | 
						|
		return vcpu->arch.sie_block->gcr[1];
 | 
						|
	case PSW_AS_SECONDARY:
 | 
						|
		return vcpu->arch.sie_block->gcr[7];
 | 
						|
	case PSW_AS_HOME:
 | 
						|
		return vcpu->arch.sie_block->gcr[13];
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static int deref_table(struct kvm *kvm, unsigned long gpa, unsigned long *val)
 | 
						|
{
 | 
						|
	return kvm_read_guest(kvm, gpa, val, sizeof(*val));
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * guest_translate - translate a guest virtual into a guest absolute address
 | 
						|
 * @vcpu: virtual cpu
 | 
						|
 * @gva: guest virtual address
 | 
						|
 * @gpa: points to where guest physical (absolute) address should be stored
 | 
						|
 * @write: indicates if access is a write access
 | 
						|
 *
 | 
						|
 * Translate a guest virtual address into a guest absolute address by means
 | 
						|
 * of dynamic address translation as specified by the architecuture.
 | 
						|
 * If the resulting absolute address is not available in the configuration
 | 
						|
 * an addressing exception is indicated and @gpa will not be changed.
 | 
						|
 *
 | 
						|
 * Returns: - zero on success; @gpa contains the resulting absolute address
 | 
						|
 *	    - a negative value if guest access failed due to e.g. broken
 | 
						|
 *	      guest mapping
 | 
						|
 *	    - a positve value if an access exception happened. In this case
 | 
						|
 *	      the returned value is the program interruption code as defined
 | 
						|
 *	      by the architecture
 | 
						|
 */
 | 
						|
static unsigned long guest_translate(struct kvm_vcpu *vcpu, unsigned long gva,
 | 
						|
				     unsigned long *gpa, int write)
 | 
						|
{
 | 
						|
	union vaddress vaddr = {.addr = gva};
 | 
						|
	union raddress raddr = {.addr = gva};
 | 
						|
	union page_table_entry pte;
 | 
						|
	int dat_protection = 0;
 | 
						|
	union ctlreg0 ctlreg0;
 | 
						|
	unsigned long ptr;
 | 
						|
	int edat1, edat2;
 | 
						|
	union asce asce;
 | 
						|
 | 
						|
	ctlreg0.val = vcpu->arch.sie_block->gcr[0];
 | 
						|
	edat1 = ctlreg0.edat && test_vfacility(8);
 | 
						|
	edat2 = edat1 && test_vfacility(78);
 | 
						|
	asce.val = get_vcpu_asce(vcpu);
 | 
						|
	if (asce.r)
 | 
						|
		goto real_address;
 | 
						|
	ptr = asce.origin * 4096;
 | 
						|
	switch (asce.dt) {
 | 
						|
	case ASCE_TYPE_REGION1:
 | 
						|
		if (vaddr.rfx01 > asce.tl)
 | 
						|
			return PGM_REGION_FIRST_TRANS;
 | 
						|
		ptr += vaddr.rfx * 8;
 | 
						|
		break;
 | 
						|
	case ASCE_TYPE_REGION2:
 | 
						|
		if (vaddr.rfx)
 | 
						|
			return PGM_ASCE_TYPE;
 | 
						|
		if (vaddr.rsx01 > asce.tl)
 | 
						|
			return PGM_REGION_SECOND_TRANS;
 | 
						|
		ptr += vaddr.rsx * 8;
 | 
						|
		break;
 | 
						|
	case ASCE_TYPE_REGION3:
 | 
						|
		if (vaddr.rfx || vaddr.rsx)
 | 
						|
			return PGM_ASCE_TYPE;
 | 
						|
		if (vaddr.rtx01 > asce.tl)
 | 
						|
			return PGM_REGION_THIRD_TRANS;
 | 
						|
		ptr += vaddr.rtx * 8;
 | 
						|
		break;
 | 
						|
	case ASCE_TYPE_SEGMENT:
 | 
						|
		if (vaddr.rfx || vaddr.rsx || vaddr.rtx)
 | 
						|
			return PGM_ASCE_TYPE;
 | 
						|
		if (vaddr.sx01 > asce.tl)
 | 
						|
			return PGM_SEGMENT_TRANSLATION;
 | 
						|
		ptr += vaddr.sx * 8;
 | 
						|
		break;
 | 
						|
	}
 | 
						|
	switch (asce.dt) {
 | 
						|
	case ASCE_TYPE_REGION1:	{
 | 
						|
		union region1_table_entry rfte;
 | 
						|
 | 
						|
		if (kvm_is_error_gpa(vcpu->kvm, ptr))
 | 
						|
			return PGM_ADDRESSING;
 | 
						|
		if (deref_table(vcpu->kvm, ptr, &rfte.val))
 | 
						|
			return -EFAULT;
 | 
						|
		if (rfte.i)
 | 
						|
			return PGM_REGION_FIRST_TRANS;
 | 
						|
		if (rfte.tt != TABLE_TYPE_REGION1)
 | 
						|
			return PGM_TRANSLATION_SPEC;
 | 
						|
		if (vaddr.rsx01 < rfte.tf || vaddr.rsx01 > rfte.tl)
 | 
						|
			return PGM_REGION_SECOND_TRANS;
 | 
						|
		if (edat1)
 | 
						|
			dat_protection |= rfte.p;
 | 
						|
		ptr = rfte.rto * 4096 + vaddr.rsx * 8;
 | 
						|
	}
 | 
						|
		/* fallthrough */
 | 
						|
	case ASCE_TYPE_REGION2: {
 | 
						|
		union region2_table_entry rste;
 | 
						|
 | 
						|
		if (kvm_is_error_gpa(vcpu->kvm, ptr))
 | 
						|
			return PGM_ADDRESSING;
 | 
						|
		if (deref_table(vcpu->kvm, ptr, &rste.val))
 | 
						|
			return -EFAULT;
 | 
						|
		if (rste.i)
 | 
						|
			return PGM_REGION_SECOND_TRANS;
 | 
						|
		if (rste.tt != TABLE_TYPE_REGION2)
 | 
						|
			return PGM_TRANSLATION_SPEC;
 | 
						|
		if (vaddr.rtx01 < rste.tf || vaddr.rtx01 > rste.tl)
 | 
						|
			return PGM_REGION_THIRD_TRANS;
 | 
						|
		if (edat1)
 | 
						|
			dat_protection |= rste.p;
 | 
						|
		ptr = rste.rto * 4096 + vaddr.rtx * 8;
 | 
						|
	}
 | 
						|
		/* fallthrough */
 | 
						|
	case ASCE_TYPE_REGION3: {
 | 
						|
		union region3_table_entry rtte;
 | 
						|
 | 
						|
		if (kvm_is_error_gpa(vcpu->kvm, ptr))
 | 
						|
			return PGM_ADDRESSING;
 | 
						|
		if (deref_table(vcpu->kvm, ptr, &rtte.val))
 | 
						|
			return -EFAULT;
 | 
						|
		if (rtte.i)
 | 
						|
			return PGM_REGION_THIRD_TRANS;
 | 
						|
		if (rtte.tt != TABLE_TYPE_REGION3)
 | 
						|
			return PGM_TRANSLATION_SPEC;
 | 
						|
		if (rtte.cr && asce.p && edat2)
 | 
						|
			return PGM_TRANSLATION_SPEC;
 | 
						|
		if (rtte.fc && edat2) {
 | 
						|
			dat_protection |= rtte.fc1.p;
 | 
						|
			raddr.rfaa = rtte.fc1.rfaa;
 | 
						|
			goto absolute_address;
 | 
						|
		}
 | 
						|
		if (vaddr.sx01 < rtte.fc0.tf)
 | 
						|
			return PGM_SEGMENT_TRANSLATION;
 | 
						|
		if (vaddr.sx01 > rtte.fc0.tl)
 | 
						|
			return PGM_SEGMENT_TRANSLATION;
 | 
						|
		if (edat1)
 | 
						|
			dat_protection |= rtte.fc0.p;
 | 
						|
		ptr = rtte.fc0.sto * 4096 + vaddr.sx * 8;
 | 
						|
	}
 | 
						|
		/* fallthrough */
 | 
						|
	case ASCE_TYPE_SEGMENT: {
 | 
						|
		union segment_table_entry ste;
 | 
						|
 | 
						|
		if (kvm_is_error_gpa(vcpu->kvm, ptr))
 | 
						|
			return PGM_ADDRESSING;
 | 
						|
		if (deref_table(vcpu->kvm, ptr, &ste.val))
 | 
						|
			return -EFAULT;
 | 
						|
		if (ste.i)
 | 
						|
			return PGM_SEGMENT_TRANSLATION;
 | 
						|
		if (ste.tt != TABLE_TYPE_SEGMENT)
 | 
						|
			return PGM_TRANSLATION_SPEC;
 | 
						|
		if (ste.cs && asce.p)
 | 
						|
			return PGM_TRANSLATION_SPEC;
 | 
						|
		if (ste.fc && edat1) {
 | 
						|
			dat_protection |= ste.fc1.p;
 | 
						|
			raddr.sfaa = ste.fc1.sfaa;
 | 
						|
			goto absolute_address;
 | 
						|
		}
 | 
						|
		dat_protection |= ste.fc0.p;
 | 
						|
		ptr = ste.fc0.pto * 2048 + vaddr.px * 8;
 | 
						|
	}
 | 
						|
	}
 | 
						|
	if (kvm_is_error_gpa(vcpu->kvm, ptr))
 | 
						|
		return PGM_ADDRESSING;
 | 
						|
	if (deref_table(vcpu->kvm, ptr, &pte.val))
 | 
						|
		return -EFAULT;
 | 
						|
	if (pte.i)
 | 
						|
		return PGM_PAGE_TRANSLATION;
 | 
						|
	if (pte.z)
 | 
						|
		return PGM_TRANSLATION_SPEC;
 | 
						|
	if (pte.co && !edat1)
 | 
						|
		return PGM_TRANSLATION_SPEC;
 | 
						|
	dat_protection |= pte.p;
 | 
						|
	raddr.pfra = pte.pfra;
 | 
						|
real_address:
 | 
						|
	raddr.addr = kvm_s390_real_to_abs(vcpu, raddr.addr);
 | 
						|
absolute_address:
 | 
						|
	if (write && dat_protection)
 | 
						|
		return PGM_PROTECTION;
 | 
						|
	if (kvm_is_error_gpa(vcpu->kvm, raddr.addr))
 | 
						|
		return PGM_ADDRESSING;
 | 
						|
	*gpa = raddr.addr;
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
static inline int is_low_address(unsigned long ga)
 | 
						|
{
 | 
						|
	/* Check for address ranges 0..511 and 4096..4607 */
 | 
						|
	return (ga & ~0x11fful) == 0;
 | 
						|
}
 | 
						|
 | 
						|
static int low_address_protection_enabled(struct kvm_vcpu *vcpu)
 | 
						|
{
 | 
						|
	union ctlreg0 ctlreg0 = {.val = vcpu->arch.sie_block->gcr[0]};
 | 
						|
	psw_t *psw = &vcpu->arch.sie_block->gpsw;
 | 
						|
	union asce asce;
 | 
						|
 | 
						|
	if (!ctlreg0.lap)
 | 
						|
		return 0;
 | 
						|
	asce.val = get_vcpu_asce(vcpu);
 | 
						|
	if (psw_bits(*psw).t && asce.p)
 | 
						|
		return 0;
 | 
						|
	return 1;
 | 
						|
}
 | 
						|
 | 
						|
struct trans_exc_code_bits {
 | 
						|
	unsigned long addr : 52; /* Translation-exception Address */
 | 
						|
	unsigned long fsi  : 2;  /* Access Exception Fetch/Store Indication */
 | 
						|
	unsigned long	   : 7;
 | 
						|
	unsigned long b61  : 1;
 | 
						|
	unsigned long as   : 2;  /* ASCE Identifier */
 | 
						|
};
 | 
						|
 | 
						|
enum {
 | 
						|
	FSI_UNKNOWN = 0, /* Unknown wether fetch or store */
 | 
						|
	FSI_STORE   = 1, /* Exception was due to store operation */
 | 
						|
	FSI_FETCH   = 2  /* Exception was due to fetch operation */
 | 
						|
};
 | 
						|
 | 
						|
static int guest_page_range(struct kvm_vcpu *vcpu, unsigned long ga,
 | 
						|
			    unsigned long *pages, unsigned long nr_pages,
 | 
						|
			    int write)
 | 
						|
{
 | 
						|
	struct kvm_s390_pgm_info *pgm = &vcpu->arch.pgm;
 | 
						|
	psw_t *psw = &vcpu->arch.sie_block->gpsw;
 | 
						|
	struct trans_exc_code_bits *tec_bits;
 | 
						|
	int lap_enabled, rc;
 | 
						|
 | 
						|
	memset(pgm, 0, sizeof(*pgm));
 | 
						|
	tec_bits = (struct trans_exc_code_bits *)&pgm->trans_exc_code;
 | 
						|
	tec_bits->fsi = write ? FSI_STORE : FSI_FETCH;
 | 
						|
	tec_bits->as = psw_bits(*psw).as;
 | 
						|
	lap_enabled = low_address_protection_enabled(vcpu);
 | 
						|
	while (nr_pages) {
 | 
						|
		ga = kvm_s390_logical_to_effective(vcpu, ga);
 | 
						|
		tec_bits->addr = ga >> PAGE_SHIFT;
 | 
						|
		if (write && lap_enabled && is_low_address(ga)) {
 | 
						|
			pgm->code = PGM_PROTECTION;
 | 
						|
			return pgm->code;
 | 
						|
		}
 | 
						|
		ga &= PAGE_MASK;
 | 
						|
		if (psw_bits(*psw).t) {
 | 
						|
			rc = guest_translate(vcpu, ga, pages, write);
 | 
						|
			if (rc < 0)
 | 
						|
				return rc;
 | 
						|
			if (rc == PGM_PROTECTION)
 | 
						|
				tec_bits->b61 = 1;
 | 
						|
			if (rc)
 | 
						|
				pgm->code = rc;
 | 
						|
		} else {
 | 
						|
			*pages = kvm_s390_real_to_abs(vcpu, ga);
 | 
						|
			if (kvm_is_error_gpa(vcpu->kvm, *pages))
 | 
						|
				pgm->code = PGM_ADDRESSING;
 | 
						|
		}
 | 
						|
		if (pgm->code)
 | 
						|
			return pgm->code;
 | 
						|
		ga += PAGE_SIZE;
 | 
						|
		pages++;
 | 
						|
		nr_pages--;
 | 
						|
	}
 | 
						|
	return 0;
 | 
						|
}
 | 
						|
 | 
						|
int access_guest(struct kvm_vcpu *vcpu, unsigned long ga, void *data,
 | 
						|
		 unsigned long len, int write)
 | 
						|
{
 | 
						|
	psw_t *psw = &vcpu->arch.sie_block->gpsw;
 | 
						|
	unsigned long _len, nr_pages, gpa, idx;
 | 
						|
	unsigned long pages_array[2];
 | 
						|
	unsigned long *pages;
 | 
						|
	int need_ipte_lock;
 | 
						|
	union asce asce;
 | 
						|
	int rc;
 | 
						|
 | 
						|
	if (!len)
 | 
						|
		return 0;
 | 
						|
	/* Access register mode is not supported yet. */
 | 
						|
	if (psw_bits(*psw).t && psw_bits(*psw).as == PSW_AS_ACCREG)
 | 
						|
		return -EOPNOTSUPP;
 | 
						|
	nr_pages = (((ga & ~PAGE_MASK) + len - 1) >> PAGE_SHIFT) + 1;
 | 
						|
	pages = pages_array;
 | 
						|
	if (nr_pages > ARRAY_SIZE(pages_array))
 | 
						|
		pages = vmalloc(nr_pages * sizeof(unsigned long));
 | 
						|
	if (!pages)
 | 
						|
		return -ENOMEM;
 | 
						|
	asce.val = get_vcpu_asce(vcpu);
 | 
						|
	need_ipte_lock = psw_bits(*psw).t && !asce.r;
 | 
						|
	if (need_ipte_lock)
 | 
						|
		ipte_lock(vcpu);
 | 
						|
	rc = guest_page_range(vcpu, ga, pages, nr_pages, write);
 | 
						|
	for (idx = 0; idx < nr_pages && !rc; idx++) {
 | 
						|
		gpa = *(pages + idx) + (ga & ~PAGE_MASK);
 | 
						|
		_len = min(PAGE_SIZE - (gpa & ~PAGE_MASK), len);
 | 
						|
		if (write)
 | 
						|
			rc = kvm_write_guest(vcpu->kvm, gpa, data, _len);
 | 
						|
		else
 | 
						|
			rc = kvm_read_guest(vcpu->kvm, gpa, data, _len);
 | 
						|
		len -= _len;
 | 
						|
		ga += _len;
 | 
						|
		data += _len;
 | 
						|
	}
 | 
						|
	if (need_ipte_lock)
 | 
						|
		ipte_unlock(vcpu);
 | 
						|
	if (nr_pages > ARRAY_SIZE(pages_array))
 | 
						|
		vfree(pages);
 | 
						|
	return rc;
 | 
						|
}
 | 
						|
 | 
						|
int access_guest_real(struct kvm_vcpu *vcpu, unsigned long gra,
 | 
						|
		      void *data, unsigned long len, int write)
 | 
						|
{
 | 
						|
	unsigned long _len, gpa;
 | 
						|
	int rc = 0;
 | 
						|
 | 
						|
	while (len && !rc) {
 | 
						|
		gpa = kvm_s390_real_to_abs(vcpu, gra);
 | 
						|
		_len = min(PAGE_SIZE - (gpa & ~PAGE_MASK), len);
 | 
						|
		if (write)
 | 
						|
			rc = write_guest_abs(vcpu, gpa, data, _len);
 | 
						|
		else
 | 
						|
			rc = read_guest_abs(vcpu, gpa, data, _len);
 | 
						|
		len -= _len;
 | 
						|
		gra += _len;
 | 
						|
		data += _len;
 | 
						|
	}
 | 
						|
	return rc;
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * guest_translate_address - translate guest logical into guest absolute address
 | 
						|
 *
 | 
						|
 * Parameter semantics are the same as the ones from guest_translate.
 | 
						|
 * The memory contents at the guest address are not changed.
 | 
						|
 *
 | 
						|
 * Note: The IPTE lock is not taken during this function, so the caller
 | 
						|
 * has to take care of this.
 | 
						|
 */
 | 
						|
int guest_translate_address(struct kvm_vcpu *vcpu, unsigned long gva,
 | 
						|
			    unsigned long *gpa, int write)
 | 
						|
{
 | 
						|
	struct kvm_s390_pgm_info *pgm = &vcpu->arch.pgm;
 | 
						|
	psw_t *psw = &vcpu->arch.sie_block->gpsw;
 | 
						|
	struct trans_exc_code_bits *tec;
 | 
						|
	union asce asce;
 | 
						|
	int rc;
 | 
						|
 | 
						|
	/* Access register mode is not supported yet. */
 | 
						|
	if (psw_bits(*psw).t && psw_bits(*psw).as == PSW_AS_ACCREG)
 | 
						|
		return -EOPNOTSUPP;
 | 
						|
 | 
						|
	gva = kvm_s390_logical_to_effective(vcpu, gva);
 | 
						|
	memset(pgm, 0, sizeof(*pgm));
 | 
						|
	tec = (struct trans_exc_code_bits *)&pgm->trans_exc_code;
 | 
						|
	tec->as = psw_bits(*psw).as;
 | 
						|
	tec->fsi = write ? FSI_STORE : FSI_FETCH;
 | 
						|
	tec->addr = gva >> PAGE_SHIFT;
 | 
						|
	if (is_low_address(gva) && low_address_protection_enabled(vcpu)) {
 | 
						|
		if (write) {
 | 
						|
			rc = pgm->code = PGM_PROTECTION;
 | 
						|
			return rc;
 | 
						|
		}
 | 
						|
	}
 | 
						|
 | 
						|
	asce.val = get_vcpu_asce(vcpu);
 | 
						|
	if (psw_bits(*psw).t && !asce.r) {	/* Use DAT? */
 | 
						|
		rc = guest_translate(vcpu, gva, gpa, write);
 | 
						|
		if (rc > 0) {
 | 
						|
			if (rc == PGM_PROTECTION)
 | 
						|
				tec->b61 = 1;
 | 
						|
			pgm->code = rc;
 | 
						|
		}
 | 
						|
	} else {
 | 
						|
		rc = 0;
 | 
						|
		*gpa = kvm_s390_real_to_abs(vcpu, gva);
 | 
						|
		if (kvm_is_error_gpa(vcpu->kvm, *gpa))
 | 
						|
			rc = pgm->code = PGM_ADDRESSING;
 | 
						|
	}
 | 
						|
 | 
						|
	return rc;
 | 
						|
}
 | 
						|
 | 
						|
/**
 | 
						|
 * kvm_s390_check_low_addr_protection - check for low-address protection
 | 
						|
 * @ga: Guest address
 | 
						|
 *
 | 
						|
 * Checks whether an address is subject to low-address protection and set
 | 
						|
 * up vcpu->arch.pgm accordingly if necessary.
 | 
						|
 *
 | 
						|
 * Return: 0 if no protection exception, or PGM_PROTECTION if protected.
 | 
						|
 */
 | 
						|
int kvm_s390_check_low_addr_protection(struct kvm_vcpu *vcpu, unsigned long ga)
 | 
						|
{
 | 
						|
	struct kvm_s390_pgm_info *pgm = &vcpu->arch.pgm;
 | 
						|
	psw_t *psw = &vcpu->arch.sie_block->gpsw;
 | 
						|
	struct trans_exc_code_bits *tec_bits;
 | 
						|
 | 
						|
	if (!is_low_address(ga) || !low_address_protection_enabled(vcpu))
 | 
						|
		return 0;
 | 
						|
 | 
						|
	memset(pgm, 0, sizeof(*pgm));
 | 
						|
	tec_bits = (struct trans_exc_code_bits *)&pgm->trans_exc_code;
 | 
						|
	tec_bits->fsi = FSI_STORE;
 | 
						|
	tec_bits->as = psw_bits(*psw).as;
 | 
						|
	tec_bits->addr = ga >> PAGE_SHIFT;
 | 
						|
	pgm->code = PGM_PROTECTION;
 | 
						|
 | 
						|
	return pgm->code;
 | 
						|
}
 |