book3s.c 21.0 KB
Newer Older
A
Alexander Graf 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
/*
 * Copyright (C) 2009. SUSE Linux Products GmbH. All rights reserved.
 *
 * Authors:
 *    Alexander Graf <agraf@suse.de>
 *    Kevin Wolf <mail@kevin-wolf.de>
 *
 * Description:
 * This file is derived from arch/powerpc/kvm/44x.c,
 * by Hollis Blanchard <hollisb@us.ibm.com>.
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License, version 2, as
 * published by the Free Software Foundation.
 */

#include <linux/kvm_host.h>
#include <linux/err.h>
19
#include <linux/export.h>
20
#include <linux/slab.h>
A
Alexander Graf 已提交
21 22 23 24 25 26 27 28 29 30

#include <asm/reg.h>
#include <asm/cputable.h>
#include <asm/cacheflush.h>
#include <asm/tlbflush.h>
#include <asm/uaccess.h>
#include <asm/io.h>
#include <asm/kvm_ppc.h>
#include <asm/kvm_book3s.h>
#include <asm/mmu_context.h>
31
#include <asm/page.h>
32
#include <linux/gfp.h>
A
Alexander Graf 已提交
33 34
#include <linux/sched.h>
#include <linux/vmalloc.h>
A
Alexander Graf 已提交
35
#include <linux/highmem.h>
A
Alexander Graf 已提交
36

37
#include "book3s.h"
38 39
#include "trace.h"

A
Alexander Graf 已提交
40 41 42
#define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU

/* #define EXIT_DEBUG */
43

A
Alexander Graf 已提交
44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72
struct kvm_stats_debugfs_item debugfs_entries[] = {
	{ "exits",       VCPU_STAT(sum_exits) },
	{ "mmio",        VCPU_STAT(mmio_exits) },
	{ "sig",         VCPU_STAT(signal_exits) },
	{ "sysc",        VCPU_STAT(syscall_exits) },
	{ "inst_emu",    VCPU_STAT(emulated_inst_exits) },
	{ "dec",         VCPU_STAT(dec_exits) },
	{ "ext_intr",    VCPU_STAT(ext_intr_exits) },
	{ "queue_intr",  VCPU_STAT(queue_intr) },
	{ "halt_wakeup", VCPU_STAT(halt_wakeup) },
	{ "pf_storage",  VCPU_STAT(pf_storage) },
	{ "sp_storage",  VCPU_STAT(sp_storage) },
	{ "pf_instruc",  VCPU_STAT(pf_instruc) },
	{ "sp_instruc",  VCPU_STAT(sp_instruc) },
	{ "ld",          VCPU_STAT(ld) },
	{ "ld_slow",     VCPU_STAT(ld_slow) },
	{ "st",          VCPU_STAT(st) },
	{ "st_slow",     VCPU_STAT(st_slow) },
	{ NULL }
};

void kvmppc_core_load_host_debugstate(struct kvm_vcpu *vcpu)
{
}

void kvmppc_core_load_guest_debugstate(struct kvm_vcpu *vcpu)
{
}

73 74
static inline unsigned long kvmppc_interrupt_offset(struct kvm_vcpu *vcpu)
{
75
	if (!is_kvmppc_hv_enabled(vcpu->kvm))
76 77 78 79 80 81 82
		return to_book3s(vcpu)->hior;
	return 0;
}

static inline void kvmppc_update_int_pending(struct kvm_vcpu *vcpu,
			unsigned long pending_now, unsigned long old_pending)
{
83
	if (is_kvmppc_hv_enabled(vcpu->kvm))
84 85 86 87 88 89 90 91 92 93 94 95 96
		return;
	if (pending_now)
		vcpu->arch.shared->int_pending = 1;
	else if (old_pending)
		vcpu->arch.shared->int_pending = 0;
}

static inline bool kvmppc_critical_section(struct kvm_vcpu *vcpu)
{
	ulong crit_raw;
	ulong crit_r1;
	bool crit;

97
	if (is_kvmppc_hv_enabled(vcpu->kvm))
98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116
		return false;

	crit_raw = vcpu->arch.shared->critical;
	crit_r1 = kvmppc_get_gpr(vcpu, 1);

	/* Truncate crit indicators in 32 bit mode */
	if (!(vcpu->arch.shared->msr & MSR_SF)) {
		crit_raw &= 0xffffffff;
		crit_r1 &= 0xffffffff;
	}

	/* Critical section when crit == r1 */
	crit = (crit_raw == crit_r1);
	/* ... and we're in supervisor mode */
	crit = crit && !(vcpu->arch.shared->msr & MSR_PR);

	return crit;
}

A
Alexander Graf 已提交
117 118
void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
{
119 120
	vcpu->arch.shared->srr0 = kvmppc_get_pc(vcpu);
	vcpu->arch.shared->srr1 = vcpu->arch.shared->msr | flags;
121
	kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
A
Alexander Graf 已提交
122 123 124
	vcpu->arch.mmu.reset_msr(vcpu);
}

125
static int kvmppc_book3s_vec2irqprio(unsigned int vec)
A
Alexander Graf 已提交
126 127 128 129 130 131 132 133 134 135 136
{
	unsigned int prio;

	switch (vec) {
	case 0x100: prio = BOOK3S_IRQPRIO_SYSTEM_RESET;		break;
	case 0x200: prio = BOOK3S_IRQPRIO_MACHINE_CHECK;	break;
	case 0x300: prio = BOOK3S_IRQPRIO_DATA_STORAGE;		break;
	case 0x380: prio = BOOK3S_IRQPRIO_DATA_SEGMENT;		break;
	case 0x400: prio = BOOK3S_IRQPRIO_INST_STORAGE;		break;
	case 0x480: prio = BOOK3S_IRQPRIO_INST_SEGMENT;		break;
	case 0x500: prio = BOOK3S_IRQPRIO_EXTERNAL;		break;
137
	case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL;	break;
A
Alexander Graf 已提交
138 139 140 141 142 143 144 145 146 147 148
	case 0x600: prio = BOOK3S_IRQPRIO_ALIGNMENT;		break;
	case 0x700: prio = BOOK3S_IRQPRIO_PROGRAM;		break;
	case 0x800: prio = BOOK3S_IRQPRIO_FP_UNAVAIL;		break;
	case 0x900: prio = BOOK3S_IRQPRIO_DECREMENTER;		break;
	case 0xc00: prio = BOOK3S_IRQPRIO_SYSCALL;		break;
	case 0xd00: prio = BOOK3S_IRQPRIO_DEBUG;		break;
	case 0xf20: prio = BOOK3S_IRQPRIO_ALTIVEC;		break;
	case 0xf40: prio = BOOK3S_IRQPRIO_VSX;			break;
	default:    prio = BOOK3S_IRQPRIO_MAX;			break;
	}

149 150 151
	return prio;
}

152
void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
153 154
					  unsigned int vec)
{
155 156
	unsigned long old_pending = vcpu->arch.pending_exceptions;

157 158
	clear_bit(kvmppc_book3s_vec2irqprio(vec),
		  &vcpu->arch.pending_exceptions);
159

160 161
	kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
				  old_pending);
162 163
}

164 165 166 167 168 169
void kvmppc_book3s_queue_irqprio(struct kvm_vcpu *vcpu, unsigned int vec)
{
	vcpu->stat.queue_intr++;

	set_bit(kvmppc_book3s_vec2irqprio(vec),
		&vcpu->arch.pending_exceptions);
A
Alexander Graf 已提交
170 171 172 173
#ifdef EXIT_DEBUG
	printk(KERN_INFO "Queueing interrupt %x\n", vec);
#endif
}
174
EXPORT_SYMBOL_GPL(kvmppc_book3s_queue_irqprio);
A
Alexander Graf 已提交
175

176
void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
A
Alexander Graf 已提交
177
{
178 179
	/* might as well deliver this straight away */
	kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_PROGRAM, flags);
A
Alexander Graf 已提交
180
}
181
EXPORT_SYMBOL_GPL(kvmppc_core_queue_program);
A
Alexander Graf 已提交
182 183 184 185 186

void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}
187
EXPORT_SYMBOL_GPL(kvmppc_core_queue_dec);
A
Alexander Graf 已提交
188 189 190

int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
{
191
	return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
A
Alexander Graf 已提交
192
}
193
EXPORT_SYMBOL_GPL(kvmppc_core_pending_dec);
A
Alexander Graf 已提交
194

195 196 197 198
void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}
199
EXPORT_SYMBOL_GPL(kvmppc_core_dequeue_dec);
200

A
Alexander Graf 已提交
201 202 203
void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
                                struct kvm_interrupt *irq)
{
204 205 206 207 208 209
	unsigned int vec = BOOK3S_INTERRUPT_EXTERNAL;

	if (irq->irq == KVM_INTERRUPT_SET_LEVEL)
		vec = BOOK3S_INTERRUPT_EXTERNAL_LEVEL;

	kvmppc_book3s_queue_irqprio(vcpu, vec);
A
Alexander Graf 已提交
210 211
}

212
void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu)
213 214
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
215
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL_LEVEL);
216 217
}

A
Alexander Graf 已提交
218 219 220 221
int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu, unsigned int priority)
{
	int deliver = 1;
	int vec = 0;
222
	bool crit = kvmppc_critical_section(vcpu);
A
Alexander Graf 已提交
223 224 225

	switch (priority) {
	case BOOK3S_IRQPRIO_DECREMENTER:
226
		deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
A
Alexander Graf 已提交
227 228 229
		vec = BOOK3S_INTERRUPT_DECREMENTER;
		break;
	case BOOK3S_IRQPRIO_EXTERNAL:
230
	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
231
		deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
A
Alexander Graf 已提交
232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286
		vec = BOOK3S_INTERRUPT_EXTERNAL;
		break;
	case BOOK3S_IRQPRIO_SYSTEM_RESET:
		vec = BOOK3S_INTERRUPT_SYSTEM_RESET;
		break;
	case BOOK3S_IRQPRIO_MACHINE_CHECK:
		vec = BOOK3S_INTERRUPT_MACHINE_CHECK;
		break;
	case BOOK3S_IRQPRIO_DATA_STORAGE:
		vec = BOOK3S_INTERRUPT_DATA_STORAGE;
		break;
	case BOOK3S_IRQPRIO_INST_STORAGE:
		vec = BOOK3S_INTERRUPT_INST_STORAGE;
		break;
	case BOOK3S_IRQPRIO_DATA_SEGMENT:
		vec = BOOK3S_INTERRUPT_DATA_SEGMENT;
		break;
	case BOOK3S_IRQPRIO_INST_SEGMENT:
		vec = BOOK3S_INTERRUPT_INST_SEGMENT;
		break;
	case BOOK3S_IRQPRIO_ALIGNMENT:
		vec = BOOK3S_INTERRUPT_ALIGNMENT;
		break;
	case BOOK3S_IRQPRIO_PROGRAM:
		vec = BOOK3S_INTERRUPT_PROGRAM;
		break;
	case BOOK3S_IRQPRIO_VSX:
		vec = BOOK3S_INTERRUPT_VSX;
		break;
	case BOOK3S_IRQPRIO_ALTIVEC:
		vec = BOOK3S_INTERRUPT_ALTIVEC;
		break;
	case BOOK3S_IRQPRIO_FP_UNAVAIL:
		vec = BOOK3S_INTERRUPT_FP_UNAVAIL;
		break;
	case BOOK3S_IRQPRIO_SYSCALL:
		vec = BOOK3S_INTERRUPT_SYSCALL;
		break;
	case BOOK3S_IRQPRIO_DEBUG:
		vec = BOOK3S_INTERRUPT_TRACE;
		break;
	case BOOK3S_IRQPRIO_PERFORMANCE_MONITOR:
		vec = BOOK3S_INTERRUPT_PERFMON;
		break;
	default:
		deliver = 0;
		printk(KERN_ERR "KVM: Unknown interrupt: 0x%x\n", priority);
		break;
	}

#if 0
	printk(KERN_INFO "Deliver interrupt 0x%x? %x\n", vec, deliver);
#endif

	if (deliver)
287
		kvmppc_inject_interrupt(vcpu, vec, 0);
A
Alexander Graf 已提交
288 289 290 291

	return deliver;
}

292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308
/*
 * This function determines if an irqprio should be cleared once issued.
 */
static bool clear_irqprio(struct kvm_vcpu *vcpu, unsigned int priority)
{
	switch (priority) {
		case BOOK3S_IRQPRIO_DECREMENTER:
			/* DEC interrupts get cleared by mtdec */
			return false;
		case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
			/* External interrupts get cleared by userspace */
			return false;
	}

	return true;
}

309
int kvmppc_core_prepare_to_enter(struct kvm_vcpu *vcpu)
A
Alexander Graf 已提交
310 311
{
	unsigned long *pending = &vcpu->arch.pending_exceptions;
312
	unsigned long old_pending = vcpu->arch.pending_exceptions;
A
Alexander Graf 已提交
313 314 315 316 317 318 319
	unsigned int priority;

#ifdef EXIT_DEBUG
	if (vcpu->arch.pending_exceptions)
		printk(KERN_EMERG "KVM: Check pending: %lx\n", vcpu->arch.pending_exceptions);
#endif
	priority = __ffs(*pending);
A
Alexander Graf 已提交
320
	while (priority < BOOK3S_IRQPRIO_MAX) {
321
		if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
322
		    clear_irqprio(vcpu, priority)) {
A
Alexander Graf 已提交
323 324 325 326 327 328 329 330
			clear_bit(priority, &vcpu->arch.pending_exceptions);
			break;
		}

		priority = find_next_bit(pending,
					 BITS_PER_BYTE * sizeof(*pending),
					 priority + 1);
	}
331 332

	/* Tell the guest about our interrupt status */
333
	kvmppc_update_int_pending(vcpu, *pending, old_pending);
334 335

	return 0;
A
Alexander Graf 已提交
336
}
337
EXPORT_SYMBOL_GPL(kvmppc_core_prepare_to_enter);
A
Alexander Graf 已提交
338

339 340
pfn_t kvmppc_gfn_to_pfn(struct kvm_vcpu *vcpu, gfn_t gfn, bool writing,
			bool *writable)
341 342 343
{
	ulong mp_pa = vcpu->arch.magic_page_pa;

344 345 346
	if (!(vcpu->arch.shared->msr & MSR_SF))
		mp_pa = (uint32_t)mp_pa;

347 348 349 350 351 352 353 354 355
	/* Magic page override */
	if (unlikely(mp_pa) &&
	    unlikely(((gfn << PAGE_SHIFT) & KVM_PAM) ==
		     ((mp_pa & PAGE_MASK) & KVM_PAM))) {
		ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK;
		pfn_t pfn;

		pfn = (pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT;
		get_page(pfn_to_page(pfn));
356 357
		if (writable)
			*writable = true;
358 359 360
		return pfn;
	}

361
	return gfn_to_pfn_prot(vcpu->kvm, gfn, writing, writable);
362
}
363
EXPORT_SYMBOL_GPL(kvmppc_gfn_to_pfn);
364

A
Alexander Graf 已提交
365
static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data,
366
			bool iswrite, struct kvmppc_pte *pte)
A
Alexander Graf 已提交
367
{
368
	int relocated = (vcpu->arch.shared->msr & (data ? MSR_DR : MSR_IR));
A
Alexander Graf 已提交
369 370 371
	int r;

	if (relocated) {
372
		r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data, iswrite);
A
Alexander Graf 已提交
373 374
	} else {
		pte->eaddr = eaddr;
A
Alexander Graf 已提交
375
		pte->raddr = eaddr & KVM_PAM;
376
		pte->vpage = VSID_REAL | eaddr >> 12;
A
Alexander Graf 已提交
377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 405 406 407 408 409 410
		pte->may_read = true;
		pte->may_write = true;
		pte->may_execute = true;
		r = 0;
	}

	return r;
}

static hva_t kvmppc_bad_hva(void)
{
	return PAGE_OFFSET;
}

static hva_t kvmppc_pte_to_hva(struct kvm_vcpu *vcpu, struct kvmppc_pte *pte,
			       bool read)
{
	hva_t hpage;

	if (read && !pte->may_read)
		goto err;

	if (!read && !pte->may_write)
		goto err;

	hpage = gfn_to_hva(vcpu->kvm, pte->raddr >> PAGE_SHIFT);
	if (kvm_is_error_hva(hpage))
		goto err;

	return hpage | (pte->raddr & ~PAGE_MASK);
err:
	return kvmppc_bad_hva();
}

411 412
int kvmppc_st(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
	      bool data)
A
Alexander Graf 已提交
413 414 415 416 417
{
	struct kvmppc_pte pte;

	vcpu->stat.st++;

418
	if (kvmppc_xlate(vcpu, *eaddr, data, true, &pte))
A
Alexander Graf 已提交
419
		return -ENOENT;
420 421

	*eaddr = pte.raddr;
A
Alexander Graf 已提交
422

A
Alexander Graf 已提交
423 424
	if (!pte.may_write)
		return -EPERM;
A
Alexander Graf 已提交
425

A
Alexander Graf 已提交
426 427
	if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size))
		return EMULATE_DO_MMIO;
A
Alexander Graf 已提交
428

429
	return EMULATE_DONE;
A
Alexander Graf 已提交
430
}
431
EXPORT_SYMBOL_GPL(kvmppc_st);
A
Alexander Graf 已提交
432

433
int kvmppc_ld(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
A
Alexander Graf 已提交
434 435 436
		      bool data)
{
	struct kvmppc_pte pte;
437
	hva_t hva = *eaddr;
A
Alexander Graf 已提交
438 439 440

	vcpu->stat.ld++;

441
	if (kvmppc_xlate(vcpu, *eaddr, data, false, &pte))
442 443 444
		goto nopte;

	*eaddr = pte.raddr;
A
Alexander Graf 已提交
445 446 447

	hva = kvmppc_pte_to_hva(vcpu, &pte, true);
	if (kvm_is_error_hva(hva))
448
		goto mmio;
A
Alexander Graf 已提交
449 450 451

	if (copy_from_user(ptr, (void __user *)hva, size)) {
		printk(KERN_INFO "kvmppc_ld at 0x%lx failed\n", hva);
452
		goto mmio;
A
Alexander Graf 已提交
453 454
	}

455
	return EMULATE_DONE;
A
Alexander Graf 已提交
456

457
nopte:
A
Alexander Graf 已提交
458
	return -ENOENT;
459 460
mmio:
	return EMULATE_DO_MMIO;
A
Alexander Graf 已提交
461
}
462
EXPORT_SYMBOL_GPL(kvmppc_ld);
A
Alexander Graf 已提交
463 464 465 466 467 468

int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
{
	return 0;
}

469 470 471 472 473 474 475 476 477
int kvmppc_subarch_vcpu_init(struct kvm_vcpu *vcpu)
{
	return 0;
}

void kvmppc_subarch_vcpu_uninit(struct kvm_vcpu *vcpu)
{
}

478 479 480
int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
				  struct kvm_sregs *sregs)
{
481
	return vcpu->kvm->arch.kvm_ops->get_sregs(vcpu, sregs);
482 483 484 485 486
}

int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
				  struct kvm_sregs *sregs)
{
487
	return vcpu->kvm->arch.kvm_ops->set_sregs(vcpu, sregs);
488 489
}

A
Alexander Graf 已提交
490 491 492 493
int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
{
	int i;

494
	regs->pc = kvmppc_get_pc(vcpu);
495
	regs->cr = kvmppc_get_cr(vcpu);
496 497
	regs->ctr = kvmppc_get_ctr(vcpu);
	regs->lr = kvmppc_get_lr(vcpu);
498
	regs->xer = kvmppc_get_xer(vcpu);
499
	regs->msr = vcpu->arch.shared->msr;
500 501
	regs->srr0 = vcpu->arch.shared->srr0;
	regs->srr1 = vcpu->arch.shared->srr1;
A
Alexander Graf 已提交
502
	regs->pid = vcpu->arch.pid;
503 504 505 506
	regs->sprg0 = vcpu->arch.shared->sprg0;
	regs->sprg1 = vcpu->arch.shared->sprg1;
	regs->sprg2 = vcpu->arch.shared->sprg2;
	regs->sprg3 = vcpu->arch.shared->sprg3;
507 508 509 510
	regs->sprg4 = vcpu->arch.shared->sprg4;
	regs->sprg5 = vcpu->arch.shared->sprg5;
	regs->sprg6 = vcpu->arch.shared->sprg6;
	regs->sprg7 = vcpu->arch.shared->sprg7;
A
Alexander Graf 已提交
511 512

	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
513
		regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
A
Alexander Graf 已提交
514 515 516 517 518 519 520 521

	return 0;
}

int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
{
	int i;

522
	kvmppc_set_pc(vcpu, regs->pc);
523
	kvmppc_set_cr(vcpu, regs->cr);
524 525
	kvmppc_set_ctr(vcpu, regs->ctr);
	kvmppc_set_lr(vcpu, regs->lr);
526
	kvmppc_set_xer(vcpu, regs->xer);
A
Alexander Graf 已提交
527
	kvmppc_set_msr(vcpu, regs->msr);
528 529
	vcpu->arch.shared->srr0 = regs->srr0;
	vcpu->arch.shared->srr1 = regs->srr1;
530 531 532 533
	vcpu->arch.shared->sprg0 = regs->sprg0;
	vcpu->arch.shared->sprg1 = regs->sprg1;
	vcpu->arch.shared->sprg2 = regs->sprg2;
	vcpu->arch.shared->sprg3 = regs->sprg3;
534 535 536 537
	vcpu->arch.shared->sprg4 = regs->sprg4;
	vcpu->arch.shared->sprg5 = regs->sprg5;
	vcpu->arch.shared->sprg6 = regs->sprg6;
	vcpu->arch.shared->sprg7 = regs->sprg7;
A
Alexander Graf 已提交
538

539 540
	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
		kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
A
Alexander Graf 已提交
541 542 543 544 545 546 547 548 549 550 551 552 553 554

	return 0;
}

int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
{
	return -ENOTSUPP;
}

int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
{
	return -ENOTSUPP;
}

555 556 557 558 559
int kvm_vcpu_ioctl_get_one_reg(struct kvm_vcpu *vcpu, struct kvm_one_reg *reg)
{
	int r;
	union kvmppc_one_reg val;
	int size;
560
	long int i;
561 562 563 564 565

	size = one_reg_size(reg->id);
	if (size > sizeof(val))
		return -EINVAL;

566
	r = vcpu->kvm->arch.kvm_ops->get_one_reg(vcpu, reg->id, &val);
567 568 569 570 571 572 573 574 575
	if (r == -EINVAL) {
		r = 0;
		switch (reg->id) {
		case KVM_REG_PPC_DAR:
			val = get_reg_val(reg->id, vcpu->arch.shared->dar);
			break;
		case KVM_REG_PPC_DSISR:
			val = get_reg_val(reg->id, vcpu->arch.shared->dsisr);
			break;
576 577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 596 597
		case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
			i = reg->id - KVM_REG_PPC_FPR0;
			val = get_reg_val(reg->id, vcpu->arch.fpr[i]);
			break;
		case KVM_REG_PPC_FPSCR:
			val = get_reg_val(reg->id, vcpu->arch.fpscr);
			break;
#ifdef CONFIG_ALTIVEC
		case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			val.vval = vcpu->arch.vr[reg->id - KVM_REG_PPC_VR0];
			break;
		case KVM_REG_PPC_VSCR:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			val = get_reg_val(reg->id, vcpu->arch.vscr.u[3]);
			break;
598 599 600
		case KVM_REG_PPC_VRSAVE:
			val = get_reg_val(reg->id, vcpu->arch.vrsave);
			break;
601
#endif /* CONFIG_ALTIVEC */
602 603 604 605 606 607
		case KVM_REG_PPC_DEBUG_INST: {
			u32 opcode = INS_TW;
			r = copy_to_user((u32 __user *)(long)reg->addr,
					 &opcode, sizeof(u32));
			break;
		}
608 609 610 611 612 613 614 615 616
#ifdef CONFIG_KVM_XICS
		case KVM_REG_PPC_ICP_STATE:
			if (!vcpu->arch.icp) {
				r = -ENXIO;
				break;
			}
			val = get_reg_val(reg->id, kvmppc_xics_get_icp(vcpu));
			break;
#endif /* CONFIG_KVM_XICS */
617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635
		default:
			r = -EINVAL;
			break;
		}
	}
	if (r)
		return r;

	if (copy_to_user((char __user *)(unsigned long)reg->addr, &val, size))
		r = -EFAULT;

	return r;
}

int kvm_vcpu_ioctl_set_one_reg(struct kvm_vcpu *vcpu, struct kvm_one_reg *reg)
{
	int r;
	union kvmppc_one_reg val;
	int size;
636
	long int i;
637 638 639 640 641 642 643 644

	size = one_reg_size(reg->id);
	if (size > sizeof(val))
		return -EINVAL;

	if (copy_from_user(&val, (char __user *)(unsigned long)reg->addr, size))
		return -EFAULT;

645
	r = vcpu->kvm->arch.kvm_ops->set_one_reg(vcpu, reg->id, &val);
646 647 648 649 650 651 652 653 654
	if (r == -EINVAL) {
		r = 0;
		switch (reg->id) {
		case KVM_REG_PPC_DAR:
			vcpu->arch.shared->dar = set_reg_val(reg->id, val);
			break;
		case KVM_REG_PPC_DSISR:
			vcpu->arch.shared->dsisr = set_reg_val(reg->id, val);
			break;
655 656 657 658 659 660 661 662 663 664 665 666 667 668 669 670 671 672 673 674 675 676
		case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
			i = reg->id - KVM_REG_PPC_FPR0;
			vcpu->arch.fpr[i] = set_reg_val(reg->id, val);
			break;
		case KVM_REG_PPC_FPSCR:
			vcpu->arch.fpscr = set_reg_val(reg->id, val);
			break;
#ifdef CONFIG_ALTIVEC
		case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			vcpu->arch.vr[reg->id - KVM_REG_PPC_VR0] = val.vval;
			break;
		case KVM_REG_PPC_VSCR:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			vcpu->arch.vscr.u[3] = set_reg_val(reg->id, val);
			break;
677 678 679 680 681 682 683
		case KVM_REG_PPC_VRSAVE:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			vcpu->arch.vrsave = set_reg_val(reg->id, val);
			break;
684
#endif /* CONFIG_ALTIVEC */
685 686 687 688 689 690 691 692 693 694
#ifdef CONFIG_KVM_XICS
		case KVM_REG_PPC_ICP_STATE:
			if (!vcpu->arch.icp) {
				r = -ENXIO;
				break;
			}
			r = kvmppc_xics_set_icp(vcpu,
						set_reg_val(reg->id, val));
			break;
#endif /* CONFIG_KVM_XICS */
695 696 697 698 699 700 701 702 703
		default:
			r = -EINVAL;
			break;
		}
	}

	return r;
}

704 705
void kvmppc_core_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
{
706
	vcpu->kvm->arch.kvm_ops->vcpu_load(vcpu, cpu);
707 708 709 710
}

void kvmppc_core_vcpu_put(struct kvm_vcpu *vcpu)
{
711
	vcpu->kvm->arch.kvm_ops->vcpu_put(vcpu);
712 713 714 715
}

void kvmppc_set_msr(struct kvm_vcpu *vcpu, u64 msr)
{
716
	vcpu->kvm->arch.kvm_ops->set_msr(vcpu, msr);
717
}
718
EXPORT_SYMBOL_GPL(kvmppc_set_msr);
719 720 721

int kvmppc_vcpu_run(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu)
{
722
	return vcpu->kvm->arch.kvm_ops->vcpu_run(kvm_run, vcpu);
723 724
}

A
Alexander Graf 已提交
725 726 727 728 729 730
int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
                                  struct kvm_translation *tr)
{
	return 0;
}

731 732 733 734 735 736
int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
					struct kvm_guest_debug *dbg)
{
	return -EINVAL;
}

737 738 739 740 741 742 743
void kvmppc_decrementer_func(unsigned long data)
{
	struct kvm_vcpu *vcpu = (struct kvm_vcpu *)data;

	kvmppc_core_queue_dec(vcpu);
	kvm_vcpu_kick(vcpu);
}
744 745 746

struct kvm_vcpu *kvmppc_core_vcpu_create(struct kvm *kvm, unsigned int id)
{
747
	return kvm->arch.kvm_ops->vcpu_create(kvm, id);
748 749 750 751
}

void kvmppc_core_vcpu_free(struct kvm_vcpu *vcpu)
{
752
	vcpu->kvm->arch.kvm_ops->vcpu_free(vcpu);
753 754 755 756
}

int kvmppc_core_check_requests(struct kvm_vcpu *vcpu)
{
757
	return vcpu->kvm->arch.kvm_ops->check_requests(vcpu);
758 759 760 761
}

int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm, struct kvm_dirty_log *log)
{
762
	return kvm->arch.kvm_ops->get_dirty_log(kvm, log);
763 764
}

765
void kvmppc_core_free_memslot(struct kvm *kvm, struct kvm_memory_slot *free,
766 767
			      struct kvm_memory_slot *dont)
{
768
	kvm->arch.kvm_ops->free_memslot(free, dont);
769 770
}

771
int kvmppc_core_create_memslot(struct kvm *kvm, struct kvm_memory_slot *slot,
772 773
			       unsigned long npages)
{
774
	return kvm->arch.kvm_ops->create_memslot(slot, npages);
775 776 777 778
}

void kvmppc_core_flush_memslot(struct kvm *kvm, struct kvm_memory_slot *memslot)
{
779
	kvm->arch.kvm_ops->flush_memslot(kvm, memslot);
780 781 782 783 784 785
}

int kvmppc_core_prepare_memory_region(struct kvm *kvm,
				struct kvm_memory_slot *memslot,
				struct kvm_userspace_memory_region *mem)
{
786
	return kvm->arch.kvm_ops->prepare_memory_region(kvm, memslot, mem);
787 788 789 790 791 792
}

void kvmppc_core_commit_memory_region(struct kvm *kvm,
				struct kvm_userspace_memory_region *mem,
				const struct kvm_memory_slot *old)
{
793
	kvm->arch.kvm_ops->commit_memory_region(kvm, mem, old);
794 795 796 797
}

int kvm_unmap_hva(struct kvm *kvm, unsigned long hva)
{
798
	return kvm->arch.kvm_ops->unmap_hva(kvm, hva);
799
}
800
EXPORT_SYMBOL_GPL(kvm_unmap_hva);
801 802 803

int kvm_unmap_hva_range(struct kvm *kvm, unsigned long start, unsigned long end)
{
804
	return kvm->arch.kvm_ops->unmap_hva_range(kvm, start, end);
805 806 807 808
}

int kvm_age_hva(struct kvm *kvm, unsigned long hva)
{
809
	return kvm->arch.kvm_ops->age_hva(kvm, hva);
810 811 812 813
}

int kvm_test_age_hva(struct kvm *kvm, unsigned long hva)
{
814
	return kvm->arch.kvm_ops->test_age_hva(kvm, hva);
815 816 817 818
}

void kvm_set_spte_hva(struct kvm *kvm, unsigned long hva, pte_t pte)
{
819
	kvm->arch.kvm_ops->set_spte_hva(kvm, hva, pte);
820 821 822 823
}

void kvmppc_mmu_destroy(struct kvm_vcpu *vcpu)
{
824
	vcpu->kvm->arch.kvm_ops->mmu_destroy(vcpu);
825 826 827 828 829 830 831 832 833 834
}

int kvmppc_core_init_vm(struct kvm *kvm)
{

#ifdef CONFIG_PPC64
	INIT_LIST_HEAD(&kvm->arch.spapr_tce_tables);
	INIT_LIST_HEAD(&kvm->arch.rtas_tokens);
#endif

835
	return kvm->arch.kvm_ops->init_vm(kvm);
836 837 838 839
}

void kvmppc_core_destroy_vm(struct kvm *kvm)
{
840
	kvm->arch.kvm_ops->destroy_vm(kvm);
841 842 843 844 845 846 847 848 849

#ifdef CONFIG_PPC64
	kvmppc_rtas_tokens_free(kvm);
	WARN_ON(!list_empty(&kvm->arch.spapr_tce_tables));
#endif
}

int kvmppc_core_check_processor_compat(void)
{
850 851 852 853 854 855 856 857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874 875 876 877
	/*
	 * We always return 0 for book3s. We check
	 * for compatability while loading the HV
	 * or PR module
	 */
	return 0;
}

static int kvmppc_book3s_init(void)
{
	int r;

	r = kvm_init(NULL, sizeof(struct kvm_vcpu), 0, THIS_MODULE);
	if (r)
		return r;
#ifdef CONFIG_KVM_BOOK3S_32
	r = kvmppc_book3s_init_pr();
#endif
	return r;

}

static void kvmppc_book3s_exit(void)
{
#ifdef CONFIG_KVM_BOOK3S_32
	kvmppc_book3s_exit_pr();
#endif
	kvm_exit();
878
}
879 880 881

module_init(kvmppc_book3s_init);
module_exit(kvmppc_book3s_exit);