[deliverable/linux.git] / arch / s390 / kvm / priv.c

/*
 * priv.c - handling privileged instructions
 *
 * Copyright IBM Corp. 2008
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License (version 2 only)
 * as published by the Free Software Foundation.
 *
 *    Author(s): Carsten Otte <cotte@de.ibm.com>
 *               Christian Borntraeger <borntraeger@de.ibm.com>
 */

#include <linux/kvm.h>
#include <linux/gfp.h>
#include <linux/errno.h>
#include <asm/current.h>
#include <asm/debug.h>
#include <asm/ebcdic.h>
#include <asm/sysinfo.h>
#include "gaccess.h"
#include "kvm-s390.h"

static int handle_set_prefix(struct kvm_vcpu *vcpu)
{
	int base2 = vcpu->arch.sie_block->ipb >> 28;
	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	u64 operand2;
	u32 address = 0;
	u8 tmp;

	vcpu->stat.instruction_spx++;

	operand2 = disp2;
	if (base2)
		operand2 += vcpu->run->s.regs.gprs[base2];

	/* must be word boundary */
	if (operand2 & 3) {
		kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
		goto out;
	}

	/* get the value */
	if (get_guest_u32(vcpu, operand2, &address)) {
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out;
	}

	address = address & 0x7fffe000u;

	/* make sure that the new value is valid memory */
	if (copy_from_guest_absolute(vcpu, &tmp, address, 1) ||
	   (copy_from_guest_absolute(vcpu, &tmp, address + PAGE_SIZE, 1))) {
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out;
	}

	kvm_s390_set_prefix(vcpu, address);

	VCPU_EVENT(vcpu, 5, "setting prefix to %x", address);
out:
	return 0;
}

static int handle_store_prefix(struct kvm_vcpu *vcpu)
{
	int base2 = vcpu->arch.sie_block->ipb >> 28;
	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	u64 operand2;
	u32 address;

	vcpu->stat.instruction_stpx++;
	operand2 = disp2;
	if (base2)
		operand2 += vcpu->run->s.regs.gprs[base2];

	/* must be word boundary */
	if (operand2 & 3) {
		kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
		goto out;
	}

	address = vcpu->arch.sie_block->prefix;
	address = address & 0x7fffe000u;

	/* get the value */
	if (put_guest_u32(vcpu, operand2, address)) {
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out;
	}

	VCPU_EVENT(vcpu, 5, "storing prefix to %x", address);
out:
	return 0;
}

static int handle_store_cpu_address(struct kvm_vcpu *vcpu)
{
	int base2 = vcpu->arch.sie_block->ipb >> 28;
	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	u64 useraddr;
	int rc;

	vcpu->stat.instruction_stap++;
	useraddr = disp2;
	if (base2)
		useraddr += vcpu->run->s.regs.gprs[base2];

	if (useraddr & 1) {
		kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
		goto out;
	}

	rc = put_guest_u16(vcpu, useraddr, vcpu->vcpu_id);
	if (rc == -EFAULT) {
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out;
	}

	VCPU_EVENT(vcpu, 5, "storing cpu address to %llx", useraddr);
out:
	return 0;
}

static int handle_skey(struct kvm_vcpu *vcpu)
{
	vcpu->stat.instruction_storage_key++;
	vcpu->arch.sie_block->gpsw.addr -= 4;
	VCPU_EVENT(vcpu, 4, "%s", "retrying storage key operation");
	return 0;
}

static int handle_stsch(struct kvm_vcpu *vcpu)
{
	vcpu->stat.instruction_stsch++;
	VCPU_EVENT(vcpu, 4, "%s", "store subchannel - CC3");
	/* condition code 3 */
	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	vcpu->arch.sie_block->gpsw.mask |= (3 & 3ul) << 44;
	return 0;
}

static int handle_chsc(struct kvm_vcpu *vcpu)
{
	vcpu->stat.instruction_chsc++;
	VCPU_EVENT(vcpu, 4, "%s", "channel subsystem call - CC3");
	/* condition code 3 */
	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	vcpu->arch.sie_block->gpsw.mask |= (3 & 3ul) << 44;
	return 0;
}

static int handle_stfl(struct kvm_vcpu *vcpu)
{
	unsigned int facility_list;
	int rc;

	vcpu->stat.instruction_stfl++;
	/* only pass the facility bits, which we can handle */
	facility_list = S390_lowcore.stfl_fac_list & 0xff00fff3;

	rc = copy_to_guest(vcpu, offsetof(struct _lowcore, stfl_fac_list),
			   &facility_list, sizeof(facility_list));
	if (rc == -EFAULT)
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	else
		VCPU_EVENT(vcpu, 5, "store facility list value %x",
			   facility_list);
	return 0;
}

static int handle_stidp(struct kvm_vcpu *vcpu)
{
	int base2 = vcpu->arch.sie_block->ipb >> 28;
	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	u64 operand2;
	int rc;

	vcpu->stat.instruction_stidp++;
	operand2 = disp2;
	if (base2)
		operand2 += vcpu->run->s.regs.gprs[base2];

	if (operand2 & 7) {
		kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
		goto out;
	}

	rc = put_guest_u64(vcpu, operand2, vcpu->arch.stidp_data);
	if (rc == -EFAULT) {
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out;
	}

	VCPU_EVENT(vcpu, 5, "%s", "store cpu id");
out:
	return 0;
}

static void handle_stsi_3_2_2(struct kvm_vcpu *vcpu, struct sysinfo_3_2_2 *mem)
{
	struct kvm_s390_float_interrupt *fi = &vcpu->kvm->arch.float_int;
	int cpus = 0;
	int n;

	spin_lock(&fi->lock);
	for (n = 0; n < KVM_MAX_VCPUS; n++)
		if (fi->local_int[n])
			cpus++;
	spin_unlock(&fi->lock);

	/* deal with other level 3 hypervisors */
	if (stsi(mem, 3, 2, 2) == -ENOSYS)
		mem->count = 0;
	if (mem->count < 8)
		mem->count++;
	for (n = mem->count - 1; n > 0 ; n--)
		memcpy(&mem->vm[n], &mem->vm[n - 1], sizeof(mem->vm[0]));

	mem->vm[0].cpus_total = cpus;
	mem->vm[0].cpus_configured = cpus;
	mem->vm[0].cpus_standby = 0;
	mem->vm[0].cpus_reserved = 0;
	mem->vm[0].caf = 1000;
	memcpy(mem->vm[0].name, "KVMguest", 8);
	ASCEBC(mem->vm[0].name, 8);
	memcpy(mem->vm[0].cpi, "KVM/Linux       ", 16);
	ASCEBC(mem->vm[0].cpi, 16);
}

static int handle_stsi(struct kvm_vcpu *vcpu)
{
	int fc = (vcpu->run->s.regs.gprs[0] & 0xf0000000) >> 28;
	int sel1 = vcpu->run->s.regs.gprs[0] & 0xff;
	int sel2 = vcpu->run->s.regs.gprs[1] & 0xffff;
	int base2 = vcpu->arch.sie_block->ipb >> 28;
	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	u64 operand2;
	unsigned long mem;

	vcpu->stat.instruction_stsi++;
	VCPU_EVENT(vcpu, 4, "stsi: fc: %x sel1: %x sel2: %x", fc, sel1, sel2);

	operand2 = disp2;
	if (base2)
		operand2 += vcpu->run->s.regs.gprs[base2];

	if (operand2 & 0xfff && fc > 0)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);

	switch (fc) {
	case 0:
		vcpu->run->s.regs.gprs[0] = 3 << 28;
		vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
		return 0;
	case 1: /* same handling for 1 and 2 */
	case 2:
		mem = get_zeroed_page(GFP_KERNEL);
		if (!mem)
			goto out_fail;
		if (stsi((void *) mem, fc, sel1, sel2) == -ENOSYS)
			goto out_mem;
		break;
	case 3:
		if (sel1 != 2 || sel2 != 2)
			goto out_fail;
		mem = get_zeroed_page(GFP_KERNEL);
		if (!mem)
			goto out_fail;
		handle_stsi_3_2_2(vcpu, (void *) mem);
		break;
	default:
		goto out_fail;
	}

	if (copy_to_guest_absolute(vcpu, operand2, (void *) mem, PAGE_SIZE)) {
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out_mem;
	}
	free_page(mem);
	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	vcpu->run->s.regs.gprs[0] = 0;
	return 0;
out_mem:
	free_page(mem);
out_fail:
	/* condition code 3 */
	vcpu->arch.sie_block->gpsw.mask |= 3ul << 44;
	return 0;
}

static intercept_handler_t priv_handlers[256] = {
	[0x02] = handle_stidp,
	[0x10] = handle_set_prefix,
	[0x11] = handle_store_prefix,
	[0x12] = handle_store_cpu_address,
	[0x29] = handle_skey,
	[0x2a] = handle_skey,
	[0x2b] = handle_skey,
	[0x34] = handle_stsch,
	[0x5f] = handle_chsc,
	[0x7d] = handle_stsi,
	[0xb1] = handle_stfl,
};

int kvm_s390_handle_b2(struct kvm_vcpu *vcpu)
{
	intercept_handler_t handler;

	/*
	 * a lot of B2 instructions are priviledged. We first check for
	 * the privileged ones, that we can handle in the kernel. If the
	 * kernel can handle this instruction, we check for the problem
	 * state bit and (a) handle the instruction or (b) send a code 2
	 * program check.
	 * Anything else goes to userspace.*/
	handler = priv_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
	if (handler) {
		if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
			return kvm_s390_inject_program_int(vcpu,
						   PGM_PRIVILEGED_OPERATION);
		else
			return handler(vcpu);
	}
	return -EOPNOTSUPP;
}

static int handle_tprot(struct kvm_vcpu *vcpu)
{
	int base1 = (vcpu->arch.sie_block->ipb & 0xf0000000) >> 28;
	int disp1 = (vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16;
	int base2 = (vcpu->arch.sie_block->ipb & 0xf000) >> 12;
	int disp2 = vcpu->arch.sie_block->ipb & 0x0fff;
	u64 address1 = disp1 + base1 ? vcpu->run->s.regs.gprs[base1] : 0;
	u64 address2 = disp2 + base2 ? vcpu->run->s.regs.gprs[base2] : 0;
	struct vm_area_struct *vma;
	unsigned long user_address;

	vcpu->stat.instruction_tprot++;

	/* we only handle the Linux memory detection case:
	 * access key == 0
	 * guest DAT == off
	 * everything else goes to userspace. */
	if (address2 & 0xf0)
		return -EOPNOTSUPP;
	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_DAT)
		return -EOPNOTSUPP;


	/* we must resolve the address without holding the mmap semaphore.
	 * This is ok since the userspace hypervisor is not supposed to change
	 * the mapping while the guest queries the memory. Otherwise the guest
	 * might crash or get wrong info anyway. */
	user_address = (unsigned long) __guestaddr_to_user(vcpu, address1);

	down_read(&current->mm->mmap_sem);
	vma = find_vma(current->mm, user_address);
	if (!vma) {
		up_read(&current->mm->mmap_sem);
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	}

	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	if (!(vma->vm_flags & VM_WRITE) && (vma->vm_flags & VM_READ))
		vcpu->arch.sie_block->gpsw.mask |= (1ul << 44);
	if (!(vma->vm_flags & VM_WRITE) && !(vma->vm_flags & VM_READ))
		vcpu->arch.sie_block->gpsw.mask |= (2ul << 44);

	up_read(&current->mm->mmap_sem);
	return 0;
}

int kvm_s390_handle_e5(struct kvm_vcpu *vcpu)
{
	/* For e5xx... instructions we only handle TPROT */
	if ((vcpu->arch.sie_block->ipa & 0x00ff) == 0x01)
		return handle_tprot(vcpu);
	return -EOPNOTSUPP;
}
Commit	Line	Data
453423dc CB	1	/*
	2	* priv.c - handling privileged instructions
	3	*
	4	* Copyright IBM Corp. 2008
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License (version 2 only)
	8	* as published by the Free Software Foundation.
	9	*
	10	* Author(s): Carsten Otte <cotte@de.ibm.com>
	11	* Christian Borntraeger <borntraeger@de.ibm.com>
	12	*/
	13
	14	#include <linux/kvm.h>
5a0e3ad6	15	#include <linux/gfp.h>
453423dc CB	16	#include <linux/errno.h>
	17	#include <asm/current.h>
	18	#include <asm/debug.h>
	19	#include <asm/ebcdic.h>
	20	#include <asm/sysinfo.h>
	21	#include "gaccess.h"
	22	#include "kvm-s390.h"
	23
	24	static int handle_set_prefix(struct kvm_vcpu *vcpu)
	25	{
	26	int base2 = vcpu->arch.sie_block->ipb >> 28;
	27	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	28	u64 operand2;
	29	u32 address = 0;
	30	u8 tmp;
	31
	32	vcpu->stat.instruction_spx++;
	33
	34	operand2 = disp2;
	35	if (base2)
5a32c1af	36	operand2 += vcpu->run->s.regs.gprs[base2];
453423dc CB	37
	38	/* must be word boundary */
	39	if (operand2 & 3) {
	40	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	41	goto out;
	42	}
	43
	44	/* get the value */
	45	if (get_guest_u32(vcpu, operand2, &address)) {
	46	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	47	goto out;
	48	}
	49
	50	address = address & 0x7fffe000u;
	51
	52	/* make sure that the new value is valid memory */
	53	if (copy_from_guest_absolute(vcpu, &tmp, address, 1) \|\|
	54	(copy_from_guest_absolute(vcpu, &tmp, address + PAGE_SIZE, 1))) {
	55	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	56	goto out;
	57	}
	58
8d26cf7b	59	kvm_s390_set_prefix(vcpu, address);
453423dc CB	60
	61	VCPU_EVENT(vcpu, 5, "setting prefix to %x", address);
	62	out:
	63	return 0;
	64	}
	65
	66	static int handle_store_prefix(struct kvm_vcpu *vcpu)
	67	{
	68	int base2 = vcpu->arch.sie_block->ipb >> 28;
	69	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	70	u64 operand2;
	71	u32 address;
	72
	73	vcpu->stat.instruction_stpx++;
	74	operand2 = disp2;
	75	if (base2)
5a32c1af	76	operand2 += vcpu->run->s.regs.gprs[base2];
453423dc CB	77
	78	/* must be word boundary */
	79	if (operand2 & 3) {
	80	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	81	goto out;
	82	}
	83
	84	address = vcpu->arch.sie_block->prefix;
	85	address = address & 0x7fffe000u;
	86
	87	/* get the value */
	88	if (put_guest_u32(vcpu, operand2, address)) {
	89	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	90	goto out;
	91	}
	92
	93	VCPU_EVENT(vcpu, 5, "storing prefix to %x", address);
	94	out:
	95	return 0;
	96	}
	97
	98	static int handle_store_cpu_address(struct kvm_vcpu *vcpu)
	99	{
	100	int base2 = vcpu->arch.sie_block->ipb >> 28;
	101	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	102	u64 useraddr;
	103	int rc;
	104
	105	vcpu->stat.instruction_stap++;
	106	useraddr = disp2;
	107	if (base2)
5a32c1af	108	useraddr += vcpu->run->s.regs.gprs[base2];
453423dc CB	109
	110	if (useraddr & 1) {
	111	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	112	goto out;
	113	}
	114
	115	rc = put_guest_u16(vcpu, useraddr, vcpu->vcpu_id);
	116	if (rc == -EFAULT) {
	117	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	118	goto out;
	119	}
	120
33e19115	121	VCPU_EVENT(vcpu, 5, "storing cpu address to %llx", useraddr);
453423dc CB	122	out:
	123	return 0;
	124	}
	125
	126	static int handle_skey(struct kvm_vcpu *vcpu)
	127	{
	128	vcpu->stat.instruction_storage_key++;
	129	vcpu->arch.sie_block->gpsw.addr -= 4;
	130	VCPU_EVENT(vcpu, 4, "%s", "retrying storage key operation");
	131	return 0;
	132	}
	133
	134	static int handle_stsch(struct kvm_vcpu *vcpu)
	135	{
	136	vcpu->stat.instruction_stsch++;
	137	VCPU_EVENT(vcpu, 4, "%s", "store subchannel - CC3");
	138	/* condition code 3 */
	139	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	140	vcpu->arch.sie_block->gpsw.mask \|= (3 & 3ul) << 44;
	141	return 0;
	142	}
	143
	144	static int handle_chsc(struct kvm_vcpu *vcpu)
	145	{
	146	vcpu->stat.instruction_chsc++;
	147	VCPU_EVENT(vcpu, 4, "%s", "channel subsystem call - CC3");
	148	/* condition code 3 */
	149	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	150	vcpu->arch.sie_block->gpsw.mask \|= (3 & 3ul) << 44;
	151	return 0;
	152	}
	153
453423dc CB	154	static int handle_stfl(struct kvm_vcpu *vcpu)
453423dc CB	155	{
14375bc4	156	unsigned int facility_list;
453423dc CB	157	int rc;
	158
	159	vcpu->stat.instruction_stfl++;
a0046b6d	160	/* only pass the facility bits, which we can handle */
14375bc4	161	facility_list = S390_lowcore.stfl_fac_list & 0xff00fff3;
453423dc CB	162
	163	rc = copy_to_guest(vcpu, offsetof(struct _lowcore, stfl_fac_list),
	164	&facility_list, sizeof(facility_list));
	165	if (rc == -EFAULT)
	166	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	167	else
	168	VCPU_EVENT(vcpu, 5, "store facility list value %x",
	169	facility_list);
	170	return 0;
	171	}
	172
	173	static int handle_stidp(struct kvm_vcpu *vcpu)
	174	{
	175	int base2 = vcpu->arch.sie_block->ipb >> 28;
	176	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	177	u64 operand2;
	178	int rc;
	179
	180	vcpu->stat.instruction_stidp++;
	181	operand2 = disp2;
	182	if (base2)
5a32c1af	183	operand2 += vcpu->run->s.regs.gprs[base2];
453423dc CB	184
	185	if (operand2 & 7) {
	186	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	187	goto out;
	188	}
	189
	190	rc = put_guest_u64(vcpu, operand2, vcpu->arch.stidp_data);
	191	if (rc == -EFAULT) {
	192	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	193	goto out;
	194	}
	195
	196	VCPU_EVENT(vcpu, 5, "%s", "store cpu id");
	197	out:
	198	return 0;
	199	}
	200
	201	static void handle_stsi_3_2_2(struct kvm_vcpu vcpu, struct sysinfo_3_2_2 mem)
	202	{
180c12fb	203	struct kvm_s390_float_interrupt *fi = &vcpu->kvm->arch.float_int;
453423dc CB	204	int cpus = 0;
	205	int n;
	206
b037a4f3	207	spin_lock(&fi->lock);
453423dc CB	208	for (n = 0; n < KVM_MAX_VCPUS; n++)
	209	if (fi->local_int[n])
	210	cpus++;
b037a4f3	211	spin_unlock(&fi->lock);
453423dc CB	212
	213	/* deal with other level 3 hypervisors */
	214	if (stsi(mem, 3, 2, 2) == -ENOSYS)
	215	mem->count = 0;
	216	if (mem->count < 8)
	217	mem->count++;
	218	for (n = mem->count - 1; n > 0 ; n--)
	219	memcpy(&mem->vm[n], &mem->vm[n - 1], sizeof(mem->vm[0]));
	220
	221	mem->vm[0].cpus_total = cpus;
	222	mem->vm[0].cpus_configured = cpus;
	223	mem->vm[0].cpus_standby = 0;
	224	mem->vm[0].cpus_reserved = 0;
	225	mem->vm[0].caf = 1000;
	226	memcpy(mem->vm[0].name, "KVMguest", 8);
	227	ASCEBC(mem->vm[0].name, 8);
	228	memcpy(mem->vm[0].cpi, "KVM/Linux ", 16);
	229	ASCEBC(mem->vm[0].cpi, 16);
	230	}
	231
	232	static int handle_stsi(struct kvm_vcpu *vcpu)
	233	{
5a32c1af CB	234	int fc = (vcpu->run->s.regs.gprs[0] & 0xf0000000) >> 28;
	235	int sel1 = vcpu->run->s.regs.gprs[0] & 0xff;
	236	int sel2 = vcpu->run->s.regs.gprs[1] & 0xffff;
453423dc CB	237	int base2 = vcpu->arch.sie_block->ipb >> 28;
	238	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	239	u64 operand2;
	240	unsigned long mem;
	241
	242	vcpu->stat.instruction_stsi++;
	243	VCPU_EVENT(vcpu, 4, "stsi: fc: %x sel1: %x sel2: %x", fc, sel1, sel2);
	244
	245	operand2 = disp2;
	246	if (base2)
5a32c1af	247	operand2 += vcpu->run->s.regs.gprs[base2];
453423dc CB	248
	249	if (operand2 & 0xfff && fc > 0)
	250	return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	251
	252	switch (fc) {
	253	case 0:
5a32c1af	254	vcpu->run->s.regs.gprs[0] = 3 << 28;
453423dc CB	255	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	256	return 0;
	257	case 1: /* same handling for 1 and 2 */
	258	case 2:
	259	mem = get_zeroed_page(GFP_KERNEL);
	260	if (!mem)
	261	goto out_fail;
	262	if (stsi((void *) mem, fc, sel1, sel2) == -ENOSYS)
	263	goto out_mem;
	264	break;
	265	case 3:
	266	if (sel1 != 2 \|\| sel2 != 2)
	267	goto out_fail;
	268	mem = get_zeroed_page(GFP_KERNEL);
	269	if (!mem)
	270	goto out_fail;
	271	handle_stsi_3_2_2(vcpu, (void *) mem);
	272	break;
	273	default:
	274	goto out_fail;
	275	}
	276
	277	if (copy_to_guest_absolute(vcpu, operand2, (void *) mem, PAGE_SIZE)) {
	278	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	279	goto out_mem;
	280	}
	281	free_page(mem);
	282	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
5a32c1af	283	vcpu->run->s.regs.gprs[0] = 0;
453423dc CB	284	return 0;
	285	out_mem:
	286	free_page(mem);
	287	out_fail:
	288	/* condition code 3 */
	289	vcpu->arch.sie_block->gpsw.mask \|= 3ul << 44;
	290	return 0;
	291	}
	292
	293	static intercept_handler_t priv_handlers[256] = {
	294	[0x02] = handle_stidp,
	295	[0x10] = handle_set_prefix,
	296	[0x11] = handle_store_prefix,
	297	[0x12] = handle_store_cpu_address,
	298	[0x29] = handle_skey,
	299	[0x2a] = handle_skey,
	300	[0x2b] = handle_skey,
	301	[0x34] = handle_stsch,
	302	[0x5f] = handle_chsc,
	303	[0x7d] = handle_stsi,
	304	[0xb1] = handle_stfl,
	305	};
	306
70455a36	307	int kvm_s390_handle_b2(struct kvm_vcpu *vcpu)
453423dc CB	308	{
	309	intercept_handler_t handler;
	310
70455a36 CB	311	/*
70455a36 CB	312	* a lot of B2 instructions are priviledged. We first check for
25985edc	313	* the privileged ones, that we can handle in the kernel. If the
70455a36 CB	314	* kernel can handle this instruction, we check for the problem
	315	* state bit and (a) handle the instruction or (b) send a code 2
	316	* program check.
	317	* Anything else goes to userspace.*/
453423dc	318	handler = priv_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
70455a36 CB	319	if (handler) {
	320	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
	321	return kvm_s390_inject_program_int(vcpu,
	322	PGM_PRIVILEGED_OPERATION);
	323	else
	324	return handler(vcpu);
	325	}
b8e660b8	326	return -EOPNOTSUPP;
453423dc	327	}
bb25b9ba CB	328
	329	static int handle_tprot(struct kvm_vcpu *vcpu)
	330	{
	331	int base1 = (vcpu->arch.sie_block->ipb & 0xf0000000) >> 28;
	332	int disp1 = (vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16;
	333	int base2 = (vcpu->arch.sie_block->ipb & 0xf000) >> 12;
	334	int disp2 = vcpu->arch.sie_block->ipb & 0x0fff;
5a32c1af CB	335	u64 address1 = disp1 + base1 ? vcpu->run->s.regs.gprs[base1] : 0;
5a32c1af CB	336	u64 address2 = disp2 + base2 ? vcpu->run->s.regs.gprs[base2] : 0;
bb25b9ba	337	struct vm_area_struct *vma;
1eddb85f	338	unsigned long user_address;
bb25b9ba CB	339
	340	vcpu->stat.instruction_tprot++;
	341
	342	/* we only handle the Linux memory detection case:
	343	* access key == 0
	344	* guest DAT == off
	345	* everything else goes to userspace. */
	346	if (address2 & 0xf0)
	347	return -EOPNOTSUPP;
	348	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_DAT)
	349	return -EOPNOTSUPP;
	350
	351
1eddb85f CB	352	/* we must resolve the address without holding the mmap semaphore.
	353	* This is ok since the userspace hypervisor is not supposed to change
	354	* the mapping while the guest queries the memory. Otherwise the guest
	355	* might crash or get wrong info anyway. */
	356	user_address = (unsigned long) __guestaddr_to_user(vcpu, address1);
	357
bb25b9ba	358	down_read(&current->mm->mmap_sem);
1eddb85f	359	vma = find_vma(current->mm, user_address);
bb25b9ba CB	360	if (!vma) {
	361	up_read(&current->mm->mmap_sem);
	362	return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	363	}
	364
	365	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	366	if (!(vma->vm_flags & VM_WRITE) && (vma->vm_flags & VM_READ))
	367	vcpu->arch.sie_block->gpsw.mask \|= (1ul << 44);
	368	if (!(vma->vm_flags & VM_WRITE) && !(vma->vm_flags & VM_READ))
	369	vcpu->arch.sie_block->gpsw.mask \|= (2ul << 44);
	370
	371	up_read(&current->mm->mmap_sem);
	372	return 0;
	373	}
	374
	375	int kvm_s390_handle_e5(struct kvm_vcpu *vcpu)
	376	{
	377	/* For e5xx... instructions we only handle TPROT */
	378	if ((vcpu->arch.sie_block->ipa & 0x00ff) == 0x01)
	379	return handle_tprot(vcpu);
	380	return -EOPNOTSUPP;
	381	}
	382