1/*
2 * in-kernel handling for sie intercepts
3 *
4 * Copyright IBM Corp. 2008, 2014
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#include <asm/asm-offsets.h>
20#include <asm/irq.h>
21
22#include "kvm-s390.h"
23#include "gaccess.h"
24#include "trace.h"
25#include "trace-s390.h"
26
27
28static const intercept_handler_t instruction_handlers[256] = {
29	[0x01] = kvm_s390_handle_01,
30	[0x82] = kvm_s390_handle_lpsw,
31	[0x83] = kvm_s390_handle_diag,
32	[0xae] = kvm_s390_handle_sigp,
33	[0xb2] = kvm_s390_handle_b2,
34	[0xb6] = kvm_s390_handle_stctl,
35	[0xb7] = kvm_s390_handle_lctl,
36	[0xb9] = kvm_s390_handle_b9,
37	[0xe5] = kvm_s390_handle_e5,
38	[0xeb] = kvm_s390_handle_eb,
39};
40
41void kvm_s390_rewind_psw(struct kvm_vcpu *vcpu, int ilc)
42{
43	struct kvm_s390_sie_block *sie_block = vcpu->arch.sie_block;
44
45	/* Use the length of the EXECUTE instruction if necessary */
46	if (sie_block->icptstatus & 1) {
47		ilc = (sie_block->icptstatus >> 4) & 0x6;
48		if (!ilc)
49			ilc = 4;
50	}
51	sie_block->gpsw.addr = __rewind_psw(sie_block->gpsw, ilc);
52}
53
54static int handle_noop(struct kvm_vcpu *vcpu)
55{
56	switch (vcpu->arch.sie_block->icptcode) {
57	case 0x0:
58		vcpu->stat.exit_null++;
59		break;
60	case 0x10:
61		vcpu->stat.exit_external_request++;
62		break;
63	default:
64		break; /* nothing */
65	}
66	return 0;
67}
68
69static int handle_stop(struct kvm_vcpu *vcpu)
70{
71	struct kvm_s390_local_interrupt *li = &vcpu->arch.local_int;
72	int rc = 0;
73	uint8_t flags, stop_pending;
74
75	vcpu->stat.exit_stop_request++;
76
77	/* delay the stop if any non-stop irq is pending */
78	if (kvm_s390_vcpu_has_irq(vcpu, 1))
79		return 0;
80
81	/* avoid races with the injection/SIGP STOP code */
82	spin_lock(&li->lock);
83	flags = li->irq.stop.flags;
84	stop_pending = kvm_s390_is_stop_irq_pending(vcpu);
85	spin_unlock(&li->lock);
86
87	trace_kvm_s390_stop_request(stop_pending, flags);
88	if (!stop_pending)
89		return 0;
90
91	if (flags & KVM_S390_STOP_FLAG_STORE_STATUS) {
92		rc = kvm_s390_vcpu_store_status(vcpu,
93						KVM_S390_STORE_STATUS_NOADDR);
94		if (rc)
95			return rc;
96	}
97
98	if (!kvm_s390_user_cpu_state_ctrl(vcpu->kvm))
99		kvm_s390_vcpu_stop(vcpu);
100	return -EOPNOTSUPP;
101}
102
103static int handle_validity(struct kvm_vcpu *vcpu)
104{
105	int viwhy = vcpu->arch.sie_block->ipb >> 16;
106
107	vcpu->stat.exit_validity++;
108	trace_kvm_s390_intercept_validity(vcpu, viwhy);
109	WARN_ONCE(true, "kvm: unhandled validity intercept 0x%x\n", viwhy);
110	return -EOPNOTSUPP;
111}
112
113static int handle_instruction(struct kvm_vcpu *vcpu)
114{
115	intercept_handler_t handler;
116
117	vcpu->stat.exit_instruction++;
118	trace_kvm_s390_intercept_instruction(vcpu,
119					     vcpu->arch.sie_block->ipa,
120					     vcpu->arch.sie_block->ipb);
121	handler = instruction_handlers[vcpu->arch.sie_block->ipa >> 8];
122	if (handler)
123		return handler(vcpu);
124	return -EOPNOTSUPP;
125}
126
127static void __extract_prog_irq(struct kvm_vcpu *vcpu,
128			       struct kvm_s390_pgm_info *pgm_info)
129{
130	memset(pgm_info, 0, sizeof(struct kvm_s390_pgm_info));
131	pgm_info->code = vcpu->arch.sie_block->iprcc;
132
133	switch (vcpu->arch.sie_block->iprcc & ~PGM_PER) {
134	case PGM_AFX_TRANSLATION:
135	case PGM_ASX_TRANSLATION:
136	case PGM_EX_TRANSLATION:
137	case PGM_LFX_TRANSLATION:
138	case PGM_LSTE_SEQUENCE:
139	case PGM_LSX_TRANSLATION:
140	case PGM_LX_TRANSLATION:
141	case PGM_PRIMARY_AUTHORITY:
142	case PGM_SECONDARY_AUTHORITY:
143	case PGM_SPACE_SWITCH:
144		pgm_info->trans_exc_code = vcpu->arch.sie_block->tecmc;
145		break;
146	case PGM_ALEN_TRANSLATION:
147	case PGM_ALE_SEQUENCE:
148	case PGM_ASTE_INSTANCE:
149	case PGM_ASTE_SEQUENCE:
150	case PGM_ASTE_VALIDITY:
151	case PGM_EXTENDED_AUTHORITY:
152		pgm_info->exc_access_id = vcpu->arch.sie_block->eai;
153		break;
154	case PGM_ASCE_TYPE:
155	case PGM_PAGE_TRANSLATION:
156	case PGM_REGION_FIRST_TRANS:
157	case PGM_REGION_SECOND_TRANS:
158	case PGM_REGION_THIRD_TRANS:
159	case PGM_SEGMENT_TRANSLATION:
160		pgm_info->trans_exc_code = vcpu->arch.sie_block->tecmc;
161		pgm_info->exc_access_id  = vcpu->arch.sie_block->eai;
162		pgm_info->op_access_id  = vcpu->arch.sie_block->oai;
163		break;
164	case PGM_MONITOR:
165		pgm_info->mon_class_nr = vcpu->arch.sie_block->mcn;
166		pgm_info->mon_code = vcpu->arch.sie_block->tecmc;
167		break;
168	case PGM_VECTOR_PROCESSING:
169	case PGM_DATA:
170		pgm_info->data_exc_code = vcpu->arch.sie_block->dxc;
171		break;
172	case PGM_PROTECTION:
173		pgm_info->trans_exc_code = vcpu->arch.sie_block->tecmc;
174		pgm_info->exc_access_id  = vcpu->arch.sie_block->eai;
175		break;
176	default:
177		break;
178	}
179
180	if (vcpu->arch.sie_block->iprcc & PGM_PER) {
181		pgm_info->per_code = vcpu->arch.sie_block->perc;
182		pgm_info->per_atmid = vcpu->arch.sie_block->peratmid;
183		pgm_info->per_address = vcpu->arch.sie_block->peraddr;
184		pgm_info->per_access_id = vcpu->arch.sie_block->peraid;
185	}
186}
187
188/*
189 * restore ITDB to program-interruption TDB in guest lowcore
190 * and set TX abort indication if required
191*/
192static int handle_itdb(struct kvm_vcpu *vcpu)
193{
194	struct kvm_s390_itdb *itdb;
195	int rc;
196
197	if (!IS_TE_ENABLED(vcpu) || !IS_ITDB_VALID(vcpu))
198		return 0;
199	if (current->thread.per_flags & PER_FLAG_NO_TE)
200		return 0;
201	itdb = (struct kvm_s390_itdb *)vcpu->arch.sie_block->itdba;
202	rc = write_guest_lc(vcpu, __LC_PGM_TDB, itdb, sizeof(*itdb));
203	if (rc)
204		return rc;
205	memset(itdb, 0, sizeof(*itdb));
206
207	return 0;
208}
209
210#define per_event(vcpu) (vcpu->arch.sie_block->iprcc & PGM_PER)
211
212static int handle_prog(struct kvm_vcpu *vcpu)
213{
214	struct kvm_s390_pgm_info pgm_info;
215	psw_t psw;
216	int rc;
217
218	vcpu->stat.exit_program_interruption++;
219
220	if (guestdbg_enabled(vcpu) && per_event(vcpu)) {
221		kvm_s390_handle_per_event(vcpu);
222		/* the interrupt might have been filtered out completely */
223		if (vcpu->arch.sie_block->iprcc == 0)
224			return 0;
225	}
226
227	trace_kvm_s390_intercept_prog(vcpu, vcpu->arch.sie_block->iprcc);
228	if (vcpu->arch.sie_block->iprcc == PGM_SPECIFICATION) {
229		rc = read_guest_lc(vcpu, __LC_PGM_NEW_PSW, &psw, sizeof(psw_t));
230		if (rc)
231			return rc;
232		/* Avoid endless loops of specification exceptions */
233		if (!is_valid_psw(&psw))
234			return -EOPNOTSUPP;
235	}
236	rc = handle_itdb(vcpu);
237	if (rc)
238		return rc;
239
240	__extract_prog_irq(vcpu, &pgm_info);
241	return kvm_s390_inject_prog_irq(vcpu, &pgm_info);
242}
243
244static int handle_instruction_and_prog(struct kvm_vcpu *vcpu)
245{
246	int rc, rc2;
247
248	vcpu->stat.exit_instr_and_program++;
249	rc = handle_instruction(vcpu);
250	rc2 = handle_prog(vcpu);
251
252	if (rc == -EOPNOTSUPP)
253		vcpu->arch.sie_block->icptcode = 0x04;
254	if (rc)
255		return rc;
256	return rc2;
257}
258
259/**
260 * handle_external_interrupt - used for external interruption interceptions
261 *
262 * This interception only occurs if the CPUSTAT_EXT_INT bit was set, or if
263 * the new PSW does not have external interrupts disabled. In the first case,
264 * we've got to deliver the interrupt manually, and in the second case, we
265 * drop to userspace to handle the situation there.
266 */
267static int handle_external_interrupt(struct kvm_vcpu *vcpu)
268{
269	u16 eic = vcpu->arch.sie_block->eic;
270	struct kvm_s390_irq irq;
271	psw_t newpsw;
272	int rc;
273
274	vcpu->stat.exit_external_interrupt++;
275
276	rc = read_guest_lc(vcpu, __LC_EXT_NEW_PSW, &newpsw, sizeof(psw_t));
277	if (rc)
278		return rc;
279	/* We can not handle clock comparator or timer interrupt with bad PSW */
280	if ((eic == EXT_IRQ_CLK_COMP || eic == EXT_IRQ_CPU_TIMER) &&
281	    (newpsw.mask & PSW_MASK_EXT))
282		return -EOPNOTSUPP;
283
284	switch (eic) {
285	case EXT_IRQ_CLK_COMP:
286		irq.type = KVM_S390_INT_CLOCK_COMP;
287		break;
288	case EXT_IRQ_CPU_TIMER:
289		irq.type = KVM_S390_INT_CPU_TIMER;
290		break;
291	case EXT_IRQ_EXTERNAL_CALL:
292		irq.type = KVM_S390_INT_EXTERNAL_CALL;
293		irq.u.extcall.code = vcpu->arch.sie_block->extcpuaddr;
294		rc = kvm_s390_inject_vcpu(vcpu, &irq);
295		/* ignore if another external call is already pending */
296		if (rc == -EBUSY)
297			return 0;
298		return rc;
299	default:
300		return -EOPNOTSUPP;
301	}
302
303	return kvm_s390_inject_vcpu(vcpu, &irq);
304}
305
306/**
307 * Handle MOVE PAGE partial execution interception.
308 *
309 * This interception can only happen for guests with DAT disabled and
310 * addresses that are currently not mapped in the host. Thus we try to
311 * set up the mappings for the corresponding user pages here (or throw
312 * addressing exceptions in case of illegal guest addresses).
313 */
314static int handle_mvpg_pei(struct kvm_vcpu *vcpu)
315{
316	unsigned long srcaddr, dstaddr;
317	int reg1, reg2, rc;
318
319	kvm_s390_get_regs_rre(vcpu, &reg1, &reg2);
320
321	/* Make sure that the source is paged-in */
322	rc = guest_translate_address(vcpu, vcpu->run->s.regs.gprs[reg2],
323				     reg2, &srcaddr, 0);
324	if (rc)
325		return kvm_s390_inject_prog_cond(vcpu, rc);
326	rc = kvm_arch_fault_in_page(vcpu, srcaddr, 0);
327	if (rc != 0)
328		return rc;
329
330	/* Make sure that the destination is paged-in */
331	rc = guest_translate_address(vcpu, vcpu->run->s.regs.gprs[reg1],
332				     reg1, &dstaddr, 1);
333	if (rc)
334		return kvm_s390_inject_prog_cond(vcpu, rc);
335	rc = kvm_arch_fault_in_page(vcpu, dstaddr, 1);
336	if (rc != 0)
337		return rc;
338
339	kvm_s390_rewind_psw(vcpu, 4);
340
341	return 0;
342}
343
344static int handle_partial_execution(struct kvm_vcpu *vcpu)
345{
346	if (vcpu->arch.sie_block->ipa == 0xb254)	/* MVPG */
347		return handle_mvpg_pei(vcpu);
348	if (vcpu->arch.sie_block->ipa >> 8 == 0xae)	/* SIGP */
349		return kvm_s390_handle_sigp_pei(vcpu);
350
351	return -EOPNOTSUPP;
352}
353
354static const intercept_handler_t intercept_funcs[] = {
355	[0x00 >> 2] = handle_noop,
356	[0x04 >> 2] = handle_instruction,
357	[0x08 >> 2] = handle_prog,
358	[0x0C >> 2] = handle_instruction_and_prog,
359	[0x10 >> 2] = handle_noop,
360	[0x14 >> 2] = handle_external_interrupt,
361	[0x18 >> 2] = handle_noop,
362	[0x1C >> 2] = kvm_s390_handle_wait,
363	[0x20 >> 2] = handle_validity,
364	[0x28 >> 2] = handle_stop,
365	[0x38 >> 2] = handle_partial_execution,
366};
367
368int kvm_handle_sie_intercept(struct kvm_vcpu *vcpu)
369{
370	intercept_handler_t func;
371	u8 code = vcpu->arch.sie_block->icptcode;
372
373	if (code & 3 || (code >> 2) >= ARRAY_SIZE(intercept_funcs))
374		return -EOPNOTSUPP;
375	func = intercept_funcs[code >> 2];
376	if (func)
377		return func(vcpu);
378	return -EOPNOTSUPP;
379}
380