[mirror_ubuntu-zesty-kernel.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 <linux/compat.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)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);

	/* get the value */
	if (get_guest(vcpu, address, (u32 __user *) operand2))
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);

	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)))
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);

	kvm_s390_set_prefix(vcpu, address);

	VCPU_EVENT(vcpu, 5, "setting prefix to %x", address);
	trace_kvm_s390_handle_prefix(vcpu, 1, address);
	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)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);

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

	/* get the value */
	if (put_guest(vcpu, address, (u32 __user *)operand2))
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);

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

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

	vcpu->stat.instruction_stap++;

	useraddr = kvm_s390_get_base_disp_s(vcpu);

	if (useraddr & 1)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);

	if (put_guest(vcpu, vcpu->vcpu_id, (u16 __user *)useraddr))
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);

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

static int handle_skey(struct kvm_vcpu *vcpu)
{
	vcpu->stat.instruction_storage_key++;
	vcpu->arch.sie_block->gpsw.addr =
		__rewind_psw(vcpu->arch.sie_block->gpsw, 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)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	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;
	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)
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	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;

	vcpu->stat.instruction_stidp++;

	operand2 = kvm_s390_get_base_disp_s(vcpu);

	if (operand2 & 7)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);

	if (put_guest(vcpu, vcpu->arch.stidp_data, (u64 __user *)operand2))
		return kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);

	VCPU_EVENT(vcpu, 5, "%s", "store cpu id");
	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;
	unsigned long mem = 0;
	u64 operand2;
	int rc = 0;

	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_no_data;
		if (stsi((void *) mem, fc, sel1, sel2))
			goto out_no_data;
		break;
	case 3:
		if (sel1 != 2 || sel2 != 2)
			goto out_no_data;
		mem = get_zeroed_page(GFP_KERNEL);
		if (!mem)
			goto out_no_data;
		handle_stsi_3_2_2(vcpu, (void *) mem);
		break;
	default:
		goto out_no_data;
	}

	if (copy_to_guest_absolute(vcpu, operand2, (void *) mem, PAGE_SIZE)) {
		rc = kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
		goto out_exception;
	}
	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_no_data:
	/* condition code 3 */
	vcpu->arch.sie_block->gpsw.mask |= 3ul << 44;
out_exception:
	free_page(mem);
	return rc;
}

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