book3s.c 22.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>
21 22
#include <linux/module.h>
#include <linux/miscdevice.h>
A
Alexander Graf 已提交
23 24 25 26 27 28 29 30 31 32

#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>
33
#include <asm/page.h>
34
#include <linux/gfp.h>
A
Alexander Graf 已提交
35 36
#include <linux/sched.h>
#include <linux/vmalloc.h>
A
Alexander Graf 已提交
37
#include <linux/highmem.h>
A
Alexander Graf 已提交
38

39
#include "book3s.h"
40 41
#include "trace.h"

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

/* #define EXIT_DEBUG */
45

A
Alexander Graf 已提交
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 73 74
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)
{
}

75 76
static inline unsigned long kvmppc_interrupt_offset(struct kvm_vcpu *vcpu)
{
77
	if (!is_kvmppc_hv_enabled(vcpu->kvm))
78 79 80 81 82 83 84
		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)
{
85
	if (is_kvmppc_hv_enabled(vcpu->kvm))
86 87
		return;
	if (pending_now)
88
		kvmppc_set_int_pending(vcpu, 1);
89
	else if (old_pending)
90
		kvmppc_set_int_pending(vcpu, 0);
91 92 93 94 95 96 97 98
}

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

99
	if (is_kvmppc_hv_enabled(vcpu->kvm))
100 101
		return false;

102
	crit_raw = kvmppc_get_critical(vcpu);
103 104 105
	crit_r1 = kvmppc_get_gpr(vcpu, 1);

	/* Truncate crit indicators in 32 bit mode */
106
	if (!(kvmppc_get_msr(vcpu) & MSR_SF)) {
107 108 109 110 111 112 113
		crit_raw &= 0xffffffff;
		crit_r1 &= 0xffffffff;
	}

	/* Critical section when crit == r1 */
	crit = (crit_raw == crit_r1);
	/* ... and we're in supervisor mode */
114
	crit = crit && !(kvmppc_get_msr(vcpu) & MSR_PR);
115 116 117 118

	return crit;
}

A
Alexander Graf 已提交
119 120
void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
{
121 122
	kvmppc_set_srr0(vcpu, kvmppc_get_pc(vcpu));
	kvmppc_set_srr1(vcpu, kvmppc_get_msr(vcpu) | flags);
123
	kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
A
Alexander Graf 已提交
124 125 126
	vcpu->arch.mmu.reset_msr(vcpu);
}

127
static int kvmppc_book3s_vec2irqprio(unsigned int vec)
A
Alexander Graf 已提交
128 129 130 131 132 133 134 135 136 137 138
{
	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;
139
	case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL;	break;
A
Alexander Graf 已提交
140 141 142 143 144 145 146 147
	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;
148
	case 0xf60: prio = BOOK3S_IRQPRIO_FAC_UNAVAIL;		break;
A
Alexander Graf 已提交
149 150 151
	default:    prio = BOOK3S_IRQPRIO_MAX;			break;
	}

152 153 154
	return prio;
}

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

160 161
	clear_bit(kvmppc_book3s_vec2irqprio(vec),
		  &vcpu->arch.pending_exceptions);
162

163 164
	kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
				  old_pending);
165 166
}

167 168 169 170 171 172
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 已提交
173 174 175 176
#ifdef EXIT_DEBUG
	printk(KERN_INFO "Queueing interrupt %x\n", vec);
#endif
}
177
EXPORT_SYMBOL_GPL(kvmppc_book3s_queue_irqprio);
A
Alexander Graf 已提交
178

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

void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}
190
EXPORT_SYMBOL_GPL(kvmppc_core_queue_dec);
A
Alexander Graf 已提交
191 192 193

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

198 199 200 201
void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}
202
EXPORT_SYMBOL_GPL(kvmppc_core_dequeue_dec);
203

A
Alexander Graf 已提交
204 205 206
void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
                                struct kvm_interrupt *irq)
{
207 208 209 210 211 212
	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 已提交
213 214
}

215
void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu)
216 217
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
218
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL_LEVEL);
219 220
}

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

	switch (priority) {
	case BOOK3S_IRQPRIO_DECREMENTER:
229
		deliver = (kvmppc_get_msr(vcpu) & MSR_EE) && !crit;
A
Alexander Graf 已提交
230 231 232
		vec = BOOK3S_INTERRUPT_DECREMENTER;
		break;
	case BOOK3S_IRQPRIO_EXTERNAL:
233
	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
234
		deliver = (kvmppc_get_msr(vcpu) & MSR_EE) && !crit;
A
Alexander Graf 已提交
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
		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;
279 280 281
	case BOOK3S_IRQPRIO_FAC_UNAVAIL:
		vec = BOOK3S_INTERRUPT_FAC_UNAVAIL;
		break;
A
Alexander Graf 已提交
282 283 284 285 286 287 288 289 290 291 292
	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)
293
		kvmppc_inject_interrupt(vcpu, vec, 0);
A
Alexander Graf 已提交
294 295 296 297

	return deliver;
}

298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314
/*
 * 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;
}

315
int kvmppc_core_prepare_to_enter(struct kvm_vcpu *vcpu)
A
Alexander Graf 已提交
316 317
{
	unsigned long *pending = &vcpu->arch.pending_exceptions;
318
	unsigned long old_pending = vcpu->arch.pending_exceptions;
A
Alexander Graf 已提交
319 320 321 322 323 324 325
	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 已提交
326
	while (priority < BOOK3S_IRQPRIO_MAX) {
327
		if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
328
		    clear_irqprio(vcpu, priority)) {
A
Alexander Graf 已提交
329 330 331 332 333 334 335 336
			clear_bit(priority, &vcpu->arch.pending_exceptions);
			break;
		}

		priority = find_next_bit(pending,
					 BITS_PER_BYTE * sizeof(*pending),
					 priority + 1);
	}
337 338

	/* Tell the guest about our interrupt status */
339
	kvmppc_update_int_pending(vcpu, *pending, old_pending);
340 341

	return 0;
A
Alexander Graf 已提交
342
}
343
EXPORT_SYMBOL_GPL(kvmppc_core_prepare_to_enter);
A
Alexander Graf 已提交
344

345 346
pfn_t kvmppc_gfn_to_pfn(struct kvm_vcpu *vcpu, gfn_t gfn, bool writing,
			bool *writable)
347 348 349
{
	ulong mp_pa = vcpu->arch.magic_page_pa;

350
	if (!(kvmppc_get_msr(vcpu) & MSR_SF))
351 352
		mp_pa = (uint32_t)mp_pa;

353 354 355 356 357 358 359 360 361
	/* 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));
362 363
		if (writable)
			*writable = true;
364 365 366
		return pfn;
	}

367
	return gfn_to_pfn_prot(vcpu->kvm, gfn, writing, writable);
368
}
369
EXPORT_SYMBOL_GPL(kvmppc_gfn_to_pfn);
370

A
Alexander Graf 已提交
371
static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data,
372
			bool iswrite, struct kvmppc_pte *pte)
A
Alexander Graf 已提交
373
{
374
	int relocated = (kvmppc_get_msr(vcpu) & (data ? MSR_DR : MSR_IR));
A
Alexander Graf 已提交
375 376 377
	int r;

	if (relocated) {
378
		r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data, iswrite);
A
Alexander Graf 已提交
379 380
	} else {
		pte->eaddr = eaddr;
A
Alexander Graf 已提交
381
		pte->raddr = eaddr & KVM_PAM;
382
		pte->vpage = VSID_REAL | eaddr >> 12;
A
Alexander Graf 已提交
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 411 412 413 414 415 416
		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();
}

417 418
int kvmppc_st(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
	      bool data)
A
Alexander Graf 已提交
419 420 421 422 423
{
	struct kvmppc_pte pte;

	vcpu->stat.st++;

424
	if (kvmppc_xlate(vcpu, *eaddr, data, true, &pte))
A
Alexander Graf 已提交
425
		return -ENOENT;
426 427

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

A
Alexander Graf 已提交
429 430
	if (!pte.may_write)
		return -EPERM;
A
Alexander Graf 已提交
431

A
Alexander Graf 已提交
432 433
	if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size))
		return EMULATE_DO_MMIO;
A
Alexander Graf 已提交
434

435
	return EMULATE_DONE;
A
Alexander Graf 已提交
436
}
437
EXPORT_SYMBOL_GPL(kvmppc_st);
A
Alexander Graf 已提交
438

439
int kvmppc_ld(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
A
Alexander Graf 已提交
440 441 442
		      bool data)
{
	struct kvmppc_pte pte;
443
	hva_t hva = *eaddr;
A
Alexander Graf 已提交
444 445 446

	vcpu->stat.ld++;

447
	if (kvmppc_xlate(vcpu, *eaddr, data, false, &pte))
448 449 450
		goto nopte;

	*eaddr = pte.raddr;
A
Alexander Graf 已提交
451 452 453

	hva = kvmppc_pte_to_hva(vcpu, &pte, true);
	if (kvm_is_error_hva(hva))
454
		goto mmio;
A
Alexander Graf 已提交
455 456 457

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

461
	return EMULATE_DONE;
A
Alexander Graf 已提交
462

463
nopte:
A
Alexander Graf 已提交
464
	return -ENOENT;
465 466
mmio:
	return EMULATE_DO_MMIO;
A
Alexander Graf 已提交
467
}
468
EXPORT_SYMBOL_GPL(kvmppc_ld);
A
Alexander Graf 已提交
469 470 471 472 473 474

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

475 476 477 478 479 480 481 482 483
int kvmppc_subarch_vcpu_init(struct kvm_vcpu *vcpu)
{
	return 0;
}

void kvmppc_subarch_vcpu_uninit(struct kvm_vcpu *vcpu)
{
}

484 485 486
int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
				  struct kvm_sregs *sregs)
{
487
	return vcpu->kvm->arch.kvm_ops->get_sregs(vcpu, sregs);
488 489 490 491 492
}

int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
				  struct kvm_sregs *sregs)
{
493
	return vcpu->kvm->arch.kvm_ops->set_sregs(vcpu, sregs);
494 495
}

A
Alexander Graf 已提交
496 497 498 499
int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
{
	int i;

500
	regs->pc = kvmppc_get_pc(vcpu);
501
	regs->cr = kvmppc_get_cr(vcpu);
502 503
	regs->ctr = kvmppc_get_ctr(vcpu);
	regs->lr = kvmppc_get_lr(vcpu);
504
	regs->xer = kvmppc_get_xer(vcpu);
505 506 507
	regs->msr = kvmppc_get_msr(vcpu);
	regs->srr0 = kvmppc_get_srr0(vcpu);
	regs->srr1 = kvmppc_get_srr1(vcpu);
A
Alexander Graf 已提交
508
	regs->pid = vcpu->arch.pid;
509 510 511 512 513 514 515 516
	regs->sprg0 = kvmppc_get_sprg0(vcpu);
	regs->sprg1 = kvmppc_get_sprg1(vcpu);
	regs->sprg2 = kvmppc_get_sprg2(vcpu);
	regs->sprg3 = kvmppc_get_sprg3(vcpu);
	regs->sprg4 = kvmppc_get_sprg4(vcpu);
	regs->sprg5 = kvmppc_get_sprg5(vcpu);
	regs->sprg6 = kvmppc_get_sprg6(vcpu);
	regs->sprg7 = kvmppc_get_sprg7(vcpu);
A
Alexander Graf 已提交
517 518

	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
519
		regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
A
Alexander Graf 已提交
520 521 522 523 524 525 526 527

	return 0;
}

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

528
	kvmppc_set_pc(vcpu, regs->pc);
529
	kvmppc_set_cr(vcpu, regs->cr);
530 531
	kvmppc_set_ctr(vcpu, regs->ctr);
	kvmppc_set_lr(vcpu, regs->lr);
532
	kvmppc_set_xer(vcpu, regs->xer);
A
Alexander Graf 已提交
533
	kvmppc_set_msr(vcpu, regs->msr);
534 535 536 537 538 539 540 541 542 543
	kvmppc_set_srr0(vcpu, regs->srr0);
	kvmppc_set_srr1(vcpu, regs->srr1);
	kvmppc_set_sprg0(vcpu, regs->sprg0);
	kvmppc_set_sprg1(vcpu, regs->sprg1);
	kvmppc_set_sprg2(vcpu, regs->sprg2);
	kvmppc_set_sprg3(vcpu, regs->sprg3);
	kvmppc_set_sprg4(vcpu, regs->sprg4);
	kvmppc_set_sprg5(vcpu, regs->sprg5);
	kvmppc_set_sprg6(vcpu, regs->sprg6);
	kvmppc_set_sprg7(vcpu, regs->sprg7);
A
Alexander Graf 已提交
544

545 546
	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
		kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
A
Alexander Graf 已提交
547 548 549 550 551 552 553 554 555 556 557 558 559 560

	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;
}

561 562 563 564 565
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;
566
	long int i;
567 568 569 570 571

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

572
	r = vcpu->kvm->arch.kvm_ops->get_one_reg(vcpu, reg->id, &val);
573 574 575 576
	if (r == -EINVAL) {
		r = 0;
		switch (reg->id) {
		case KVM_REG_PPC_DAR:
577
			val = get_reg_val(reg->id, kvmppc_get_dar(vcpu));
578 579
			break;
		case KVM_REG_PPC_DSISR:
580
			val = get_reg_val(reg->id, kvmppc_get_dsisr(vcpu));
581
			break;
582 583
		case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
			i = reg->id - KVM_REG_PPC_FPR0;
584
			val = get_reg_val(reg->id, VCPU_FPR(vcpu, i));
585 586
			break;
		case KVM_REG_PPC_FPSCR:
587
			val = get_reg_val(reg->id, vcpu->arch.fp.fpscr);
588 589 590 591 592 593 594
			break;
#ifdef CONFIG_ALTIVEC
		case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
595
			val.vval = vcpu->arch.vr.vr[reg->id - KVM_REG_PPC_VR0];
596 597 598 599 600 601
			break;
		case KVM_REG_PPC_VSCR:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
602
			val = get_reg_val(reg->id, vcpu->arch.vr.vscr.u[3]);
603
			break;
604 605 606
		case KVM_REG_PPC_VRSAVE:
			val = get_reg_val(reg->id, vcpu->arch.vrsave);
			break;
607
#endif /* CONFIG_ALTIVEC */
608 609 610 611 612 613 614 615 616 617 618
#ifdef CONFIG_VSX
		case KVM_REG_PPC_VSR0 ... KVM_REG_PPC_VSR31:
			if (cpu_has_feature(CPU_FTR_VSX)) {
				long int i = reg->id - KVM_REG_PPC_VSR0;
				val.vsxval[0] = vcpu->arch.fp.fpr[i][0];
				val.vsxval[1] = vcpu->arch.fp.fpr[i][1];
			} else {
				r = -ENXIO;
			}
			break;
#endif /* CONFIG_VSX */
619 620 621 622 623 624
		case KVM_REG_PPC_DEBUG_INST: {
			u32 opcode = INS_TW;
			r = copy_to_user((u32 __user *)(long)reg->addr,
					 &opcode, sizeof(u32));
			break;
		}
625 626 627 628 629 630 631 632 633
#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 */
634 635 636
		case KVM_REG_PPC_FSCR:
			val = get_reg_val(reg->id, vcpu->arch.fscr);
			break;
637 638 639 640 641 642 643 644 645 646 647 648 649 650 651 652 653 654 655
		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;
656
	long int i;
657 658 659 660 661 662 663 664

	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;

665
	r = vcpu->kvm->arch.kvm_ops->set_one_reg(vcpu, reg->id, &val);
666 667 668 669
	if (r == -EINVAL) {
		r = 0;
		switch (reg->id) {
		case KVM_REG_PPC_DAR:
670
			kvmppc_set_dar(vcpu, set_reg_val(reg->id, val));
671 672
			break;
		case KVM_REG_PPC_DSISR:
673
			kvmppc_set_dsisr(vcpu, set_reg_val(reg->id, val));
674
			break;
675 676
		case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
			i = reg->id - KVM_REG_PPC_FPR0;
677
			VCPU_FPR(vcpu, i) = set_reg_val(reg->id, val);
678 679
			break;
		case KVM_REG_PPC_FPSCR:
680
			vcpu->arch.fp.fpscr = set_reg_val(reg->id, val);
681 682 683 684 685 686 687
			break;
#ifdef CONFIG_ALTIVEC
		case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
688
			vcpu->arch.vr.vr[reg->id - KVM_REG_PPC_VR0] = val.vval;
689 690 691 692 693 694
			break;
		case KVM_REG_PPC_VSCR:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
695
			vcpu->arch.vr.vscr.u[3] = set_reg_val(reg->id, val);
696
			break;
697 698 699 700 701 702 703
		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;
704
#endif /* CONFIG_ALTIVEC */
705 706 707 708 709 710 711 712 713 714 715
#ifdef CONFIG_VSX
		case KVM_REG_PPC_VSR0 ... KVM_REG_PPC_VSR31:
			if (cpu_has_feature(CPU_FTR_VSX)) {
				long int i = reg->id - KVM_REG_PPC_VSR0;
				vcpu->arch.fp.fpr[i][0] = val.vsxval[0];
				vcpu->arch.fp.fpr[i][1] = val.vsxval[1];
			} else {
				r = -ENXIO;
			}
			break;
#endif /* CONFIG_VSX */
716 717 718 719 720 721 722 723 724 725
#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 */
726 727 728
		case KVM_REG_PPC_FSCR:
			vcpu->arch.fscr = set_reg_val(reg->id, val);
			break;
729 730 731 732 733 734 735 736 737
		default:
			r = -EINVAL;
			break;
		}
	}

	return r;
}

738 739
void kvmppc_core_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
{
740
	vcpu->kvm->arch.kvm_ops->vcpu_load(vcpu, cpu);
741 742 743 744
}

void kvmppc_core_vcpu_put(struct kvm_vcpu *vcpu)
{
745
	vcpu->kvm->arch.kvm_ops->vcpu_put(vcpu);
746 747 748 749
}

void kvmppc_set_msr(struct kvm_vcpu *vcpu, u64 msr)
{
750
	vcpu->kvm->arch.kvm_ops->set_msr(vcpu, msr);
751
}
752
EXPORT_SYMBOL_GPL(kvmppc_set_msr);
753 754 755

int kvmppc_vcpu_run(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu)
{
756
	return vcpu->kvm->arch.kvm_ops->vcpu_run(kvm_run, vcpu);
757 758
}

A
Alexander Graf 已提交
759 760 761 762 763 764
int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
                                  struct kvm_translation *tr)
{
	return 0;
}

765 766 767 768 769 770
int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
					struct kvm_guest_debug *dbg)
{
	return -EINVAL;
}

771 772 773 774 775 776 777
void kvmppc_decrementer_func(unsigned long data)
{
	struct kvm_vcpu *vcpu = (struct kvm_vcpu *)data;

	kvmppc_core_queue_dec(vcpu);
	kvm_vcpu_kick(vcpu);
}
778 779 780

struct kvm_vcpu *kvmppc_core_vcpu_create(struct kvm *kvm, unsigned int id)
{
781
	return kvm->arch.kvm_ops->vcpu_create(kvm, id);
782 783 784 785
}

void kvmppc_core_vcpu_free(struct kvm_vcpu *vcpu)
{
786
	vcpu->kvm->arch.kvm_ops->vcpu_free(vcpu);
787 788 789 790
}

int kvmppc_core_check_requests(struct kvm_vcpu *vcpu)
{
791
	return vcpu->kvm->arch.kvm_ops->check_requests(vcpu);
792 793 794 795
}

int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm, struct kvm_dirty_log *log)
{
796
	return kvm->arch.kvm_ops->get_dirty_log(kvm, log);
797 798
}

799
void kvmppc_core_free_memslot(struct kvm *kvm, struct kvm_memory_slot *free,
800 801
			      struct kvm_memory_slot *dont)
{
802
	kvm->arch.kvm_ops->free_memslot(free, dont);
803 804
}

805
int kvmppc_core_create_memslot(struct kvm *kvm, struct kvm_memory_slot *slot,
806 807
			       unsigned long npages)
{
808
	return kvm->arch.kvm_ops->create_memslot(slot, npages);
809 810 811 812
}

void kvmppc_core_flush_memslot(struct kvm *kvm, struct kvm_memory_slot *memslot)
{
813
	kvm->arch.kvm_ops->flush_memslot(kvm, memslot);
814 815 816 817 818 819
}

int kvmppc_core_prepare_memory_region(struct kvm *kvm,
				struct kvm_memory_slot *memslot,
				struct kvm_userspace_memory_region *mem)
{
820
	return kvm->arch.kvm_ops->prepare_memory_region(kvm, memslot, mem);
821 822 823 824 825 826
}

void kvmppc_core_commit_memory_region(struct kvm *kvm,
				struct kvm_userspace_memory_region *mem,
				const struct kvm_memory_slot *old)
{
827
	kvm->arch.kvm_ops->commit_memory_region(kvm, mem, old);
828 829 830 831
}

int kvm_unmap_hva(struct kvm *kvm, unsigned long hva)
{
832
	return kvm->arch.kvm_ops->unmap_hva(kvm, hva);
833
}
834
EXPORT_SYMBOL_GPL(kvm_unmap_hva);
835 836 837

int kvm_unmap_hva_range(struct kvm *kvm, unsigned long start, unsigned long end)
{
838
	return kvm->arch.kvm_ops->unmap_hva_range(kvm, start, end);
839 840 841 842
}

int kvm_age_hva(struct kvm *kvm, unsigned long hva)
{
843
	return kvm->arch.kvm_ops->age_hva(kvm, hva);
844 845 846 847
}

int kvm_test_age_hva(struct kvm *kvm, unsigned long hva)
{
848
	return kvm->arch.kvm_ops->test_age_hva(kvm, hva);
849 850 851 852
}

void kvm_set_spte_hva(struct kvm *kvm, unsigned long hva, pte_t pte)
{
853
	kvm->arch.kvm_ops->set_spte_hva(kvm, hva, pte);
854 855 856 857
}

void kvmppc_mmu_destroy(struct kvm_vcpu *vcpu)
{
858
	vcpu->kvm->arch.kvm_ops->mmu_destroy(vcpu);
859 860 861 862 863 864 865 866 867 868
}

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

869
	return kvm->arch.kvm_ops->init_vm(kvm);
870 871 872 873
}

void kvmppc_core_destroy_vm(struct kvm *kvm)
{
874
	kvm->arch.kvm_ops->destroy_vm(kvm);
875 876 877 878 879 880 881 882 883

#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)
{
884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900 901 902 903 904 905 906 907 908 909 910 911
	/*
	 * 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();
912
}
913 914 915

module_init(kvmppc_book3s_init);
module_exit(kvmppc_book3s_exit);
916 917 918 919 920 921

/* On 32bit this is our one and only kernel module */
#ifdef CONFIG_KVM_BOOK3S_32
MODULE_ALIAS_MISCDEV(KVM_MINOR);
MODULE_ALIAS("devname:kvm");
#endif