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

/*
 * intercept.c - in-kernel handling for sie intercepts
 *
 * 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_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_lctg(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_lctg++;
	if ((vcpu->arch.sie_block->ipb & 0xff) != 0x2f)
		return -ENOTSUPP;

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

	reg = reg1;

	VCPU_EVENT(vcpu, 5, "lctg 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];

	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] = {
	[0xb7] = handle_lctl,
	[0xeb] = handle_lctg,
};

static int handle_noop(struct kvm_vcpu *vcpu)
{
	switch (vcpu->arch.sie_block->icptcode) {
	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)
{
	vcpu->stat.exit_stop_request++;
	VCPU_EVENT(vcpu, 3, "%s", "cpu stopped");
	atomic_clear_mask(CPUSTAT_RUNNING, &vcpu->arch.sie_block->cpuflags);
	return -ENOTSUPP;
}

static int handle_validity(struct kvm_vcpu *vcpu)
{
	int viwhy = vcpu->arch.sie_block->ipb >> 16;
	vcpu->stat.exit_validity++;
	if (viwhy == 0x37) {
		fault_in_pages_writeable((char __user *)
					 vcpu->kvm->arch.guest_origin +
					 vcpu->arch.sie_block->prefix,
					 PAGE_SIZE);
		return 0;
	}
	VCPU_EVENT(vcpu, 2, "unhandled validity intercept code %d",
		   viwhy);
	return -ENOTSUPP;
}

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[0x48 >> 2] = {
	[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 > 0x48)
		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	*
	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_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"
	22
	23	static int handle_lctg(struct kvm_vcpu *vcpu)
	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
	33	vcpu->stat.instruction_lctg++;
	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
	41	reg = reg1;
	42
	43	VCPU_EVENT(vcpu, 5, "lctg r1:%x, r3:%x,b2:%x,d2:%x", reg1, reg3, base2,
	44	disp2);
	45
	46	do {
	47	rc = get_guest_u64(vcpu, useraddr,
	48	&vcpu->arch.sie_block->gcr[reg]);
	49	if (rc == -EFAULT) {
	50	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
	51	break;
	52	}
	53	useraddr += 8;
	54	if (reg == reg3)
	55	break;
	56	reg = (reg + 1) % 16;
	57	} while (1);
	58	return 0;
	59	}
	60
	61	static int handle_lctl(struct kvm_vcpu *vcpu)
	62	{
	63	int reg1 = (vcpu->arch.sie_block->ipa & 0x00f0) >> 4;
	64	int reg3 = vcpu->arch.sie_block->ipa & 0x000f;
	65	int base2 = vcpu->arch.sie_block->ipb >> 28;
	66	int disp2 = ((vcpu->arch.sie_block->ipb & 0x0fff0000) >> 16);
	67	u64 useraddr;
	68	u32 val = 0;
	69	int reg, rc;
	70
	71	vcpu->stat.instruction_lctl++;
	72
	73	useraddr = disp2;
	74	if (base2)
	75	useraddr += vcpu->arch.guest_gprs[base2];
	76
	77	VCPU_EVENT(vcpu, 5, "lctl r1:%x, r3:%x,b2:%x,d2:%x", reg1, reg3, base2,
	78	disp2);
	79
	80	reg = reg1;
	81	do {
	82	rc = get_guest_u32(vcpu, useraddr, &val);
	83	if (rc == -EFAULT) {
	84	kvm_s390_inject_program_int(vcpu, PGM_ADDRESSING);
85	break;
86	}
87	vcpu->arch.sie_block->gcr[reg] &= 0xffffffff00000000ul;
88	vcpu->arch.sie_block->gcr[reg] \|= val;
89	useraddr += 4;
90	if (reg == reg3)
91	break;
92	reg = (reg + 1) % 16;
93	} while (1);
94	return 0;
95	}
96
97	static intercept_handler_t instruction_handlers[256] = {
98	[0xb7] = handle_lctl,
99	[0xeb] = handle_lctg,
100	};
8f2abe6a CB	101
	102	static int handle_noop(struct kvm_vcpu *vcpu)
	103	{
	104	switch (vcpu->arch.sie_block->icptcode) {
	105	case 0x10:
	106	vcpu->stat.exit_external_request++;
	107	break;
	108	case 0x14:
	109	vcpu->stat.exit_external_interrupt++;
	110	break;
	111	default:
	112	break; /* nothing */
	113	}
	114	return 0;
	115	}
	116
	117	static int handle_stop(struct kvm_vcpu *vcpu)
	118	{
	119	vcpu->stat.exit_stop_request++;
	120	VCPU_EVENT(vcpu, 3, "%s", "cpu stopped");
	121	atomic_clear_mask(CPUSTAT_RUNNING, &vcpu->arch.sie_block->cpuflags);
	122	return -ENOTSUPP;
	123	}
	124
	125	static int handle_validity(struct kvm_vcpu *vcpu)
	126	{
	127	int viwhy = vcpu->arch.sie_block->ipb >> 16;
	128	vcpu->stat.exit_validity++;
	129	if (viwhy == 0x37) {
	130	fault_in_pages_writeable((char __user *)
	131	vcpu->kvm->arch.guest_origin +
	132	vcpu->arch.sie_block->prefix,
	133	PAGE_SIZE);
	134	return 0;
	135	}
	136	VCPU_EVENT(vcpu, 2, "unhandled validity intercept code %d",
	137	viwhy);
	138	return -ENOTSUPP;
	139	}
	140
ba5c1e9b CO	141	static int handle_instruction(struct kvm_vcpu *vcpu)
	142	{
	143	intercept_handler_t handler;
	144
	145	vcpu->stat.exit_instruction++;
	146	handler = instruction_handlers[vcpu->arch.sie_block->ipa >> 8];
	147	if (handler)
	148	return handler(vcpu);
	149	return -ENOTSUPP;
	150	}
	151
	152	static int handle_prog(struct kvm_vcpu *vcpu)
	153	{
	154	vcpu->stat.exit_program_interruption++;
	155	return kvm_s390_inject_program_int(vcpu, vcpu->arch.sie_block->iprcc);
	156	}
	157
	158	static int handle_instruction_and_prog(struct kvm_vcpu *vcpu)
	159	{
	160	int rc, rc2;
	161
	162	vcpu->stat.exit_instr_and_program++;
	163	rc = handle_instruction(vcpu);
	164	rc2 = handle_prog(vcpu);
	165
	166	if (rc == -ENOTSUPP)
	167	vcpu->arch.sie_block->icptcode = 0x04;
	168	if (rc)
	169	return rc;
	170	return rc2;
	171	}
	172
8f2abe6a CB	173	static const intercept_handler_t intercept_funcs[0x48 >> 2] = {
8f2abe6a CB	174	[0x00 >> 2] = handle_noop,
ba5c1e9b CO	175	[0x04 >> 2] = handle_instruction,
	176	[0x08 >> 2] = handle_prog,
	177	[0x0C >> 2] = handle_instruction_and_prog,
8f2abe6a CB	178	[0x10 >> 2] = handle_noop,
8f2abe6a CB	179	[0x14 >> 2] = handle_noop,
ba5c1e9b	180	[0x1C >> 2] = kvm_s390_handle_wait,
8f2abe6a CB	181	[0x20 >> 2] = handle_validity,
	182	[0x28 >> 2] = handle_stop,
	183	};
	184
	185	int kvm_handle_sie_intercept(struct kvm_vcpu *vcpu)
	186	{
	187	intercept_handler_t func;
	188	u8 code = vcpu->arch.sie_block->icptcode;
	189
	190	if (code & 3 \|\| code > 0x48)
	191	return -ENOTSUPP;
	192	func = intercept_funcs[code >> 2];
	193	if (func)
	194	return func(vcpu);
	195	return -ENOTSUPP;
	196	}