xref: /openbmc/linux/arch/x86/kvm/xen.c (revision 7f9321ff)
1 // SPDX-License-Identifier: GPL-2.0
2 /*
3  * Copyright © 2019 Oracle and/or its affiliates. All rights reserved.
4  * Copyright © 2020 Amazon.com, Inc. or its affiliates. All Rights Reserved.
5  *
6  * KVM Xen emulation
7  */
8 
9 #include "x86.h"
10 #include "xen.h"
11 #include "hyperv.h"
12 
13 #include <linux/kvm_host.h>
14 #include <linux/sched/stat.h>
15 
16 #include <trace/events/kvm.h>
17 #include <xen/interface/xen.h>
18 #include <xen/interface/vcpu.h>
19 
20 #include "trace.h"
21 
22 DEFINE_STATIC_KEY_DEFERRED_FALSE(kvm_xen_enabled, HZ);
23 
24 static int kvm_xen_shared_info_init(struct kvm *kvm, gfn_t gfn)
25 {
26 	gpa_t gpa = gfn_to_gpa(gfn);
27 	int wc_ofs, sec_hi_ofs;
28 	int ret;
29 	int idx = srcu_read_lock(&kvm->srcu);
30 
31 	ret = kvm_gfn_to_hva_cache_init(kvm, &kvm->arch.xen.shinfo_cache,
32 					gpa, PAGE_SIZE);
33 	if (ret)
34 		goto out;
35 
36 	kvm->arch.xen.shinfo_set = true;
37 
38 	/* Paranoia checks on the 32-bit struct layout */
39 	BUILD_BUG_ON(offsetof(struct compat_shared_info, wc) != 0x900);
40 	BUILD_BUG_ON(offsetof(struct compat_shared_info, arch.wc_sec_hi) != 0x924);
41 	BUILD_BUG_ON(offsetof(struct pvclock_vcpu_time_info, version) != 0);
42 
43 	/* 32-bit location by default */
44 	wc_ofs = offsetof(struct compat_shared_info, wc);
45 	sec_hi_ofs = offsetof(struct compat_shared_info, arch.wc_sec_hi);
46 
47 #ifdef CONFIG_X86_64
48 	/* Paranoia checks on the 64-bit struct layout */
49 	BUILD_BUG_ON(offsetof(struct shared_info, wc) != 0xc00);
50 	BUILD_BUG_ON(offsetof(struct shared_info, wc_sec_hi) != 0xc0c);
51 
52 	if (kvm->arch.xen.long_mode) {
53 		wc_ofs = offsetof(struct shared_info, wc);
54 		sec_hi_ofs = offsetof(struct shared_info, wc_sec_hi);
55 	}
56 #endif
57 
58 	kvm_write_wall_clock(kvm, gpa + wc_ofs, sec_hi_ofs - wc_ofs);
59 	kvm_make_all_cpus_request(kvm, KVM_REQ_MASTERCLOCK_UPDATE);
60 
61 out:
62 	srcu_read_unlock(&kvm->srcu, idx);
63 	return ret;
64 }
65 
66 static void kvm_xen_update_runstate(struct kvm_vcpu *v, int state)
67 {
68 	struct kvm_vcpu_xen *vx = &v->arch.xen;
69 	u64 now = get_kvmclock_ns(v->kvm);
70 	u64 delta_ns = now - vx->runstate_entry_time;
71 	u64 run_delay = current->sched_info.run_delay;
72 
73 	if (unlikely(!vx->runstate_entry_time))
74 		vx->current_runstate = RUNSTATE_offline;
75 
76 	/*
77 	 * Time waiting for the scheduler isn't "stolen" if the
78 	 * vCPU wasn't running anyway.
79 	 */
80 	if (vx->current_runstate == RUNSTATE_running) {
81 		u64 steal_ns = run_delay - vx->last_steal;
82 
83 		delta_ns -= steal_ns;
84 
85 		vx->runstate_times[RUNSTATE_runnable] += steal_ns;
86 	}
87 	vx->last_steal = run_delay;
88 
89 	vx->runstate_times[vx->current_runstate] += delta_ns;
90 	vx->current_runstate = state;
91 	vx->runstate_entry_time = now;
92 }
93 
94 void kvm_xen_update_runstate_guest(struct kvm_vcpu *v, int state)
95 {
96 	struct kvm_vcpu_xen *vx = &v->arch.xen;
97 	uint64_t state_entry_time;
98 	unsigned int offset;
99 
100 	kvm_xen_update_runstate(v, state);
101 
102 	if (!vx->runstate_set)
103 		return;
104 
105 	BUILD_BUG_ON(sizeof(struct compat_vcpu_runstate_info) != 0x2c);
106 
107 	offset = offsetof(struct compat_vcpu_runstate_info, state_entry_time);
108 #ifdef CONFIG_X86_64
109 	/*
110 	 * The only difference is alignment of uint64_t in 32-bit.
111 	 * So the first field 'state' is accessed directly using
112 	 * offsetof() (where its offset happens to be zero), while the
113 	 * remaining fields which are all uint64_t, start at 'offset'
114 	 * which we tweak here by adding 4.
115 	 */
116 	BUILD_BUG_ON(offsetof(struct vcpu_runstate_info, state_entry_time) !=
117 		     offsetof(struct compat_vcpu_runstate_info, state_entry_time) + 4);
118 	BUILD_BUG_ON(offsetof(struct vcpu_runstate_info, time) !=
119 		     offsetof(struct compat_vcpu_runstate_info, time) + 4);
120 
121 	if (v->kvm->arch.xen.long_mode)
122 		offset = offsetof(struct vcpu_runstate_info, state_entry_time);
123 #endif
124 	/*
125 	 * First write the updated state_entry_time at the appropriate
126 	 * location determined by 'offset'.
127 	 */
128 	state_entry_time = vx->runstate_entry_time;
129 	state_entry_time |= XEN_RUNSTATE_UPDATE;
130 
131 	BUILD_BUG_ON(sizeof(((struct vcpu_runstate_info *)0)->state_entry_time) !=
132 		     sizeof(state_entry_time));
133 	BUILD_BUG_ON(sizeof(((struct compat_vcpu_runstate_info *)0)->state_entry_time) !=
134 		     sizeof(state_entry_time));
135 
136 	if (kvm_write_guest_offset_cached(v->kvm, &v->arch.xen.runstate_cache,
137 					  &state_entry_time, offset,
138 					  sizeof(state_entry_time)))
139 		return;
140 	smp_wmb();
141 
142 	/*
143 	 * Next, write the new runstate. This is in the *same* place
144 	 * for 32-bit and 64-bit guests, asserted here for paranoia.
145 	 */
146 	BUILD_BUG_ON(offsetof(struct vcpu_runstate_info, state) !=
147 		     offsetof(struct compat_vcpu_runstate_info, state));
148 	BUILD_BUG_ON(sizeof(((struct vcpu_runstate_info *)0)->state) !=
149 		     sizeof(vx->current_runstate));
150 	BUILD_BUG_ON(sizeof(((struct compat_vcpu_runstate_info *)0)->state) !=
151 		     sizeof(vx->current_runstate));
152 
153 	if (kvm_write_guest_offset_cached(v->kvm, &v->arch.xen.runstate_cache,
154 					  &vx->current_runstate,
155 					  offsetof(struct vcpu_runstate_info, state),
156 					  sizeof(vx->current_runstate)))
157 		return;
158 
159 	/*
160 	 * Write the actual runstate times immediately after the
161 	 * runstate_entry_time.
162 	 */
163 	BUILD_BUG_ON(offsetof(struct vcpu_runstate_info, state_entry_time) !=
164 		     offsetof(struct vcpu_runstate_info, time) - sizeof(u64));
165 	BUILD_BUG_ON(offsetof(struct compat_vcpu_runstate_info, state_entry_time) !=
166 		     offsetof(struct compat_vcpu_runstate_info, time) - sizeof(u64));
167 	BUILD_BUG_ON(sizeof(((struct vcpu_runstate_info *)0)->time) !=
168 		     sizeof(((struct compat_vcpu_runstate_info *)0)->time));
169 	BUILD_BUG_ON(sizeof(((struct vcpu_runstate_info *)0)->time) !=
170 		     sizeof(vx->runstate_times));
171 
172 	if (kvm_write_guest_offset_cached(v->kvm, &v->arch.xen.runstate_cache,
173 					  &vx->runstate_times[0],
174 					  offset + sizeof(u64),
175 					  sizeof(vx->runstate_times)))
176 		return;
177 
178 	smp_wmb();
179 
180 	/*
181 	 * Finally, clear the XEN_RUNSTATE_UPDATE bit in the guest's
182 	 * runstate_entry_time field.
183 	 */
184 
185 	state_entry_time &= ~XEN_RUNSTATE_UPDATE;
186 	if (kvm_write_guest_offset_cached(v->kvm, &v->arch.xen.runstate_cache,
187 					  &state_entry_time, offset,
188 					  sizeof(state_entry_time)))
189 		return;
190 }
191 
192 int __kvm_xen_has_interrupt(struct kvm_vcpu *v)
193 {
194 	u8 rc = 0;
195 
196 	/*
197 	 * If the global upcall vector (HVMIRQ_callback_vector) is set and
198 	 * the vCPU's evtchn_upcall_pending flag is set, the IRQ is pending.
199 	 */
200 	struct gfn_to_hva_cache *ghc = &v->arch.xen.vcpu_info_cache;
201 	struct kvm_memslots *slots = kvm_memslots(v->kvm);
202 	unsigned int offset = offsetof(struct vcpu_info, evtchn_upcall_pending);
203 
204 	/* No need for compat handling here */
205 	BUILD_BUG_ON(offsetof(struct vcpu_info, evtchn_upcall_pending) !=
206 		     offsetof(struct compat_vcpu_info, evtchn_upcall_pending));
207 	BUILD_BUG_ON(sizeof(rc) !=
208 		     sizeof(((struct vcpu_info *)0)->evtchn_upcall_pending));
209 	BUILD_BUG_ON(sizeof(rc) !=
210 		     sizeof(((struct compat_vcpu_info *)0)->evtchn_upcall_pending));
211 
212 	/*
213 	 * For efficiency, this mirrors the checks for using the valid
214 	 * cache in kvm_read_guest_offset_cached(), but just uses
215 	 * __get_user() instead. And falls back to the slow path.
216 	 */
217 	if (likely(slots->generation == ghc->generation &&
218 		   !kvm_is_error_hva(ghc->hva) && ghc->memslot)) {
219 		/* Fast path */
220 		__get_user(rc, (u8 __user *)ghc->hva + offset);
221 	} else {
222 		/* Slow path */
223 		kvm_read_guest_offset_cached(v->kvm, ghc, &rc, offset,
224 					     sizeof(rc));
225 	}
226 
227 	return rc;
228 }
229 
230 int kvm_xen_hvm_set_attr(struct kvm *kvm, struct kvm_xen_hvm_attr *data)
231 {
232 	int r = -ENOENT;
233 
234 	mutex_lock(&kvm->lock);
235 
236 	switch (data->type) {
237 	case KVM_XEN_ATTR_TYPE_LONG_MODE:
238 		if (!IS_ENABLED(CONFIG_64BIT) && data->u.long_mode) {
239 			r = -EINVAL;
240 		} else {
241 			kvm->arch.xen.long_mode = !!data->u.long_mode;
242 			r = 0;
243 		}
244 		break;
245 
246 	case KVM_XEN_ATTR_TYPE_SHARED_INFO:
247 		if (data->u.shared_info.gfn == GPA_INVALID) {
248 			kvm->arch.xen.shinfo_set = false;
249 			r = 0;
250 			break;
251 		}
252 		r = kvm_xen_shared_info_init(kvm, data->u.shared_info.gfn);
253 		break;
254 
255 
256 	case KVM_XEN_ATTR_TYPE_UPCALL_VECTOR:
257 		if (data->u.vector && data->u.vector < 0x10)
258 			r = -EINVAL;
259 		else {
260 			kvm->arch.xen.upcall_vector = data->u.vector;
261 			r = 0;
262 		}
263 		break;
264 
265 	default:
266 		break;
267 	}
268 
269 	mutex_unlock(&kvm->lock);
270 	return r;
271 }
272 
273 int kvm_xen_hvm_get_attr(struct kvm *kvm, struct kvm_xen_hvm_attr *data)
274 {
275 	int r = -ENOENT;
276 
277 	mutex_lock(&kvm->lock);
278 
279 	switch (data->type) {
280 	case KVM_XEN_ATTR_TYPE_LONG_MODE:
281 		data->u.long_mode = kvm->arch.xen.long_mode;
282 		r = 0;
283 		break;
284 
285 	case KVM_XEN_ATTR_TYPE_SHARED_INFO:
286 		if (kvm->arch.xen.shinfo_set)
287 			data->u.shared_info.gfn = gpa_to_gfn(kvm->arch.xen.shinfo_cache.gpa);
288 		else
289 			data->u.shared_info.gfn = GPA_INVALID;
290 		r = 0;
291 		break;
292 
293 	case KVM_XEN_ATTR_TYPE_UPCALL_VECTOR:
294 		data->u.vector = kvm->arch.xen.upcall_vector;
295 		r = 0;
296 		break;
297 
298 	default:
299 		break;
300 	}
301 
302 	mutex_unlock(&kvm->lock);
303 	return r;
304 }
305 
306 int kvm_xen_vcpu_set_attr(struct kvm_vcpu *vcpu, struct kvm_xen_vcpu_attr *data)
307 {
308 	int idx, r = -ENOENT;
309 
310 	mutex_lock(&vcpu->kvm->lock);
311 	idx = srcu_read_lock(&vcpu->kvm->srcu);
312 
313 	switch (data->type) {
314 	case KVM_XEN_VCPU_ATTR_TYPE_VCPU_INFO:
315 		/* No compat necessary here. */
316 		BUILD_BUG_ON(sizeof(struct vcpu_info) !=
317 			     sizeof(struct compat_vcpu_info));
318 		BUILD_BUG_ON(offsetof(struct vcpu_info, time) !=
319 			     offsetof(struct compat_vcpu_info, time));
320 
321 		if (data->u.gpa == GPA_INVALID) {
322 			vcpu->arch.xen.vcpu_info_set = false;
323 			r = 0;
324 			break;
325 		}
326 
327 		r = kvm_gfn_to_hva_cache_init(vcpu->kvm,
328 					      &vcpu->arch.xen.vcpu_info_cache,
329 					      data->u.gpa,
330 					      sizeof(struct vcpu_info));
331 		if (!r) {
332 			vcpu->arch.xen.vcpu_info_set = true;
333 			kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
334 		}
335 		break;
336 
337 	case KVM_XEN_VCPU_ATTR_TYPE_VCPU_TIME_INFO:
338 		if (data->u.gpa == GPA_INVALID) {
339 			vcpu->arch.xen.vcpu_time_info_set = false;
340 			r = 0;
341 			break;
342 		}
343 
344 		r = kvm_gfn_to_hva_cache_init(vcpu->kvm,
345 					      &vcpu->arch.xen.vcpu_time_info_cache,
346 					      data->u.gpa,
347 					      sizeof(struct pvclock_vcpu_time_info));
348 		if (!r) {
349 			vcpu->arch.xen.vcpu_time_info_set = true;
350 			kvm_make_request(KVM_REQ_CLOCK_UPDATE, vcpu);
351 		}
352 		break;
353 
354 	case KVM_XEN_VCPU_ATTR_TYPE_RUNSTATE_ADDR:
355 		if (!sched_info_on()) {
356 			r = -EOPNOTSUPP;
357 			break;
358 		}
359 		if (data->u.gpa == GPA_INVALID) {
360 			vcpu->arch.xen.runstate_set = false;
361 			r = 0;
362 			break;
363 		}
364 
365 		r = kvm_gfn_to_hva_cache_init(vcpu->kvm,
366 					      &vcpu->arch.xen.runstate_cache,
367 					      data->u.gpa,
368 					      sizeof(struct vcpu_runstate_info));
369 		if (!r) {
370 			vcpu->arch.xen.runstate_set = true;
371 		}
372 		break;
373 
374 	case KVM_XEN_VCPU_ATTR_TYPE_RUNSTATE_CURRENT:
375 		if (!sched_info_on()) {
376 			r = -EOPNOTSUPP;
377 			break;
378 		}
379 		if (data->u.runstate.state > RUNSTATE_offline) {
380 			r = -EINVAL;
381 			break;
382 		}
383 
384 		kvm_xen_update_runstate(vcpu, data->u.runstate.state);
385 		r = 0;
386 		break;
387 
388 	case KVM_XEN_VCPU_ATTR_TYPE_RUNSTATE_DATA:
389 		if (!sched_info_on()) {
390 			r = -EOPNOTSUPP;
391 			break;
392 		}
393 		if (data->u.runstate.state > RUNSTATE_offline) {
394 			r = -EINVAL;
395 			break;
396 		}
397 		if (data->u.runstate.state_entry_time !=
398 		    (data->u.runstate.time_running +
399 		     data->u.runstate.time_runnable +
400 		     data->u.runstate.time_blocked +
401 		     data->u.runstate.time_offline)) {
402 			r = -EINVAL;
403 			break;
404 		}
405 		if (get_kvmclock_ns(vcpu->kvm) <
406 		    data->u.runstate.state_entry_time) {
407 			r = -EINVAL;
408 			break;
409 		}
410 
411 		vcpu->arch.xen.current_runstate = data->u.runstate.state;
412 		vcpu->arch.xen.runstate_entry_time =
413 			data->u.runstate.state_entry_time;
414 		vcpu->arch.xen.runstate_times[RUNSTATE_running] =
415 			data->u.runstate.time_running;
416 		vcpu->arch.xen.runstate_times[RUNSTATE_runnable] =
417 			data->u.runstate.time_runnable;
418 		vcpu->arch.xen.runstate_times[RUNSTATE_blocked] =
419 			data->u.runstate.time_blocked;
420 		vcpu->arch.xen.runstate_times[RUNSTATE_offline] =
421 			data->u.runstate.time_offline;
422 		vcpu->arch.xen.last_steal = current->sched_info.run_delay;
423 		r = 0;
424 		break;
425 
426 	case KVM_XEN_VCPU_ATTR_TYPE_RUNSTATE_ADJUST:
427 		if (!sched_info_on()) {
428 			r = -EOPNOTSUPP;
429 			break;
430 		}
431 		if (data->u.runstate.state > RUNSTATE_offline &&
432 		    data->u.runstate.state != (u64)-1) {
433 			r = -EINVAL;
434 			break;
435 		}
436 		/* The adjustment must add up */
437 		if (data->u.runstate.state_entry_time !=
438 		    (data->u.runstate.time_running +
439 		     data->u.runstate.time_runnable +
440 		     data->u.runstate.time_blocked +
441 		     data->u.runstate.time_offline)) {
442 			r = -EINVAL;
443 			break;
444 		}
445 
446 		if (get_kvmclock_ns(vcpu->kvm) <
447 		    (vcpu->arch.xen.runstate_entry_time +
448 		     data->u.runstate.state_entry_time)) {
449 			r = -EINVAL;
450 			break;
451 		}
452 
453 		vcpu->arch.xen.runstate_entry_time +=
454 			data->u.runstate.state_entry_time;
455 		vcpu->arch.xen.runstate_times[RUNSTATE_running] +=
456 			data->u.runstate.time_running;
457 		vcpu->arch.xen.runstate_times[RUNSTATE_runnable] +=
458 			data->u.runstate.time_runnable;
459 		vcpu->arch.xen.runstate_times[RUNSTATE_blocked] +=
460 			data->u.runstate.time_blocked;
461 		vcpu->arch.xen.runstate_times[RUNSTATE_offline] +=
462 			data->u.runstate.time_offline;
463 
464 		if (data->u.runstate.state <= RUNSTATE_offline)
465 			kvm_xen_update_runstate(vcpu, data->u.runstate.state);
466 		r = 0;
467 		break;
468 
469 	default:
470 		break;
471 	}
472 
473 	srcu_read_unlock(&vcpu->kvm->srcu, idx);
474 	mutex_unlock(&vcpu->kvm->lock);
475 	return r;
476 }
477 
478 int kvm_xen_vcpu_get_attr(struct kvm_vcpu *vcpu, struct kvm_xen_vcpu_attr *data)
479 {
480 	int r = -ENOENT;
481 
482 	mutex_lock(&vcpu->kvm->lock);
483 
484 	switch (data->type) {
485 	case KVM_XEN_VCPU_ATTR_TYPE_VCPU_INFO:
486 		if (vcpu->arch.xen.vcpu_info_set)
487 			data->u.gpa = vcpu->arch.xen.vcpu_info_cache.gpa;
488 		else
489 			data->u.gpa = GPA_INVALID;
490 		r = 0;
491 		break;
492 
493 	case KVM_XEN_VCPU_ATTR_TYPE_VCPU_TIME_INFO:
494 		if (vcpu->arch.xen.vcpu_time_info_set)
495 			data->u.gpa = vcpu->arch.xen.vcpu_time_info_cache.gpa;
496 		else
497 			data->u.gpa = GPA_INVALID;
498 		r = 0;
499 		break;
500 
501 	case KVM_XEN_VCPU_ATTR_TYPE_RUNSTATE_ADDR:
502 		if (!sched_info_on()) {
503 			r = -EOPNOTSUPP;
504 			break;
505 		}
506 		if (vcpu->arch.xen.runstate_set) {
507 			data->u.gpa = vcpu->arch.xen.runstate_cache.gpa;
508 			r = 0;
509 		}
510 		break;
511 
512 	case KVM_XEN_VCPU_ATTR_TYPE_RUNSTATE_CURRENT:
513 		if (!sched_info_on()) {
514 			r = -EOPNOTSUPP;
515 			break;
516 		}
517 		data->u.runstate.state = vcpu->arch.xen.current_runstate;
518 		r = 0;
519 		break;
520 
521 	case KVM_XEN_VCPU_ATTR_TYPE_RUNSTATE_DATA:
522 		if (!sched_info_on()) {
523 			r = -EOPNOTSUPP;
524 			break;
525 		}
526 		data->u.runstate.state = vcpu->arch.xen.current_runstate;
527 		data->u.runstate.state_entry_time =
528 			vcpu->arch.xen.runstate_entry_time;
529 		data->u.runstate.time_running =
530 			vcpu->arch.xen.runstate_times[RUNSTATE_running];
531 		data->u.runstate.time_runnable =
532 			vcpu->arch.xen.runstate_times[RUNSTATE_runnable];
533 		data->u.runstate.time_blocked =
534 			vcpu->arch.xen.runstate_times[RUNSTATE_blocked];
535 		data->u.runstate.time_offline =
536 			vcpu->arch.xen.runstate_times[RUNSTATE_offline];
537 		r = 0;
538 		break;
539 
540 	case KVM_XEN_VCPU_ATTR_TYPE_RUNSTATE_ADJUST:
541 		r = -EINVAL;
542 		break;
543 
544 	default:
545 		break;
546 	}
547 
548 	mutex_unlock(&vcpu->kvm->lock);
549 	return r;
550 }
551 
552 int kvm_xen_write_hypercall_page(struct kvm_vcpu *vcpu, u64 data)
553 {
554 	struct kvm *kvm = vcpu->kvm;
555 	u32 page_num = data & ~PAGE_MASK;
556 	u64 page_addr = data & PAGE_MASK;
557 	bool lm = is_long_mode(vcpu);
558 
559 	/* Latch long_mode for shared_info pages etc. */
560 	vcpu->kvm->arch.xen.long_mode = lm;
561 
562 	/*
563 	 * If Xen hypercall intercept is enabled, fill the hypercall
564 	 * page with VMCALL/VMMCALL instructions since that's what
565 	 * we catch. Else the VMM has provided the hypercall pages
566 	 * with instructions of its own choosing, so use those.
567 	 */
568 	if (kvm_xen_hypercall_enabled(kvm)) {
569 		u8 instructions[32];
570 		int i;
571 
572 		if (page_num)
573 			return 1;
574 
575 		/* mov imm32, %eax */
576 		instructions[0] = 0xb8;
577 
578 		/* vmcall / vmmcall */
579 		kvm_x86_ops.patch_hypercall(vcpu, instructions + 5);
580 
581 		/* ret */
582 		instructions[8] = 0xc3;
583 
584 		/* int3 to pad */
585 		memset(instructions + 9, 0xcc, sizeof(instructions) - 9);
586 
587 		for (i = 0; i < PAGE_SIZE / sizeof(instructions); i++) {
588 			*(u32 *)&instructions[1] = i;
589 			if (kvm_vcpu_write_guest(vcpu,
590 						 page_addr + (i * sizeof(instructions)),
591 						 instructions, sizeof(instructions)))
592 				return 1;
593 		}
594 	} else {
595 		/*
596 		 * Note, truncation is a non-issue as 'lm' is guaranteed to be
597 		 * false for a 32-bit kernel, i.e. when hva_t is only 4 bytes.
598 		 */
599 		hva_t blob_addr = lm ? kvm->arch.xen_hvm_config.blob_addr_64
600 				     : kvm->arch.xen_hvm_config.blob_addr_32;
601 		u8 blob_size = lm ? kvm->arch.xen_hvm_config.blob_size_64
602 				  : kvm->arch.xen_hvm_config.blob_size_32;
603 		u8 *page;
604 
605 		if (page_num >= blob_size)
606 			return 1;
607 
608 		blob_addr += page_num * PAGE_SIZE;
609 
610 		page = memdup_user((u8 __user *)blob_addr, PAGE_SIZE);
611 		if (IS_ERR(page))
612 			return PTR_ERR(page);
613 
614 		if (kvm_vcpu_write_guest(vcpu, page_addr, page, PAGE_SIZE)) {
615 			kfree(page);
616 			return 1;
617 		}
618 	}
619 	return 0;
620 }
621 
622 int kvm_xen_hvm_config(struct kvm *kvm, struct kvm_xen_hvm_config *xhc)
623 {
624 	if (xhc->flags & ~KVM_XEN_HVM_CONFIG_INTERCEPT_HCALL)
625 		return -EINVAL;
626 
627 	/*
628 	 * With hypercall interception the kernel generates its own
629 	 * hypercall page so it must not be provided.
630 	 */
631 	if ((xhc->flags & KVM_XEN_HVM_CONFIG_INTERCEPT_HCALL) &&
632 	    (xhc->blob_addr_32 || xhc->blob_addr_64 ||
633 	     xhc->blob_size_32 || xhc->blob_size_64))
634 		return -EINVAL;
635 
636 	mutex_lock(&kvm->lock);
637 
638 	if (xhc->msr && !kvm->arch.xen_hvm_config.msr)
639 		static_branch_inc(&kvm_xen_enabled.key);
640 	else if (!xhc->msr && kvm->arch.xen_hvm_config.msr)
641 		static_branch_slow_dec_deferred(&kvm_xen_enabled);
642 
643 	memcpy(&kvm->arch.xen_hvm_config, xhc, sizeof(*xhc));
644 
645 	mutex_unlock(&kvm->lock);
646 	return 0;
647 }
648 
649 void kvm_xen_destroy_vm(struct kvm *kvm)
650 {
651 	if (kvm->arch.xen_hvm_config.msr)
652 		static_branch_slow_dec_deferred(&kvm_xen_enabled);
653 }
654 
655 static int kvm_xen_hypercall_set_result(struct kvm_vcpu *vcpu, u64 result)
656 {
657 	kvm_rax_write(vcpu, result);
658 	return kvm_skip_emulated_instruction(vcpu);
659 }
660 
661 static int kvm_xen_hypercall_complete_userspace(struct kvm_vcpu *vcpu)
662 {
663 	struct kvm_run *run = vcpu->run;
664 
665 	if (unlikely(!kvm_is_linear_rip(vcpu, vcpu->arch.xen.hypercall_rip)))
666 		return 1;
667 
668 	return kvm_xen_hypercall_set_result(vcpu, run->xen.u.hcall.result);
669 }
670 
671 int kvm_xen_hypercall(struct kvm_vcpu *vcpu)
672 {
673 	bool longmode;
674 	u64 input, params[6];
675 
676 	input = (u64)kvm_register_read(vcpu, VCPU_REGS_RAX);
677 
678 	/* Hyper-V hypercalls get bit 31 set in EAX */
679 	if ((input & 0x80000000) &&
680 	    kvm_hv_hypercall_enabled(vcpu))
681 		return kvm_hv_hypercall(vcpu);
682 
683 	longmode = is_64_bit_mode(vcpu);
684 	if (!longmode) {
685 		params[0] = (u32)kvm_rbx_read(vcpu);
686 		params[1] = (u32)kvm_rcx_read(vcpu);
687 		params[2] = (u32)kvm_rdx_read(vcpu);
688 		params[3] = (u32)kvm_rsi_read(vcpu);
689 		params[4] = (u32)kvm_rdi_read(vcpu);
690 		params[5] = (u32)kvm_rbp_read(vcpu);
691 	}
692 #ifdef CONFIG_X86_64
693 	else {
694 		params[0] = (u64)kvm_rdi_read(vcpu);
695 		params[1] = (u64)kvm_rsi_read(vcpu);
696 		params[2] = (u64)kvm_rdx_read(vcpu);
697 		params[3] = (u64)kvm_r10_read(vcpu);
698 		params[4] = (u64)kvm_r8_read(vcpu);
699 		params[5] = (u64)kvm_r9_read(vcpu);
700 	}
701 #endif
702 	trace_kvm_xen_hypercall(input, params[0], params[1], params[2],
703 				params[3], params[4], params[5]);
704 
705 	vcpu->run->exit_reason = KVM_EXIT_XEN;
706 	vcpu->run->xen.type = KVM_EXIT_XEN_HCALL;
707 	vcpu->run->xen.u.hcall.longmode = longmode;
708 	vcpu->run->xen.u.hcall.cpl = kvm_x86_ops.get_cpl(vcpu);
709 	vcpu->run->xen.u.hcall.input = input;
710 	vcpu->run->xen.u.hcall.params[0] = params[0];
711 	vcpu->run->xen.u.hcall.params[1] = params[1];
712 	vcpu->run->xen.u.hcall.params[2] = params[2];
713 	vcpu->run->xen.u.hcall.params[3] = params[3];
714 	vcpu->run->xen.u.hcall.params[4] = params[4];
715 	vcpu->run->xen.u.hcall.params[5] = params[5];
716 	vcpu->arch.xen.hypercall_rip = kvm_get_linear_rip(vcpu);
717 	vcpu->arch.complete_userspace_io =
718 		kvm_xen_hypercall_complete_userspace;
719 
720 	return 0;
721 }
722