book3s.c 23.4 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
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) },
55
	{ "halt_successful_poll", VCPU_STAT(halt_successful_poll), },
56
	{ "halt_attempted_poll", VCPU_STAT(halt_attempted_poll), },
57
	{ "halt_poll_invalid", VCPU_STAT(halt_poll_invalid) },
A
Alexander Graf 已提交
58 59 60 61 62 63 64 65 66 67 68 69
	{ "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 }
};

70 71 72 73 74 75 76 77 78 79 80
void kvmppc_unfixup_split_real(struct kvm_vcpu *vcpu)
{
	if (vcpu->arch.hflags & BOOK3S_HFLAG_SPLIT_HACK) {
		ulong pc = kvmppc_get_pc(vcpu);
		if ((pc & SPLIT_HACK_MASK) == SPLIT_HACK_OFFS)
			kvmppc_set_pc(vcpu, pc & ~SPLIT_HACK_MASK);
		vcpu->arch.hflags &= ~BOOK3S_HFLAG_SPLIT_HACK;
	}
}
EXPORT_SYMBOL_GPL(kvmppc_unfixup_split_real);

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

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

105
	if (is_kvmppc_hv_enabled(vcpu->kvm))
106 107
		return false;

108
	crit_raw = kvmppc_get_critical(vcpu);
109 110 111
	crit_r1 = kvmppc_get_gpr(vcpu, 1);

	/* Truncate crit indicators in 32 bit mode */
112
	if (!(kvmppc_get_msr(vcpu) & MSR_SF)) {
113 114 115 116 117 118 119
		crit_raw &= 0xffffffff;
		crit_r1 &= 0xffffffff;
	}

	/* Critical section when crit == r1 */
	crit = (crit_raw == crit_r1);
	/* ... and we're in supervisor mode */
120
	crit = crit && !(kvmppc_get_msr(vcpu) & MSR_PR);
121 122 123 124

	return crit;
}

A
Alexander Graf 已提交
125 126
void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
{
127
	kvmppc_unfixup_split_real(vcpu);
128 129
	kvmppc_set_srr0(vcpu, kvmppc_get_pc(vcpu));
	kvmppc_set_srr1(vcpu, kvmppc_get_msr(vcpu) | flags);
130
	kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
A
Alexander Graf 已提交
131 132 133
	vcpu->arch.mmu.reset_msr(vcpu);
}

134
static int kvmppc_book3s_vec2irqprio(unsigned int vec)
A
Alexander Graf 已提交
135 136 137 138 139 140 141 142 143 144 145
{
	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;
146
	case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL;	break;
A
Alexander Graf 已提交
147 148 149 150 151 152 153 154
	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;
155
	case 0xf60: prio = BOOK3S_IRQPRIO_FAC_UNAVAIL;		break;
A
Alexander Graf 已提交
156 157 158
	default:    prio = BOOK3S_IRQPRIO_MAX;			break;
	}

159 160 161
	return prio;
}

162
void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
163 164
					  unsigned int vec)
{
165 166
	unsigned long old_pending = vcpu->arch.pending_exceptions;

167 168
	clear_bit(kvmppc_book3s_vec2irqprio(vec),
		  &vcpu->arch.pending_exceptions);
169

170 171
	kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
				  old_pending);
172 173
}

174 175 176 177 178 179
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 已提交
180 181 182 183
#ifdef EXIT_DEBUG
	printk(KERN_INFO "Queueing interrupt %x\n", vec);
#endif
}
184
EXPORT_SYMBOL_GPL(kvmppc_book3s_queue_irqprio);
A
Alexander Graf 已提交
185

186
void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
A
Alexander Graf 已提交
187
{
188 189
	/* might as well deliver this straight away */
	kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_PROGRAM, flags);
A
Alexander Graf 已提交
190
}
191
EXPORT_SYMBOL_GPL(kvmppc_core_queue_program);
A
Alexander Graf 已提交
192 193 194 195 196

void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}
197
EXPORT_SYMBOL_GPL(kvmppc_core_queue_dec);
A
Alexander Graf 已提交
198 199 200

int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
{
201
	return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
A
Alexander Graf 已提交
202
}
203
EXPORT_SYMBOL_GPL(kvmppc_core_pending_dec);
A
Alexander Graf 已提交
204

205 206 207 208
void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}
209
EXPORT_SYMBOL_GPL(kvmppc_core_dequeue_dec);
210

A
Alexander Graf 已提交
211 212 213
void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
                                struct kvm_interrupt *irq)
{
214 215 216 217 218 219
	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 已提交
220 221
}

222
void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu)
223 224
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
225
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL_LEVEL);
226 227
}

228 229 230 231 232 233 234 235 236 237 238 239 240 241 242 243 244
void kvmppc_core_queue_data_storage(struct kvm_vcpu *vcpu, ulong dar,
				    ulong flags)
{
	kvmppc_set_dar(vcpu, dar);
	kvmppc_set_dsisr(vcpu, flags);
	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DATA_STORAGE);
}

void kvmppc_core_queue_inst_storage(struct kvm_vcpu *vcpu, ulong flags)
{
	u64 msr = kvmppc_get_msr(vcpu);
	msr &= ~(SRR1_ISI_NOPT | SRR1_ISI_N_OR_G | SRR1_ISI_PROT);
	msr |= flags & (SRR1_ISI_NOPT | SRR1_ISI_N_OR_G | SRR1_ISI_PROT);
	kvmppc_set_msr_fast(vcpu, msr);
	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_INST_STORAGE);
}

T
Thomas Huth 已提交
245 246
static int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu,
					 unsigned int priority)
A
Alexander Graf 已提交
247 248 249
{
	int deliver = 1;
	int vec = 0;
250
	bool crit = kvmppc_critical_section(vcpu);
A
Alexander Graf 已提交
251 252 253

	switch (priority) {
	case BOOK3S_IRQPRIO_DECREMENTER:
254
		deliver = (kvmppc_get_msr(vcpu) & MSR_EE) && !crit;
A
Alexander Graf 已提交
255 256 257
		vec = BOOK3S_INTERRUPT_DECREMENTER;
		break;
	case BOOK3S_IRQPRIO_EXTERNAL:
258
	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
259
		deliver = (kvmppc_get_msr(vcpu) & MSR_EE) && !crit;
A
Alexander Graf 已提交
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 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303
		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;
304 305 306
	case BOOK3S_IRQPRIO_FAC_UNAVAIL:
		vec = BOOK3S_INTERRUPT_FAC_UNAVAIL;
		break;
A
Alexander Graf 已提交
307 308 309 310 311 312 313 314 315 316 317
	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)
318
		kvmppc_inject_interrupt(vcpu, vec, 0);
A
Alexander Graf 已提交
319 320 321 322

	return deliver;
}

323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339
/*
 * 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;
}

340
int kvmppc_core_prepare_to_enter(struct kvm_vcpu *vcpu)
A
Alexander Graf 已提交
341 342
{
	unsigned long *pending = &vcpu->arch.pending_exceptions;
343
	unsigned long old_pending = vcpu->arch.pending_exceptions;
A
Alexander Graf 已提交
344 345 346 347 348 349 350
	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 已提交
351
	while (priority < BOOK3S_IRQPRIO_MAX) {
352
		if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
353
		    clear_irqprio(vcpu, priority)) {
A
Alexander Graf 已提交
354 355 356 357 358 359 360 361
			clear_bit(priority, &vcpu->arch.pending_exceptions);
			break;
		}

		priority = find_next_bit(pending,
					 BITS_PER_BYTE * sizeof(*pending),
					 priority + 1);
	}
362 363

	/* Tell the guest about our interrupt status */
364
	kvmppc_update_int_pending(vcpu, *pending, old_pending);
365 366

	return 0;
A
Alexander Graf 已提交
367
}
368
EXPORT_SYMBOL_GPL(kvmppc_core_prepare_to_enter);
A
Alexander Graf 已提交
369

D
Dan Williams 已提交
370
kvm_pfn_t kvmppc_gpa_to_pfn(struct kvm_vcpu *vcpu, gpa_t gpa, bool writing,
371
			bool *writable)
372
{
373 374
	ulong mp_pa = vcpu->arch.magic_page_pa & KVM_PAM;
	gfn_t gfn = gpa >> PAGE_SHIFT;
375

376
	if (!(kvmppc_get_msr(vcpu) & MSR_SF))
377 378
		mp_pa = (uint32_t)mp_pa;

379
	/* Magic page override */
380 381
	gpa &= ~0xFFFULL;
	if (unlikely(mp_pa) && unlikely((gpa & KVM_PAM) == mp_pa)) {
382
		ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK;
D
Dan Williams 已提交
383
		kvm_pfn_t pfn;
384

D
Dan Williams 已提交
385
		pfn = (kvm_pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT;
386
		get_page(pfn_to_page(pfn));
387 388
		if (writable)
			*writable = true;
389 390 391
		return pfn;
	}

392
	return gfn_to_pfn_prot(vcpu->kvm, gfn, writing, writable);
393
}
394
EXPORT_SYMBOL_GPL(kvmppc_gpa_to_pfn);
395

396 397
int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, enum xlate_instdata xlid,
		 enum xlate_readwrite xlrw, struct kvmppc_pte *pte)
A
Alexander Graf 已提交
398
{
399 400
	bool data = (xlid == XLATE_DATA);
	bool iswrite = (xlrw == XLATE_WRITE);
401
	int relocated = (kvmppc_get_msr(vcpu) & (data ? MSR_DR : MSR_IR));
A
Alexander Graf 已提交
402 403 404
	int r;

	if (relocated) {
405
		r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data, iswrite);
A
Alexander Graf 已提交
406 407
	} else {
		pte->eaddr = eaddr;
A
Alexander Graf 已提交
408
		pte->raddr = eaddr & KVM_PAM;
409
		pte->vpage = VSID_REAL | eaddr >> 12;
A
Alexander Graf 已提交
410 411 412 413
		pte->may_read = true;
		pte->may_write = true;
		pte->may_execute = true;
		r = 0;
414 415 416 417 418 419 420

		if ((kvmppc_get_msr(vcpu) & (MSR_IR | MSR_DR)) == MSR_DR &&
		    !data) {
			if ((vcpu->arch.hflags & BOOK3S_HFLAG_SPLIT_HACK) &&
			    ((eaddr & SPLIT_HACK_MASK) == SPLIT_HACK_OFFS))
			pte->raddr &= ~SPLIT_HACK_MASK;
		}
A
Alexander Graf 已提交
421 422 423 424 425
	}

	return r;
}

426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442
int kvmppc_load_last_inst(struct kvm_vcpu *vcpu, enum instruction_type type,
					 u32 *inst)
{
	ulong pc = kvmppc_get_pc(vcpu);
	int r;

	if (type == INST_SC)
		pc -= 4;

	r = kvmppc_ld(vcpu, &pc, sizeof(u32), inst, false);
	if (r == EMULATE_DONE)
		return r;
	else
		return EMULATE_AGAIN;
}
EXPORT_SYMBOL_GPL(kvmppc_load_last_inst);

A
Alexander Graf 已提交
443 444 445 446 447
int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
{
	return 0;
}

448 449 450 451 452 453 454 455 456
int kvmppc_subarch_vcpu_init(struct kvm_vcpu *vcpu)
{
	return 0;
}

void kvmppc_subarch_vcpu_uninit(struct kvm_vcpu *vcpu)
{
}

457 458 459
int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
				  struct kvm_sregs *sregs)
{
460
	return vcpu->kvm->arch.kvm_ops->get_sregs(vcpu, sregs);
461 462 463 464 465
}

int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
				  struct kvm_sregs *sregs)
{
466
	return vcpu->kvm->arch.kvm_ops->set_sregs(vcpu, sregs);
467 468
}

A
Alexander Graf 已提交
469 470 471 472
int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
{
	int i;

473
	regs->pc = kvmppc_get_pc(vcpu);
474
	regs->cr = kvmppc_get_cr(vcpu);
475 476
	regs->ctr = kvmppc_get_ctr(vcpu);
	regs->lr = kvmppc_get_lr(vcpu);
477
	regs->xer = kvmppc_get_xer(vcpu);
478 479 480
	regs->msr = kvmppc_get_msr(vcpu);
	regs->srr0 = kvmppc_get_srr0(vcpu);
	regs->srr1 = kvmppc_get_srr1(vcpu);
A
Alexander Graf 已提交
481
	regs->pid = vcpu->arch.pid;
482 483 484 485 486 487 488 489
	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 已提交
490 491

	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
492
		regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
A
Alexander Graf 已提交
493 494 495 496 497 498 499 500

	return 0;
}

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

501
	kvmppc_set_pc(vcpu, regs->pc);
502
	kvmppc_set_cr(vcpu, regs->cr);
503 504
	kvmppc_set_ctr(vcpu, regs->ctr);
	kvmppc_set_lr(vcpu, regs->lr);
505
	kvmppc_set_xer(vcpu, regs->xer);
A
Alexander Graf 已提交
506
	kvmppc_set_msr(vcpu, regs->msr);
507 508 509 510 511 512 513 514 515 516
	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 已提交
517

518 519
	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
		kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
A
Alexander Graf 已提交
520 521 522 523 524 525 526 527 528 529 530 531 532 533

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

534 535
int kvmppc_get_one_reg(struct kvm_vcpu *vcpu, u64 id,
			union kvmppc_one_reg *val)
536
{
537
	int r = 0;
538
	long int i;
539

540
	r = vcpu->kvm->arch.kvm_ops->get_one_reg(vcpu, id, val);
541 542
	if (r == -EINVAL) {
		r = 0;
543
		switch (id) {
544
		case KVM_REG_PPC_DAR:
545
			*val = get_reg_val(id, kvmppc_get_dar(vcpu));
546 547
			break;
		case KVM_REG_PPC_DSISR:
548
			*val = get_reg_val(id, kvmppc_get_dsisr(vcpu));
549
			break;
550
		case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
551 552
			i = id - KVM_REG_PPC_FPR0;
			*val = get_reg_val(id, VCPU_FPR(vcpu, i));
553 554
			break;
		case KVM_REG_PPC_FPSCR:
555
			*val = get_reg_val(id, vcpu->arch.fp.fpscr);
556
			break;
557 558 559
#ifdef CONFIG_VSX
		case KVM_REG_PPC_VSR0 ... KVM_REG_PPC_VSR31:
			if (cpu_has_feature(CPU_FTR_VSX)) {
560 561 562
				i = id - KVM_REG_PPC_VSR0;
				val->vsxval[0] = vcpu->arch.fp.fpr[i][0];
				val->vsxval[1] = vcpu->arch.fp.fpr[i][1];
563 564 565 566 567
			} else {
				r = -ENXIO;
			}
			break;
#endif /* CONFIG_VSX */
568 569
		case KVM_REG_PPC_DEBUG_INST:
			*val = get_reg_val(id, INS_TW);
570
			break;
571 572 573 574 575 576
#ifdef CONFIG_KVM_XICS
		case KVM_REG_PPC_ICP_STATE:
			if (!vcpu->arch.icp) {
				r = -ENXIO;
				break;
			}
577
			*val = get_reg_val(id, kvmppc_xics_get_icp(vcpu));
578 579
			break;
#endif /* CONFIG_KVM_XICS */
580
		case KVM_REG_PPC_FSCR:
581
			*val = get_reg_val(id, vcpu->arch.fscr);
582
			break;
583
		case KVM_REG_PPC_TAR:
584
			*val = get_reg_val(id, vcpu->arch.tar);
585
			break;
586
		case KVM_REG_PPC_EBBHR:
587
			*val = get_reg_val(id, vcpu->arch.ebbhr);
588 589
			break;
		case KVM_REG_PPC_EBBRR:
590
			*val = get_reg_val(id, vcpu->arch.ebbrr);
591 592
			break;
		case KVM_REG_PPC_BESCR:
593
			*val = get_reg_val(id, vcpu->arch.bescr);
594
			break;
595
		case KVM_REG_PPC_VTB:
596
			*val = get_reg_val(id, vcpu->arch.vtb);
597
			break;
598
		case KVM_REG_PPC_IC:
599
			*val = get_reg_val(id, vcpu->arch.ic);
600
			break;
601 602 603 604 605 606 607 608 609
		default:
			r = -EINVAL;
			break;
		}
	}

	return r;
}

610 611
int kvmppc_set_one_reg(struct kvm_vcpu *vcpu, u64 id,
			union kvmppc_one_reg *val)
612
{
613
	int r = 0;
614
	long int i;
615

616
	r = vcpu->kvm->arch.kvm_ops->set_one_reg(vcpu, id, val);
617 618
	if (r == -EINVAL) {
		r = 0;
619
		switch (id) {
620
		case KVM_REG_PPC_DAR:
621
			kvmppc_set_dar(vcpu, set_reg_val(id, *val));
622 623
			break;
		case KVM_REG_PPC_DSISR:
624
			kvmppc_set_dsisr(vcpu, set_reg_val(id, *val));
625
			break;
626
		case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
627 628
			i = id - KVM_REG_PPC_FPR0;
			VCPU_FPR(vcpu, i) = set_reg_val(id, *val);
629 630
			break;
		case KVM_REG_PPC_FPSCR:
631
			vcpu->arch.fp.fpscr = set_reg_val(id, *val);
632
			break;
633 634 635
#ifdef CONFIG_VSX
		case KVM_REG_PPC_VSR0 ... KVM_REG_PPC_VSR31:
			if (cpu_has_feature(CPU_FTR_VSX)) {
636 637 638
				i = id - KVM_REG_PPC_VSR0;
				vcpu->arch.fp.fpr[i][0] = val->vsxval[0];
				vcpu->arch.fp.fpr[i][1] = val->vsxval[1];
639 640 641 642 643
			} else {
				r = -ENXIO;
			}
			break;
#endif /* CONFIG_VSX */
644 645 646 647 648 649 650
#ifdef CONFIG_KVM_XICS
		case KVM_REG_PPC_ICP_STATE:
			if (!vcpu->arch.icp) {
				r = -ENXIO;
				break;
			}
			r = kvmppc_xics_set_icp(vcpu,
651
						set_reg_val(id, *val));
652 653
			break;
#endif /* CONFIG_KVM_XICS */
654
		case KVM_REG_PPC_FSCR:
655
			vcpu->arch.fscr = set_reg_val(id, *val);
656
			break;
657
		case KVM_REG_PPC_TAR:
658
			vcpu->arch.tar = set_reg_val(id, *val);
659
			break;
660
		case KVM_REG_PPC_EBBHR:
661
			vcpu->arch.ebbhr = set_reg_val(id, *val);
662 663
			break;
		case KVM_REG_PPC_EBBRR:
664
			vcpu->arch.ebbrr = set_reg_val(id, *val);
665 666
			break;
		case KVM_REG_PPC_BESCR:
667
			vcpu->arch.bescr = set_reg_val(id, *val);
668
			break;
669
		case KVM_REG_PPC_VTB:
670
			vcpu->arch.vtb = set_reg_val(id, *val);
671
			break;
672
		case KVM_REG_PPC_IC:
673
			vcpu->arch.ic = set_reg_val(id, *val);
674
			break;
675 676 677 678 679 680 681 682 683
		default:
			r = -EINVAL;
			break;
		}
	}

	return r;
}

684 685
void kvmppc_core_vcpu_load(struct kvm_vcpu *vcpu, int cpu)
{
686
	vcpu->kvm->arch.kvm_ops->vcpu_load(vcpu, cpu);
687 688 689 690
}

void kvmppc_core_vcpu_put(struct kvm_vcpu *vcpu)
{
691
	vcpu->kvm->arch.kvm_ops->vcpu_put(vcpu);
692 693 694 695
}

void kvmppc_set_msr(struct kvm_vcpu *vcpu, u64 msr)
{
696
	vcpu->kvm->arch.kvm_ops->set_msr(vcpu, msr);
697
}
698
EXPORT_SYMBOL_GPL(kvmppc_set_msr);
699 700 701

int kvmppc_vcpu_run(struct kvm_run *kvm_run, struct kvm_vcpu *vcpu)
{
702
	return vcpu->kvm->arch.kvm_ops->vcpu_run(kvm_run, vcpu);
703 704
}

A
Alexander Graf 已提交
705 706 707 708 709 710
int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
                                  struct kvm_translation *tr)
{
	return 0;
}

711 712 713
int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
					struct kvm_guest_debug *dbg)
{
714 715
	vcpu->guest_debug = dbg->control;
	return 0;
716 717
}

718
void kvmppc_decrementer_func(struct kvm_vcpu *vcpu)
719 720 721 722
{
	kvmppc_core_queue_dec(vcpu);
	kvm_vcpu_kick(vcpu);
}
723 724 725

struct kvm_vcpu *kvmppc_core_vcpu_create(struct kvm *kvm, unsigned int id)
{
726
	return kvm->arch.kvm_ops->vcpu_create(kvm, id);
727 728 729 730
}

void kvmppc_core_vcpu_free(struct kvm_vcpu *vcpu)
{
731
	vcpu->kvm->arch.kvm_ops->vcpu_free(vcpu);
732 733 734 735
}

int kvmppc_core_check_requests(struct kvm_vcpu *vcpu)
{
736
	return vcpu->kvm->arch.kvm_ops->check_requests(vcpu);
737 738 739 740
}

int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm, struct kvm_dirty_log *log)
{
741
	return kvm->arch.kvm_ops->get_dirty_log(kvm, log);
742 743
}

744
void kvmppc_core_free_memslot(struct kvm *kvm, struct kvm_memory_slot *free,
745 746
			      struct kvm_memory_slot *dont)
{
747
	kvm->arch.kvm_ops->free_memslot(free, dont);
748 749
}

750
int kvmppc_core_create_memslot(struct kvm *kvm, struct kvm_memory_slot *slot,
751 752
			       unsigned long npages)
{
753
	return kvm->arch.kvm_ops->create_memslot(slot, npages);
754 755 756 757
}

void kvmppc_core_flush_memslot(struct kvm *kvm, struct kvm_memory_slot *memslot)
{
758
	kvm->arch.kvm_ops->flush_memslot(kvm, memslot);
759 760 761 762
}

int kvmppc_core_prepare_memory_region(struct kvm *kvm,
				struct kvm_memory_slot *memslot,
763
				const struct kvm_userspace_memory_region *mem)
764
{
765
	return kvm->arch.kvm_ops->prepare_memory_region(kvm, memslot, mem);
766 767 768
}

void kvmppc_core_commit_memory_region(struct kvm *kvm,
769
				const struct kvm_userspace_memory_region *mem,
770 771
				const struct kvm_memory_slot *old,
				const struct kvm_memory_slot *new)
772
{
773
	kvm->arch.kvm_ops->commit_memory_region(kvm, mem, old, new);
774 775 776 777
}

int kvm_unmap_hva(struct kvm *kvm, unsigned long hva)
{
778
	return kvm->arch.kvm_ops->unmap_hva(kvm, hva);
779
}
780
EXPORT_SYMBOL_GPL(kvm_unmap_hva);
781 782 783

int kvm_unmap_hva_range(struct kvm *kvm, unsigned long start, unsigned long end)
{
784
	return kvm->arch.kvm_ops->unmap_hva_range(kvm, start, end);
785 786
}

A
Andres Lagar-Cavilla 已提交
787
int kvm_age_hva(struct kvm *kvm, unsigned long start, unsigned long end)
788
{
A
Andres Lagar-Cavilla 已提交
789
	return kvm->arch.kvm_ops->age_hva(kvm, start, end);
790 791 792 793
}

int kvm_test_age_hva(struct kvm *kvm, unsigned long hva)
{
794
	return kvm->arch.kvm_ops->test_age_hva(kvm, hva);
795 796 797 798
}

void kvm_set_spte_hva(struct kvm *kvm, unsigned long hva, pte_t pte)
{
799
	kvm->arch.kvm_ops->set_spte_hva(kvm, hva, pte);
800 801 802 803
}

void kvmppc_mmu_destroy(struct kvm_vcpu *vcpu)
{
804
	vcpu->kvm->arch.kvm_ops->mmu_destroy(vcpu);
805 806 807 808 809 810
}

int kvmppc_core_init_vm(struct kvm *kvm)
{

#ifdef CONFIG_PPC64
811
	INIT_LIST_HEAD_RCU(&kvm->arch.spapr_tce_tables);
812 813 814
	INIT_LIST_HEAD(&kvm->arch.rtas_tokens);
#endif

815
	return kvm->arch.kvm_ops->init_vm(kvm);
816 817 818 819
}

void kvmppc_core_destroy_vm(struct kvm *kvm)
{
820
	kvm->arch.kvm_ops->destroy_vm(kvm);
821 822 823 824 825 826 827

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

828 829 830 831 832
int kvmppc_h_logical_ci_load(struct kvm_vcpu *vcpu)
{
	unsigned long size = kvmppc_get_gpr(vcpu, 4);
	unsigned long addr = kvmppc_get_gpr(vcpu, 5);
	u64 buf;
833
	int srcu_idx;
834 835 836 837 838
	int ret;

	if (!is_power_of_2(size) || (size > sizeof(buf)))
		return H_TOO_HARD;

839
	srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
840
	ret = kvm_io_bus_read(vcpu, KVM_MMIO_BUS, addr, size, &buf);
841
	srcu_read_unlock(&vcpu->kvm->srcu, srcu_idx);
842 843 844 845 846 847 848 849 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
	if (ret != 0)
		return H_TOO_HARD;

	switch (size) {
	case 1:
		kvmppc_set_gpr(vcpu, 4, *(u8 *)&buf);
		break;

	case 2:
		kvmppc_set_gpr(vcpu, 4, be16_to_cpu(*(__be16 *)&buf));
		break;

	case 4:
		kvmppc_set_gpr(vcpu, 4, be32_to_cpu(*(__be32 *)&buf));
		break;

	case 8:
		kvmppc_set_gpr(vcpu, 4, be64_to_cpu(*(__be64 *)&buf));
		break;

	default:
		BUG();
	}

	return H_SUCCESS;
}
EXPORT_SYMBOL_GPL(kvmppc_h_logical_ci_load);

int kvmppc_h_logical_ci_store(struct kvm_vcpu *vcpu)
{
	unsigned long size = kvmppc_get_gpr(vcpu, 4);
	unsigned long addr = kvmppc_get_gpr(vcpu, 5);
	unsigned long val = kvmppc_get_gpr(vcpu, 6);
	u64 buf;
876
	int srcu_idx;
877 878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899
	int ret;

	switch (size) {
	case 1:
		*(u8 *)&buf = val;
		break;

	case 2:
		*(__be16 *)&buf = cpu_to_be16(val);
		break;

	case 4:
		*(__be32 *)&buf = cpu_to_be32(val);
		break;

	case 8:
		*(__be64 *)&buf = cpu_to_be64(val);
		break;

	default:
		return H_TOO_HARD;
	}

900
	srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
901
	ret = kvm_io_bus_write(vcpu, KVM_MMIO_BUS, addr, size, &buf);
902
	srcu_read_unlock(&vcpu->kvm->srcu, srcu_idx);
903 904 905 906 907 908 909
	if (ret != 0)
		return H_TOO_HARD;

	return H_SUCCESS;
}
EXPORT_SYMBOL_GPL(kvmppc_h_logical_ci_store);

910 911
int kvmppc_core_check_processor_compat(void)
{
912 913
	/*
	 * We always return 0 for book3s. We check
914
	 * for compatibility while loading the HV
915 916 917 918 919
	 * or PR module
	 */
	return 0;
}

920 921 922 923 924
int kvmppc_book3s_hcall_implemented(struct kvm *kvm, unsigned long hcall)
{
	return kvm->arch.kvm_ops->hcall_implemented(hcall);
}

925 926 927 928 929 930 931
static int kvmppc_book3s_init(void)
{
	int r;

	r = kvm_init(NULL, sizeof(struct kvm_vcpu), 0, THIS_MODULE);
	if (r)
		return r;
932
#ifdef CONFIG_KVM_BOOK3S_32_HANDLER
933 934 935 936 937 938 939 940
	r = kvmppc_book3s_init_pr();
#endif
	return r;

}

static void kvmppc_book3s_exit(void)
{
941
#ifdef CONFIG_KVM_BOOK3S_32_HANDLER
942 943 944
	kvmppc_book3s_exit_pr();
#endif
	kvm_exit();
945
}
946 947 948

module_init(kvmppc_book3s_init);
module_exit(kvmppc_book3s_exit);
949 950

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