[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/asm-offsets.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(vcpu, address, (u32 __user *) operand2)) {
		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(vcpu, address, (u32 __user *)operand2)) {
		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(vcpu, vcpu->vcpu_id, (u16 __user *)useraddr);
	if (rc) {
		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)
{
	struct kvm_s390_interrupt_info *inti;
	u64 addr;
	int cc;

	addr = kvm_s390_get_base_disp_s(vcpu);
	if (addr & 3) {
		kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
		goto out;
	}
	cc = 0;
	inti = kvm_s390_get_io_int(vcpu->kvm, vcpu->run->s.regs.crs[6], 0);
	if (!inti)
		goto no_interrupt;
	cc = 1;
	if (addr) {
		/*
		 * Store the two-word I/O interruption code into the
		 * provided area.
		 */
		put_guest(vcpu, inti->io.subchannel_id, (u16 __user *) addr);
		put_guest(vcpu, inti->io.subchannel_nr, (u16 __user *) (addr + 2));
		put_guest(vcpu, inti->io.io_int_parm, (u32 __user *) (addr + 4));
	} else {
		/*
		 * Store the three-word I/O interruption code into
		 * the appropriate lowcore area.
		 */
		put_guest(vcpu, inti->io.subchannel_id, (u16 __user *) __LC_SUBCHANNEL_ID);
		put_guest(vcpu, inti->io.subchannel_nr, (u16 __user *) __LC_SUBCHANNEL_NR);
		put_guest(vcpu, inti->io.io_int_parm, (u32 __user *) __LC_IO_INT_PARM);
		put_guest(vcpu, inti->io.io_int_word, (u32 __user *) __LC_IO_INT_WORD);
	}
	kfree(inti);
no_interrupt:
	/* Set condition code and we're done. */
	vcpu->arch.sie_block->gpsw.mask &= ~(3ul << 44);
	vcpu->arch.sie_block->gpsw.mask |= (cc & 3ul) << 44;
out:
	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)
		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 0x0000000000ffffffUL
#define PSW_ADDR_31 0x000000007fffffffUL

static int is_valid_psw(psw_t *psw) {
	if (psw->mask & PSW_MASK_UNASSIGNED)
		return 0;
	if ((psw->mask & PSW_MASK_ADDR_MODE) == PSW_MASK_BA) {
		if (psw->addr & ~PSW_ADDR_31)
			return 0;
	}
	if (!(psw->mask & PSW_MASK_ADDR_MODE) && (psw->addr & ~PSW_ADDR_24))
		return 0;
	if ((psw->mask & PSW_MASK_ADDR_MODE) ==  PSW_MASK_EA)
		return 0;
	return 1;
}

int kvm_s390_handle_lpsw(struct kvm_vcpu *vcpu)
{
	psw_t *gpsw = &vcpu->arch.sie_block->gpsw;
	psw_compat_t new_psw;
	u64 addr;

	if (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)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	if (copy_from_guest(vcpu, &new_psw, addr, sizeof(new_psw)))
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	if (!(new_psw.mask & PSW32_MASK_BASE))
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	gpsw->mask = (new_psw.mask & ~PSW32_MASK_BASE) << 32;
	gpsw->mask |= new_psw.addr & PSW32_ADDR_AMODE;
	gpsw->addr = new_psw.addr & ~PSW32_ADDR_AMODE;
	if (!is_valid_psw(gpsw))
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	handle_new_psw(vcpu);
	return 0;
}

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

	addr = kvm_s390_get_base_disp_s(vcpu);
	if (addr & 7)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	if (copy_from_guest(vcpu, &new_psw, addr, sizeof(new_psw)))
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	vcpu->arch.sie_block->gpsw = new_psw;
	if (!is_valid_psw(&vcpu->arch.sie_block->gpsw))
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	handle_new_psw(vcpu);
	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(vcpu, vcpu->arch.stidp_data, (u64 __user *)operand2);
	if (rc) {
		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;

	down_read(&current->mm->mmap_sem);
	user_address = __gmap_translate(address1, vcpu->arch.gmap);
	if (IS_ERR_VALUE(user_address))
		goto out_inject;
	vma = find_vma(current->mm, user_address);
	if (!vma)
		goto out_inject;
	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;

out_inject:
	up_read(&current->mm->mmap_sem);
	return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
}

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