kvm_main.c 62.4 KB
Newer Older
A
Avi Kivity 已提交
1 2 3 4 5 6 7
/*
 * Kernel-based Virtual Machine driver for Linux
 *
 * This module enables machines with Intel VT-x extensions to run virtual
 * machines without emulation or binary translation.
 *
 * Copyright (C) 2006 Qumranet, Inc.
N
Nicolas Kaiser 已提交
8
 * Copyright 2010 Red Hat, Inc. and/or its affiliates.
A
Avi Kivity 已提交
9 10 11 12 13 14 15 16 17 18
 *
 * Authors:
 *   Avi Kivity   <avi@qumranet.com>
 *   Yaniv Kamay  <yaniv@qumranet.com>
 *
 * This work is licensed under the terms of the GNU GPL, version 2.  See
 * the COPYING file in the top-level directory.
 *
 */

19
#include "iodev.h"
A
Avi Kivity 已提交
20

21
#include <linux/kvm_host.h>
A
Avi Kivity 已提交
22 23 24 25 26 27 28 29 30 31 32
#include <linux/kvm.h>
#include <linux/module.h>
#include <linux/errno.h>
#include <linux/percpu.h>
#include <linux/mm.h>
#include <linux/miscdevice.h>
#include <linux/vmalloc.h>
#include <linux/reboot.h>
#include <linux/debugfs.h>
#include <linux/highmem.h>
#include <linux/file.h>
33
#include <linux/syscore_ops.h>
A
Avi Kivity 已提交
34
#include <linux/cpu.h>
A
Alexey Dobriyan 已提交
35
#include <linux/sched.h>
36 37
#include <linux/cpumask.h>
#include <linux/smp.h>
38
#include <linux/anon_inodes.h>
39
#include <linux/profile.h>
40
#include <linux/kvm_para.h>
41
#include <linux/pagemap.h>
42
#include <linux/mman.h>
43
#include <linux/swap.h>
44
#include <linux/bitops.h>
45
#include <linux/spinlock.h>
46
#include <linux/compat.h>
47
#include <linux/srcu.h>
J
Joerg Roedel 已提交
48
#include <linux/hugetlb.h>
49
#include <linux/slab.h>
50 51
#include <linux/sort.h>
#include <linux/bsearch.h>
A
Avi Kivity 已提交
52

A
Avi Kivity 已提交
53 54 55
#include <asm/processor.h>
#include <asm/io.h>
#include <asm/uaccess.h>
56
#include <asm/pgtable.h>
A
Avi Kivity 已提交
57

58
#include "coalesced_mmio.h"
59
#include "async_pf.h"
60

61 62 63
#define CREATE_TRACE_POINTS
#include <trace/events/kvm.h>

A
Avi Kivity 已提交
64 65 66
MODULE_AUTHOR("Qumranet");
MODULE_LICENSE("GPL");

67 68 69
/*
 * Ordering of locks:
 *
70
 * 		kvm->lock --> kvm->slots_lock --> kvm->irq_lock
71 72
 */

73
DEFINE_RAW_SPINLOCK(kvm_lock);
74
LIST_HEAD(vm_list);
75

76
static cpumask_var_t cpus_hardware_enabled;
77 78
static int kvm_usage_count = 0;
static atomic_t hardware_enable_failed;
79

80 81
struct kmem_cache *kvm_vcpu_cache;
EXPORT_SYMBOL_GPL(kvm_vcpu_cache);
A
Avi Kivity 已提交
82

83 84
static __read_mostly struct preempt_ops kvm_preempt_ops;

85
struct dentry *kvm_debugfs_dir;
A
Avi Kivity 已提交
86

A
Avi Kivity 已提交
87 88
static long kvm_vcpu_ioctl(struct file *file, unsigned int ioctl,
			   unsigned long arg);
89 90 91 92
#ifdef CONFIG_COMPAT
static long kvm_vcpu_compat_ioctl(struct file *file, unsigned int ioctl,
				  unsigned long arg);
#endif
93 94
static int hardware_enable_all(void);
static void hardware_disable_all(void);
A
Avi Kivity 已提交
95

M
Marcelo Tosatti 已提交
96 97
static void kvm_io_bus_destroy(struct kvm_io_bus *bus);

98 99
bool kvm_rebooting;
EXPORT_SYMBOL_GPL(kvm_rebooting);
100

101 102
static bool largepages_enabled = true;

X
Xiao Guangrong 已提交
103
bool kvm_is_mmio_pfn(pfn_t pfn)
B
Ben-Ami Yassour 已提交
104
{
105
	if (pfn_valid(pfn)) {
106
		int reserved;
107
		struct page *tail = pfn_to_page(pfn);
108 109
		struct page *head = compound_trans_head(tail);
		reserved = PageReserved(head);
110 111
		if (head != tail) {
			/*
112 113 114 115 116 117 118 119
			 * "head" is not a dangling pointer
			 * (compound_trans_head takes care of that)
			 * but the hugepage may have been splitted
			 * from under us (and we may not hold a
			 * reference count on the head page so it can
			 * be reused before we run PageReferenced), so
			 * we've to check PageTail before returning
			 * what we just read.
120
			 */
121 122 123
			smp_rmb();
			if (PageTail(tail))
				return reserved;
124 125
		}
		return PageReserved(tail);
126
	}
B
Ben-Ami Yassour 已提交
127 128 129 130

	return true;
}

A
Avi Kivity 已提交
131 132 133
/*
 * Switches to specified vcpu, until a matching vcpu_put()
 */
134
void vcpu_load(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
135
{
136 137
	int cpu;

A
Avi Kivity 已提交
138
	mutex_lock(&vcpu->mutex);
139 140 141 142 143 144 145 146
	if (unlikely(vcpu->pid != current->pids[PIDTYPE_PID].pid)) {
		/* The thread running this VCPU changed. */
		struct pid *oldpid = vcpu->pid;
		struct pid *newpid = get_task_pid(current, PIDTYPE_PID);
		rcu_assign_pointer(vcpu->pid, newpid);
		synchronize_rcu();
		put_pid(oldpid);
	}
147 148
	cpu = get_cpu();
	preempt_notifier_register(&vcpu->preempt_notifier);
149
	kvm_arch_vcpu_load(vcpu, cpu);
150
	put_cpu();
A
Avi Kivity 已提交
151 152
}

153
void vcpu_put(struct kvm_vcpu *vcpu)
A
Avi Kivity 已提交
154
{
155
	preempt_disable();
156
	kvm_arch_vcpu_put(vcpu);
157 158
	preempt_notifier_unregister(&vcpu->preempt_notifier);
	preempt_enable();
A
Avi Kivity 已提交
159 160 161
	mutex_unlock(&vcpu->mutex);
}

162 163 164 165
static void ack_flush(void *_completed)
{
}

166
static bool make_all_cpus_request(struct kvm *kvm, unsigned int req)
167
{
168
	int i, cpu, me;
169 170
	cpumask_var_t cpus;
	bool called = true;
171 172
	struct kvm_vcpu *vcpu;

173
	zalloc_cpumask_var(&cpus, GFP_ATOMIC);
174

175
	me = get_cpu();
176
	kvm_for_each_vcpu(i, vcpu, kvm) {
177
		kvm_make_request(req, vcpu);
178
		cpu = vcpu->cpu;
179 180 181 182 183 184

		/* Set ->requests bit before we read ->mode */
		smp_mb();

		if (cpus != NULL && cpu != -1 && cpu != me &&
		      kvm_vcpu_exiting_guest_mode(vcpu) != OUTSIDE_GUEST_MODE)
185
			cpumask_set_cpu(cpu, cpus);
186
	}
187 188 189 190 191 192
	if (unlikely(cpus == NULL))
		smp_call_function_many(cpu_online_mask, ack_flush, NULL, 1);
	else if (!cpumask_empty(cpus))
		smp_call_function_many(cpus, ack_flush, NULL, 1);
	else
		called = false;
193
	put_cpu();
194
	free_cpumask_var(cpus);
195
	return called;
196 197
}

198
void kvm_flush_remote_tlbs(struct kvm *kvm)
199
{
200
	long dirty_count = kvm->tlbs_dirty;
201 202

	smp_mb();
203 204
	if (make_all_cpus_request(kvm, KVM_REQ_TLB_FLUSH))
		++kvm->stat.remote_tlb_flush;
205
	cmpxchg(&kvm->tlbs_dirty, dirty_count, 0);
206 207
}

208 209 210 211
void kvm_reload_remote_mmus(struct kvm *kvm)
{
	make_all_cpus_request(kvm, KVM_REQ_MMU_RELOAD);
}
212

R
Rusty Russell 已提交
213 214 215 216 217 218 219 220 221
int kvm_vcpu_init(struct kvm_vcpu *vcpu, struct kvm *kvm, unsigned id)
{
	struct page *page;
	int r;

	mutex_init(&vcpu->mutex);
	vcpu->cpu = -1;
	vcpu->kvm = kvm;
	vcpu->vcpu_id = id;
222
	vcpu->pid = NULL;
E
Eddie Dong 已提交
223
	init_waitqueue_head(&vcpu->wq);
224
	kvm_async_pf_vcpu_init(vcpu);
R
Rusty Russell 已提交
225 226 227 228 229 230 231 232

	page = alloc_page(GFP_KERNEL | __GFP_ZERO);
	if (!page) {
		r = -ENOMEM;
		goto fail;
	}
	vcpu->run = page_address(page);

233 234 235
	kvm_vcpu_set_in_spin_loop(vcpu, false);
	kvm_vcpu_set_dy_eligible(vcpu, false);

236
	r = kvm_arch_vcpu_init(vcpu);
R
Rusty Russell 已提交
237
	if (r < 0)
238
		goto fail_free_run;
R
Rusty Russell 已提交
239 240 241 242 243
	return 0;

fail_free_run:
	free_page((unsigned long)vcpu->run);
fail:
244
	return r;
R
Rusty Russell 已提交
245 246 247 248 249
}
EXPORT_SYMBOL_GPL(kvm_vcpu_init);

void kvm_vcpu_uninit(struct kvm_vcpu *vcpu)
{
250
	put_pid(vcpu->pid);
251
	kvm_arch_vcpu_uninit(vcpu);
R
Rusty Russell 已提交
252 253 254 255
	free_page((unsigned long)vcpu->run);
}
EXPORT_SYMBOL_GPL(kvm_vcpu_uninit);

256 257 258 259 260 261 262 263 264 265 266
#if defined(CONFIG_MMU_NOTIFIER) && defined(KVM_ARCH_WANT_MMU_NOTIFIER)
static inline struct kvm *mmu_notifier_to_kvm(struct mmu_notifier *mn)
{
	return container_of(mn, struct kvm, mmu_notifier);
}

static void kvm_mmu_notifier_invalidate_page(struct mmu_notifier *mn,
					     struct mm_struct *mm,
					     unsigned long address)
{
	struct kvm *kvm = mmu_notifier_to_kvm(mn);
267
	int need_tlb_flush, idx;
268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286

	/*
	 * When ->invalidate_page runs, the linux pte has been zapped
	 * already but the page is still allocated until
	 * ->invalidate_page returns. So if we increase the sequence
	 * here the kvm page fault will notice if the spte can't be
	 * established because the page is going to be freed. If
	 * instead the kvm page fault establishes the spte before
	 * ->invalidate_page runs, kvm_unmap_hva will release it
	 * before returning.
	 *
	 * The sequence increase only need to be seen at spin_unlock
	 * time, and not at spin_lock time.
	 *
	 * Increasing the sequence after the spin_unlock would be
	 * unsafe because the kvm page fault could then establish the
	 * pte after kvm_unmap_hva returned, without noticing the page
	 * is going to be freed.
	 */
287
	idx = srcu_read_lock(&kvm->srcu);
288
	spin_lock(&kvm->mmu_lock);
289

290
	kvm->mmu_notifier_seq++;
291
	need_tlb_flush = kvm_unmap_hva(kvm, address) | kvm->tlbs_dirty;
292 293 294 295
	/* we've to flush the tlb before the pages can be freed */
	if (need_tlb_flush)
		kvm_flush_remote_tlbs(kvm);

296 297
	spin_unlock(&kvm->mmu_lock);
	srcu_read_unlock(&kvm->srcu, idx);
298 299
}

300 301 302 303 304 305
static void kvm_mmu_notifier_change_pte(struct mmu_notifier *mn,
					struct mm_struct *mm,
					unsigned long address,
					pte_t pte)
{
	struct kvm *kvm = mmu_notifier_to_kvm(mn);
306
	int idx;
307

308
	idx = srcu_read_lock(&kvm->srcu);
309 310 311 312
	spin_lock(&kvm->mmu_lock);
	kvm->mmu_notifier_seq++;
	kvm_set_spte_hva(kvm, address, pte);
	spin_unlock(&kvm->mmu_lock);
313
	srcu_read_unlock(&kvm->srcu, idx);
314 315
}

316 317 318 319 320 321
static void kvm_mmu_notifier_invalidate_range_start(struct mmu_notifier *mn,
						    struct mm_struct *mm,
						    unsigned long start,
						    unsigned long end)
{
	struct kvm *kvm = mmu_notifier_to_kvm(mn);
322
	int need_tlb_flush = 0, idx;
323

324
	idx = srcu_read_lock(&kvm->srcu);
325 326 327 328 329 330 331
	spin_lock(&kvm->mmu_lock);
	/*
	 * The count increase must become visible at unlock time as no
	 * spte can be established without taking the mmu_lock and
	 * count is also read inside the mmu_lock critical section.
	 */
	kvm->mmu_notifier_count++;
332
	need_tlb_flush = kvm_unmap_hva_range(kvm, start, end);
333
	need_tlb_flush |= kvm->tlbs_dirty;
334 335 336
	/* we've to flush the tlb before the pages can be freed */
	if (need_tlb_flush)
		kvm_flush_remote_tlbs(kvm);
337 338 339

	spin_unlock(&kvm->mmu_lock);
	srcu_read_unlock(&kvm->srcu, idx);
340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355
}

static void kvm_mmu_notifier_invalidate_range_end(struct mmu_notifier *mn,
						  struct mm_struct *mm,
						  unsigned long start,
						  unsigned long end)
{
	struct kvm *kvm = mmu_notifier_to_kvm(mn);

	spin_lock(&kvm->mmu_lock);
	/*
	 * This sequence increase will notify the kvm page fault that
	 * the page that is going to be mapped in the spte could have
	 * been freed.
	 */
	kvm->mmu_notifier_seq++;
356
	smp_wmb();
357 358
	/*
	 * The above sequence increase must be visible before the
359 360
	 * below count decrease, which is ensured by the smp_wmb above
	 * in conjunction with the smp_rmb in mmu_notifier_retry().
361 362 363 364 365 366 367 368 369 370 371 372
	 */
	kvm->mmu_notifier_count--;
	spin_unlock(&kvm->mmu_lock);

	BUG_ON(kvm->mmu_notifier_count < 0);
}

static int kvm_mmu_notifier_clear_flush_young(struct mmu_notifier *mn,
					      struct mm_struct *mm,
					      unsigned long address)
{
	struct kvm *kvm = mmu_notifier_to_kvm(mn);
373
	int young, idx;
374

375
	idx = srcu_read_lock(&kvm->srcu);
376 377
	spin_lock(&kvm->mmu_lock);

378
	young = kvm_age_hva(kvm, address);
379 380 381
	if (young)
		kvm_flush_remote_tlbs(kvm);

382 383 384
	spin_unlock(&kvm->mmu_lock);
	srcu_read_unlock(&kvm->srcu, idx);

385 386 387
	return young;
}

A
Andrea Arcangeli 已提交
388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403
static int kvm_mmu_notifier_test_young(struct mmu_notifier *mn,
				       struct mm_struct *mm,
				       unsigned long address)
{
	struct kvm *kvm = mmu_notifier_to_kvm(mn);
	int young, idx;

	idx = srcu_read_lock(&kvm->srcu);
	spin_lock(&kvm->mmu_lock);
	young = kvm_test_age_hva(kvm, address);
	spin_unlock(&kvm->mmu_lock);
	srcu_read_unlock(&kvm->srcu, idx);

	return young;
}

404 405 406 407
static void kvm_mmu_notifier_release(struct mmu_notifier *mn,
				     struct mm_struct *mm)
{
	struct kvm *kvm = mmu_notifier_to_kvm(mn);
408 409 410
	int idx;

	idx = srcu_read_lock(&kvm->srcu);
411
	kvm_arch_flush_shadow(kvm);
412
	srcu_read_unlock(&kvm->srcu, idx);
413 414
}

415 416 417 418 419
static const struct mmu_notifier_ops kvm_mmu_notifier_ops = {
	.invalidate_page	= kvm_mmu_notifier_invalidate_page,
	.invalidate_range_start	= kvm_mmu_notifier_invalidate_range_start,
	.invalidate_range_end	= kvm_mmu_notifier_invalidate_range_end,
	.clear_flush_young	= kvm_mmu_notifier_clear_flush_young,
A
Andrea Arcangeli 已提交
420
	.test_young		= kvm_mmu_notifier_test_young,
421
	.change_pte		= kvm_mmu_notifier_change_pte,
422
	.release		= kvm_mmu_notifier_release,
423
};
424 425 426 427 428 429 430 431 432 433 434 435 436 437

static int kvm_init_mmu_notifier(struct kvm *kvm)
{
	kvm->mmu_notifier.ops = &kvm_mmu_notifier_ops;
	return mmu_notifier_register(&kvm->mmu_notifier, current->mm);
}

#else  /* !(CONFIG_MMU_NOTIFIER && KVM_ARCH_WANT_MMU_NOTIFIER) */

static int kvm_init_mmu_notifier(struct kvm *kvm)
{
	return 0;
}

438 439
#endif /* CONFIG_MMU_NOTIFIER && KVM_ARCH_WANT_MMU_NOTIFIER */

440 441 442 443 444 445
static void kvm_init_memslots_id(struct kvm *kvm)
{
	int i;
	struct kvm_memslots *slots = kvm->memslots;

	for (i = 0; i < KVM_MEM_SLOTS_NUM; i++)
446
		slots->id_to_index[i] = slots->memslots[i].id = i;
447 448
}

449
static struct kvm *kvm_create_vm(unsigned long type)
A
Avi Kivity 已提交
450
{
451 452
	int r, i;
	struct kvm *kvm = kvm_arch_alloc_vm();
A
Avi Kivity 已提交
453

454 455 456
	if (!kvm)
		return ERR_PTR(-ENOMEM);

457
	r = kvm_arch_init_vm(kvm, type);
458 459
	if (r)
		goto out_err_nodisable;
460 461 462 463 464

	r = hardware_enable_all();
	if (r)
		goto out_err_nodisable;

465 466
#ifdef CONFIG_HAVE_KVM_IRQCHIP
	INIT_HLIST_HEAD(&kvm->mask_notifier_list);
467
	INIT_HLIST_HEAD(&kvm->irq_ack_notifier_list);
468
#endif
A
Avi Kivity 已提交
469

470 471 472
	r = -ENOMEM;
	kvm->memslots = kzalloc(sizeof(struct kvm_memslots), GFP_KERNEL);
	if (!kvm->memslots)
473
		goto out_err_nosrcu;
474
	kvm_init_memslots_id(kvm);
475
	if (init_srcu_struct(&kvm->srcu))
476
		goto out_err_nosrcu;
M
Marcelo Tosatti 已提交
477 478 479
	for (i = 0; i < KVM_NR_BUSES; i++) {
		kvm->buses[i] = kzalloc(sizeof(struct kvm_io_bus),
					GFP_KERNEL);
480
		if (!kvm->buses[i])
M
Marcelo Tosatti 已提交
481 482
			goto out_err;
	}
483

484
	spin_lock_init(&kvm->mmu_lock);
485 486
	kvm->mm = current->mm;
	atomic_inc(&kvm->mm->mm_count);
G
Gregory Haskins 已提交
487
	kvm_eventfd_init(kvm);
S
Shaohua Li 已提交
488
	mutex_init(&kvm->lock);
489
	mutex_init(&kvm->irq_lock);
490
	mutex_init(&kvm->slots_lock);
I
Izik Eidus 已提交
491
	atomic_set(&kvm->users_count, 1);
492 493 494 495 496

	r = kvm_init_mmu_notifier(kvm);
	if (r)
		goto out_err;

497
	raw_spin_lock(&kvm_lock);
498
	list_add(&kvm->vm_list, &vm_list);
499
	raw_spin_unlock(&kvm_lock);
500

501
	return kvm;
502 503

out_err:
504 505
	cleanup_srcu_struct(&kvm->srcu);
out_err_nosrcu:
506 507
	hardware_disable_all();
out_err_nodisable:
M
Marcelo Tosatti 已提交
508 509
	for (i = 0; i < KVM_NR_BUSES; i++)
		kfree(kvm->buses[i]);
510
	kfree(kvm->memslots);
511
	kvm_arch_free_vm(kvm);
512
	return ERR_PTR(r);
513 514
}

515 516 517 518
/*
 * Avoid using vmalloc for a small buffer.
 * Should not be used when the size is statically known.
 */
519
void *kvm_kvzalloc(unsigned long size)
520 521 522 523 524 525 526
{
	if (size > PAGE_SIZE)
		return vzalloc(size);
	else
		return kzalloc(size, GFP_KERNEL);
}

527
void kvm_kvfree(const void *addr)
528 529 530 531 532 533 534
{
	if (is_vmalloc_addr(addr))
		vfree(addr);
	else
		kfree(addr);
}

535 536 537 538 539
static void kvm_destroy_dirty_bitmap(struct kvm_memory_slot *memslot)
{
	if (!memslot->dirty_bitmap)
		return;

540
	kvm_kvfree(memslot->dirty_bitmap);
541 542 543
	memslot->dirty_bitmap = NULL;
}

A
Avi Kivity 已提交
544 545 546 547 548 549 550
/*
 * Free any memory in @free but not in @dont.
 */
static void kvm_free_physmem_slot(struct kvm_memory_slot *free,
				  struct kvm_memory_slot *dont)
{
	if (!dont || free->dirty_bitmap != dont->dirty_bitmap)
551
		kvm_destroy_dirty_bitmap(free);
A
Avi Kivity 已提交
552

553
	kvm_arch_free_memslot(free, dont);
M
Marcelo Tosatti 已提交
554

A
Avi Kivity 已提交
555 556 557
	free->npages = 0;
}

558
void kvm_free_physmem(struct kvm *kvm)
A
Avi Kivity 已提交
559
{
560
	struct kvm_memslots *slots = kvm->memslots;
561
	struct kvm_memory_slot *memslot;
562

563 564
	kvm_for_each_memslot(memslot, slots)
		kvm_free_physmem_slot(memslot, NULL);
A
Avi Kivity 已提交
565

566
	kfree(kvm->memslots);
A
Avi Kivity 已提交
567 568
}

569 570
static void kvm_destroy_vm(struct kvm *kvm)
{
M
Marcelo Tosatti 已提交
571
	int i;
572 573
	struct mm_struct *mm = kvm->mm;

574
	kvm_arch_sync_events(kvm);
575
	raw_spin_lock(&kvm_lock);
576
	list_del(&kvm->vm_list);
577
	raw_spin_unlock(&kvm_lock);
578
	kvm_free_irq_routing(kvm);
M
Marcelo Tosatti 已提交
579 580
	for (i = 0; i < KVM_NR_BUSES; i++)
		kvm_io_bus_destroy(kvm->buses[i]);
581
	kvm_coalesced_mmio_free(kvm);
582 583
#if defined(CONFIG_MMU_NOTIFIER) && defined(KVM_ARCH_WANT_MMU_NOTIFIER)
	mmu_notifier_unregister(&kvm->mmu_notifier, kvm->mm);
584 585
#else
	kvm_arch_flush_shadow(kvm);
586
#endif
587
	kvm_arch_destroy_vm(kvm);
588 589 590
	kvm_free_physmem(kvm);
	cleanup_srcu_struct(&kvm->srcu);
	kvm_arch_free_vm(kvm);
591
	hardware_disable_all();
592
	mmdrop(mm);
593 594
}

I
Izik Eidus 已提交
595 596 597 598 599 600 601 602 603 604 605 606 607 608
void kvm_get_kvm(struct kvm *kvm)
{
	atomic_inc(&kvm->users_count);
}
EXPORT_SYMBOL_GPL(kvm_get_kvm);

void kvm_put_kvm(struct kvm *kvm)
{
	if (atomic_dec_and_test(&kvm->users_count))
		kvm_destroy_vm(kvm);
}
EXPORT_SYMBOL_GPL(kvm_put_kvm);


609 610 611 612
static int kvm_vm_release(struct inode *inode, struct file *filp)
{
	struct kvm *kvm = filp->private_data;

G
Gregory Haskins 已提交
613 614
	kvm_irqfd_release(kvm);

I
Izik Eidus 已提交
615
	kvm_put_kvm(kvm);
A
Avi Kivity 已提交
616 617 618
	return 0;
}

619 620
/*
 * Allocation size is twice as large as the actual dirty bitmap size.
621
 * See x86's kvm_vm_ioctl_get_dirty_log() why this is needed.
622
 */
623 624
static int kvm_create_dirty_bitmap(struct kvm_memory_slot *memslot)
{
625
#ifndef CONFIG_S390
626
	unsigned long dirty_bytes = 2 * kvm_dirty_bitmap_bytes(memslot);
627

628
	memslot->dirty_bitmap = kvm_kvzalloc(dirty_bytes);
629 630 631
	if (!memslot->dirty_bitmap)
		return -ENOMEM;

632
#endif /* !CONFIG_S390 */
633 634 635
	return 0;
}

636 637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655 656
static int cmp_memslot(const void *slot1, const void *slot2)
{
	struct kvm_memory_slot *s1, *s2;

	s1 = (struct kvm_memory_slot *)slot1;
	s2 = (struct kvm_memory_slot *)slot2;

	if (s1->npages < s2->npages)
		return 1;
	if (s1->npages > s2->npages)
		return -1;

	return 0;
}

/*
 * Sort the memslots base on its size, so the larger slots
 * will get better fit.
 */
static void sort_memslots(struct kvm_memslots *slots)
{
657 658
	int i;

659 660
	sort(slots->memslots, KVM_MEM_SLOTS_NUM,
	      sizeof(struct kvm_memory_slot), cmp_memslot, NULL);
661 662 663

	for (i = 0; i < KVM_MEM_SLOTS_NUM; i++)
		slots->id_to_index[slots->memslots[i].id] = i;
664 665
}

666 667 668 669
void update_memslots(struct kvm_memslots *slots, struct kvm_memory_slot *new)
{
	if (new) {
		int id = new->id;
670
		struct kvm_memory_slot *old = id_to_memslot(slots, id);
671
		unsigned long npages = old->npages;
672

673
		*old = *new;
674 675
		if (new->npages != npages)
			sort_memslots(slots);
676 677 678 679 680
	}

	slots->generation++;
}

A
Avi Kivity 已提交
681 682 683 684 685
/*
 * Allocate some memory and give it an address in the guest physical address
 * space.
 *
 * Discontiguous memory is allowed, mostly for framebuffers.
686
 *
687
 * Must be called holding mmap_sem for write.
A
Avi Kivity 已提交
688
 */
689 690 691
int __kvm_set_memory_region(struct kvm *kvm,
			    struct kvm_userspace_memory_region *mem,
			    int user_alloc)
A
Avi Kivity 已提交
692
{
693
	int r;
A
Avi Kivity 已提交
694
	gfn_t base_gfn;
695 696
	unsigned long npages;
	unsigned long i;
A
Avi Kivity 已提交
697 698
	struct kvm_memory_slot *memslot;
	struct kvm_memory_slot old, new;
699
	struct kvm_memslots *slots, *old_memslots;
A
Avi Kivity 已提交
700 701 702 703 704 705 706

	r = -EINVAL;
	/* General sanity checks */
	if (mem->memory_size & (PAGE_SIZE - 1))
		goto out;
	if (mem->guest_phys_addr & (PAGE_SIZE - 1))
		goto out;
707 708 709
	/* We can read the guest memory with __xxx_user() later on. */
	if (user_alloc &&
	    ((mem->userspace_addr & (PAGE_SIZE - 1)) ||
710 711 712
	     !access_ok(VERIFY_WRITE,
			(void __user *)(unsigned long)mem->userspace_addr,
			mem->memory_size)))
713
		goto out;
714
	if (mem->slot >= KVM_MEM_SLOTS_NUM)
A
Avi Kivity 已提交
715 716 717 718
		goto out;
	if (mem->guest_phys_addr + mem->memory_size < mem->guest_phys_addr)
		goto out;

719
	memslot = id_to_memslot(kvm->memslots, mem->slot);
A
Avi Kivity 已提交
720 721 722
	base_gfn = mem->guest_phys_addr >> PAGE_SHIFT;
	npages = mem->memory_size >> PAGE_SHIFT;

723 724 725 726
	r = -EINVAL;
	if (npages > KVM_MEM_MAX_NR_PAGES)
		goto out;

A
Avi Kivity 已提交
727 728 729 730 731
	if (!npages)
		mem->flags &= ~KVM_MEM_LOG_DIRTY_PAGES;

	new = old = *memslot;

732
	new.id = mem->slot;
A
Avi Kivity 已提交
733 734 735 736 737 738 739
	new.base_gfn = base_gfn;
	new.npages = npages;
	new.flags = mem->flags;

	/* Disallow changing a memory slot's size. */
	r = -EINVAL;
	if (npages && old.npages && npages != old.npages)
740
		goto out_free;
A
Avi Kivity 已提交
741 742 743 744

	/* Check for overlaps */
	r = -EEXIST;
	for (i = 0; i < KVM_MEMORY_SLOTS; ++i) {
745
		struct kvm_memory_slot *s = &kvm->memslots->memslots[i];
A
Avi Kivity 已提交
746

747
		if (s == memslot || !s->npages)
A
Avi Kivity 已提交
748 749 750
			continue;
		if (!((base_gfn + npages <= s->base_gfn) ||
		      (base_gfn >= s->base_gfn + s->npages)))
751
			goto out_free;
A
Avi Kivity 已提交
752 753 754 755
	}

	/* Free page dirty bitmap if unneeded */
	if (!(new.flags & KVM_MEM_LOG_DIRTY_PAGES))
A
Al Viro 已提交
756
		new.dirty_bitmap = NULL;
A
Avi Kivity 已提交
757 758 759 760

	r = -ENOMEM;

	/* Allocate if a slot is being created */
761 762 763
	if (npages && !old.npages) {
		new.user_alloc = user_alloc;
		new.userspace_addr = mem->userspace_addr;
764

765 766
		if (kvm_arch_create_memslot(&new, npages))
			goto out_free;
A
Avi Kivity 已提交
767
	}
768

A
Avi Kivity 已提交
769 770
	/* Allocate page dirty bitmap if needed */
	if ((new.flags & KVM_MEM_LOG_DIRTY_PAGES) && !new.dirty_bitmap) {
771
		if (kvm_create_dirty_bitmap(&new) < 0)
772
			goto out_free;
773
		/* destroy any largepage mappings for dirty tracking */
A
Avi Kivity 已提交
774 775
	}

776
	if (!npages) {
777 778
		struct kvm_memory_slot *slot;

779
		r = -ENOMEM;
780 781
		slots = kmemdup(kvm->memslots, sizeof(struct kvm_memslots),
				GFP_KERNEL);
782 783
		if (!slots)
			goto out_free;
784 785 786
		slot = id_to_memslot(slots, mem->slot);
		slot->flags |= KVM_MEMSLOT_INVALID;

787
		update_memslots(slots, NULL);
788 789 790 791 792 793 794 795 796 797 798

		old_memslots = kvm->memslots;
		rcu_assign_pointer(kvm->memslots, slots);
		synchronize_srcu_expedited(&kvm->srcu);
		/* From this point no new shadow pages pointing to a deleted
		 * memslot will be created.
		 *
		 * validation of sp->gfn happens in:
		 * 	- gfn_to_hva (kvm_read_guest, gfn_to_pfn)
		 * 	- kvm_is_visible_gfn (mmu_check_roots)
		 */
799
		kvm_arch_flush_shadow(kvm);
800 801
		kfree(old_memslots);
	}
802

803 804 805 806
	r = kvm_arch_prepare_memory_region(kvm, &new, old, mem, user_alloc);
	if (r)
		goto out_free;

807
	/* map/unmap the pages in iommu page table */
808 809 810 811
	if (npages) {
		r = kvm_iommu_map_pages(kvm, &new);
		if (r)
			goto out_free;
812 813
	} else
		kvm_iommu_unmap_pages(kvm, &old);
814

815
	r = -ENOMEM;
816 817
	slots = kmemdup(kvm->memslots, sizeof(struct kvm_memslots),
			GFP_KERNEL);
818 819 820 821 822 823
	if (!slots)
		goto out_free;

	/* actual memory is freed via old in kvm_free_physmem_slot below */
	if (!npages) {
		new.dirty_bitmap = NULL;
824
		memset(&new.arch, 0, sizeof(new.arch));
825 826
	}

827
	update_memslots(slots, &new);
828 829 830
	old_memslots = kvm->memslots;
	rcu_assign_pointer(kvm->memslots, slots);
	synchronize_srcu_expedited(&kvm->srcu);
831

832
	kvm_arch_commit_memory_region(kvm, mem, old, user_alloc);
833

834 835 836 837 838 839 840
	/*
	 * If the new memory slot is created, we need to clear all
	 * mmio sptes.
	 */
	if (npages && old.base_gfn != mem->guest_phys_addr >> PAGE_SHIFT)
		kvm_arch_flush_shadow(kvm);

841 842 843
	kvm_free_physmem_slot(&old, &new);
	kfree(old_memslots);

A
Avi Kivity 已提交
844 845
	return 0;

846
out_free:
A
Avi Kivity 已提交
847 848 849
	kvm_free_physmem_slot(&new, &old);
out:
	return r;
850 851

}
852 853 854 855 856 857 858 859
EXPORT_SYMBOL_GPL(__kvm_set_memory_region);

int kvm_set_memory_region(struct kvm *kvm,
			  struct kvm_userspace_memory_region *mem,
			  int user_alloc)
{
	int r;

860
	mutex_lock(&kvm->slots_lock);
861
	r = __kvm_set_memory_region(kvm, mem, user_alloc);
862
	mutex_unlock(&kvm->slots_lock);
863 864
	return r;
}
865 866
EXPORT_SYMBOL_GPL(kvm_set_memory_region);

867 868 869 870
int kvm_vm_ioctl_set_memory_region(struct kvm *kvm,
				   struct
				   kvm_userspace_memory_region *mem,
				   int user_alloc)
871
{
872 873
	if (mem->slot >= KVM_MEMORY_SLOTS)
		return -EINVAL;
874
	return kvm_set_memory_region(kvm, mem, user_alloc);
A
Avi Kivity 已提交
875 876
}

877 878
int kvm_get_dirty_log(struct kvm *kvm,
			struct kvm_dirty_log *log, int *is_dirty)
A
Avi Kivity 已提交
879 880 881
{
	struct kvm_memory_slot *memslot;
	int r, i;
882
	unsigned long n;
A
Avi Kivity 已提交
883 884 885 886 887 888
	unsigned long any = 0;

	r = -EINVAL;
	if (log->slot >= KVM_MEMORY_SLOTS)
		goto out;

889
	memslot = id_to_memslot(kvm->memslots, log->slot);
A
Avi Kivity 已提交
890 891 892 893
	r = -ENOENT;
	if (!memslot->dirty_bitmap)
		goto out;

894
	n = kvm_dirty_bitmap_bytes(memslot);
A
Avi Kivity 已提交
895

896
	for (i = 0; !any && i < n/sizeof(long); ++i)
A
Avi Kivity 已提交
897 898 899 900 901 902
		any = memslot->dirty_bitmap[i];

	r = -EFAULT;
	if (copy_to_user(log->dirty_bitmap, memslot->dirty_bitmap, n))
		goto out;

903 904
	if (any)
		*is_dirty = 1;
A
Avi Kivity 已提交
905 906 907 908 909 910

	r = 0;
out:
	return r;
}

911 912 913 914 915
bool kvm_largepages_enabled(void)
{
	return largepages_enabled;
}

916 917 918 919 920 921
void kvm_disable_largepages(void)
{
	largepages_enabled = false;
}
EXPORT_SYMBOL_GPL(kvm_disable_largepages);

I
Izik Eidus 已提交
922 923 924 925 926 927 928 929 930 931 932
static inline unsigned long bad_hva(void)
{
	return PAGE_OFFSET;
}

int kvm_is_error_hva(unsigned long addr)
{
	return addr == bad_hva();
}
EXPORT_SYMBOL_GPL(kvm_is_error_hva);

933 934 935 936
struct kvm_memory_slot *gfn_to_memslot(struct kvm *kvm, gfn_t gfn)
{
	return __gfn_to_memslot(kvm_memslots(kvm), gfn);
}
A
Avi Kivity 已提交
937
EXPORT_SYMBOL_GPL(gfn_to_memslot);
A
Avi Kivity 已提交
938

939 940
int kvm_is_visible_gfn(struct kvm *kvm, gfn_t gfn)
{
941
	struct kvm_memory_slot *memslot = gfn_to_memslot(kvm, gfn);
942

943 944 945
	if (!memslot || memslot->id >= KVM_MEMORY_SLOTS ||
	      memslot->flags & KVM_MEMSLOT_INVALID)
		return 0;
946

947
	return 1;
948 949 950
}
EXPORT_SYMBOL_GPL(kvm_is_visible_gfn);

J
Joerg Roedel 已提交
951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974
unsigned long kvm_host_page_size(struct kvm *kvm, gfn_t gfn)
{
	struct vm_area_struct *vma;
	unsigned long addr, size;

	size = PAGE_SIZE;

	addr = gfn_to_hva(kvm, gfn);
	if (kvm_is_error_hva(addr))
		return PAGE_SIZE;

	down_read(&current->mm->mmap_sem);
	vma = find_vma(current->mm, addr);
	if (!vma)
		goto out;

	size = vma_kernel_pagesize(vma);

out:
	up_read(&current->mm->mmap_sem);

	return size;
}

975
static unsigned long gfn_to_hva_many(struct kvm_memory_slot *slot, gfn_t gfn,
976
				     gfn_t *nr_pages)
I
Izik Eidus 已提交
977
{
978
	if (!slot || slot->flags & KVM_MEMSLOT_INVALID)
I
Izik Eidus 已提交
979
		return bad_hva();
980 981 982 983

	if (nr_pages)
		*nr_pages = slot->npages - (gfn - slot->base_gfn);

984
	return gfn_to_hva_memslot(slot, gfn);
I
Izik Eidus 已提交
985
}
986 987 988

unsigned long gfn_to_hva(struct kvm *kvm, gfn_t gfn)
{
989
	return gfn_to_hva_many(gfn_to_memslot(kvm, gfn), gfn, NULL);
990
}
991
EXPORT_SYMBOL_GPL(gfn_to_hva);
I
Izik Eidus 已提交
992

993 994 995 996 997 998 999 1000 1001 1002 1003
int get_user_page_nowait(struct task_struct *tsk, struct mm_struct *mm,
	unsigned long start, int write, struct page **page)
{
	int flags = FOLL_TOUCH | FOLL_NOWAIT | FOLL_HWPOISON | FOLL_GET;

	if (write)
		flags |= FOLL_WRITE;

	return __get_user_pages(tsk, mm, start, 1, flags, page, NULL, NULL);
}

1004 1005 1006 1007 1008 1009 1010 1011 1012
static inline int check_user_page_hwpoison(unsigned long addr)
{
	int rc, flags = FOLL_TOUCH | FOLL_HWPOISON | FOLL_WRITE;

	rc = __get_user_pages(current, current->mm, addr, 1,
			      flags, NULL, NULL, NULL);
	return rc == -EHWPOISON;
}

1013 1014
static pfn_t hva_to_pfn(unsigned long addr, bool atomic, bool *async,
			bool write_fault, bool *writable)
A
Avi Kivity 已提交
1015
{
1016
	struct page *page[1];
1017
	int npages = 0;
1018
	pfn_t pfn;
A
Avi Kivity 已提交
1019

1020 1021 1022
	/* we can do it either atomically or asynchronously, not both */
	BUG_ON(atomic && async);

1023 1024 1025 1026 1027
	BUG_ON(!write_fault && !writable);

	if (writable)
		*writable = true;

1028
	if (atomic || async)
1029
		npages = __get_user_pages_fast(addr, 1, 1, page);
1030 1031

	if (unlikely(npages != 1) && !atomic) {
1032
		might_sleep();
1033 1034 1035 1036

		if (writable)
			*writable = write_fault;

1037 1038 1039 1040 1041 1042 1043 1044
		if (async) {
			down_read(&current->mm->mmap_sem);
			npages = get_user_page_nowait(current, current->mm,
						     addr, write_fault, page);
			up_read(&current->mm->mmap_sem);
		} else
			npages = get_user_pages_fast(addr, 1, write_fault,
						     page);
1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057

		/* map read fault as writable if possible */
		if (unlikely(!write_fault) && npages == 1) {
			struct page *wpage[1];

			npages = __get_user_pages_fast(addr, 1, 1, wpage);
			if (npages == 1) {
				*writable = true;
				put_page(page[0]);
				page[0] = wpage[0];
			}
			npages = 1;
		}
1058
	}
I
Izik Eidus 已提交
1059

1060 1061 1062
	if (unlikely(npages != 1)) {
		struct vm_area_struct *vma;

1063
		if (atomic)
1064
			return KVM_PFN_ERR_FAULT;
1065

1066
		down_read(&current->mm->mmap_sem);
1067 1068
		if (npages == -EHWPOISON ||
			(!async && check_user_page_hwpoison(addr))) {
1069
			up_read(&current->mm->mmap_sem);
1070
			return KVM_PFN_ERR_HWPOISON;
1071 1072
		}

1073
		vma = find_vma_intersection(current->mm, addr, addr+1);
1074

1075
		if (vma == NULL)
1076
			pfn = KVM_PFN_ERR_FAULT;
1077 1078 1079 1080 1081 1082
		else if ((vma->vm_flags & VM_PFNMAP)) {
			pfn = ((addr - vma->vm_start) >> PAGE_SHIFT) +
				vma->vm_pgoff;
			BUG_ON(!kvm_is_mmio_pfn(pfn));
		} else {
			if (async && (vma->vm_flags & VM_WRITE))
1083
				*async = true;
1084
			pfn = KVM_PFN_ERR_FAULT;
1085
		}
1086
		up_read(&current->mm->mmap_sem);
1087 1088
	} else
		pfn = page_to_pfn(page[0]);
1089

1090
	return pfn;
1091 1092
}

1093
pfn_t hva_to_pfn_atomic(unsigned long addr)
1094
{
1095
	return hva_to_pfn(addr, true, NULL, true, NULL);
1096 1097 1098
}
EXPORT_SYMBOL_GPL(hva_to_pfn_atomic);

1099 1100
static pfn_t __gfn_to_pfn(struct kvm *kvm, gfn_t gfn, bool atomic, bool *async,
			  bool write_fault, bool *writable)
1101 1102 1103
{
	unsigned long addr;

1104 1105 1106
	if (async)
		*async = false;

1107
	addr = gfn_to_hva(kvm, gfn);
X
Xiao Guangrong 已提交
1108
	if (kvm_is_error_hva(addr))
X
Xiao Guangrong 已提交
1109
		return KVM_PFN_ERR_BAD;
1110

1111
	return hva_to_pfn(addr, atomic, async, write_fault, writable);
1112 1113 1114 1115
}

pfn_t gfn_to_pfn_atomic(struct kvm *kvm, gfn_t gfn)
{
1116
	return __gfn_to_pfn(kvm, gfn, true, NULL, true, NULL);
1117 1118 1119
}
EXPORT_SYMBOL_GPL(gfn_to_pfn_atomic);

1120 1121
pfn_t gfn_to_pfn_async(struct kvm *kvm, gfn_t gfn, bool *async,
		       bool write_fault, bool *writable)
1122
{
1123
	return __gfn_to_pfn(kvm, gfn, false, async, write_fault, writable);
1124 1125 1126
}
EXPORT_SYMBOL_GPL(gfn_to_pfn_async);

1127 1128
pfn_t gfn_to_pfn(struct kvm *kvm, gfn_t gfn)
{
1129
	return __gfn_to_pfn(kvm, gfn, false, NULL, true, NULL);
1130
}
1131 1132
EXPORT_SYMBOL_GPL(gfn_to_pfn);

1133 1134 1135 1136 1137 1138 1139
pfn_t gfn_to_pfn_prot(struct kvm *kvm, gfn_t gfn, bool write_fault,
		      bool *writable)
{
	return __gfn_to_pfn(kvm, gfn, false, NULL, write_fault, writable);
}
EXPORT_SYMBOL_GPL(gfn_to_pfn_prot);

1140
pfn_t gfn_to_pfn_memslot(struct kvm_memory_slot *slot, gfn_t gfn)
1141 1142
{
	unsigned long addr = gfn_to_hva_memslot(slot, gfn);
1143
	return hva_to_pfn(addr, false, NULL, true, NULL);
1144 1145
}

1146 1147 1148 1149 1150 1151
int gfn_to_page_many_atomic(struct kvm *kvm, gfn_t gfn, struct page **pages,
								  int nr_pages)
{
	unsigned long addr;
	gfn_t entry;

1152
	addr = gfn_to_hva_many(gfn_to_memslot(kvm, gfn), gfn, &entry);
1153 1154 1155 1156 1157 1158 1159 1160 1161 1162
	if (kvm_is_error_hva(addr))
		return -1;

	if (entry < nr_pages)
		return 0;

	return __get_user_pages_fast(addr, nr_pages, 1, pages);
}
EXPORT_SYMBOL_GPL(gfn_to_page_many_atomic);

X
Xiao Guangrong 已提交
1163 1164
static struct page *kvm_pfn_to_page(pfn_t pfn)
{
1165 1166
	if (is_error_pfn(pfn))
		return KVM_ERR_PTR_BAD_PAGE;
X
Xiao Guangrong 已提交
1167

1168 1169
	if (kvm_is_mmio_pfn(pfn)) {
		WARN_ON(1);
1170
		return KVM_ERR_PTR_BAD_PAGE;
1171
	}
X
Xiao Guangrong 已提交
1172 1173 1174 1175

	return pfn_to_page(pfn);
}

1176 1177
struct page *gfn_to_page(struct kvm *kvm, gfn_t gfn)
{
1178 1179 1180 1181
	pfn_t pfn;

	pfn = gfn_to_pfn(kvm, gfn);

X
Xiao Guangrong 已提交
1182
	return kvm_pfn_to_page(pfn);
A
Avi Kivity 已提交
1183
}
1184

A
Avi Kivity 已提交
1185 1186
EXPORT_SYMBOL_GPL(gfn_to_page);

1187 1188
void kvm_release_page_clean(struct page *page)
{
1189 1190 1191
	WARN_ON(is_error_page(page));

	kvm_release_pfn_clean(page_to_pfn(page));
1192 1193 1194
}
EXPORT_SYMBOL_GPL(kvm_release_page_clean);

1195 1196
void kvm_release_pfn_clean(pfn_t pfn)
{
1197 1198 1199
	WARN_ON(is_error_pfn(pfn));

	if (!kvm_is_mmio_pfn(pfn))
1200
		put_page(pfn_to_page(pfn));
1201 1202 1203
}
EXPORT_SYMBOL_GPL(kvm_release_pfn_clean);

1204
void kvm_release_page_dirty(struct page *page)
1205
{
X
Xiao Guangrong 已提交
1206 1207
	WARN_ON(is_error_page(page));

1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220 1221 1222 1223 1224 1225 1226
	kvm_release_pfn_dirty(page_to_pfn(page));
}
EXPORT_SYMBOL_GPL(kvm_release_page_dirty);

void kvm_release_pfn_dirty(pfn_t pfn)
{
	kvm_set_pfn_dirty(pfn);
	kvm_release_pfn_clean(pfn);
}
EXPORT_SYMBOL_GPL(kvm_release_pfn_dirty);

void kvm_set_page_dirty(struct page *page)
{
	kvm_set_pfn_dirty(page_to_pfn(page));
}
EXPORT_SYMBOL_GPL(kvm_set_page_dirty);

void kvm_set_pfn_dirty(pfn_t pfn)
{
1227
	if (!kvm_is_mmio_pfn(pfn)) {
1228 1229 1230 1231
		struct page *page = pfn_to_page(pfn);
		if (!PageReserved(page))
			SetPageDirty(page);
	}
1232
}
1233 1234 1235 1236
EXPORT_SYMBOL_GPL(kvm_set_pfn_dirty);

void kvm_set_pfn_accessed(pfn_t pfn)
{
1237
	if (!kvm_is_mmio_pfn(pfn))
1238
		mark_page_accessed(pfn_to_page(pfn));
1239 1240 1241 1242 1243
}
EXPORT_SYMBOL_GPL(kvm_set_pfn_accessed);

void kvm_get_pfn(pfn_t pfn)
{
1244
	if (!kvm_is_mmio_pfn(pfn))
1245
		get_page(pfn_to_page(pfn));
1246 1247
}
EXPORT_SYMBOL_GPL(kvm_get_pfn);
1248

1249 1250 1251 1252 1253 1254 1255 1256 1257 1258 1259
static int next_segment(unsigned long len, int offset)
{
	if (len > PAGE_SIZE - offset)
		return PAGE_SIZE - offset;
	else
		return len;
}

int kvm_read_guest_page(struct kvm *kvm, gfn_t gfn, void *data, int offset,
			int len)
{
1260 1261
	int r;
	unsigned long addr;
1262

1263 1264 1265
	addr = gfn_to_hva(kvm, gfn);
	if (kvm_is_error_hva(addr))
		return -EFAULT;
1266
	r = __copy_from_user(data, (void __user *)addr + offset, len);
1267
	if (r)
1268 1269 1270 1271 1272 1273 1274 1275 1276 1277 1278 1279 1280 1281 1282 1283 1284 1285 1286 1287 1288 1289 1290 1291 1292
		return -EFAULT;
	return 0;
}
EXPORT_SYMBOL_GPL(kvm_read_guest_page);

int kvm_read_guest(struct kvm *kvm, gpa_t gpa, void *data, unsigned long len)
{
	gfn_t gfn = gpa >> PAGE_SHIFT;
	int seg;
	int offset = offset_in_page(gpa);
	int ret;

	while ((seg = next_segment(len, offset)) != 0) {
		ret = kvm_read_guest_page(kvm, gfn, data, offset, seg);
		if (ret < 0)
			return ret;
		offset = 0;
		len -= seg;
		data += seg;
		++gfn;
	}
	return 0;
}
EXPORT_SYMBOL_GPL(kvm_read_guest);

1293 1294 1295 1296 1297 1298 1299 1300 1301 1302 1303
int kvm_read_guest_atomic(struct kvm *kvm, gpa_t gpa, void *data,
			  unsigned long len)
{
	int r;
	unsigned long addr;
	gfn_t gfn = gpa >> PAGE_SHIFT;
	int offset = offset_in_page(gpa);

	addr = gfn_to_hva(kvm, gfn);
	if (kvm_is_error_hva(addr))
		return -EFAULT;
1304
	pagefault_disable();
1305
	r = __copy_from_user_inatomic(data, (void __user *)addr + offset, len);
1306
	pagefault_enable();
1307 1308 1309 1310 1311 1312
	if (r)
		return -EFAULT;
	return 0;
}
EXPORT_SYMBOL(kvm_read_guest_atomic);

1313 1314 1315
int kvm_write_guest_page(struct kvm *kvm, gfn_t gfn, const void *data,
			 int offset, int len)
{
1316 1317
	int r;
	unsigned long addr;
1318

1319 1320 1321
	addr = gfn_to_hva(kvm, gfn);
	if (kvm_is_error_hva(addr))
		return -EFAULT;
1322
	r = __copy_to_user((void __user *)addr + offset, data, len);
1323
	if (r)
1324 1325 1326 1327 1328 1329 1330 1331 1332 1333 1334 1335 1336 1337 1338 1339 1340 1341 1342 1343 1344 1345 1346 1347 1348 1349
		return -EFAULT;
	mark_page_dirty(kvm, gfn);
	return 0;
}
EXPORT_SYMBOL_GPL(kvm_write_guest_page);

int kvm_write_guest(struct kvm *kvm, gpa_t gpa, const void *data,
		    unsigned long len)
{
	gfn_t gfn = gpa >> PAGE_SHIFT;
	int seg;
	int offset = offset_in_page(gpa);
	int ret;

	while ((seg = next_segment(len, offset)) != 0) {
		ret = kvm_write_guest_page(kvm, gfn, data, offset, seg);
		if (ret < 0)
			return ret;
		offset = 0;
		len -= seg;
		data += seg;
		++gfn;
	}
	return 0;
}

1350 1351 1352 1353 1354 1355 1356 1357 1358
int kvm_gfn_to_hva_cache_init(struct kvm *kvm, struct gfn_to_hva_cache *ghc,
			      gpa_t gpa)
{
	struct kvm_memslots *slots = kvm_memslots(kvm);
	int offset = offset_in_page(gpa);
	gfn_t gfn = gpa >> PAGE_SHIFT;

	ghc->gpa = gpa;
	ghc->generation = slots->generation;
1359
	ghc->memslot = gfn_to_memslot(kvm, gfn);
1360 1361 1362 1363 1364 1365 1366 1367 1368 1369 1370 1371 1372 1373 1374 1375 1376 1377 1378 1379 1380 1381
	ghc->hva = gfn_to_hva_many(ghc->memslot, gfn, NULL);
	if (!kvm_is_error_hva(ghc->hva))
		ghc->hva += offset;
	else
		return -EFAULT;

	return 0;
}
EXPORT_SYMBOL_GPL(kvm_gfn_to_hva_cache_init);

int kvm_write_guest_cached(struct kvm *kvm, struct gfn_to_hva_cache *ghc,
			   void *data, unsigned long len)
{
	struct kvm_memslots *slots = kvm_memslots(kvm);
	int r;

	if (slots->generation != ghc->generation)
		kvm_gfn_to_hva_cache_init(kvm, ghc, ghc->gpa);

	if (kvm_is_error_hva(ghc->hva))
		return -EFAULT;

1382
	r = __copy_to_user((void __user *)ghc->hva, data, len);
1383 1384 1385 1386 1387 1388 1389 1390
	if (r)
		return -EFAULT;
	mark_page_dirty_in_slot(kvm, ghc->memslot, ghc->gpa >> PAGE_SHIFT);

	return 0;
}
EXPORT_SYMBOL_GPL(kvm_write_guest_cached);

1391 1392 1393 1394 1395 1396 1397 1398 1399 1400 1401 1402 1403 1404 1405 1406 1407 1408 1409 1410
int kvm_read_guest_cached(struct kvm *kvm, struct gfn_to_hva_cache *ghc,
			   void *data, unsigned long len)
{
	struct kvm_memslots *slots = kvm_memslots(kvm);
	int r;

	if (slots->generation != ghc->generation)
		kvm_gfn_to_hva_cache_init(kvm, ghc, ghc->gpa);

	if (kvm_is_error_hva(ghc->hva))
		return -EFAULT;

	r = __copy_from_user(data, (void __user *)ghc->hva, len);
	if (r)
		return -EFAULT;

	return 0;
}
EXPORT_SYMBOL_GPL(kvm_read_guest_cached);

1411 1412
int kvm_clear_guest_page(struct kvm *kvm, gfn_t gfn, int offset, int len)
{
1413 1414
	return kvm_write_guest_page(kvm, gfn, (const void *) empty_zero_page,
				    offset, len);
1415 1416 1417 1418 1419 1420 1421 1422 1423 1424 1425 1426 1427 1428 1429 1430 1431 1432 1433 1434 1435 1436
}
EXPORT_SYMBOL_GPL(kvm_clear_guest_page);

int kvm_clear_guest(struct kvm *kvm, gpa_t gpa, unsigned long len)
{
	gfn_t gfn = gpa >> PAGE_SHIFT;
	int seg;
	int offset = offset_in_page(gpa);
	int ret;

        while ((seg = next_segment(len, offset)) != 0) {
		ret = kvm_clear_guest_page(kvm, gfn, offset, seg);
		if (ret < 0)
			return ret;
		offset = 0;
		len -= seg;
		++gfn;
	}
	return 0;
}
EXPORT_SYMBOL_GPL(kvm_clear_guest);

1437 1438
void mark_page_dirty_in_slot(struct kvm *kvm, struct kvm_memory_slot *memslot,
			     gfn_t gfn)
A
Avi Kivity 已提交
1439
{
R
Rusty Russell 已提交
1440 1441
	if (memslot && memslot->dirty_bitmap) {
		unsigned long rel_gfn = gfn - memslot->base_gfn;
A
Avi Kivity 已提交
1442

1443 1444
		/* TODO: introduce set_bit_le() and use it */
		test_and_set_bit_le(rel_gfn, memslot->dirty_bitmap);
A
Avi Kivity 已提交
1445 1446 1447
	}
}

1448 1449 1450 1451 1452 1453 1454 1455
void mark_page_dirty(struct kvm *kvm, gfn_t gfn)
{
	struct kvm_memory_slot *memslot;

	memslot = gfn_to_memslot(kvm, gfn);
	mark_page_dirty_in_slot(kvm, memslot, gfn);
}

E
Eddie Dong 已提交
1456 1457 1458
/*
 * The vCPU has executed a HLT instruction with in-kernel mode enabled.
 */
1459
void kvm_vcpu_block(struct kvm_vcpu *vcpu)
1460
{
1461 1462 1463 1464 1465
	DEFINE_WAIT(wait);

	for (;;) {
		prepare_to_wait(&vcpu->wq, &wait, TASK_INTERRUPTIBLE);

1466
		if (kvm_arch_vcpu_runnable(vcpu)) {
1467
			kvm_make_request(KVM_REQ_UNHALT, vcpu);
1468
			break;
1469
		}
1470 1471
		if (kvm_cpu_has_pending_timer(vcpu))
			break;
1472 1473 1474
		if (signal_pending(current))
			break;

E
Eddie Dong 已提交
1475 1476
		schedule();
	}
1477

1478
	finish_wait(&vcpu->wq, &wait);
E
Eddie Dong 已提交
1479 1480
}

1481
#ifndef CONFIG_S390
1482 1483 1484 1485 1486 1487 1488 1489 1490 1491 1492 1493 1494 1495 1496 1497 1498 1499 1500 1501 1502
/*
 * Kick a sleeping VCPU, or a guest VCPU in guest mode, into host kernel mode.
 */
void kvm_vcpu_kick(struct kvm_vcpu *vcpu)
{
	int me;
	int cpu = vcpu->cpu;
	wait_queue_head_t *wqp;

	wqp = kvm_arch_vcpu_wq(vcpu);
	if (waitqueue_active(wqp)) {
		wake_up_interruptible(wqp);
		++vcpu->stat.halt_wakeup;
	}

	me = get_cpu();
	if (cpu != me && (unsigned)cpu < nr_cpu_ids && cpu_online(cpu))
		if (kvm_arch_vcpu_should_kick(vcpu))
			smp_send_reschedule(cpu);
	put_cpu();
}
1503
#endif /* !CONFIG_S390 */
1504

A
Avi Kivity 已提交
1505 1506
void kvm_resched(struct kvm_vcpu *vcpu)
{
1507 1508
	if (!need_resched())
		return;
A
Avi Kivity 已提交
1509 1510 1511 1512
	cond_resched();
}
EXPORT_SYMBOL_GPL(kvm_resched);

1513 1514 1515 1516 1517 1518 1519 1520 1521 1522 1523 1524 1525 1526 1527 1528 1529 1530 1531 1532 1533 1534 1535 1536 1537
bool kvm_vcpu_yield_to(struct kvm_vcpu *target)
{
	struct pid *pid;
	struct task_struct *task = NULL;

	rcu_read_lock();
	pid = rcu_dereference(target->pid);
	if (pid)
		task = get_pid_task(target->pid, PIDTYPE_PID);
	rcu_read_unlock();
	if (!task)
		return false;
	if (task->flags & PF_VCPU) {
		put_task_struct(task);
		return false;
	}
	if (yield_to(task, 1)) {
		put_task_struct(task);
		return true;
	}
	put_task_struct(task);
	return false;
}
EXPORT_SYMBOL_GPL(kvm_vcpu_yield_to);

1538 1539 1540 1541 1542 1543 1544 1545 1546 1547 1548 1549 1550 1551 1552 1553 1554 1555 1556 1557 1558 1559 1560 1561 1562 1563 1564 1565 1566 1567 1568 1569 1570 1571 1572 1573 1574
#ifdef CONFIG_HAVE_KVM_CPU_RELAX_INTERCEPT
/*
 * Helper that checks whether a VCPU is eligible for directed yield.
 * Most eligible candidate to yield is decided by following heuristics:
 *
 *  (a) VCPU which has not done pl-exit or cpu relax intercepted recently
 *  (preempted lock holder), indicated by @in_spin_loop.
 *  Set at the beiginning and cleared at the end of interception/PLE handler.
 *
 *  (b) VCPU which has done pl-exit/ cpu relax intercepted but did not get
 *  chance last time (mostly it has become eligible now since we have probably
 *  yielded to lockholder in last iteration. This is done by toggling
 *  @dy_eligible each time a VCPU checked for eligibility.)
 *
 *  Yielding to a recently pl-exited/cpu relax intercepted VCPU before yielding
 *  to preempted lock-holder could result in wrong VCPU selection and CPU
 *  burning. Giving priority for a potential lock-holder increases lock
 *  progress.
 *
 *  Since algorithm is based on heuristics, accessing another VCPU data without
 *  locking does not harm. It may result in trying to yield to  same VCPU, fail
 *  and continue with next VCPU and so on.
 */
bool kvm_vcpu_eligible_for_directed_yield(struct kvm_vcpu *vcpu)
{
	bool eligible;

	eligible = !vcpu->spin_loop.in_spin_loop ||
			(vcpu->spin_loop.in_spin_loop &&
			 vcpu->spin_loop.dy_eligible);

	if (vcpu->spin_loop.in_spin_loop)
		kvm_vcpu_set_dy_eligible(vcpu, !vcpu->spin_loop.dy_eligible);

	return eligible;
}
#endif
1575
void kvm_vcpu_on_spin(struct kvm_vcpu *me)
Z
Zhai, Edwin 已提交
1576
{
1577 1578 1579 1580 1581 1582
	struct kvm *kvm = me->kvm;
	struct kvm_vcpu *vcpu;
	int last_boosted_vcpu = me->kvm->last_boosted_vcpu;
	int yielded = 0;
	int pass;
	int i;
Z
Zhai, Edwin 已提交
1583

1584
	kvm_vcpu_set_in_spin_loop(me, true);
1585 1586 1587 1588 1589 1590 1591 1592 1593
	/*
	 * We boost the priority of a VCPU that is runnable but not
	 * currently running, because it got preempted by something
	 * else and called schedule in __vcpu_run.  Hopefully that
	 * VCPU is holding the lock that we need and will release it.
	 * We approximate round-robin by starting at the last boosted VCPU.
	 */
	for (pass = 0; pass < 2 && !yielded; pass++) {
		kvm_for_each_vcpu(i, vcpu, kvm) {
1594
			if (!pass && i <= last_boosted_vcpu) {
1595 1596 1597 1598 1599 1600 1601 1602
				i = last_boosted_vcpu;
				continue;
			} else if (pass && i > last_boosted_vcpu)
				break;
			if (vcpu == me)
				continue;
			if (waitqueue_active(&vcpu->wq))
				continue;
1603 1604
			if (!kvm_vcpu_eligible_for_directed_yield(vcpu))
				continue;
1605
			if (kvm_vcpu_yield_to(vcpu)) {
1606 1607 1608 1609 1610 1611
				kvm->last_boosted_vcpu = i;
				yielded = 1;
				break;
			}
		}
	}
1612
	kvm_vcpu_set_in_spin_loop(me, false);
1613 1614 1615

	/* Ensure vcpu is not eligible during next spinloop */
	kvm_vcpu_set_dy_eligible(me, false);
Z
Zhai, Edwin 已提交
1616 1617 1618
}
EXPORT_SYMBOL_GPL(kvm_vcpu_on_spin);

1619
static int kvm_vcpu_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
1620 1621 1622 1623
{
	struct kvm_vcpu *vcpu = vma->vm_file->private_data;
	struct page *page;

1624
	if (vmf->pgoff == 0)
1625
		page = virt_to_page(vcpu->run);
A
Avi Kivity 已提交
1626
#ifdef CONFIG_X86
1627
	else if (vmf->pgoff == KVM_PIO_PAGE_OFFSET)
1628
		page = virt_to_page(vcpu->arch.pio_data);
1629 1630 1631 1632
#endif
#ifdef KVM_COALESCED_MMIO_PAGE_OFFSET
	else if (vmf->pgoff == KVM_COALESCED_MMIO_PAGE_OFFSET)
		page = virt_to_page(vcpu->kvm->coalesced_mmio_ring);
A
Avi Kivity 已提交
1633
#endif
1634
	else
1635
		return kvm_arch_vcpu_fault(vcpu, vmf);
1636
	get_page(page);
1637 1638
	vmf->page = page;
	return 0;
1639 1640
}

1641
static const struct vm_operations_struct kvm_vcpu_vm_ops = {
1642
	.fault = kvm_vcpu_fault,
1643 1644 1645 1646 1647 1648 1649 1650
};

static int kvm_vcpu_mmap(struct file *file, struct vm_area_struct *vma)
{
	vma->vm_ops = &kvm_vcpu_vm_ops;
	return 0;
}

A
Avi Kivity 已提交
1651 1652 1653 1654
static int kvm_vcpu_release(struct inode *inode, struct file *filp)
{
	struct kvm_vcpu *vcpu = filp->private_data;

A
Al Viro 已提交
1655
	kvm_put_kvm(vcpu->kvm);
A
Avi Kivity 已提交
1656 1657 1658
	return 0;
}

1659
static struct file_operations kvm_vcpu_fops = {
A
Avi Kivity 已提交
1660 1661
	.release        = kvm_vcpu_release,
	.unlocked_ioctl = kvm_vcpu_ioctl,
1662 1663 1664
#ifdef CONFIG_COMPAT
	.compat_ioctl   = kvm_vcpu_compat_ioctl,
#endif
1665
	.mmap           = kvm_vcpu_mmap,
1666
	.llseek		= noop_llseek,
A
Avi Kivity 已提交
1667 1668 1669 1670 1671 1672 1673
};

/*
 * Allocates an inode for the vcpu.
 */
static int create_vcpu_fd(struct kvm_vcpu *vcpu)
{
1674
	return anon_inode_getfd("kvm-vcpu", &kvm_vcpu_fops, vcpu, O_RDWR);
A
Avi Kivity 已提交
1675 1676
}

1677 1678 1679
/*
 * Creates some virtual cpus.  Good luck creating more than one.
 */
1680
static int kvm_vm_ioctl_create_vcpu(struct kvm *kvm, u32 id)
1681 1682
{
	int r;
1683
	struct kvm_vcpu *vcpu, *v;
1684

1685
	vcpu = kvm_arch_vcpu_create(kvm, id);
R
Rusty Russell 已提交
1686 1687
	if (IS_ERR(vcpu))
		return PTR_ERR(vcpu);
1688

1689 1690
	preempt_notifier_init(&vcpu->preempt_notifier, &kvm_preempt_ops);

1691 1692
	r = kvm_arch_vcpu_setup(vcpu);
	if (r)
1693
		goto vcpu_destroy;
1694

S
Shaohua Li 已提交
1695
	mutex_lock(&kvm->lock);
1696 1697 1698 1699
	if (!kvm_vcpu_compatible(vcpu)) {
		r = -EINVAL;
		goto unlock_vcpu_destroy;
	}
1700 1701
	if (atomic_read(&kvm->online_vcpus) == KVM_MAX_VCPUS) {
		r = -EINVAL;
1702
		goto unlock_vcpu_destroy;
R
Rusty Russell 已提交
1703
	}
1704

1705 1706
	kvm_for_each_vcpu(r, v, kvm)
		if (v->vcpu_id == id) {
1707
			r = -EEXIST;
1708
			goto unlock_vcpu_destroy;
1709 1710 1711
		}

	BUG_ON(kvm->vcpus[atomic_read(&kvm->online_vcpus)]);
1712

R
Rusty Russell 已提交
1713
	/* Now it's all set up, let userspace reach it */
A
Al Viro 已提交
1714
	kvm_get_kvm(kvm);
A
Avi Kivity 已提交
1715
	r = create_vcpu_fd(vcpu);
1716 1717
	if (r < 0) {
		kvm_put_kvm(kvm);
1718
		goto unlock_vcpu_destroy;
1719 1720 1721 1722 1723 1724 1725
	}

	kvm->vcpus[atomic_read(&kvm->online_vcpus)] = vcpu;
	smp_wmb();
	atomic_inc(&kvm->online_vcpus);

	mutex_unlock(&kvm->lock);
R
Rusty Russell 已提交
1726
	return r;
1727

1728
unlock_vcpu_destroy:
1729
	mutex_unlock(&kvm->lock);
1730
vcpu_destroy:
1731
	kvm_arch_vcpu_destroy(vcpu);
1732 1733 1734
	return r;
}

A
Avi Kivity 已提交
1735 1736 1737 1738 1739 1740 1741 1742 1743 1744 1745
static int kvm_vcpu_ioctl_set_sigmask(struct kvm_vcpu *vcpu, sigset_t *sigset)
{
	if (sigset) {
		sigdelsetmask(sigset, sigmask(SIGKILL)|sigmask(SIGSTOP));
		vcpu->sigset_active = 1;
		vcpu->sigset = *sigset;
	} else
		vcpu->sigset_active = 0;
	return 0;
}

A
Avi Kivity 已提交
1746 1747
static long kvm_vcpu_ioctl(struct file *filp,
			   unsigned int ioctl, unsigned long arg)
A
Avi Kivity 已提交
1748
{
A
Avi Kivity 已提交
1749
	struct kvm_vcpu *vcpu = filp->private_data;
A
Al Viro 已提交
1750
	void __user *argp = (void __user *)arg;
1751
	int r;
1752 1753
	struct kvm_fpu *fpu = NULL;
	struct kvm_sregs *kvm_sregs = NULL;
A
Avi Kivity 已提交
1754

1755 1756
	if (vcpu->kvm->mm != current->mm)
		return -EIO;
1757 1758 1759 1760 1761 1762 1763 1764 1765 1766 1767 1768

#if defined(CONFIG_S390) || defined(CONFIG_PPC)
	/*
	 * Special cases: vcpu ioctls that are asynchronous to vcpu execution,
	 * so vcpu_load() would break it.
	 */
	if (ioctl == KVM_S390_INTERRUPT || ioctl == KVM_INTERRUPT)
		return kvm_arch_vcpu_ioctl(filp, ioctl, arg);
#endif


	vcpu_load(vcpu);
A
Avi Kivity 已提交
1769
	switch (ioctl) {
1770
	case KVM_RUN:
1771 1772 1773
		r = -EINVAL;
		if (arg)
			goto out;
1774
		r = kvm_arch_vcpu_ioctl_run(vcpu, vcpu->run);
1775
		trace_kvm_userspace_exit(vcpu->run->exit_reason, r);
A
Avi Kivity 已提交
1776 1777
		break;
	case KVM_GET_REGS: {
1778
		struct kvm_regs *kvm_regs;
A
Avi Kivity 已提交
1779

1780 1781 1782
		r = -ENOMEM;
		kvm_regs = kzalloc(sizeof(struct kvm_regs), GFP_KERNEL);
		if (!kvm_regs)
A
Avi Kivity 已提交
1783
			goto out;
1784 1785 1786
		r = kvm_arch_vcpu_ioctl_get_regs(vcpu, kvm_regs);
		if (r)
			goto out_free1;
A
Avi Kivity 已提交
1787
		r = -EFAULT;
1788 1789
		if (copy_to_user(argp, kvm_regs, sizeof(struct kvm_regs)))
			goto out_free1;
A
Avi Kivity 已提交
1790
		r = 0;
1791 1792
out_free1:
		kfree(kvm_regs);
A
Avi Kivity 已提交
1793 1794 1795
		break;
	}
	case KVM_SET_REGS: {
1796
		struct kvm_regs *kvm_regs;
A
Avi Kivity 已提交
1797

1798
		r = -ENOMEM;
1799 1800 1801
		kvm_regs = memdup_user(argp, sizeof(*kvm_regs));
		if (IS_ERR(kvm_regs)) {
			r = PTR_ERR(kvm_regs);
A
Avi Kivity 已提交
1802
			goto out;
1803
		}
1804
		r = kvm_arch_vcpu_ioctl_set_regs(vcpu, kvm_regs);
A
Avi Kivity 已提交
1805
		if (r)
1806
			goto out_free2;
A
Avi Kivity 已提交
1807
		r = 0;
1808 1809
out_free2:
		kfree(kvm_regs);
A
Avi Kivity 已提交
1810 1811 1812
		break;
	}
	case KVM_GET_SREGS: {
1813 1814 1815 1816 1817
		kvm_sregs = kzalloc(sizeof(struct kvm_sregs), GFP_KERNEL);
		r = -ENOMEM;
		if (!kvm_sregs)
			goto out;
		r = kvm_arch_vcpu_ioctl_get_sregs(vcpu, kvm_sregs);
A
Avi Kivity 已提交
1818 1819 1820
		if (r)
			goto out;
		r = -EFAULT;
1821
		if (copy_to_user(argp, kvm_sregs, sizeof(struct kvm_sregs)))
A
Avi Kivity 已提交
1822 1823 1824 1825 1826
			goto out;
		r = 0;
		break;
	}
	case KVM_SET_SREGS: {
1827 1828 1829
		kvm_sregs = memdup_user(argp, sizeof(*kvm_sregs));
		if (IS_ERR(kvm_sregs)) {
			r = PTR_ERR(kvm_sregs);
A
Avi Kivity 已提交
1830
			goto out;
1831
		}
1832
		r = kvm_arch_vcpu_ioctl_set_sregs(vcpu, kvm_sregs);
A
Avi Kivity 已提交
1833 1834 1835 1836 1837
		if (r)
			goto out;
		r = 0;
		break;
	}
1838 1839 1840 1841 1842 1843 1844 1845 1846 1847 1848 1849 1850 1851 1852 1853 1854 1855 1856 1857 1858 1859 1860 1861
	case KVM_GET_MP_STATE: {
		struct kvm_mp_state mp_state;

		r = kvm_arch_vcpu_ioctl_get_mpstate(vcpu, &mp_state);
		if (r)
			goto out;
		r = -EFAULT;
		if (copy_to_user(argp, &mp_state, sizeof mp_state))
			goto out;
		r = 0;
		break;
	}
	case KVM_SET_MP_STATE: {
		struct kvm_mp_state mp_state;

		r = -EFAULT;
		if (copy_from_user(&mp_state, argp, sizeof mp_state))
			goto out;
		r = kvm_arch_vcpu_ioctl_set_mpstate(vcpu, &mp_state);
		if (r)
			goto out;
		r = 0;
		break;
	}
A
Avi Kivity 已提交
1862 1863 1864 1865
	case KVM_TRANSLATE: {
		struct kvm_translation tr;

		r = -EFAULT;
A
Al Viro 已提交
1866
		if (copy_from_user(&tr, argp, sizeof tr))
A
Avi Kivity 已提交
1867
			goto out;
1868
		r = kvm_arch_vcpu_ioctl_translate(vcpu, &tr);
A
Avi Kivity 已提交
1869 1870 1871
		if (r)
			goto out;
		r = -EFAULT;
A
Al Viro 已提交
1872
		if (copy_to_user(argp, &tr, sizeof tr))
A
Avi Kivity 已提交
1873 1874 1875 1876
			goto out;
		r = 0;
		break;
	}
J
Jan Kiszka 已提交
1877 1878
	case KVM_SET_GUEST_DEBUG: {
		struct kvm_guest_debug dbg;
A
Avi Kivity 已提交
1879 1880

		r = -EFAULT;
A
Al Viro 已提交
1881
		if (copy_from_user(&dbg, argp, sizeof dbg))
A
Avi Kivity 已提交
1882
			goto out;
J
Jan Kiszka 已提交
1883
		r = kvm_arch_vcpu_ioctl_set_guest_debug(vcpu, &dbg);
A
Avi Kivity 已提交
1884 1885 1886 1887 1888
		if (r)
			goto out;
		r = 0;
		break;
	}
A
Avi Kivity 已提交
1889 1890 1891 1892 1893 1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905 1906 1907 1908
	case KVM_SET_SIGNAL_MASK: {
		struct kvm_signal_mask __user *sigmask_arg = argp;
		struct kvm_signal_mask kvm_sigmask;
		sigset_t sigset, *p;

		p = NULL;
		if (argp) {
			r = -EFAULT;
			if (copy_from_user(&kvm_sigmask, argp,
					   sizeof kvm_sigmask))
				goto out;
			r = -EINVAL;
			if (kvm_sigmask.len != sizeof sigset)
				goto out;
			r = -EFAULT;
			if (copy_from_user(&sigset, sigmask_arg->sigset,
					   sizeof sigset))
				goto out;
			p = &sigset;
		}
1909
		r = kvm_vcpu_ioctl_set_sigmask(vcpu, p);
A
Avi Kivity 已提交
1910 1911
		break;
	}
A
Avi Kivity 已提交
1912
	case KVM_GET_FPU: {
1913 1914 1915 1916 1917
		fpu = kzalloc(sizeof(struct kvm_fpu), GFP_KERNEL);
		r = -ENOMEM;
		if (!fpu)
			goto out;
		r = kvm_arch_vcpu_ioctl_get_fpu(vcpu, fpu);
A
Avi Kivity 已提交
1918 1919 1920
		if (r)
			goto out;
		r = -EFAULT;
1921
		if (copy_to_user(argp, fpu, sizeof(struct kvm_fpu)))
A
Avi Kivity 已提交
1922 1923 1924 1925 1926
			goto out;
		r = 0;
		break;
	}
	case KVM_SET_FPU: {
1927 1928 1929
		fpu = memdup_user(argp, sizeof(*fpu));
		if (IS_ERR(fpu)) {
			r = PTR_ERR(fpu);
A
Avi Kivity 已提交
1930
			goto out;
1931
		}
1932
		r = kvm_arch_vcpu_ioctl_set_fpu(vcpu, fpu);
A
Avi Kivity 已提交
1933 1934 1935 1936 1937
		if (r)
			goto out;
		r = 0;
		break;
	}
A
Avi Kivity 已提交
1938
	default:
1939
		r = kvm_arch_vcpu_ioctl(filp, ioctl, arg);
A
Avi Kivity 已提交
1940 1941
	}
out:
1942
	vcpu_put(vcpu);
1943 1944
	kfree(fpu);
	kfree(kvm_sregs);
A
Avi Kivity 已提交
1945 1946 1947
	return r;
}

1948 1949 1950 1951 1952 1953 1954 1955 1956 1957 1958 1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989 1990 1991
#ifdef CONFIG_COMPAT
static long kvm_vcpu_compat_ioctl(struct file *filp,
				  unsigned int ioctl, unsigned long arg)
{
	struct kvm_vcpu *vcpu = filp->private_data;
	void __user *argp = compat_ptr(arg);
	int r;

	if (vcpu->kvm->mm != current->mm)
		return -EIO;

	switch (ioctl) {
	case KVM_SET_SIGNAL_MASK: {
		struct kvm_signal_mask __user *sigmask_arg = argp;
		struct kvm_signal_mask kvm_sigmask;
		compat_sigset_t csigset;
		sigset_t sigset;

		if (argp) {
			r = -EFAULT;
			if (copy_from_user(&kvm_sigmask, argp,
					   sizeof kvm_sigmask))
				goto out;
			r = -EINVAL;
			if (kvm_sigmask.len != sizeof csigset)
				goto out;
			r = -EFAULT;
			if (copy_from_user(&csigset, sigmask_arg->sigset,
					   sizeof csigset))
				goto out;
		}
		sigset_from_compat(&sigset, &csigset);
		r = kvm_vcpu_ioctl_set_sigmask(vcpu, &sigset);
		break;
	}
	default:
		r = kvm_vcpu_ioctl(filp, ioctl, arg);
	}

out:
	return r;
}
#endif

A
Avi Kivity 已提交
1992 1993 1994 1995 1996
static long kvm_vm_ioctl(struct file *filp,
			   unsigned int ioctl, unsigned long arg)
{
	struct kvm *kvm = filp->private_data;
	void __user *argp = (void __user *)arg;
1997
	int r;
A
Avi Kivity 已提交
1998

1999 2000
	if (kvm->mm != current->mm)
		return -EIO;
A
Avi Kivity 已提交
2001 2002 2003 2004 2005 2006
	switch (ioctl) {
	case KVM_CREATE_VCPU:
		r = kvm_vm_ioctl_create_vcpu(kvm, arg);
		if (r < 0)
			goto out;
		break;
2007 2008 2009 2010 2011 2012 2013 2014 2015
	case KVM_SET_USER_MEMORY_REGION: {
		struct kvm_userspace_memory_region kvm_userspace_mem;

		r = -EFAULT;
		if (copy_from_user(&kvm_userspace_mem, argp,
						sizeof kvm_userspace_mem))
			goto out;

		r = kvm_vm_ioctl_set_memory_region(kvm, &kvm_userspace_mem, 1);
A
Avi Kivity 已提交
2016 2017 2018 2019 2020 2021 2022 2023
		if (r)
			goto out;
		break;
	}
	case KVM_GET_DIRTY_LOG: {
		struct kvm_dirty_log log;

		r = -EFAULT;
A
Al Viro 已提交
2024
		if (copy_from_user(&log, argp, sizeof log))
A
Avi Kivity 已提交
2025
			goto out;
2026
		r = kvm_vm_ioctl_get_dirty_log(kvm, &log);
A
Avi Kivity 已提交
2027 2028 2029 2030
		if (r)
			goto out;
		break;
	}
2031 2032 2033 2034 2035 2036 2037 2038 2039 2040 2041 2042 2043 2044 2045 2046 2047 2048 2049 2050 2051 2052 2053 2054
#ifdef KVM_COALESCED_MMIO_PAGE_OFFSET
	case KVM_REGISTER_COALESCED_MMIO: {
		struct kvm_coalesced_mmio_zone zone;
		r = -EFAULT;
		if (copy_from_user(&zone, argp, sizeof zone))
			goto out;
		r = kvm_vm_ioctl_register_coalesced_mmio(kvm, &zone);
		if (r)
			goto out;
		r = 0;
		break;
	}
	case KVM_UNREGISTER_COALESCED_MMIO: {
		struct kvm_coalesced_mmio_zone zone;
		r = -EFAULT;
		if (copy_from_user(&zone, argp, sizeof zone))
			goto out;
		r = kvm_vm_ioctl_unregister_coalesced_mmio(kvm, &zone);
		if (r)
			goto out;
		r = 0;
		break;
	}
#endif
G
Gregory Haskins 已提交
2055 2056 2057 2058 2059 2060
	case KVM_IRQFD: {
		struct kvm_irqfd data;

		r = -EFAULT;
		if (copy_from_user(&data, argp, sizeof data))
			goto out;
2061
		r = kvm_irqfd(kvm, &data);
G
Gregory Haskins 已提交
2062 2063
		break;
	}
G
Gregory Haskins 已提交
2064 2065 2066 2067 2068 2069 2070 2071 2072
	case KVM_IOEVENTFD: {
		struct kvm_ioeventfd data;

		r = -EFAULT;
		if (copy_from_user(&data, argp, sizeof data))
			goto out;
		r = kvm_ioeventfd(kvm, &data);
		break;
	}
2073 2074 2075
#ifdef CONFIG_KVM_APIC_ARCHITECTURE
	case KVM_SET_BOOT_CPU_ID:
		r = 0;
2076
		mutex_lock(&kvm->lock);
2077 2078 2079 2080
		if (atomic_read(&kvm->online_vcpus) != 0)
			r = -EBUSY;
		else
			kvm->bsp_vcpu_id = arg;
2081
		mutex_unlock(&kvm->lock);
2082
		break;
2083 2084 2085 2086 2087 2088 2089 2090 2091 2092 2093
#endif
#ifdef CONFIG_HAVE_KVM_MSI
	case KVM_SIGNAL_MSI: {
		struct kvm_msi msi;

		r = -EFAULT;
		if (copy_from_user(&msi, argp, sizeof msi))
			goto out;
		r = kvm_send_userspace_msi(kvm, &msi);
		break;
	}
2094 2095 2096 2097 2098 2099 2100 2101 2102 2103 2104 2105 2106 2107 2108 2109 2110 2111 2112 2113 2114 2115 2116
#endif
#ifdef __KVM_HAVE_IRQ_LINE
	case KVM_IRQ_LINE_STATUS:
	case KVM_IRQ_LINE: {
		struct kvm_irq_level irq_event;

		r = -EFAULT;
		if (copy_from_user(&irq_event, argp, sizeof irq_event))
			goto out;

		r = kvm_vm_ioctl_irq_line(kvm, &irq_event);
		if (r)
			goto out;

		r = -EFAULT;
		if (ioctl == KVM_IRQ_LINE_STATUS) {
			if (copy_to_user(argp, &irq_event, sizeof irq_event))
				goto out;
		}

		r = 0;
		break;
	}
2117
#endif
2118
	default:
2119
		r = kvm_arch_vm_ioctl(filp, ioctl, arg);
2120 2121
		if (r == -ENOTTY)
			r = kvm_vm_ioctl_assigned_device(kvm, ioctl, arg);
2122 2123 2124 2125 2126
	}
out:
	return r;
}

2127 2128 2129 2130 2131 2132 2133 2134 2135 2136 2137 2138 2139 2140 2141 2142 2143 2144 2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156 2157 2158 2159 2160 2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172
#ifdef CONFIG_COMPAT
struct compat_kvm_dirty_log {
	__u32 slot;
	__u32 padding1;
	union {
		compat_uptr_t dirty_bitmap; /* one bit per page */
		__u64 padding2;
	};
};

static long kvm_vm_compat_ioctl(struct file *filp,
			   unsigned int ioctl, unsigned long arg)
{
	struct kvm *kvm = filp->private_data;
	int r;

	if (kvm->mm != current->mm)
		return -EIO;
	switch (ioctl) {
	case KVM_GET_DIRTY_LOG: {
		struct compat_kvm_dirty_log compat_log;
		struct kvm_dirty_log log;

		r = -EFAULT;
		if (copy_from_user(&compat_log, (void __user *)arg,
				   sizeof(compat_log)))
			goto out;
		log.slot	 = compat_log.slot;
		log.padding1	 = compat_log.padding1;
		log.padding2	 = compat_log.padding2;
		log.dirty_bitmap = compat_ptr(compat_log.dirty_bitmap);

		r = kvm_vm_ioctl_get_dirty_log(kvm, &log);
		if (r)
			goto out;
		break;
	}
	default:
		r = kvm_vm_ioctl(filp, ioctl, arg);
	}

out:
	return r;
}
#endif

2173
static int kvm_vm_fault(struct vm_area_struct *vma, struct vm_fault *vmf)
2174
{
2175 2176 2177 2178
	struct page *page[1];
	unsigned long addr;
	int npages;
	gfn_t gfn = vmf->pgoff;
2179 2180
	struct kvm *kvm = vma->vm_file->private_data;

2181 2182
	addr = gfn_to_hva(kvm, gfn);
	if (kvm_is_error_hva(addr))
2183
		return VM_FAULT_SIGBUS;
2184 2185 2186 2187

	npages = get_user_pages(current, current->mm, addr, 1, 1, 0, page,
				NULL);
	if (unlikely(npages != 1))
2188
		return VM_FAULT_SIGBUS;
2189 2190

	vmf->page = page[0];
2191
	return 0;
2192 2193
}

2194
static const struct vm_operations_struct kvm_vm_vm_ops = {
2195
	.fault = kvm_vm_fault,
2196 2197 2198 2199 2200 2201 2202 2203
};

static int kvm_vm_mmap(struct file *file, struct vm_area_struct *vma)
{
	vma->vm_ops = &kvm_vm_vm_ops;
	return 0;
}

2204
static struct file_operations kvm_vm_fops = {
2205 2206
	.release        = kvm_vm_release,
	.unlocked_ioctl = kvm_vm_ioctl,
2207 2208 2209
#ifdef CONFIG_COMPAT
	.compat_ioctl   = kvm_vm_compat_ioctl,
#endif
2210
	.mmap           = kvm_vm_mmap,
2211
	.llseek		= noop_llseek,
2212 2213
};

2214
static int kvm_dev_ioctl_create_vm(unsigned long type)
2215
{
2216
	int r;
2217 2218
	struct kvm *kvm;

2219
	kvm = kvm_create_vm(type);
2220 2221
	if (IS_ERR(kvm))
		return PTR_ERR(kvm);
2222 2223 2224 2225 2226 2227 2228
#ifdef KVM_COALESCED_MMIO_PAGE_OFFSET
	r = kvm_coalesced_mmio_init(kvm);
	if (r < 0) {
		kvm_put_kvm(kvm);
		return r;
	}
#endif
2229 2230
	r = anon_inode_getfd("kvm-vm", &kvm_vm_fops, kvm, O_RDWR);
	if (r < 0)
A
Al Viro 已提交
2231
		kvm_put_kvm(kvm);
2232

2233
	return r;
2234 2235
}

2236 2237 2238
static long kvm_dev_ioctl_check_extension_generic(long arg)
{
	switch (arg) {
2239
	case KVM_CAP_USER_MEMORY:
2240
	case KVM_CAP_DESTROY_MEMORY_REGION_WORKS:
2241
	case KVM_CAP_JOIN_MEMORY_REGIONS_WORKS:
2242 2243 2244
#ifdef CONFIG_KVM_APIC_ARCHITECTURE
	case KVM_CAP_SET_BOOT_CPU_ID:
#endif
2245
	case KVM_CAP_INTERNAL_ERROR_DATA:
2246 2247 2248
#ifdef CONFIG_HAVE_KVM_MSI
	case KVM_CAP_SIGNAL_MSI:
#endif
2249
		return 1;
2250
#ifdef KVM_CAP_IRQ_ROUTING
2251
	case KVM_CAP_IRQ_ROUTING:
2252
		return KVM_MAX_IRQ_ROUTES;
2253
#endif
2254 2255 2256 2257 2258 2259
	default:
		break;
	}
	return kvm_dev_ioctl_check_extension(arg);
}

2260 2261 2262
static long kvm_dev_ioctl(struct file *filp,
			  unsigned int ioctl, unsigned long arg)
{
2263
	long r = -EINVAL;
2264 2265 2266

	switch (ioctl) {
	case KVM_GET_API_VERSION:
2267 2268 2269
		r = -EINVAL;
		if (arg)
			goto out;
2270 2271 2272
		r = KVM_API_VERSION;
		break;
	case KVM_CREATE_VM:
2273
		r = kvm_dev_ioctl_create_vm(arg);
2274
		break;
2275
	case KVM_CHECK_EXTENSION:
2276
		r = kvm_dev_ioctl_check_extension_generic(arg);
2277
		break;
2278 2279 2280 2281
	case KVM_GET_VCPU_MMAP_SIZE:
		r = -EINVAL;
		if (arg)
			goto out;
2282 2283 2284
		r = PAGE_SIZE;     /* struct kvm_run */
#ifdef CONFIG_X86
		r += PAGE_SIZE;    /* pio data page */
2285 2286 2287
#endif
#ifdef KVM_COALESCED_MMIO_PAGE_OFFSET
		r += PAGE_SIZE;    /* coalesced mmio ring page */
2288
#endif
2289
		break;
2290 2291 2292
	case KVM_TRACE_ENABLE:
	case KVM_TRACE_PAUSE:
	case KVM_TRACE_DISABLE:
2293
		r = -EOPNOTSUPP;
2294
		break;
A
Avi Kivity 已提交
2295
	default:
2296
		return kvm_arch_dev_ioctl(filp, ioctl, arg);
A
Avi Kivity 已提交
2297 2298 2299 2300 2301 2302 2303 2304
	}
out:
	return r;
}

static struct file_operations kvm_chardev_ops = {
	.unlocked_ioctl = kvm_dev_ioctl,
	.compat_ioctl   = kvm_dev_ioctl,
2305
	.llseek		= noop_llseek,
A
Avi Kivity 已提交
2306 2307 2308
};

static struct miscdevice kvm_dev = {
A
Avi Kivity 已提交
2309
	KVM_MINOR,
A
Avi Kivity 已提交
2310 2311 2312 2313
	"kvm",
	&kvm_chardev_ops,
};

2314
static void hardware_enable_nolock(void *junk)
2315 2316
{
	int cpu = raw_smp_processor_id();
2317
	int r;
2318

2319
	if (cpumask_test_cpu(cpu, cpus_hardware_enabled))
2320
		return;
2321

2322
	cpumask_set_cpu(cpu, cpus_hardware_enabled);
2323 2324 2325 2326 2327 2328 2329 2330 2331

	r = kvm_arch_hardware_enable(NULL);

	if (r) {
		cpumask_clear_cpu(cpu, cpus_hardware_enabled);
		atomic_inc(&hardware_enable_failed);
		printk(KERN_INFO "kvm: enabling virtualization on "
				 "CPU%d failed\n", cpu);
	}
2332 2333
}

2334 2335
static void hardware_enable(void *junk)
{
2336
	raw_spin_lock(&kvm_lock);
2337
	hardware_enable_nolock(junk);
2338
	raw_spin_unlock(&kvm_lock);
2339 2340 2341
}

static void hardware_disable_nolock(void *junk)
2342 2343 2344
{
	int cpu = raw_smp_processor_id();

2345
	if (!cpumask_test_cpu(cpu, cpus_hardware_enabled))
2346
		return;
2347
	cpumask_clear_cpu(cpu, cpus_hardware_enabled);
2348
	kvm_arch_hardware_disable(NULL);
2349 2350
}

2351 2352
static void hardware_disable(void *junk)
{
2353
	raw_spin_lock(&kvm_lock);
2354
	hardware_disable_nolock(junk);
2355
	raw_spin_unlock(&kvm_lock);
2356 2357
}

2358 2359 2360 2361 2362 2363
static void hardware_disable_all_nolock(void)
{
	BUG_ON(!kvm_usage_count);

	kvm_usage_count--;
	if (!kvm_usage_count)
2364
		on_each_cpu(hardware_disable_nolock, NULL, 1);
2365 2366 2367 2368
}

static void hardware_disable_all(void)
{
2369
	raw_spin_lock(&kvm_lock);
2370
	hardware_disable_all_nolock();
2371
	raw_spin_unlock(&kvm_lock);
2372 2373 2374 2375 2376 2377
}

static int hardware_enable_all(void)
{
	int r = 0;

2378
	raw_spin_lock(&kvm_lock);
2379 2380 2381 2382

	kvm_usage_count++;
	if (kvm_usage_count == 1) {
		atomic_set(&hardware_enable_failed, 0);
2383
		on_each_cpu(hardware_enable_nolock, NULL, 1);
2384 2385 2386 2387 2388 2389 2390

		if (atomic_read(&hardware_enable_failed)) {
			hardware_disable_all_nolock();
			r = -EBUSY;
		}
	}

2391
	raw_spin_unlock(&kvm_lock);
2392 2393 2394 2395

	return r;
}

A
Avi Kivity 已提交
2396 2397 2398 2399 2400
static int kvm_cpu_hotplug(struct notifier_block *notifier, unsigned long val,
			   void *v)
{
	int cpu = (long)v;

2401 2402 2403
	if (!kvm_usage_count)
		return NOTIFY_OK;

2404
	val &= ~CPU_TASKS_FROZEN;
A
Avi Kivity 已提交
2405
	switch (val) {
2406
	case CPU_DYING:
2407 2408 2409 2410
		printk(KERN_INFO "kvm: disabling virtualization on CPU%d\n",
		       cpu);
		hardware_disable(NULL);
		break;
2411
	case CPU_STARTING:
2412 2413
		printk(KERN_INFO "kvm: enabling virtualization on CPU%d\n",
		       cpu);
2414
		hardware_enable(NULL);
A
Avi Kivity 已提交
2415 2416 2417 2418 2419
		break;
	}
	return NOTIFY_OK;
}

2420

2421
asmlinkage void kvm_spurious_fault(void)
2422 2423 2424 2425
{
	/* Fault while not rebooting.  We want the trace. */
	BUG();
}
2426
EXPORT_SYMBOL_GPL(kvm_spurious_fault);
2427

2428
static int kvm_reboot(struct notifier_block *notifier, unsigned long val,
M
Mike Day 已提交
2429
		      void *v)
2430
{
2431 2432 2433 2434 2435 2436 2437 2438
	/*
	 * Some (well, at least mine) BIOSes hang on reboot if
	 * in vmx root mode.
	 *
	 * And Intel TXT required VMX off for all cpu when system shutdown.
	 */
	printk(KERN_INFO "kvm: exiting hardware virtualization\n");
	kvm_rebooting = true;
2439
	on_each_cpu(hardware_disable_nolock, NULL, 1);
2440 2441 2442 2443 2444 2445 2446 2447
	return NOTIFY_OK;
}

static struct notifier_block kvm_reboot_notifier = {
	.notifier_call = kvm_reboot,
	.priority = 0,
};

M
Marcelo Tosatti 已提交
2448
static void kvm_io_bus_destroy(struct kvm_io_bus *bus)
2449 2450 2451 2452
{
	int i;

	for (i = 0; i < bus->dev_count; i++) {
2453
		struct kvm_io_device *pos = bus->range[i].dev;
2454 2455 2456

		kvm_iodevice_destructor(pos);
	}
M
Marcelo Tosatti 已提交
2457
	kfree(bus);
2458 2459
}

2460 2461 2462 2463 2464 2465 2466 2467 2468 2469 2470 2471 2472 2473 2474 2475 2476 2477 2478 2479 2480 2481 2482 2483 2484 2485 2486 2487 2488 2489 2490 2491 2492 2493 2494 2495 2496 2497 2498 2499 2500 2501 2502 2503 2504 2505 2506 2507 2508 2509 2510
int kvm_io_bus_sort_cmp(const void *p1, const void *p2)
{
	const struct kvm_io_range *r1 = p1;
	const struct kvm_io_range *r2 = p2;

	if (r1->addr < r2->addr)
		return -1;
	if (r1->addr + r1->len > r2->addr + r2->len)
		return 1;
	return 0;
}

int kvm_io_bus_insert_dev(struct kvm_io_bus *bus, struct kvm_io_device *dev,
			  gpa_t addr, int len)
{
	bus->range[bus->dev_count++] = (struct kvm_io_range) {
		.addr = addr,
		.len = len,
		.dev = dev,
	};

	sort(bus->range, bus->dev_count, sizeof(struct kvm_io_range),
		kvm_io_bus_sort_cmp, NULL);

	return 0;
}

int kvm_io_bus_get_first_dev(struct kvm_io_bus *bus,
			     gpa_t addr, int len)
{
	struct kvm_io_range *range, key;
	int off;

	key = (struct kvm_io_range) {
		.addr = addr,
		.len = len,
	};

	range = bsearch(&key, bus->range, bus->dev_count,
			sizeof(struct kvm_io_range), kvm_io_bus_sort_cmp);
	if (range == NULL)
		return -ENOENT;

	off = range - bus->range;

	while (off > 0 && kvm_io_bus_sort_cmp(&key, &bus->range[off-1]) == 0)
		off--;

	return off;
}

2511
/* kvm_io_bus_write - called under kvm->slots_lock */
M
Marcelo Tosatti 已提交
2512
int kvm_io_bus_write(struct kvm *kvm, enum kvm_bus bus_idx, gpa_t addr,
2513
		     int len, const void *val)
2514
{
2515
	int idx;
2516
	struct kvm_io_bus *bus;
2517 2518 2519 2520 2521 2522
	struct kvm_io_range range;

	range = (struct kvm_io_range) {
		.addr = addr,
		.len = len,
	};
2523 2524

	bus = srcu_dereference(kvm->buses[bus_idx], &kvm->srcu);
2525 2526 2527 2528 2529 2530 2531
	idx = kvm_io_bus_get_first_dev(bus, addr, len);
	if (idx < 0)
		return -EOPNOTSUPP;

	while (idx < bus->dev_count &&
		kvm_io_bus_sort_cmp(&range, &bus->range[idx]) == 0) {
		if (!kvm_iodevice_write(bus->range[idx].dev, addr, len, val))
2532
			return 0;
2533 2534 2535
		idx++;
	}

2536 2537
	return -EOPNOTSUPP;
}
2538

2539
/* kvm_io_bus_read - called under kvm->slots_lock */
M
Marcelo Tosatti 已提交
2540 2541
int kvm_io_bus_read(struct kvm *kvm, enum kvm_bus bus_idx, gpa_t addr,
		    int len, void *val)
2542
{
2543
	int idx;
2544
	struct kvm_io_bus *bus;
2545 2546 2547 2548 2549 2550
	struct kvm_io_range range;

	range = (struct kvm_io_range) {
		.addr = addr,
		.len = len,
	};
M
Marcelo Tosatti 已提交
2551

2552
	bus = srcu_dereference(kvm->buses[bus_idx], &kvm->srcu);
2553 2554 2555 2556 2557 2558 2559
	idx = kvm_io_bus_get_first_dev(bus, addr, len);
	if (idx < 0)
		return -EOPNOTSUPP;

	while (idx < bus->dev_count &&
		kvm_io_bus_sort_cmp(&range, &bus->range[idx]) == 0) {
		if (!kvm_iodevice_read(bus->range[idx].dev, addr, len, val))
2560
			return 0;
2561 2562 2563
		idx++;
	}

2564
	return -EOPNOTSUPP;
2565 2566
}

2567
/* Caller must hold slots_lock. */
2568 2569
int kvm_io_bus_register_dev(struct kvm *kvm, enum kvm_bus bus_idx, gpa_t addr,
			    int len, struct kvm_io_device *dev)
2570
{
M
Marcelo Tosatti 已提交
2571
	struct kvm_io_bus *new_bus, *bus;
2572

M
Marcelo Tosatti 已提交
2573
	bus = kvm->buses[bus_idx];
2574
	if (bus->dev_count > NR_IOBUS_DEVS - 1)
2575
		return -ENOSPC;
2576

2577 2578
	new_bus = kzalloc(sizeof(*bus) + ((bus->dev_count + 1) *
			  sizeof(struct kvm_io_range)), GFP_KERNEL);
M
Marcelo Tosatti 已提交
2579 2580
	if (!new_bus)
		return -ENOMEM;
2581 2582
	memcpy(new_bus, bus, sizeof(*bus) + (bus->dev_count *
	       sizeof(struct kvm_io_range)));
2583
	kvm_io_bus_insert_dev(new_bus, dev, addr, len);
M
Marcelo Tosatti 已提交
2584 2585 2586
	rcu_assign_pointer(kvm->buses[bus_idx], new_bus);
	synchronize_srcu_expedited(&kvm->srcu);
	kfree(bus);
2587 2588 2589 2590

	return 0;
}

2591
/* Caller must hold slots_lock. */
M
Marcelo Tosatti 已提交
2592 2593
int kvm_io_bus_unregister_dev(struct kvm *kvm, enum kvm_bus bus_idx,
			      struct kvm_io_device *dev)
2594
{
M
Marcelo Tosatti 已提交
2595 2596
	int i, r;
	struct kvm_io_bus *new_bus, *bus;
2597

2598
	bus = kvm->buses[bus_idx];
M
Marcelo Tosatti 已提交
2599
	r = -ENOENT;
2600 2601
	for (i = 0; i < bus->dev_count; i++)
		if (bus->range[i].dev == dev) {
M
Marcelo Tosatti 已提交
2602
			r = 0;
2603 2604
			break;
		}
M
Marcelo Tosatti 已提交
2605

2606
	if (r)
M
Marcelo Tosatti 已提交
2607
		return r;
2608 2609 2610 2611 2612 2613 2614 2615 2616 2617

	new_bus = kzalloc(sizeof(*bus) + ((bus->dev_count - 1) *
			  sizeof(struct kvm_io_range)), GFP_KERNEL);
	if (!new_bus)
		return -ENOMEM;

	memcpy(new_bus, bus, sizeof(*bus) + i * sizeof(struct kvm_io_range));
	new_bus->dev_count--;
	memcpy(new_bus->range + i, bus->range + i + 1,
	       (new_bus->dev_count - i) * sizeof(struct kvm_io_range));
M
Marcelo Tosatti 已提交
2618 2619 2620 2621 2622

	rcu_assign_pointer(kvm->buses[bus_idx], new_bus);
	synchronize_srcu_expedited(&kvm->srcu);
	kfree(bus);
	return r;
2623 2624
}

A
Avi Kivity 已提交
2625 2626 2627 2628
static struct notifier_block kvm_cpu_notifier = {
	.notifier_call = kvm_cpu_hotplug,
};

2629
static int vm_stat_get(void *_offset, u64 *val)
2630 2631 2632 2633
{
	unsigned offset = (long)_offset;
	struct kvm *kvm;

2634
	*val = 0;
2635
	raw_spin_lock(&kvm_lock);
2636
	list_for_each_entry(kvm, &vm_list, vm_list)
2637
		*val += *(u32 *)((void *)kvm + offset);
2638
	raw_spin_unlock(&kvm_lock);
2639
	return 0;
2640 2641 2642 2643
}

DEFINE_SIMPLE_ATTRIBUTE(vm_stat_fops, vm_stat_get, NULL, "%llu\n");

2644
static int vcpu_stat_get(void *_offset, u64 *val)
A
Avi Kivity 已提交
2645 2646 2647 2648 2649 2650
{
	unsigned offset = (long)_offset;
	struct kvm *kvm;
	struct kvm_vcpu *vcpu;
	int i;

2651
	*val = 0;
2652
	raw_spin_lock(&kvm_lock);
A
Avi Kivity 已提交
2653
	list_for_each_entry(kvm, &vm_list, vm_list)
2654 2655 2656
		kvm_for_each_vcpu(i, vcpu, kvm)
			*val += *(u32 *)((void *)vcpu + offset);

2657
	raw_spin_unlock(&kvm_lock);
2658
	return 0;
A
Avi Kivity 已提交
2659 2660
}

2661 2662
DEFINE_SIMPLE_ATTRIBUTE(vcpu_stat_fops, vcpu_stat_get, NULL, "%llu\n");

2663
static const struct file_operations *stat_fops[] = {
2664 2665 2666
	[KVM_STAT_VCPU] = &vcpu_stat_fops,
	[KVM_STAT_VM]   = &vm_stat_fops,
};
A
Avi Kivity 已提交
2667

2668
static int kvm_init_debug(void)
A
Avi Kivity 已提交
2669
{
2670
	int r = -EFAULT;
A
Avi Kivity 已提交
2671 2672
	struct kvm_stats_debugfs_item *p;

2673
	kvm_debugfs_dir = debugfs_create_dir("kvm", NULL);
2674 2675 2676 2677
	if (kvm_debugfs_dir == NULL)
		goto out;

	for (p = debugfs_entries; p->name; ++p) {
2678
		p->dentry = debugfs_create_file(p->name, 0444, kvm_debugfs_dir,
A
Avi Kivity 已提交
2679
						(void *)(long)p->offset,
2680
						stat_fops[p->kind]);
2681 2682 2683 2684 2685 2686 2687 2688 2689 2690
		if (p->dentry == NULL)
			goto out_dir;
	}

	return 0;

out_dir:
	debugfs_remove_recursive(kvm_debugfs_dir);
out:
	return r;
A
Avi Kivity 已提交
2691 2692 2693 2694 2695 2696 2697 2698
}

static void kvm_exit_debug(void)
{
	struct kvm_stats_debugfs_item *p;

	for (p = debugfs_entries; p->name; ++p)
		debugfs_remove(p->dentry);
2699
	debugfs_remove(kvm_debugfs_dir);
A
Avi Kivity 已提交
2700 2701
}

2702
static int kvm_suspend(void)
2703
{
2704
	if (kvm_usage_count)
2705
		hardware_disable_nolock(NULL);
2706 2707 2708
	return 0;
}

2709
static void kvm_resume(void)
2710
{
2711
	if (kvm_usage_count) {
2712
		WARN_ON(raw_spin_is_locked(&kvm_lock));
2713
		hardware_enable_nolock(NULL);
2714
	}
2715 2716
}

2717
static struct syscore_ops kvm_syscore_ops = {
2718 2719 2720 2721
	.suspend = kvm_suspend,
	.resume = kvm_resume,
};

2722 2723 2724 2725 2726 2727 2728 2729 2730 2731
static inline
struct kvm_vcpu *preempt_notifier_to_vcpu(struct preempt_notifier *pn)
{
	return container_of(pn, struct kvm_vcpu, preempt_notifier);
}

static void kvm_sched_in(struct preempt_notifier *pn, int cpu)
{
	struct kvm_vcpu *vcpu = preempt_notifier_to_vcpu(pn);

2732
	kvm_arch_vcpu_load(vcpu, cpu);
2733 2734 2735 2736 2737 2738 2739
}

static void kvm_sched_out(struct preempt_notifier *pn,
			  struct task_struct *next)
{
	struct kvm_vcpu *vcpu = preempt_notifier_to_vcpu(pn);

2740
	kvm_arch_vcpu_put(vcpu);
2741 2742
}

2743
int kvm_init(void *opaque, unsigned vcpu_size, unsigned vcpu_align,
2744
		  struct module *module)
A
Avi Kivity 已提交
2745 2746
{
	int r;
Y
Yang, Sheng 已提交
2747
	int cpu;
A
Avi Kivity 已提交
2748

2749 2750
	r = kvm_arch_init(opaque);
	if (r)
2751
		goto out_fail;
2752

2753
	if (!zalloc_cpumask_var(&cpus_hardware_enabled, GFP_KERNEL)) {
2754 2755 2756 2757
		r = -ENOMEM;
		goto out_free_0;
	}

2758
	r = kvm_arch_hardware_setup();
A
Avi Kivity 已提交
2759
	if (r < 0)
2760
		goto out_free_0a;
A
Avi Kivity 已提交
2761

Y
Yang, Sheng 已提交
2762 2763
	for_each_online_cpu(cpu) {
		smp_call_function_single(cpu,
2764
				kvm_arch_check_processor_compat,
2765
				&r, 1);
Y
Yang, Sheng 已提交
2766
		if (r < 0)
2767
			goto out_free_1;
Y
Yang, Sheng 已提交
2768 2769
	}

A
Avi Kivity 已提交
2770 2771
	r = register_cpu_notifier(&kvm_cpu_notifier);
	if (r)
2772
		goto out_free_2;
A
Avi Kivity 已提交
2773 2774
	register_reboot_notifier(&kvm_reboot_notifier);

2775
	/* A kmem cache lets us meet the alignment requirements of fx_save. */
2776 2777 2778
	if (!vcpu_align)
		vcpu_align = __alignof__(struct kvm_vcpu);
	kvm_vcpu_cache = kmem_cache_create("kvm_vcpu", vcpu_size, vcpu_align,
J
Joe Perches 已提交
2779
					   0, NULL);
2780 2781
	if (!kvm_vcpu_cache) {
		r = -ENOMEM;
2782
		goto out_free_3;
2783 2784
	}

2785 2786 2787 2788
	r = kvm_async_pf_init();
	if (r)
		goto out_free;

A
Avi Kivity 已提交
2789
	kvm_chardev_ops.owner = module;
2790 2791
	kvm_vm_fops.owner = module;
	kvm_vcpu_fops.owner = module;
A
Avi Kivity 已提交
2792 2793 2794

	r = misc_register(&kvm_dev);
	if (r) {
M
Mike Day 已提交
2795
		printk(KERN_ERR "kvm: misc device register failed\n");
2796
		goto out_unreg;
A
Avi Kivity 已提交
2797 2798
	}

2799 2800
	register_syscore_ops(&kvm_syscore_ops);

2801 2802 2803
	kvm_preempt_ops.sched_in = kvm_sched_in;
	kvm_preempt_ops.sched_out = kvm_sched_out;

2804 2805 2806 2807 2808
	r = kvm_init_debug();
	if (r) {
		printk(KERN_ERR "kvm: create debugfs files failed\n");
		goto out_undebugfs;
	}
2809

2810
	return 0;
A
Avi Kivity 已提交
2811

2812 2813
out_undebugfs:
	unregister_syscore_ops(&kvm_syscore_ops);
2814 2815
out_unreg:
	kvm_async_pf_deinit();
A
Avi Kivity 已提交
2816
out_free:
2817
	kmem_cache_destroy(kvm_vcpu_cache);
2818
out_free_3:
A
Avi Kivity 已提交
2819
	unregister_reboot_notifier(&kvm_reboot_notifier);
A
Avi Kivity 已提交
2820
	unregister_cpu_notifier(&kvm_cpu_notifier);
2821 2822
out_free_2:
out_free_1:
2823
	kvm_arch_hardware_unsetup();
2824 2825
out_free_0a:
	free_cpumask_var(cpus_hardware_enabled);
2826
out_free_0:
2827
	kvm_arch_exit();
2828
out_fail:
A
Avi Kivity 已提交
2829 2830
	return r;
}
2831
EXPORT_SYMBOL_GPL(kvm_init);
A
Avi Kivity 已提交
2832

2833
void kvm_exit(void)
A
Avi Kivity 已提交
2834
{
2835
	kvm_exit_debug();
A
Avi Kivity 已提交
2836
	misc_deregister(&kvm_dev);
2837
	kmem_cache_destroy(kvm_vcpu_cache);
2838
	kvm_async_pf_deinit();
2839
	unregister_syscore_ops(&kvm_syscore_ops);
A
Avi Kivity 已提交
2840
	unregister_reboot_notifier(&kvm_reboot_notifier);
2841
	unregister_cpu_notifier(&kvm_cpu_notifier);
2842
	on_each_cpu(hardware_disable_nolock, NULL, 1);
2843
	kvm_arch_hardware_unsetup();
2844
	kvm_arch_exit();
2845
	free_cpumask_var(cpus_hardware_enabled);
A
Avi Kivity 已提交
2846
}
2847
EXPORT_SYMBOL_GPL(kvm_exit);