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

// SPDX-License-Identifier: GPL-2.0
/*
 * in-kernel handling for sie intercepts
 *
 * Copyright IBM Corp. 2008, 2014
 *
 *    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 <asm/asm-offsets.h>
#include <asm/irq.h>
#include <asm/sysinfo.h>

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


static const intercept_handler_t instruction_handlers[256] = {
	[0x01] = kvm_s390_handle_01,
	[0x82] = kvm_s390_handle_lpsw,
	[0x83] = kvm_s390_handle_diag,
	[0xaa] = kvm_s390_handle_aa,
	[0xae] = kvm_s390_handle_sigp,
	[0xb2] = kvm_s390_handle_b2,
	[0xb6] = kvm_s390_handle_stctl,
	[0xb7] = kvm_s390_handle_lctl,
	[0xb9] = kvm_s390_handle_b9,
	[0xe3] = kvm_s390_handle_e3,
	[0xe5] = kvm_s390_handle_e5,
	[0xeb] = kvm_s390_handle_eb,
};

u8 kvm_s390_get_ilen(struct kvm_vcpu *vcpu)
{
	struct kvm_s390_sie_block *sie_block = vcpu->arch.sie_block;
	u8 ilen = 0;

	switch (vcpu->arch.sie_block->icptcode) {
	case ICPT_INST:
	case ICPT_INSTPROGI:
	case ICPT_OPEREXC:
	case ICPT_PARTEXEC:
	case ICPT_IOINST:
		/* instruction only stored for these icptcodes */
		ilen = insn_length(vcpu->arch.sie_block->ipa >> 8);
		/* Use the length of the EXECUTE instruction if necessary */
		if (sie_block->icptstatus & 1) {
			ilen = (sie_block->icptstatus >> 4) & 0x6;
			if (!ilen)
				ilen = 4;
		}
		break;
	case ICPT_PROGI:
		/* bit 1+2 of pgmilc are the ilc, so we directly get ilen */
		ilen = vcpu->arch.sie_block->pgmilc & 0x6;
		break;
	}
	return ilen;
}

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

static int handle_stop(struct kvm_vcpu *vcpu)
{
	struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
	int rc = 0;
	uint8_t flags, stop_pending;

	vcpu->stat.exit_stop_request++;

	/* delay the stop if any non-stop irq is pending */
	if (kvm_s390_vcpu_has_irq(vcpu, 1))
		return 0;

	/* avoid races with the injection/SIGP STOP code */
	spin_lock(&li->lock);
	flags = li->irq.stop.flags;
	stop_pending = kvm_s390_is_stop_irq_pending(vcpu);
	spin_unlock(&li->lock);

	trace_kvm_s390_stop_request(stop_pending, flags);
	if (!stop_pending)
		return 0;

	if (flags & KVM_S390_STOP_FLAG_STORE_STATUS) {
		rc = kvm_s390_vcpu_store_status(vcpu,
						KVM_S390_STORE_STATUS_NOADDR);
		if (rc)
			return rc;
	}

	if (!kvm_s390_user_cpu_state_ctrl(vcpu->kvm))
		kvm_s390_vcpu_stop(vcpu);
	return -EOPNOTSUPP;
}

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

	vcpu->stat.exit_validity++;
	trace_kvm_s390_intercept_validity(vcpu, viwhy);
	KVM_EVENT(3, "validity intercept 0x%x for pid %u (kvm 0x%pK)", viwhy,
		  current->pid, vcpu->kvm);

	/* do not warn on invalid runtime instrumentation mode */
	WARN_ONCE(viwhy != 0x44, "kvm: unhandled validity intercept 0x%x\n",
		  viwhy);
	return -EINVAL;
}

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

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

static int inject_prog_on_prog_intercept(struct kvm_vcpu *vcpu)
{
	struct kvm_s390_pgm_info pgm_info = {
		.code = vcpu->arch.sie_block->iprcc,
		/* the PSW has already been rewound */
		.flags = KVM_S390_PGM_FLAGS_NO_REWIND,
	};

	switch (vcpu->arch.sie_block->iprcc & ~PGM_PER) {
	case PGM_AFX_TRANSLATION:
	case PGM_ASX_TRANSLATION:
	case PGM_EX_TRANSLATION:
	case PGM_LFX_TRANSLATION:
	case PGM_LSTE_SEQUENCE:
	case PGM_LSX_TRANSLATION:
	case PGM_LX_TRANSLATION:
	case PGM_PRIMARY_AUTHORITY:
	case PGM_SECONDARY_AUTHORITY:
	case PGM_SPACE_SWITCH:
		pgm_info.trans_exc_code = vcpu->arch.sie_block->tecmc;
		break;
	case PGM_ALEN_TRANSLATION:
	case PGM_ALE_SEQUENCE:
	case PGM_ASTE_INSTANCE:
	case PGM_ASTE_SEQUENCE:
	case PGM_ASTE_VALIDITY:
	case PGM_EXTENDED_AUTHORITY:
		pgm_info.exc_access_id = vcpu->arch.sie_block->eai;
		break;
	case PGM_ASCE_TYPE:
	case PGM_PAGE_TRANSLATION:
	case PGM_REGION_FIRST_TRANS:
	case PGM_REGION_SECOND_TRANS:
	case PGM_REGION_THIRD_TRANS:
	case PGM_SEGMENT_TRANSLATION:
		pgm_info.trans_exc_code = vcpu->arch.sie_block->tecmc;
		pgm_info.exc_access_id  = vcpu->arch.sie_block->eai;
		pgm_info.op_access_id  = vcpu->arch.sie_block->oai;
		break;
	case PGM_MONITOR:
		pgm_info.mon_class_nr = vcpu->arch.sie_block->mcn;
		pgm_info.mon_code = vcpu->arch.sie_block->tecmc;
		break;
	case PGM_VECTOR_PROCESSING:
	case PGM_DATA:
		pgm_info.data_exc_code = vcpu->arch.sie_block->dxc;
		break;
	case PGM_PROTECTION:
		pgm_info.trans_exc_code = vcpu->arch.sie_block->tecmc;
		pgm_info.exc_access_id  = vcpu->arch.sie_block->eai;
		break;
	default:
		break;
	}

	if (vcpu->arch.sie_block->iprcc & PGM_PER) {
		pgm_info.per_code = vcpu->arch.sie_block->perc;
		pgm_info.per_atmid = vcpu->arch.sie_block->peratmid;
		pgm_info.per_address = vcpu->arch.sie_block->peraddr;
		pgm_info.per_access_id = vcpu->arch.sie_block->peraid;
	}
	return kvm_s390_inject_prog_irq(vcpu, &pgm_info);
}

/*
 * restore ITDB to program-interruption TDB in guest lowcore
 * and set TX abort indication if required
*/
static int handle_itdb(struct kvm_vcpu *vcpu)
{
	struct kvm_s390_itdb *itdb;
	int rc;

	if (!IS_TE_ENABLED(vcpu) || !IS_ITDB_VALID(vcpu))
		return 0;
	if (current->thread.per_flags & PER_FLAG_NO_TE)
		return 0;
	itdb = (struct kvm_s390_itdb *)vcpu->arch.sie_block->itdba;
	rc = write_guest_lc(vcpu, __LC_PGM_TDB, itdb, sizeof(*itdb));
	if (rc)
		return rc;
	memset(itdb, 0, sizeof(*itdb));

	return 0;
}

#define per_event(vcpu) (vcpu->arch.sie_block->iprcc & PGM_PER)

static int handle_prog(struct kvm_vcpu *vcpu)
{
	psw_t psw;
	int rc;

	vcpu->stat.exit_program_interruption++;

	if (guestdbg_enabled(vcpu) && per_event(vcpu)) {
		rc = kvm_s390_handle_per_event(vcpu);
		if (rc)
			return rc;
		/* the interrupt might have been filtered out completely */
		if (vcpu->arch.sie_block->iprcc == 0)
			return 0;
	}

	trace_kvm_s390_intercept_prog(vcpu, vcpu->arch.sie_block->iprcc);
	if (vcpu->arch.sie_block->iprcc == PGM_SPECIFICATION) {
		rc = read_guest_lc(vcpu, __LC_PGM_NEW_PSW, &psw, sizeof(psw_t));
		if (rc)
			return rc;
		/* Avoid endless loops of specification exceptions */
		if (!is_valid_psw(&psw))
			return -EOPNOTSUPP;
	}
	rc = handle_itdb(vcpu);
	if (rc)
		return rc;

	return inject_prog_on_prog_intercept(vcpu);
}

/**
 * handle_external_interrupt - used for external interruption interceptions
 *
 * This interception only occurs if the CPUSTAT_EXT_INT bit was set, or if
 * the new PSW does not have external interrupts disabled. In the first case,
 * we've got to deliver the interrupt manually, and in the second case, we
 * drop to userspace to handle the situation there.
 */
static int handle_external_interrupt(struct kvm_vcpu *vcpu)
{
	u16 eic = vcpu->arch.sie_block->eic;
	struct kvm_s390_irq irq;
	psw_t newpsw;
	int rc;

	vcpu->stat.exit_external_interrupt++;

	rc = read_guest_lc(vcpu, __LC_EXT_NEW_PSW, &newpsw, sizeof(psw_t));
	if (rc)
		return rc;
	/* We can not handle clock comparator or timer interrupt with bad PSW */
	if ((eic == EXT_IRQ_CLK_COMP || eic == EXT_IRQ_CPU_TIMER) &&
	    (newpsw.mask & PSW_MASK_EXT))
		return -EOPNOTSUPP;

	switch (eic) {
	case EXT_IRQ_CLK_COMP:
		irq.type = KVM_S390_INT_CLOCK_COMP;
		break;
	case EXT_IRQ_CPU_TIMER:
		irq.type = KVM_S390_INT_CPU_TIMER;
		break;
	case EXT_IRQ_EXTERNAL_CALL:
		irq.type = KVM_S390_INT_EXTERNAL_CALL;
		irq.u.extcall.code = vcpu->arch.sie_block->extcpuaddr;
		rc = kvm_s390_inject_vcpu(vcpu, &irq);
		/* ignore if another external call is already pending */
		if (rc == -EBUSY)
			return 0;
		return rc;
	default:
		return -EOPNOTSUPP;
	}

	return kvm_s390_inject_vcpu(vcpu, &irq);
}

/**
 * Handle MOVE PAGE partial execution interception.
 *
 * This interception can only happen for guests with DAT disabled and
 * addresses that are currently not mapped in the host. Thus we try to
 * set up the mappings for the corresponding user pages here (or throw
 * addressing exceptions in case of illegal guest addresses).
 */
static int handle_mvpg_pei(struct kvm_vcpu *vcpu)
{
	unsigned long srcaddr, dstaddr;
	int reg1, reg2, rc;

	kvm_s390_get_regs_rre(vcpu, &reg1, &reg2);

	/* Make sure that the source is paged-in */
	rc = guest_translate_address(vcpu, vcpu->run->s.regs.gprs[reg2],
				     reg2, &srcaddr, GACC_FETCH);
	if (rc)
		return kvm_s390_inject_prog_cond(vcpu, rc);
	rc = kvm_arch_fault_in_page(vcpu, srcaddr, 0);
	if (rc != 0)
		return rc;

	/* Make sure that the destination is paged-in */
	rc = guest_translate_address(vcpu, vcpu->run->s.regs.gprs[reg1],
				     reg1, &dstaddr, GACC_STORE);
	if (rc)
		return kvm_s390_inject_prog_cond(vcpu, rc);
	rc = kvm_arch_fault_in_page(vcpu, dstaddr, 1);
	if (rc != 0)
		return rc;

	kvm_s390_retry_instr(vcpu);

	return 0;
}

static int handle_partial_execution(struct kvm_vcpu *vcpu)
{
	vcpu->stat.exit_pei++;

	if (vcpu->arch.sie_block->ipa == 0xb254)	/* MVPG */
		return handle_mvpg_pei(vcpu);
	if (vcpu->arch.sie_block->ipa >> 8 == 0xae)	/* SIGP */
		return kvm_s390_handle_sigp_pei(vcpu);

	return -EOPNOTSUPP;
}

/*
 * Handle the sthyi instruction that provides the guest with system
 * information, like current CPU resources available at each level of
 * the machine.
 */
int handle_sthyi(struct kvm_vcpu *vcpu)
{
	int reg1, reg2, r = 0;
	u64 code, addr, cc = 0, rc = 0;
	struct sthyi_sctns *sctns = NULL;

	if (!test_kvm_facility(vcpu->kvm, 74))
		return kvm_s390_inject_program_int(vcpu, PGM_OPERATION);

	kvm_s390_get_regs_rre(vcpu, &reg1, &reg2);
	code = vcpu->run->s.regs.gprs[reg1];
	addr = vcpu->run->s.regs.gprs[reg2];

	vcpu->stat.instruction_sthyi++;
	VCPU_EVENT(vcpu, 3, "STHYI: fc: %llu addr: 0x%016llx", code, addr);
	trace_kvm_s390_handle_sthyi(vcpu, code, addr);

	if (reg1 == reg2 || reg1 & 1 || reg2 & 1)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);

	if (code & 0xffff) {
		cc = 3;
		rc = 4;
		goto out;
	}

	if (addr & ~PAGE_MASK)
		return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);

	sctns = (void *)get_zeroed_page(GFP_KERNEL);
	if (!sctns)
		return -ENOMEM;

	cc = sthyi_fill(sctns, &rc);

out:
	if (!cc) {
		r = write_guest(vcpu, addr, reg2, sctns, PAGE_SIZE);
		if (r) {
			free_page((unsigned long)sctns);
			return kvm_s390_inject_prog_cond(vcpu, r);
		}
	}

	free_page((unsigned long)sctns);
	vcpu->run->s.regs.gprs[reg2 + 1] = rc;
	kvm_s390_set_psw_cc(vcpu, cc);
	return r;
}

static int handle_operexc(struct kvm_vcpu *vcpu)
{
	psw_t oldpsw, newpsw;
	int rc;

	vcpu->stat.exit_operation_exception++;
	trace_kvm_s390_handle_operexc(vcpu, vcpu->arch.sie_block->ipa,
				      vcpu->arch.sie_block->ipb);

	if (vcpu->arch.sie_block->ipa == 0xb256)
		return handle_sthyi(vcpu);

	if (vcpu->arch.sie_block->ipa == 0 && vcpu->kvm->arch.user_instr0)
		return -EOPNOTSUPP;
	rc = read_guest_lc(vcpu, __LC_PGM_NEW_PSW, &newpsw, sizeof(psw_t));
	if (rc)
		return rc;
	/*
	 * Avoid endless loops of operation exceptions, if the pgm new
	 * PSW will cause a new operation exception.
	 * The heuristic checks if the pgm new psw is within 6 bytes before
	 * the faulting psw address (with same DAT, AS settings) and the
	 * new psw is not a wait psw and the fault was not triggered by
	 * problem state.
	 */
	oldpsw = vcpu->arch.sie_block->gpsw;
	if (oldpsw.addr - newpsw.addr <= 6 &&
	    !(newpsw.mask & PSW_MASK_WAIT) &&
	    !(oldpsw.mask & PSW_MASK_PSTATE) &&
	    (newpsw.mask & PSW_MASK_ASC) == (oldpsw.mask & PSW_MASK_ASC) &&
	    (newpsw.mask & PSW_MASK_DAT) == (oldpsw.mask & PSW_MASK_DAT))
		return -EOPNOTSUPP;

	return kvm_s390_inject_program_int(vcpu, PGM_OPERATION);
}

int kvm_handle_sie_intercept(struct kvm_vcpu *vcpu)
{
	int rc, per_rc = 0;

	if (kvm_is_ucontrol(vcpu->kvm))
		return -EOPNOTSUPP;

	switch (vcpu->arch.sie_block->icptcode) {
	case ICPT_EXTREQ:
	case ICPT_IOREQ:
		return handle_noop(vcpu);
	case ICPT_INST:
		rc = handle_instruction(vcpu);
		break;
	case ICPT_PROGI:
		return handle_prog(vcpu);
	case ICPT_EXTINT:
		return handle_external_interrupt(vcpu);
	case ICPT_WAIT:
		return kvm_s390_handle_wait(vcpu);
	case ICPT_VALIDITY:
		return handle_validity(vcpu);
	case ICPT_STOP:
		return handle_stop(vcpu);
	case ICPT_OPEREXC:
		rc = handle_operexc(vcpu);
		break;
	case ICPT_PARTEXEC:
		rc = handle_partial_execution(vcpu);
		break;
	case ICPT_KSS:
		rc = kvm_s390_skey_check_enable(vcpu);
		break;
	default:
		return -EOPNOTSUPP;
	}

	/* process PER, also if the instrution is processed in user space */
	if (vcpu->arch.sie_block->icptstatus & 0x02 &&
	    (!rc || rc == -EOPNOTSUPP))
		per_rc = kvm_s390_handle_per_ifetch_icpt(vcpu);
	return per_rc ? per_rc : rc;
}
Commit	Line	Data
d809aa23	1	// SPDX-License-Identifier: GPL-2.0
8f2abe6a	2	/*
a53c8fab	3	* in-kernel handling for sie intercepts
8f2abe6a	4	*
9a558ee3	5	* Copyright IBM Corp. 2008, 2014
8f2abe6a	6	*
8f2abe6a CB	7	* Author(s): Carsten Otte <cotte@de.ibm.com>
	8	* Christian Borntraeger <borntraeger@de.ibm.com>
	9	*/
	10
	11	#include <linux/kvm_host.h>
	12	#include <linux/errno.h>
	13	#include <linux/pagemap.h>
	14
	15	#include <asm/kvm_host.h>
a86dcc24	16	#include <asm/asm-offsets.h>
f14d82e0	17	#include <asm/irq.h>
b7c92f1a	18	#include <asm/sysinfo.h>
8f2abe6a CB	19
8f2abe6a CB	20	#include "kvm-s390.h"
ba5c1e9b	21	#include "gaccess.h"
5786fffa	22	#include "trace.h"
ade38c31	23	#include "trace-s390.h"
ba5c1e9b	24
f379aae5	25
77975357	26	static const intercept_handler_t instruction_handlers[256] = {
8c3f61e2	27	[0x01] = kvm_s390_handle_01,
48a3e950	28	[0x82] = kvm_s390_handle_lpsw,
e28acfea	29	[0x83] = kvm_s390_handle_diag,
80cd8763	30	[0xaa] = kvm_s390_handle_aa,
5288fbf0	31	[0xae] = kvm_s390_handle_sigp,
70455a36	32	[0xb2] = kvm_s390_handle_b2,
aba07508	33	[0xb6] = kvm_s390_handle_stctl,
953ed88d	34	[0xb7] = kvm_s390_handle_lctl,
48a3e950	35	[0xb9] = kvm_s390_handle_b9,
4e0b1ab7	36	[0xe3] = kvm_s390_handle_e3,
bb25b9ba	37	[0xe5] = kvm_s390_handle_e5,
953ed88d	38	[0xeb] = kvm_s390_handle_eb,
ba5c1e9b	39	};
8f2abe6a	40
0e8bc06a	41	u8 kvm_s390_get_ilen(struct kvm_vcpu *vcpu)
04b41acd TH	42	{
04b41acd TH	43	struct kvm_s390_sie_block *sie_block = vcpu->arch.sie_block;
0e8bc06a	44	u8 ilen = 0;
04b41acd	45
0e8bc06a DH	46	switch (vcpu->arch.sie_block->icptcode) {
	47	case ICPT_INST:
	48	case ICPT_INSTPROGI:
	49	case ICPT_OPEREXC:
	50	case ICPT_PARTEXEC:
	51	case ICPT_IOINST:
	52	/* instruction only stored for these icptcodes */
	53	ilen = insn_length(vcpu->arch.sie_block->ipa >> 8);
	54	/* Use the length of the EXECUTE instruction if necessary */
	55	if (sie_block->icptstatus & 1) {
	56	ilen = (sie_block->icptstatus >> 4) & 0x6;
	57	if (!ilen)
	58	ilen = 4;
	59	}
	60	break;
	61	case ICPT_PROGI:
	62	/* bit 1+2 of pgmilc are the ilc, so we directly get ilen */
	63	ilen = vcpu->arch.sie_block->pgmilc & 0x6;
	64	break;
04b41acd	65	}
0e8bc06a	66	return ilen;
04b41acd TH	67	}
04b41acd TH	68
8f2abe6a CB	69	static int handle_noop(struct kvm_vcpu *vcpu)
	70	{
	71	switch (vcpu->arch.sie_block->icptcode) {
	72	case 0x10:
	73	vcpu->stat.exit_external_request++;
	74	break;
8f2abe6a CB	75	default:
	76	break; /* nothing */
	77	}
	78	return 0;
	79	}
	80
	81	static int handle_stop(struct kvm_vcpu *vcpu)
	82	{
6cddd432	83	struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
9ace903d	84	int rc = 0;
6cddd432	85	uint8_t flags, stop_pending;
5288fbf0	86
8f2abe6a	87	vcpu->stat.exit_stop_request++;
ade38c31	88
9a022067 DH	89	/* delay the stop if any non-stop irq is pending */
	90	if (kvm_s390_vcpu_has_irq(vcpu, 1))
	91	return 0;
	92
6cddd432 DH	93	/* avoid races with the injection/SIGP STOP code */
	94	spin_lock(&li->lock);
	95	flags = li->irq.stop.flags;
	96	stop_pending = kvm_s390_is_stop_irq_pending(vcpu);
	97	spin_unlock(&li->lock);
32f5ff63	98
6cddd432 DH	99	trace_kvm_s390_stop_request(stop_pending, flags);
6cddd432 DH	100	if (!stop_pending)
32f5ff63	101	return 0;
9ace903d	102
6cddd432	103	if (flags & KVM_S390_STOP_FLAG_STORE_STATUS) {
9e0d5473 JF	104	rc = kvm_s390_vcpu_store_status(vcpu,
9e0d5473 JF	105	KVM_S390_STORE_STATUS_NOADDR);
32f5ff63 DH	106	if (rc)
	107	return rc;
	108	}
	109
6352e4d2 DH	110	if (!kvm_s390_user_cpu_state_ctrl(vcpu->kvm))
6352e4d2 DH	111	kvm_s390_vcpu_stop(vcpu);
32f5ff63	112	return -EOPNOTSUPP;
8f2abe6a CB	113	}
	114
	115	static int handle_validity(struct kvm_vcpu *vcpu)
	116	{
	117	int viwhy = vcpu->arch.sie_block->ipb >> 16;
3edbcff9	118
8f2abe6a	119	vcpu->stat.exit_validity++;
5786fffa	120	trace_kvm_s390_intercept_validity(vcpu, viwhy);
a5efb6b6 CB	121	KVM_EVENT(3, "validity intercept 0x%x for pid %u (kvm 0x%pK)", viwhy,
	122	current->pid, vcpu->kvm);
	123
	124	/* do not warn on invalid runtime instrumentation mode */
	125	WARN_ONCE(viwhy != 0x44, "kvm: unhandled validity intercept 0x%x\n",
	126	viwhy);
	127	return -EINVAL;
8f2abe6a CB	128	}
8f2abe6a CB	129
ba5c1e9b CO	130	static int handle_instruction(struct kvm_vcpu *vcpu)
	131	{
	132	intercept_handler_t handler;
	133
	134	vcpu->stat.exit_instruction++;
5786fffa CH	135	trace_kvm_s390_intercept_instruction(vcpu,
	136	vcpu->arch.sie_block->ipa,
	137	vcpu->arch.sie_block->ipb);
ba5c1e9b CO	138	handler = instruction_handlers[vcpu->arch.sie_block->ipa >> 8];
	139	if (handler)
	140	return handler(vcpu);
b8e660b8	141	return -EOPNOTSUPP;
ba5c1e9b CO	142	}
ba5c1e9b CO	143
f6af84e7	144	static int inject_prog_on_prog_intercept(struct kvm_vcpu *vcpu)
439716a5	145	{
f6af84e7 DH	146	struct kvm_s390_pgm_info pgm_info = {
f6af84e7 DH	147	.code = vcpu->arch.sie_block->iprcc,
eaa4f416 DH	148	/* the PSW has already been rewound */
eaa4f416 DH	149	.flags = KVM_S390_PGM_FLAGS_NO_REWIND,
f6af84e7	150	};
439716a5 DH	151
	152	switch (vcpu->arch.sie_block->iprcc & ~PGM_PER) {
	153	case PGM_AFX_TRANSLATION:
	154	case PGM_ASX_TRANSLATION:
	155	case PGM_EX_TRANSLATION:
	156	case PGM_LFX_TRANSLATION:
	157	case PGM_LSTE_SEQUENCE:
	158	case PGM_LSX_TRANSLATION:
	159	case PGM_LX_TRANSLATION:
	160	case PGM_PRIMARY_AUTHORITY:
	161	case PGM_SECONDARY_AUTHORITY:
	162	case PGM_SPACE_SWITCH:
f6af84e7	163	pgm_info.trans_exc_code = vcpu->arch.sie_block->tecmc;
439716a5 DH	164	break;
	165	case PGM_ALEN_TRANSLATION:
	166	case PGM_ALE_SEQUENCE:
	167	case PGM_ASTE_INSTANCE:
	168	case PGM_ASTE_SEQUENCE:
	169	case PGM_ASTE_VALIDITY:
	170	case PGM_EXTENDED_AUTHORITY:
f6af84e7	171	pgm_info.exc_access_id = vcpu->arch.sie_block->eai;
439716a5 DH	172	break;
	173	case PGM_ASCE_TYPE:
	174	case PGM_PAGE_TRANSLATION:
	175	case PGM_REGION_FIRST_TRANS:
	176	case PGM_REGION_SECOND_TRANS:
	177	case PGM_REGION_THIRD_TRANS:
	178	case PGM_SEGMENT_TRANSLATION:
f6af84e7 DH	179	pgm_info.trans_exc_code = vcpu->arch.sie_block->tecmc;
	180	pgm_info.exc_access_id = vcpu->arch.sie_block->eai;
	181	pgm_info.op_access_id = vcpu->arch.sie_block->oai;
439716a5 DH	182	break;
439716a5 DH	183	case PGM_MONITOR:
f6af84e7 DH	184	pgm_info.mon_class_nr = vcpu->arch.sie_block->mcn;
f6af84e7 DH	185	pgm_info.mon_code = vcpu->arch.sie_block->tecmc;
439716a5	186	break;
403c8648	187	case PGM_VECTOR_PROCESSING:
439716a5	188	case PGM_DATA:
f6af84e7	189	pgm_info.data_exc_code = vcpu->arch.sie_block->dxc;
439716a5 DH	190	break;
439716a5 DH	191	case PGM_PROTECTION:
f6af84e7 DH	192	pgm_info.trans_exc_code = vcpu->arch.sie_block->tecmc;
f6af84e7 DH	193	pgm_info.exc_access_id = vcpu->arch.sie_block->eai;
439716a5 DH	194	break;
	195	default:
	196	break;
	197	}
	198
	199	if (vcpu->arch.sie_block->iprcc & PGM_PER) {
f6af84e7 DH	200	pgm_info.per_code = vcpu->arch.sie_block->perc;
	201	pgm_info.per_atmid = vcpu->arch.sie_block->peratmid;
	202	pgm_info.per_address = vcpu->arch.sie_block->peraddr;
	203	pgm_info.per_access_id = vcpu->arch.sie_block->peraid;
439716a5	204	}
f6af84e7	205	return kvm_s390_inject_prog_irq(vcpu, &pgm_info);
439716a5 DH	206	}
439716a5 DH	207
e325fe69 MM	208	/*
	209	* restore ITDB to program-interruption TDB in guest lowcore
	210	* and set TX abort indication if required
	211	*/
	212	static int handle_itdb(struct kvm_vcpu *vcpu)
	213	{
	214	struct kvm_s390_itdb *itdb;
	215	int rc;
	216
	217	if (!IS_TE_ENABLED(vcpu) \|\| !IS_ITDB_VALID(vcpu))
	218	return 0;
	219	if (current->thread.per_flags & PER_FLAG_NO_TE)
	220	return 0;
	221	itdb = (struct kvm_s390_itdb *)vcpu->arch.sie_block->itdba;
	222	rc = write_guest_lc(vcpu, __LC_PGM_TDB, itdb, sizeof(*itdb));
	223	if (rc)
	224	return rc;
	225	memset(itdb, 0, sizeof(*itdb));
	226
	227	return 0;
	228	}
	229
27291e21 DH	230	#define per_event(vcpu) (vcpu->arch.sie_block->iprcc & PGM_PER)
27291e21 DH	231
ba5c1e9b CO	232	static int handle_prog(struct kvm_vcpu *vcpu)
ba5c1e9b CO	233	{
684135e0	234	psw_t psw;
0040e7d2 HC	235	int rc;
0040e7d2 HC	236
ba5c1e9b	237	vcpu->stat.exit_program_interruption++;
7feb6bb8	238
27291e21	239	if (guestdbg_enabled(vcpu) && per_event(vcpu)) {
a69cbe81 DH	240	rc = kvm_s390_handle_per_event(vcpu);
	241	if (rc)
	242	return rc;
27291e21 DH	243	/* the interrupt might have been filtered out completely */
	244	if (vcpu->arch.sie_block->iprcc == 0)
	245	return 0;
	246	}
	247
e325fe69	248	trace_kvm_s390_intercept_prog(vcpu, vcpu->arch.sie_block->iprcc);
684135e0 TH	249	if (vcpu->arch.sie_block->iprcc == PGM_SPECIFICATION) {
	250	rc = read_guest_lc(vcpu, __LC_PGM_NEW_PSW, &psw, sizeof(psw_t));
	251	if (rc)
	252	return rc;
	253	/* Avoid endless loops of specification exceptions */
	254	if (!is_valid_psw(&psw))
	255	return -EOPNOTSUPP;
	256	}
e325fe69	257	rc = handle_itdb(vcpu);
0040e7d2 HC	258	if (rc)
0040e7d2 HC	259	return rc;
439716a5	260
f6af84e7	261	return inject_prog_on_prog_intercept(vcpu);
ba5c1e9b CO	262	}
ba5c1e9b CO	263
f14d82e0 TH	264	/**
	265	* handle_external_interrupt - used for external interruption interceptions
	266	*
	267	* This interception only occurs if the CPUSTAT_EXT_INT bit was set, or if
	268	* the new PSW does not have external interrupts disabled. In the first case,
	269	* we've got to deliver the interrupt manually, and in the second case, we
	270	* drop to userspace to handle the situation there.
	271	*/
	272	static int handle_external_interrupt(struct kvm_vcpu *vcpu)
	273	{
	274	u16 eic = vcpu->arch.sie_block->eic;
383d0b05	275	struct kvm_s390_irq irq;
f14d82e0 TH	276	psw_t newpsw;
	277	int rc;
	278
	279	vcpu->stat.exit_external_interrupt++;
	280
	281	rc = read_guest_lc(vcpu, __LC_EXT_NEW_PSW, &newpsw, sizeof(psw_t));
	282	if (rc)
	283	return rc;
	284	/* We can not handle clock comparator or timer interrupt with bad PSW */
	285	if ((eic == EXT_IRQ_CLK_COMP \|\| eic == EXT_IRQ_CPU_TIMER) &&
	286	(newpsw.mask & PSW_MASK_EXT))
	287	return -EOPNOTSUPP;
	288
	289	switch (eic) {
	290	case EXT_IRQ_CLK_COMP:
	291	irq.type = KVM_S390_INT_CLOCK_COMP;
	292	break;
	293	case EXT_IRQ_CPU_TIMER:
	294	irq.type = KVM_S390_INT_CPU_TIMER;
	295	break;
	296	case EXT_IRQ_EXTERNAL_CALL:
	297	irq.type = KVM_S390_INT_EXTERNAL_CALL;
383d0b05	298	irq.u.extcall.code = vcpu->arch.sie_block->extcpuaddr;
ea5f4969 DH	299	rc = kvm_s390_inject_vcpu(vcpu, &irq);
	300	/* ignore if another external call is already pending */
	301	if (rc == -EBUSY)
	302	return 0;
	303	return rc;
f14d82e0 TH	304	default:
	305	return -EOPNOTSUPP;
	306	}
	307
	308	return kvm_s390_inject_vcpu(vcpu, &irq);
	309	}
	310
9a558ee3 TH	311	/**
	312	* Handle MOVE PAGE partial execution interception.
	313	*
	314	* This interception can only happen for guests with DAT disabled and
	315	* addresses that are currently not mapped in the host. Thus we try to
	316	* set up the mappings for the corresponding user pages here (or throw
	317	* addressing exceptions in case of illegal guest addresses).
	318	*/
	319	static int handle_mvpg_pei(struct kvm_vcpu *vcpu)
	320	{
f22166dc	321	unsigned long srcaddr, dstaddr;
9a558ee3 TH	322	int reg1, reg2, rc;
	323
	324	kvm_s390_get_regs_rre(vcpu, &reg1, &reg2);
9a558ee3 TH	325
9a558ee3 TH	326	/* Make sure that the source is paged-in */
3cfad023	327	rc = guest_translate_address(vcpu, vcpu->run->s.regs.gprs[reg2],
92c96321	328	reg2, &srcaddr, GACC_FETCH);
3cfad023 TH	329	if (rc)
3cfad023 TH	330	return kvm_s390_inject_prog_cond(vcpu, rc);
f22166dc TH	331	rc = kvm_arch_fault_in_page(vcpu, srcaddr, 0);
f22166dc TH	332	if (rc != 0)
9a558ee3 TH	333	return rc;
	334
	335	/* Make sure that the destination is paged-in */
3cfad023	336	rc = guest_translate_address(vcpu, vcpu->run->s.regs.gprs[reg1],
92c96321	337	reg1, &dstaddr, GACC_STORE);
3cfad023 TH	338	if (rc)
3cfad023 TH	339	return kvm_s390_inject_prog_cond(vcpu, rc);
f22166dc TH	340	rc = kvm_arch_fault_in_page(vcpu, dstaddr, 1);
f22166dc TH	341	if (rc != 0)
9a558ee3 TH	342	return rc;
9a558ee3 TH	343
0e8bc06a	344	kvm_s390_retry_instr(vcpu);
9a558ee3 TH	345
	346	return 0;
	347	}
	348
	349	static int handle_partial_execution(struct kvm_vcpu *vcpu)
	350	{
9ec6de19 AY	351	vcpu->stat.exit_pei++;
9ec6de19 AY	352
9a558ee3 TH	353	if (vcpu->arch.sie_block->ipa == 0xb254) /* MVPG */
9a558ee3 TH	354	return handle_mvpg_pei(vcpu);
4953919f DH	355	if (vcpu->arch.sie_block->ipa >> 8 == 0xae) /* SIGP */
4953919f DH	356	return kvm_s390_handle_sigp_pei(vcpu);
9a558ee3 TH	357
	358	return -EOPNOTSUPP;
	359	}
	360
b7c92f1a QH	361	/*
	362	* Handle the sthyi instruction that provides the guest with system
	363	* information, like current CPU resources available at each level of
	364	* the machine.
	365	*/
	366	int handle_sthyi(struct kvm_vcpu *vcpu)
	367	{
	368	int reg1, reg2, r = 0;
	369	u64 code, addr, cc = 0, rc = 0;
	370	struct sthyi_sctns *sctns = NULL;
	371
	372	if (!test_kvm_facility(vcpu->kvm, 74))
	373	return kvm_s390_inject_program_int(vcpu, PGM_OPERATION);
	374
b7c92f1a QH	375	kvm_s390_get_regs_rre(vcpu, &reg1, &reg2);
	376	code = vcpu->run->s.regs.gprs[reg1];
	377	addr = vcpu->run->s.regs.gprs[reg2];
	378
	379	vcpu->stat.instruction_sthyi++;
	380	VCPU_EVENT(vcpu, 3, "STHYI: fc: %llu addr: 0x%016llx", code, addr);
	381	trace_kvm_s390_handle_sthyi(vcpu, code, addr);
	382
	383	if (reg1 == reg2 \|\| reg1 & 1 \|\| reg2 & 1)
	384	return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	385
	386	if (code & 0xffff) {
	387	cc = 3;
	388	rc = 4;
	389	goto out;
	390	}
	391
	392	if (addr & ~PAGE_MASK)
	393	return kvm_s390_inject_program_int(vcpu, PGM_SPECIFICATION);
	394
	395	sctns = (void *)get_zeroed_page(GFP_KERNEL);
	396	if (!sctns)
	397	return -ENOMEM;
	398
	399	cc = sthyi_fill(sctns, &rc);
	400
	401	out:
	402	if (!cc) {
	403	r = write_guest(vcpu, addr, reg2, sctns, PAGE_SIZE);
	404	if (r) {
	405	free_page((unsigned long)sctns);
	406	return kvm_s390_inject_prog_cond(vcpu, r);
	407	}
	408	}
	409
	410	free_page((unsigned long)sctns);
	411	vcpu->run->s.regs.gprs[reg2 + 1] = rc;
	412	kvm_s390_set_psw_cc(vcpu, cc);
	413	return r;
	414	}
	415
a011eeb2 JF	416	static int handle_operexc(struct kvm_vcpu *vcpu)
a011eeb2 JF	417	{
fb7dc1d4 CB	418	psw_t oldpsw, newpsw;
	419	int rc;
	420
a011eeb2 JF	421	vcpu->stat.exit_operation_exception++;
	422	trace_kvm_s390_handle_operexc(vcpu, vcpu->arch.sie_block->ipa,
	423	vcpu->arch.sie_block->ipb);
	424
c0a6bfdc	425	if (vcpu->arch.sie_block->ipa == 0xb256)
95ca2cb5 JF	426	return handle_sthyi(vcpu);
95ca2cb5 JF	427
6502a34c DH	428	if (vcpu->arch.sie_block->ipa == 0 && vcpu->kvm->arch.user_instr0)
6502a34c DH	429	return -EOPNOTSUPP;
fb7dc1d4 CB	430	rc = read_guest_lc(vcpu, __LC_PGM_NEW_PSW, &newpsw, sizeof(psw_t));
	431	if (rc)
	432	return rc;
	433	/*
	434	* Avoid endless loops of operation exceptions, if the pgm new
	435	* PSW will cause a new operation exception.
	436	* The heuristic checks if the pgm new psw is within 6 bytes before
	437	* the faulting psw address (with same DAT, AS settings) and the
	438	* new psw is not a wait psw and the fault was not triggered by
	439	* problem state.
	440	*/
	441	oldpsw = vcpu->arch.sie_block->gpsw;
	442	if (oldpsw.addr - newpsw.addr <= 6 &&
	443	!(newpsw.mask & PSW_MASK_WAIT) &&
	444	!(oldpsw.mask & PSW_MASK_PSTATE) &&
	445	(newpsw.mask & PSW_MASK_ASC) == (oldpsw.mask & PSW_MASK_ASC) &&
	446	(newpsw.mask & PSW_MASK_DAT) == (oldpsw.mask & PSW_MASK_DAT))
	447	return -EOPNOTSUPP;
6502a34c	448
a011eeb2 JF	449	return kvm_s390_inject_program_int(vcpu, PGM_OPERATION);
	450	}
	451
8f2abe6a CB	452	int kvm_handle_sie_intercept(struct kvm_vcpu *vcpu)
8f2abe6a CB	453	{
5ffe466c DH	454	int rc, per_rc = 0;
5ffe466c DH	455
71f116bf DH	456	if (kvm_is_ucontrol(vcpu->kvm))
	457	return -EOPNOTSUPP;
	458
46b708ea	459	switch (vcpu->arch.sie_block->icptcode) {
947b8972 FA	460	case ICPT_EXTREQ:
947b8972 FA	461	case ICPT_IOREQ:
46b708ea	462	return handle_noop(vcpu);
947b8972	463	case ICPT_INST:
5ffe466c DH	464	rc = handle_instruction(vcpu);
5ffe466c DH	465	break;
947b8972	466	case ICPT_PROGI:
46b708ea	467	return handle_prog(vcpu);
947b8972	468	case ICPT_EXTINT:
46b708ea	469	return handle_external_interrupt(vcpu);
947b8972	470	case ICPT_WAIT:
46b708ea	471	return kvm_s390_handle_wait(vcpu);
947b8972	472	case ICPT_VALIDITY:
46b708ea	473	return handle_validity(vcpu);
947b8972	474	case ICPT_STOP:
46b708ea	475	return handle_stop(vcpu);
947b8972	476	case ICPT_OPEREXC:
5ffe466c DH	477	rc = handle_operexc(vcpu);
5ffe466c DH	478	break;
947b8972	479	case ICPT_PARTEXEC:
5ffe466c DH	480	rc = handle_partial_execution(vcpu);
5ffe466c DH	481	break;
730cd632 FA	482	case ICPT_KSS:
	483	rc = kvm_s390_skey_check_enable(vcpu);
	484	break;
46b708ea	485	default:
b8e660b8	486	return -EOPNOTSUPP;
46b708ea	487	}
5ffe466c DH	488
	489	/* process PER, also if the instrution is processed in user space */
	490	if (vcpu->arch.sie_block->icptstatus & 0x02 &&
	491	(!rc \|\| rc == -EOPNOTSUPP))
	492	per_rc = kvm_s390_handle_per_ifetch_icpt(vcpu);
	493	return per_rc ? per_rc : rc;
8f2abe6a	494	}