[deliverable/linux.git] / arch / s390 / kvm / 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 <asm/ptrace.h>
#include <asm/compat.h>
#include "gaccess.h"
#include "kvm-s390.h"
#include "trace.h"

static int handle_set_prefix(struct kvm_vcpu *vcpu)
{
	u64 operand2;
	u32 address = 0;
	u8 tmp;

	vcpu->stat.instruction_spx++;

	operand2 = kvm_s390_get_base_disp_s(vcpu);

	/* 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);
	trace_kvm_s390_handle_prefix(vcpu, 1, address);
out:
	return 0;
}

static int handle_store_prefix(struct kvm_vcpu *vcpu)
{
	u64 operand2;
	u32 address;

	vcpu->stat.instruction_stpx++;

	operand2 = kvm_s390_get_base_disp_s(vcpu);

	/* 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);
	trace_kvm_s390_handle_prefix(vcpu, 0, address);
out:
	return 0;
}

static int handle_store_cpu_address(struct kvm_vcpu *vcpu)
{
	u64 useraddr;
	int rc;

	vcpu->stat.instruction_stap++;

	useraddr = kvm_s390_get_base_disp_s(vcpu);

	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);
	trace_kvm_s390_handle_stap(vcpu, 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_tpi(struct kvm_vcpu *vcpu)
{
	u64 addr;
	struct kvm_s390_interrupt_info *inti;
	int cc;

	addr = kvm_s390_get_base_disp_s(vcpu);

	inti = kvm_s390_get_io_int(vcpu->kvm, vcpu->run->s.regs.crs[6], 0);
	if (inti) {
		if (addr) {
			/*
			 * Store the two-word I/O interruption code into the
			 * provided area.
			 */
			put_guest_u16(vcpu, addr, inti->io.subchannel_id);
			put_guest_u16(vcpu, addr + 2, inti->io.subchannel_nr);
			put_guest_u32(vcpu, addr + 4, inti->io.io_int_parm);
		} else {
			/*
			 * Store the three-word I/O interruption code into
			 * the appropriate lowcore area.
			 */
			put_guest_u16(vcpu, 184, inti->io.subchannel_id);
			put_guest_u16(vcpu, 186, inti->io.subchannel_nr);
			put_guest_u32(vcpu, 188, inti->io.io_int_parm);
			put_guest_u32(vcpu, 192, inti->io.io_int_word);
		}
		cc = 1;
	} else
		cc = 0;
	kfree(inti);
	/* Set condition code and we're done. */
	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	vcpu->arch.sie_block->gpsw.mask |= (cc & 3ul) << 44;
	return 0;
}

static int handle_tsch(struct kvm_vcpu *vcpu)
{
	struct kvm_s390_interrupt_info *inti;

	inti = kvm_s390_get_io_int(vcpu->kvm, 0,
				   vcpu->run->s.regs.gprs[1]);

	/*
	 * Prepare exit to userspace.
	 * We indicate whether we dequeued a pending I/O interrupt
	 * so that userspace can re-inject it if the instruction gets
	 * a program check. While this may re-order the pending I/O
	 * interrupts, this is no problem since the priority is kept
	 * intact.
	 */
	vcpu->run->exit_reason = KVM_EXIT_S390_TSCH;
	vcpu->run->s390_tsch.dequeued = !!inti;
	if (inti) {
		vcpu->run->s390_tsch.subchannel_id = inti->io.subchannel_id;
		vcpu->run->s390_tsch.subchannel_nr = inti->io.subchannel_nr;
		vcpu->run->s390_tsch.io_int_parm = inti->io.io_int_parm;
		vcpu->run->s390_tsch.io_int_word = inti->io.io_int_word;
	}
	vcpu->run->s390_tsch.ipb = vcpu->arch.sie_block->ipb;
	kfree(inti);
	return -EREMOTE;
}

static int handle_io_inst(struct kvm_vcpu *vcpu)
{
	VCPU_EVENT(vcpu, 4, "%s", "I/O instruction");

	if (vcpu->kvm->arch.css_support) {
		/*
		 * Most I/O instructions will be handled by userspace.
		 * Exceptions are tpi and the interrupt portion of tsch.
		 */
		if (vcpu->arch.sie_block->ipa == 0xb236)
			return handle_tpi(vcpu);
		if (vcpu->arch.sie_block->ipa == 0xb235)
			return handle_tsch(vcpu);
		/* Handle in userspace. */
		return -EOPNOTSUPP;
	} else {
		/*
		 * Set condition code 3 to stop the guest from issueing channel
		 * I/O instructions.
		 */
		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);
		trace_kvm_s390_handle_stfl(vcpu, facility_list);
	}
	return 0;
}

static void handle_new_psw(struct kvm_vcpu *vcpu)
{
	/* Check whether the new psw is enabled for machine checks. */
	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_MCHECK)
		kvm_s390_deliver_pending_machine_checks(vcpu);
}

#define PSW_MASK_ADDR_MODE (PSW_MASK_EA | PSW_MASK_BA)
#define PSW_MASK_UNASSIGNED 0xb80800fe7fffffffUL
#define PSW_ADDR_24 0x00000000000fffffUL
#define PSW_ADDR_31 0x000000007fffffffUL

int kvm_s390_handle_lpsw(struct kvm_vcpu *vcpu)
{
	u64 addr;
	psw_compat_t new_psw;

	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
		return kvm_s390_inject_program_int(vcpu,
						   PGM_PRIVILEGED_OPERATION);

	addr = kvm_s390_get_base_disp_s(vcpu);

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

	if (copy_from_guest(vcpu, &new_psw, addr, sizeof(new_psw))) {
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out;
	}

	if (!(new_psw.mask & PSW32_MASK_BASE)) {
		kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
		goto out;
	}

	vcpu->arch.sie_block->gpsw.mask =
		(new_psw.mask & ~PSW32_MASK_BASE) << 32;
	vcpu->arch.sie_block->gpsw.addr = new_psw.addr;

	if ((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_UNASSIGNED) ||
	    (!(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) &&
	     (vcpu->arch.sie_block->gpsw.addr & ~PSW_ADDR_24)) ||
	    ((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) ==
	     PSW_MASK_EA)) {
		kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
		goto out;
	}

	handle_new_psw(vcpu);
out:
	return 0;
}

static int handle_lpswe(struct kvm_vcpu *vcpu)
{
	u64 addr;
	psw_t new_psw;

	addr = kvm_s390_get_base_disp_s(vcpu);

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

	if (copy_from_guest(vcpu, &new_psw, addr, sizeof(new_psw))) {
		kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out;
	}

	vcpu->arch.sie_block->gpsw.mask = new_psw.mask;
	vcpu->arch.sie_block->gpsw.addr = new_psw.addr;

	if ((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_UNASSIGNED) ||
	    (((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) ==
	      PSW_MASK_BA) &&
	     (vcpu->arch.sie_block->gpsw.addr & ~PSW_ADDR_31)) ||
	    (!(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) &&
	     (vcpu->arch.sie_block->gpsw.addr & ~PSW_ADDR_24)) ||
	    ((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) ==
	     PSW_MASK_EA)) {
		kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
		goto out;
	}

	handle_new_psw(vcpu);
out:
	return 0;
}

static int handle_stidp(struct kvm_vcpu *vcpu)
{
	u64 operand2;
	int rc;

	vcpu->stat.instruction_stidp++;

	operand2 = kvm_s390_get_base_disp_s(vcpu);

	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))
		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;
	u64 operand2;
	unsigned long mem;

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

	operand2 = kvm_s390_get_base_disp_s(vcpu);

	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))
			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;
	}
	trace_kvm_s390_handle_stsi(vcpu, fc, sel1, sel2, operand2);
	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 const intercept_handler_t b2_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,
	[0x30] = handle_io_inst,
	[0x31] = handle_io_inst,
	[0x32] = handle_io_inst,
	[0x33] = handle_io_inst,
	[0x34] = handle_io_inst,
	[0x35] = handle_io_inst,
	[0x36] = handle_io_inst,
	[0x37] = handle_io_inst,
	[0x38] = handle_io_inst,
	[0x39] = handle_io_inst,
	[0x3a] = handle_io_inst,
	[0x3b] = handle_io_inst,
	[0x3c] = handle_io_inst,
	[0x5f] = handle_io_inst,
	[0x74] = handle_io_inst,
	[0x76] = handle_io_inst,
	[0x7d] = handle_stsi,
	[0xb1] = handle_stfl,
	[0xb2] = handle_lpswe,
};

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 = b2_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_epsw(struct kvm_vcpu *vcpu)
{
	int reg1, reg2;

	reg1 = (vcpu->arch.sie_block->ipb & 0x00f00000) >> 24;
	reg2 = (vcpu->arch.sie_block->ipb & 0x000f0000) >> 16;

	/* This basically extracts the mask half of the psw. */
	vcpu->run->s.regs.gprs[reg1] &= 0xffffffff00000000;
	vcpu->run->s.regs.gprs[reg1] |= vcpu->arch.sie_block->gpsw.mask >> 32;
	if (reg2) {
		vcpu->run->s.regs.gprs[reg2] &= 0xffffffff00000000;
		vcpu->run->s.regs.gprs[reg2] |=
			vcpu->arch.sie_block->gpsw.mask & 0x00000000ffffffff;
	}
	return 0;
}

static const intercept_handler_t b9_handlers[256] = {
	[0x8d] = handle_epsw,
	[0x9c] = handle_io_inst,
};

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

	/* This is handled just as for the B2 instructions. */
	handler = b9_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
	if (handler) {
		if ((handler != handle_epsw) &&
		    (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 const intercept_handler_t eb_handlers[256] = {
	[0x8a] = handle_io_inst,
};

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

	/* All eb instructions that end up here are privileged. */
	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
		return kvm_s390_inject_program_int(vcpu,
						   PGM_PRIVILEGED_OPERATION);
	handler = eb_handlers[vcpu->arch.sie_block->ipb & 0xff];
	if (handler)
		return handler(vcpu);
	return -EOPNOTSUPP;
}

static int handle_tprot(struct kvm_vcpu *vcpu)
{
	u64 address1, address2;
	struct vm_area_struct *vma;
	unsigned long user_address;

	vcpu->stat.instruction_tprot++;

	kvm_s390_get_base_disp_sse(vcpu, &address1, &address2);

	/* 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;
}

static int handle_sckpf(struct kvm_vcpu *vcpu)
{
	u32 value;

	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
		return kvm_s390_inject_program_int(vcpu,
						   PGM_PRIVILEGED_OPERATION);

	if (vcpu->run->s.regs.gprs[0] & 0x00000000ffff0000)
		return kvm_s390_inject_program_int(vcpu,
						   PGM_SPECIFICATION);

	value = vcpu->run->s.regs.gprs[0] & 0x000000000000ffff;
	vcpu->arch.sie_block->todpr = value;

	return 0;
}

static const intercept_handler_t x01_handlers[256] = {
	[0x07] = handle_sckpf,
};

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

	handler = x01_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
	if (handler)
		return handler(vcpu);
	return -EOPNOTSUPP;
}
Commit	Line	Data
453423dc	1	/*
a53c8fab	2	* handling privileged instructions
453423dc CB	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>
48a3e950 CH	21	#include <asm/ptrace.h>
48a3e950 CH	22	#include <asm/compat.h>
453423dc CB	23	#include "gaccess.h"
453423dc CB	24	#include "kvm-s390.h"
5786fffa	25	#include "trace.h"
453423dc CB	26
	27	static int handle_set_prefix(struct kvm_vcpu *vcpu)
	28	{
453423dc CB	29	u64 operand2;
	30	u32 address = 0;
	31	u8 tmp;
	32
	33	vcpu->stat.instruction_spx++;
	34
b1c571a5	35	operand2 = kvm_s390_get_base_disp_s(vcpu);
453423dc CB	36
	37	/* must be word boundary */
	38	if (operand2 & 3) {
	39	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	40	goto out;
	41	}
	42
	43	/* get the value */
	44	if (get_guest_u32(vcpu, operand2, &address)) {
	45	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	46	goto out;
	47	}
	48
	49	address = address & 0x7fffe000u;
	50
	51	/* make sure that the new value is valid memory */
	52	if (copy_from_guest_absolute(vcpu, &tmp, address, 1) \|\|
	53	(copy_from_guest_absolute(vcpu, &tmp, address + PAGE_SIZE, 1))) {
	54	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	55	goto out;
	56	}
	57
8d26cf7b	58	kvm_s390_set_prefix(vcpu, address);
453423dc CB	59
453423dc CB	60	VCPU_EVENT(vcpu, 5, "setting prefix to %x", address);
5786fffa	61	trace_kvm_s390_handle_prefix(vcpu, 1, address);
453423dc CB	62	out:
	63	return 0;
	64	}
	65
	66	static int handle_store_prefix(struct kvm_vcpu *vcpu)
	67	{
453423dc CB	68	u64 operand2;
	69	u32 address;
	70
	71	vcpu->stat.instruction_stpx++;
b1c571a5 CH	72
b1c571a5 CH	73	operand2 = kvm_s390_get_base_disp_s(vcpu);
453423dc CB	74
	75	/* must be word boundary */
	76	if (operand2 & 3) {
	77	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	78	goto out;
	79	}
	80
	81	address = vcpu->arch.sie_block->prefix;
	82	address = address & 0x7fffe000u;
	83
	84	/* get the value */
	85	if (put_guest_u32(vcpu, operand2, address)) {
	86	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	87	goto out;
	88	}
	89
	90	VCPU_EVENT(vcpu, 5, "storing prefix to %x", address);
5786fffa	91	trace_kvm_s390_handle_prefix(vcpu, 0, address);
453423dc CB	92	out:
	93	return 0;
	94	}
	95
	96	static int handle_store_cpu_address(struct kvm_vcpu *vcpu)
	97	{
453423dc CB	98	u64 useraddr;
	99	int rc;
	100
	101	vcpu->stat.instruction_stap++;
b1c571a5 CH	102
b1c571a5 CH	103	useraddr = kvm_s390_get_base_disp_s(vcpu);
453423dc CB	104
	105	if (useraddr & 1) {
	106	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	107	goto out;
	108	}
	109
	110	rc = put_guest_u16(vcpu, useraddr, vcpu->vcpu_id);
	111	if (rc == -EFAULT) {
	112	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	113	goto out;
	114	}
	115
33e19115	116	VCPU_EVENT(vcpu, 5, "storing cpu address to %llx", useraddr);
5786fffa	117	trace_kvm_s390_handle_stap(vcpu, useraddr);
453423dc CB	118	out:
	119	return 0;
	120	}
	121
	122	static int handle_skey(struct kvm_vcpu *vcpu)
	123	{
	124	vcpu->stat.instruction_storage_key++;
	125	vcpu->arch.sie_block->gpsw.addr -= 4;
	126	VCPU_EVENT(vcpu, 4, "%s", "retrying storage key operation");
	127	return 0;
	128	}
	129
fa6b7fe9	130	static int handle_tpi(struct kvm_vcpu *vcpu)
453423dc	131	{
fa6b7fe9 CH	132	u64 addr;
	133	struct kvm_s390_interrupt_info *inti;
	134	int cc;
	135
	136	addr = kvm_s390_get_base_disp_s(vcpu);
	137
	138	inti = kvm_s390_get_io_int(vcpu->kvm, vcpu->run->s.regs.crs[6], 0);
	139	if (inti) {
	140	if (addr) {
	141	/*
	142	* Store the two-word I/O interruption code into the
	143	* provided area.
	144	*/
	145	put_guest_u16(vcpu, addr, inti->io.subchannel_id);
	146	put_guest_u16(vcpu, addr + 2, inti->io.subchannel_nr);
	147	put_guest_u32(vcpu, addr + 4, inti->io.io_int_parm);
	148	} else {
	149	/*
	150	* Store the three-word I/O interruption code into
	151	* the appropriate lowcore area.
	152	*/
	153	put_guest_u16(vcpu, 184, inti->io.subchannel_id);
	154	put_guest_u16(vcpu, 186, inti->io.subchannel_nr);
	155	put_guest_u32(vcpu, 188, inti->io.io_int_parm);
	156	put_guest_u32(vcpu, 192, inti->io.io_int_word);
	157	}
	158	cc = 1;
	159	} else
	160	cc = 0;
	161	kfree(inti);
	162	/* Set condition code and we're done. */
453423dc	163	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
fa6b7fe9	164	vcpu->arch.sie_block->gpsw.mask \|= (cc & 3ul) << 44;
453423dc CB	165	return 0;
	166	}
	167
fa6b7fe9 CH	168	static int handle_tsch(struct kvm_vcpu *vcpu)
	169	{
	170	struct kvm_s390_interrupt_info *inti;
	171
	172	inti = kvm_s390_get_io_int(vcpu->kvm, 0,
	173	vcpu->run->s.regs.gprs[1]);
	174
	175	/*
	176	* Prepare exit to userspace.
	177	* We indicate whether we dequeued a pending I/O interrupt
	178	* so that userspace can re-inject it if the instruction gets
	179	* a program check. While this may re-order the pending I/O
	180	* interrupts, this is no problem since the priority is kept
	181	* intact.
	182	*/
	183	vcpu->run->exit_reason = KVM_EXIT_S390_TSCH;
	184	vcpu->run->s390_tsch.dequeued = !!inti;
	185	if (inti) {
	186	vcpu->run->s390_tsch.subchannel_id = inti->io.subchannel_id;
	187	vcpu->run->s390_tsch.subchannel_nr = inti->io.subchannel_nr;
	188	vcpu->run->s390_tsch.io_int_parm = inti->io.io_int_parm;
	189	vcpu->run->s390_tsch.io_int_word = inti->io.io_int_word;
	190	}
	191	vcpu->run->s390_tsch.ipb = vcpu->arch.sie_block->ipb;
	192	kfree(inti);
	193	return -EREMOTE;
	194	}
	195
	196	static int handle_io_inst(struct kvm_vcpu *vcpu)
	197	{
	198	VCPU_EVENT(vcpu, 4, "%s", "I/O instruction");
	199
	200	if (vcpu->kvm->arch.css_support) {
	201	/*
	202	* Most I/O instructions will be handled by userspace.
	203	* Exceptions are tpi and the interrupt portion of tsch.
	204	*/
	205	if (vcpu->arch.sie_block->ipa == 0xb236)
	206	return handle_tpi(vcpu);
	207	if (vcpu->arch.sie_block->ipa == 0xb235)
	208	return handle_tsch(vcpu);
	209	/* Handle in userspace. */
	210	return -EOPNOTSUPP;
	211	} else {
	212	/*
	213	* Set condition code 3 to stop the guest from issueing channel
	214	* I/O instructions.
	215	*/
	216	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	217	vcpu->arch.sie_block->gpsw.mask \|= (3 & 3ul) << 44;
	218	return 0;
	219	}
	220	}
	221
453423dc CB	222	static int handle_stfl(struct kvm_vcpu *vcpu)
453423dc CB	223	{
14375bc4	224	unsigned int facility_list;
453423dc CB	225	int rc;
	226
	227	vcpu->stat.instruction_stfl++;
a0046b6d	228	/* only pass the facility bits, which we can handle */
14375bc4	229	facility_list = S390_lowcore.stfl_fac_list & 0xff00fff3;
453423dc CB	230
	231	rc = copy_to_guest(vcpu, offsetof(struct _lowcore, stfl_fac_list),
	232	&facility_list, sizeof(facility_list));
	233	if (rc == -EFAULT)
	234	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
5786fffa	235	else {
453423dc CB	236	VCPU_EVENT(vcpu, 5, "store facility list value %x",
453423dc CB	237	facility_list);
5786fffa CH	238	trace_kvm_s390_handle_stfl(vcpu, facility_list);
5786fffa CH	239	}
453423dc CB	240	return 0;
	241	}
	242
48a3e950 CH	243	static void handle_new_psw(struct kvm_vcpu *vcpu)
	244	{
	245	/* Check whether the new psw is enabled for machine checks. */
	246	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_MCHECK)
	247	kvm_s390_deliver_pending_machine_checks(vcpu);
	248	}
	249
	250	#define PSW_MASK_ADDR_MODE (PSW_MASK_EA \| PSW_MASK_BA)
	251	#define PSW_MASK_UNASSIGNED 0xb80800fe7fffffffUL
	252	#define PSW_ADDR_24 0x00000000000fffffUL
	253	#define PSW_ADDR_31 0x000000007fffffffUL
	254
	255	int kvm_s390_handle_lpsw(struct kvm_vcpu *vcpu)
	256	{
	257	u64 addr;
	258	psw_compat_t new_psw;
	259
	260	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
	261	return kvm_s390_inject_program_int(vcpu,
	262	PGM_PRIVILEGED_OPERATION);
	263
	264	addr = kvm_s390_get_base_disp_s(vcpu);
	265
	266	if (addr & 7) {
	267	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	268	goto out;
	269	}
	270
	271	if (copy_from_guest(vcpu, &new_psw, addr, sizeof(new_psw))) {
	272	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	273	goto out;
	274	}
	275
	276	if (!(new_psw.mask & PSW32_MASK_BASE)) {
	277	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	278	goto out;
	279	}
	280
	281	vcpu->arch.sie_block->gpsw.mask =
	282	(new_psw.mask & ~PSW32_MASK_BASE) << 32;
	283	vcpu->arch.sie_block->gpsw.addr = new_psw.addr;
	284
	285	if ((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_UNASSIGNED) \|\|
	286	(!(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) &&
	287	(vcpu->arch.sie_block->gpsw.addr & ~PSW_ADDR_24)) \|\|
	288	((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) ==
	289	PSW_MASK_EA)) {
	290	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	291	goto out;
	292	}
	293
	294	handle_new_psw(vcpu);
	295	out:
	296	return 0;
	297	}
	298
	299	static int handle_lpswe(struct kvm_vcpu *vcpu)
	300	{
	301	u64 addr;
	302	psw_t new_psw;
	303
	304	addr = kvm_s390_get_base_disp_s(vcpu);
	305
	306	if (addr & 7) {
307	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
308	goto out;
309	}
310
311	if (copy_from_guest(vcpu, &new_psw, addr, sizeof(new_psw))) {
312	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
313	goto out;
314	}
315
316	vcpu->arch.sie_block->gpsw.mask = new_psw.mask;
317	vcpu->arch.sie_block->gpsw.addr = new_psw.addr;
318
319	if ((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_UNASSIGNED) \|\|
320	(((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) ==
321	PSW_MASK_BA) &&
322	(vcpu->arch.sie_block->gpsw.addr & ~PSW_ADDR_31)) \|\|
323	(!(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) &&
324	(vcpu->arch.sie_block->gpsw.addr & ~PSW_ADDR_24)) \|\|
325	((vcpu->arch.sie_block->gpsw.mask & PSW_MASK_ADDR_MODE) ==
326	PSW_MASK_EA)) {
327	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
328	goto out;
329	}
330
331	handle_new_psw(vcpu);
332	out:
333	return 0;
334	}
335
453423dc CB	336	static int handle_stidp(struct kvm_vcpu *vcpu)
453423dc CB	337	{
453423dc CB	338	u64 operand2;
	339	int rc;
	340
	341	vcpu->stat.instruction_stidp++;
b1c571a5 CH	342
b1c571a5 CH	343	operand2 = kvm_s390_get_base_disp_s(vcpu);
453423dc CB	344
	345	if (operand2 & 7) {
	346	kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	347	goto out;
	348	}
	349
	350	rc = put_guest_u64(vcpu, operand2, vcpu->arch.stidp_data);
	351	if (rc == -EFAULT) {
	352	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	353	goto out;
	354	}
	355
	356	VCPU_EVENT(vcpu, 5, "%s", "store cpu id");
	357	out:
	358	return 0;
	359	}
	360
	361	static void handle_stsi_3_2_2(struct kvm_vcpu vcpu, struct sysinfo_3_2_2 mem)
	362	{
180c12fb	363	struct kvm_s390_float_interrupt *fi = &vcpu->kvm->arch.float_int;
453423dc CB	364	int cpus = 0;
	365	int n;
	366
b037a4f3	367	spin_lock(&fi->lock);
453423dc CB	368	for (n = 0; n < KVM_MAX_VCPUS; n++)
	369	if (fi->local_int[n])
	370	cpus++;
b037a4f3	371	spin_unlock(&fi->lock);
453423dc CB	372
453423dc CB	373	/* deal with other level 3 hypervisors */
caf757c6	374	if (stsi(mem, 3, 2, 2))
453423dc CB	375	mem->count = 0;
	376	if (mem->count < 8)
	377	mem->count++;
	378	for (n = mem->count - 1; n > 0 ; n--)
	379	memcpy(&mem->vm[n], &mem->vm[n - 1], sizeof(mem->vm[0]));
	380
	381	mem->vm[0].cpus_total = cpus;
	382	mem->vm[0].cpus_configured = cpus;
	383	mem->vm[0].cpus_standby = 0;
	384	mem->vm[0].cpus_reserved = 0;
	385	mem->vm[0].caf = 1000;
	386	memcpy(mem->vm[0].name, "KVMguest", 8);
	387	ASCEBC(mem->vm[0].name, 8);
	388	memcpy(mem->vm[0].cpi, "KVM/Linux ", 16);
	389	ASCEBC(mem->vm[0].cpi, 16);
	390	}
	391
	392	static int handle_stsi(struct kvm_vcpu *vcpu)
	393	{
5a32c1af CB	394	int fc = (vcpu->run->s.regs.gprs[0] & 0xf0000000) >> 28;
	395	int sel1 = vcpu->run->s.regs.gprs[0] & 0xff;
	396	int sel2 = vcpu->run->s.regs.gprs[1] & 0xffff;
453423dc CB	397	u64 operand2;
	398	unsigned long mem;
	399
	400	vcpu->stat.instruction_stsi++;
	401	VCPU_EVENT(vcpu, 4, "stsi: fc: %x sel1: %x sel2: %x", fc, sel1, sel2);
	402
b1c571a5	403	operand2 = kvm_s390_get_base_disp_s(vcpu);
453423dc CB	404
	405	if (operand2 & 0xfff && fc > 0)
	406	return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	407
	408	switch (fc) {
	409	case 0:
5a32c1af	410	vcpu->run->s.regs.gprs[0] = 3 << 28;
453423dc CB	411	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	412	return 0;
	413	case 1: /* same handling for 1 and 2 */
	414	case 2:
	415	mem = get_zeroed_page(GFP_KERNEL);
	416	if (!mem)
	417	goto out_fail;
caf757c6	418	if (stsi((void *) mem, fc, sel1, sel2))
453423dc CB	419	goto out_mem;
	420	break;
	421	case 3:
	422	if (sel1 != 2 \|\| sel2 != 2)
	423	goto out_fail;
	424	mem = get_zeroed_page(GFP_KERNEL);
	425	if (!mem)
	426	goto out_fail;
	427	handle_stsi_3_2_2(vcpu, (void *) mem);
	428	break;
	429	default:
	430	goto out_fail;
	431	}
	432
	433	if (copy_to_guest_absolute(vcpu, operand2, (void *) mem, PAGE_SIZE)) {
	434	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	435	goto out_mem;
	436	}
5786fffa	437	trace_kvm_s390_handle_stsi(vcpu, fc, sel1, sel2, operand2);
453423dc CB	438	free_page(mem);
453423dc CB	439	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
5a32c1af	440	vcpu->run->s.regs.gprs[0] = 0;
453423dc CB	441	return 0;
	442	out_mem:
	443	free_page(mem);
	444	out_fail:
	445	/* condition code 3 */
	446	vcpu->arch.sie_block->gpsw.mask \|= 3ul << 44;
	447	return 0;
	448	}
	449
f379aae5	450	static const intercept_handler_t b2_handlers[256] = {
453423dc CB	451	[0x02] = handle_stidp,
	452	[0x10] = handle_set_prefix,
	453	[0x11] = handle_store_prefix,
	454	[0x12] = handle_store_cpu_address,
	455	[0x29] = handle_skey,
	456	[0x2a] = handle_skey,
	457	[0x2b] = handle_skey,
f379aae5 CH	458	[0x30] = handle_io_inst,
	459	[0x31] = handle_io_inst,
	460	[0x32] = handle_io_inst,
	461	[0x33] = handle_io_inst,
	462	[0x34] = handle_io_inst,
	463	[0x35] = handle_io_inst,
	464	[0x36] = handle_io_inst,
	465	[0x37] = handle_io_inst,
	466	[0x38] = handle_io_inst,
	467	[0x39] = handle_io_inst,
	468	[0x3a] = handle_io_inst,
	469	[0x3b] = handle_io_inst,
	470	[0x3c] = handle_io_inst,
	471	[0x5f] = handle_io_inst,
	472	[0x74] = handle_io_inst,
	473	[0x76] = handle_io_inst,
453423dc CB	474	[0x7d] = handle_stsi,
453423dc CB	475	[0xb1] = handle_stfl,
48a3e950	476	[0xb2] = handle_lpswe,
453423dc CB	477	};
453423dc CB	478
70455a36	479	int kvm_s390_handle_b2(struct kvm_vcpu *vcpu)
453423dc CB	480	{
	481	intercept_handler_t handler;
	482
70455a36 CB	483	/*
70455a36 CB	484	* a lot of B2 instructions are priviledged. We first check for
25985edc	485	* the privileged ones, that we can handle in the kernel. If the
70455a36 CB	486	* kernel can handle this instruction, we check for the problem
	487	* state bit and (a) handle the instruction or (b) send a code 2
	488	* program check.
	489	* Anything else goes to userspace.*/
f379aae5	490	handler = b2_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
70455a36 CB	491	if (handler) {
	492	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
	493	return kvm_s390_inject_program_int(vcpu,
	494	PGM_PRIVILEGED_OPERATION);
	495	else
	496	return handler(vcpu);
	497	}
b8e660b8	498	return -EOPNOTSUPP;
453423dc	499	}
bb25b9ba	500
48a3e950 CH	501	static int handle_epsw(struct kvm_vcpu *vcpu)
	502	{
	503	int reg1, reg2;
	504
	505	reg1 = (vcpu->arch.sie_block->ipb & 0x00f00000) >> 24;
	506	reg2 = (vcpu->arch.sie_block->ipb & 0x000f0000) >> 16;
	507
	508	/* This basically extracts the mask half of the psw. */
	509	vcpu->run->s.regs.gprs[reg1] &= 0xffffffff00000000;
	510	vcpu->run->s.regs.gprs[reg1] \|= vcpu->arch.sie_block->gpsw.mask >> 32;
	511	if (reg2) {
	512	vcpu->run->s.regs.gprs[reg2] &= 0xffffffff00000000;
	513	vcpu->run->s.regs.gprs[reg2] \|=
	514	vcpu->arch.sie_block->gpsw.mask & 0x00000000ffffffff;
	515	}
	516	return 0;
	517	}
	518
	519	static const intercept_handler_t b9_handlers[256] = {
	520	[0x8d] = handle_epsw,
f379aae5	521	[0x9c] = handle_io_inst,
48a3e950 CH	522	};
	523
	524	int kvm_s390_handle_b9(struct kvm_vcpu *vcpu)
	525	{
	526	intercept_handler_t handler;
	527
	528	/* This is handled just as for the B2 instructions. */
	529	handler = b9_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
	530	if (handler) {
	531	if ((handler != handle_epsw) &&
	532	(vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE))
	533	return kvm_s390_inject_program_int(vcpu,
	534	PGM_PRIVILEGED_OPERATION);
	535	else
	536	return handler(vcpu);
	537	}
	538	return -EOPNOTSUPP;
	539	}
	540
f379aae5 CH	541	static const intercept_handler_t eb_handlers[256] = {
	542	[0x8a] = handle_io_inst,
	543	};
	544
	545	int kvm_s390_handle_priv_eb(struct kvm_vcpu *vcpu)
	546	{
	547	intercept_handler_t handler;
	548
	549	/* All eb instructions that end up here are privileged. */
	550	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
	551	return kvm_s390_inject_program_int(vcpu,
	552	PGM_PRIVILEGED_OPERATION);
	553	handler = eb_handlers[vcpu->arch.sie_block->ipb & 0xff];
	554	if (handler)
	555	return handler(vcpu);
	556	return -EOPNOTSUPP;
	557	}
	558
bb25b9ba CB	559	static int handle_tprot(struct kvm_vcpu *vcpu)
bb25b9ba CB	560	{
b1c571a5	561	u64 address1, address2;
bb25b9ba	562	struct vm_area_struct *vma;
1eddb85f	563	unsigned long user_address;
bb25b9ba CB	564
	565	vcpu->stat.instruction_tprot++;
	566
b1c571a5 CH	567	kvm_s390_get_base_disp_sse(vcpu, &address1, &address2);
b1c571a5 CH	568
bb25b9ba CB	569	/* we only handle the Linux memory detection case:
	570	* access key == 0
	571	* guest DAT == off
	572	* everything else goes to userspace. */
	573	if (address2 & 0xf0)
	574	return -EOPNOTSUPP;
	575	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_DAT)
	576	return -EOPNOTSUPP;
	577
	578
1eddb85f CB	579	/* we must resolve the address without holding the mmap semaphore.
	580	* This is ok since the userspace hypervisor is not supposed to change
	581	* the mapping while the guest queries the memory. Otherwise the guest
	582	* might crash or get wrong info anyway. */
	583	user_address = (unsigned long) __guestaddr_to_user(vcpu, address1);
	584
bb25b9ba	585	down_read(&current->mm->mmap_sem);
1eddb85f	586	vma = find_vma(current->mm, user_address);
bb25b9ba CB	587	if (!vma) {
	588	up_read(&current->mm->mmap_sem);
	589	return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	590	}
	591
	592	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	593	if (!(vma->vm_flags & VM_WRITE) && (vma->vm_flags & VM_READ))
	594	vcpu->arch.sie_block->gpsw.mask \|= (1ul << 44);
	595	if (!(vma->vm_flags & VM_WRITE) && !(vma->vm_flags & VM_READ))
	596	vcpu->arch.sie_block->gpsw.mask \|= (2ul << 44);
	597
	598	up_read(&current->mm->mmap_sem);
	599	return 0;
	600	}
	601
	602	int kvm_s390_handle_e5(struct kvm_vcpu *vcpu)
	603	{
	604	/* For e5xx... instructions we only handle TPROT */
	605	if ((vcpu->arch.sie_block->ipa & 0x00ff) == 0x01)
	606	return handle_tprot(vcpu);
	607	return -EOPNOTSUPP;
	608	}
	609
8c3f61e2 CH	610	static int handle_sckpf(struct kvm_vcpu *vcpu)
	611	{
	612	u32 value;
	613
	614	if (vcpu->arch.sie_block->gpsw.mask & PSW_MASK_PSTATE)
	615	return kvm_s390_inject_program_int(vcpu,
	616	PGM_PRIVILEGED_OPERATION);
	617
	618	if (vcpu->run->s.regs.gprs[0] & 0x00000000ffff0000)
	619	return kvm_s390_inject_program_int(vcpu,
	620	PGM_SPECIFICATION);
	621
	622	value = vcpu->run->s.regs.gprs[0] & 0x000000000000ffff;
	623	vcpu->arch.sie_block->todpr = value;
	624
	625	return 0;
	626	}
	627
77975357	628	static const intercept_handler_t x01_handlers[256] = {
8c3f61e2 CH	629	[0x07] = handle_sckpf,
	630	};
	631
	632	int kvm_s390_handle_01(struct kvm_vcpu *vcpu)
	633	{
	634	intercept_handler_t handler;
	635
	636	handler = x01_handlers[vcpu->arch.sie_block->ipa & 0x00ff];
	637	if (handler)
	638	return handler(vcpu);
	639	return -EOPNOTSUPP;
	640	}