[mirror_ubuntu-bionic-kernel.git] / arch / s390 / kvm / intercept.c

/*
 * intercept.c - in-kernel handling for sie intercepts
 *
 * Copyright IBM Corp. 2008,2009
 *
 * 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_host.h>
#include <linux/errno.h>
#include <linux/pagemap.h>

#include <asm/kvm_host.h>

#include "kvm-s390.h"
#include "gaccess.h"

static int handle_lctlg(struct kvm_vcpu *vcpu)
{
	int reg1 = (vcpu->arch.sie_block->ipa & 0x00f0) >> 4;
	int reg3 = vcpu->arch.sie_block->ipa & 0x000f;
	int base2 = vcpu->arch.sie_block->ipb >> 28;
	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16) +
			((vcpu->arch.sie_block->ipb & 0xff00) << 4);
	u64 useraddr;
	int reg, rc;

	vcpu->stat.instruction_lctlg++;
	if ((vcpu->arch.sie_block->ipb & 0xff) != 0x2f)
		return -ENOTSUPP;

	useraddr = disp2;
	if (base2)
		useraddr += vcpu->arch.guest_gprs[base2];

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

	reg = reg1;

	VCPU_EVENT(vcpu, 5, "lctlg r1:%x, r3:%x,b2:%x,d2:%x", reg1, reg3, base2,
		   disp2);

	do {
		rc = get_guest_u64(vcpu, useraddr,
				   &vcpu->arch.sie_block->gcr[reg]);
		if (rc == -EFAULT) {
			kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
			break;
		}
		useraddr += 8;
		if (reg == reg3)
			break;
		reg = (reg + 1) % 16;
	} while (1);
	return 0;
}

static int handle_lctl(struct kvm_vcpu *vcpu)
{
	int reg1 = (vcpu->arch.sie_block->ipa & 0x00f0) >> 4;
	int reg3 = vcpu->arch.sie_block->ipa & 0x000f;
	int base2 = vcpu->arch.sie_block->ipb >> 28;
	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	u64 useraddr;
	u32 val = 0;
	int reg, rc;

	vcpu->stat.instruction_lctl++;

	useraddr = disp2;
	if (base2)
		useraddr += vcpu->arch.guest_gprs[base2];

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

	VCPU_EVENT(vcpu, 5, "lctl r1:%x, r3:%x,b2:%x,d2:%x", reg1, reg3, base2,
		   disp2);

	reg = reg1;
	do {
		rc = get_guest_u32(vcpu, useraddr, &val);
		if (rc == -EFAULT) {
			kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
			break;
		}
		vcpu->arch.sie_block->gcr[reg] &= 0xffffffff00000000ul;
		vcpu->arch.sie_block->gcr[reg] |= val;
		useraddr += 4;
		if (reg == reg3)
			break;
		reg = (reg + 1) % 16;
	} while (1);
	return 0;
}

static intercept_handler_t instruction_handlers[256] = {
	[0x83] = kvm_s390_handle_diag,
	[0xae] = kvm_s390_handle_sigp,
	[0xb2] = kvm_s390_handle_b2,
	[0xb7] = handle_lctl,
	[0xeb] = handle_lctlg,
};

static int handle_noop(struct kvm_vcpu *vcpu)
{
	switch (vcpu->arch.sie_block->icptcode) {
	case 0x0:
		vcpu->stat.exit_null++;
		break;
	case 0x10:
		vcpu->stat.exit_external_request++;
		break;
	case 0x14:
		vcpu->stat.exit_external_interrupt++;
		break;
	default:
		break; /* nothing */
	}
	return 0;
}

static int handle_stop(struct kvm_vcpu *vcpu)
{
	int rc = 0;

	vcpu->stat.exit_stop_request++;
	atomic_clear_mask(CPUSTAT_RUNNING, &vcpu->arch.sie_block->cpuflags);
	spin_lock_bh(&vcpu->arch.local_int.lock);
	if (vcpu->arch.local_int.action_bits & ACTION_STORE_ON_STOP) {
		vcpu->arch.local_int.action_bits &= ~ACTION_STORE_ON_STOP;
		rc = __kvm_s390_vcpu_store_status(vcpu,
						  KVM_S390_STORE_STATUS_NOADDR);
		if (rc >= 0)
			rc = -ENOTSUPP;
	}

	if (vcpu->arch.local_int.action_bits & ACTION_RELOADVCPU_ON_STOP) {
		vcpu->arch.local_int.action_bits &= ~ACTION_RELOADVCPU_ON_STOP;
		rc = SIE_INTERCEPT_RERUNVCPU;
		vcpu->run->exit_reason = KVM_EXIT_INTR;
	}

	if (vcpu->arch.local_int.action_bits & ACTION_STOP_ON_STOP) {
		vcpu->arch.local_int.action_bits &= ~ACTION_STOP_ON_STOP;
		VCPU_EVENT(vcpu, 3, "%s", "cpu stopped");
		rc = -ENOTSUPP;
	}

	spin_unlock_bh(&vcpu->arch.local_int.lock);
	return rc;
}

static int handle_validity(struct kvm_vcpu *vcpu)
{
	int viwhy = vcpu->arch.sie_block->ipb >> 16;
	int rc;

	vcpu->stat.exit_validity++;
	if ((viwhy == 0x37) && (vcpu->arch.sie_block->prefix
		<= kvm_s390_vcpu_get_memsize(vcpu) - 2*PAGE_SIZE)) {
		rc = fault_in_pages_writeable((char __user *)
			 vcpu->arch.sie_block->gmsor +
			 vcpu->arch.sie_block->prefix,
			 2*PAGE_SIZE);
		if (rc)
			/* user will receive sigsegv, exit to user */
			rc = -ENOTSUPP;
	} else
		rc = -ENOTSUPP;

	if (rc)
		VCPU_EVENT(vcpu, 2, "unhandled validity intercept code %d",
			   viwhy);
	return rc;
}

static int handle_instruction(struct kvm_vcpu *vcpu)
{
	intercept_handler_t handler;

	vcpu->stat.exit_instruction++;
	handler = instruction_handlers[vcpu->arch.sie_block->ipa >> 8];
	if (handler)
		return handler(vcpu);
	return -ENOTSUPP;
}

static int handle_prog(struct kvm_vcpu *vcpu)
{
	vcpu->stat.exit_program_interruption++;
	return kvm_s390_inject_program_int(vcpu, vcpu->arch.sie_block->iprcc);
}

static int handle_instruction_and_prog(struct kvm_vcpu *vcpu)
{
	int rc, rc2;

	vcpu->stat.exit_instr_and_program++;
	rc = handle_instruction(vcpu);
	rc2 = handle_prog(vcpu);

	if (rc == -ENOTSUPP)
		vcpu->arch.sie_block->icptcode = 0x04;
	if (rc)
		return rc;
	return rc2;
}

static const intercept_handler_t intercept_funcs[] = {
	[0x00 >> 2] = handle_noop,
	[0x04 >> 2] = handle_instruction,
	[0x08 >> 2] = handle_prog,
	[0x0C >> 2] = handle_instruction_and_prog,
	[0x10 >> 2] = handle_noop,
	[0x14 >> 2] = handle_noop,
	[0x1C >> 2] = kvm_s390_handle_wait,
	[0x20 >> 2] = handle_validity,
	[0x28 >> 2] = handle_stop,
};

int kvm_handle_sie_intercept(struct kvm_vcpu *vcpu)
{
	intercept_handler_t func;
	u8 code = vcpu->arch.sie_block->icptcode;

	if (code & 3 || (code >> 2) >= ARRAY_SIZE(intercept_funcs))
		return -ENOTSUPP;
	func = intercept_funcs[code >> 2];
	if (func)
		return func(vcpu);
	return -ENOTSUPP;
}
Commit	Line	Data
8f2abe6a CB	1	/*
	2	* intercept.c - in-kernel handling for sie intercepts
	3	*
628eb9b8	4	* Copyright IBM Corp. 2008,2009
8f2abe6a CB	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_host.h>
	15	#include <linux/errno.h>
	16	#include <linux/pagemap.h>
	17
	18	#include <asm/kvm_host.h>
	19
	20	#include "kvm-s390.h"
ba5c1e9b CO	21	#include "gaccess.h"
ba5c1e9b CO	22
f5e10b09	23	static int handle_lctlg(struct kvm_vcpu *vcpu)
ba5c1e9b CO	24	{
	25	int reg1 = (vcpu->arch.sie_block->ipa & 0x00f0) >> 4;
	26	int reg3 = vcpu->arch.sie_block->ipa & 0x000f;
	27	int base2 = vcpu->arch.sie_block->ipb >> 28;
	28	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16) +
	29	((vcpu->arch.sie_block->ipb & 0xff00) << 4);
	30	u64 useraddr;
	31	int reg, rc;
	32
f5e10b09	33	vcpu->stat.instruction_lctlg++;
ba5c1e9b CO	34	if ((vcpu->arch.sie_block->ipb & 0xff) != 0x2f)
	35	return -ENOTSUPP;
	36
	37	useraddr = disp2;
	38	if (base2)
	39	useraddr += vcpu->arch.guest_gprs[base2];
	40
5a00a5e7 CB	41	if (useraddr & 7)
	42	return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	43
ba5c1e9b CO	44	reg = reg1;
ba5c1e9b CO	45
f5e10b09	46	VCPU_EVENT(vcpu, 5, "lctlg r1:%x, r3:%x,b2:%x,d2:%x", reg1, reg3, base2,
ba5c1e9b CO	47	disp2);
	48
	49	do {
	50	rc = get_guest_u64(vcpu, useraddr,
	51	&vcpu->arch.sie_block->gcr[reg]);
	52	if (rc == -EFAULT) {
	53	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	54	break;
	55	}
	56	useraddr += 8;
	57	if (reg == reg3)
	58	break;
	59	reg = (reg + 1) % 16;
	60	} while (1);
	61	return 0;
	62	}
	63
	64	static int handle_lctl(struct kvm_vcpu *vcpu)
	65	{
	66	int reg1 = (vcpu->arch.sie_block->ipa & 0x00f0) >> 4;
	67	int reg3 = vcpu->arch.sie_block->ipa & 0x000f;
	68	int base2 = vcpu->arch.sie_block->ipb >> 28;
	69	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	70	u64 useraddr;
	71	u32 val = 0;
	72	int reg, rc;
	73
	74	vcpu->stat.instruction_lctl++;
	75
	76	useraddr = disp2;
	77	if (base2)
	78	useraddr += vcpu->arch.guest_gprs[base2];
	79
5a00a5e7 CB	80	if (useraddr & 3)
	81	return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	82
ba5c1e9b CO	83	VCPU_EVENT(vcpu, 5, "lctl r1:%x, r3:%x,b2:%x,d2:%x", reg1, reg3, base2,
	84	disp2);
	85
	86	reg = reg1;
	87	do {
	88	rc = get_guest_u32(vcpu, useraddr, &val);
	89	if (rc == -EFAULT) {
	90	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	91	break;
	92	}
	93	vcpu->arch.sie_block->gcr[reg] &= 0xffffffff00000000ul;
	94	vcpu->arch.sie_block->gcr[reg] \|= val;
	95	useraddr += 4;
	96	if (reg == reg3)
	97	break;
	98	reg = (reg + 1) % 16;
	99	} while (1);
	100	return 0;
	101	}
	102
	103	static intercept_handler_t instruction_handlers[256] = {
e28acfea	104	[0x83] = kvm_s390_handle_diag,
5288fbf0	105	[0xae] = kvm_s390_handle_sigp,
70455a36	106	[0xb2] = kvm_s390_handle_b2,
ba5c1e9b	107	[0xb7] = handle_lctl,
f5e10b09	108	[0xeb] = handle_lctlg,
ba5c1e9b	109	};
8f2abe6a CB	110
	111	static int handle_noop(struct kvm_vcpu *vcpu)
	112	{
	113	switch (vcpu->arch.sie_block->icptcode) {
0eaeafa1 CB	114	case 0x0:
	115	vcpu->stat.exit_null++;
	116	break;
8f2abe6a CB	117	case 0x10:
	118	vcpu->stat.exit_external_request++;
	119	break;
	120	case 0x14:
	121	vcpu->stat.exit_external_interrupt++;
	122	break;
	123	default:
	124	break; /* nothing */
	125	}
	126	return 0;
	127	}
	128
	129	static int handle_stop(struct kvm_vcpu *vcpu)
	130	{
9ace903d	131	int rc = 0;
5288fbf0	132
8f2abe6a	133	vcpu->stat.exit_stop_request++;
8f2abe6a	134	atomic_clear_mask(CPUSTAT_RUNNING, &vcpu->arch.sie_block->cpuflags);
5288fbf0 CB	135	spin_lock_bh(&vcpu->arch.local_int.lock);
	136	if (vcpu->arch.local_int.action_bits & ACTION_STORE_ON_STOP) {
	137	vcpu->arch.local_int.action_bits &= ~ACTION_STORE_ON_STOP;
	138	rc = __kvm_s390_vcpu_store_status(vcpu,
	139	KVM_S390_STORE_STATUS_NOADDR);
	140	if (rc >= 0)
	141	rc = -ENOTSUPP;
	142	}
	143
9ace903d CE	144	if (vcpu->arch.local_int.action_bits & ACTION_RELOADVCPU_ON_STOP) {
	145	vcpu->arch.local_int.action_bits &= ~ACTION_RELOADVCPU_ON_STOP;
	146	rc = SIE_INTERCEPT_RERUNVCPU;
	147	vcpu->run->exit_reason = KVM_EXIT_INTR;
	148	}
	149
5288fbf0 CB	150	if (vcpu->arch.local_int.action_bits & ACTION_STOP_ON_STOP) {
	151	vcpu->arch.local_int.action_bits &= ~ACTION_STOP_ON_STOP;
	152	VCPU_EVENT(vcpu, 3, "%s", "cpu stopped");
	153	rc = -ENOTSUPP;
9ace903d CE	154	}
9ace903d CE	155
5288fbf0 CB	156	spin_unlock_bh(&vcpu->arch.local_int.lock);
5288fbf0 CB	157	return rc;
8f2abe6a CB	158	}
	159
	160	static int handle_validity(struct kvm_vcpu *vcpu)
	161	{
	162	int viwhy = vcpu->arch.sie_block->ipb >> 16;
3edbcff9 CO	163	int rc;
3edbcff9 CO	164
8f2abe6a	165	vcpu->stat.exit_validity++;
3edbcff9	166	if ((viwhy == 0x37) && (vcpu->arch.sie_block->prefix
628eb9b8	167	<= kvm_s390_vcpu_get_memsize(vcpu) - 2*PAGE_SIZE)) {
3edbcff9	168	rc = fault_in_pages_writeable((char __user *)
628eb9b8	169	vcpu->arch.sie_block->gmsor +
3edbcff9 CO	170	vcpu->arch.sie_block->prefix,
	171	2*PAGE_SIZE);
	172	if (rc)
	173	/* user will receive sigsegv, exit to user */
	174	rc = -ENOTSUPP;
	175	} else
	176	rc = -ENOTSUPP;
	177
	178	if (rc)
	179	VCPU_EVENT(vcpu, 2, "unhandled validity intercept code %d",
	180	viwhy);
	181	return rc;
8f2abe6a CB	182	}
8f2abe6a CB	183
ba5c1e9b CO	184	static int handle_instruction(struct kvm_vcpu *vcpu)
	185	{
	186	intercept_handler_t handler;
	187
	188	vcpu->stat.exit_instruction++;
	189	handler = instruction_handlers[vcpu->arch.sie_block->ipa >> 8];
	190	if (handler)
	191	return handler(vcpu);
	192	return -ENOTSUPP;
	193	}
	194
	195	static int handle_prog(struct kvm_vcpu *vcpu)
	196	{
	197	vcpu->stat.exit_program_interruption++;
	198	return kvm_s390_inject_program_int(vcpu, vcpu->arch.sie_block->iprcc);
	199	}
	200
	201	static int handle_instruction_and_prog(struct kvm_vcpu *vcpu)
	202	{
	203	int rc, rc2;
	204
	205	vcpu->stat.exit_instr_and_program++;
	206	rc = handle_instruction(vcpu);
	207	rc2 = handle_prog(vcpu);
	208
	209	if (rc == -ENOTSUPP)
	210	vcpu->arch.sie_block->icptcode = 0x04;
	211	if (rc)
	212	return rc;
	213	return rc2;
	214	}
	215
062d5e9b	216	static const intercept_handler_t intercept_funcs[] = {
8f2abe6a	217	[0x00 >> 2] = handle_noop,
ba5c1e9b CO	218	[0x04 >> 2] = handle_instruction,
	219	[0x08 >> 2] = handle_prog,
	220	[0x0C >> 2] = handle_instruction_and_prog,
8f2abe6a CB	221	[0x10 >> 2] = handle_noop,
8f2abe6a CB	222	[0x14 >> 2] = handle_noop,
ba5c1e9b	223	[0x1C >> 2] = kvm_s390_handle_wait,
8f2abe6a CB	224	[0x20 >> 2] = handle_validity,
	225	[0x28 >> 2] = handle_stop,
	226	};
	227
	228	int kvm_handle_sie_intercept(struct kvm_vcpu *vcpu)
	229	{
	230	intercept_handler_t func;
	231	u8 code = vcpu->arch.sie_block->icptcode;
	232
062d5e9b	233	if (code & 3 \|\| (code >> 2) >= ARRAY_SIZE(intercept_funcs))
8f2abe6a CB	234	return -ENOTSUPP;
	235	func = intercept_funcs[code >> 2];
	236	if (func)
	237	return func(vcpu);
	238	return -ENOTSUPP;
	239	}