book3s.c 23.6 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 56 57
	{ "halt_poll_success_ns",	VCPU_STAT(halt_poll_success_ns) },
	{ "halt_poll_fail_ns",		VCPU_STAT(halt_poll_fail_ns) },
	{ "halt_wait_ns",		VCPU_STAT(halt_wait_ns) },
58
	{ "halt_successful_poll", VCPU_STAT(halt_successful_poll), },
59
	{ "halt_attempted_poll", VCPU_STAT(halt_attempted_poll), },
60
	{ "halt_successful_wait",	VCPU_STAT(halt_successful_wait) },
61
	{ "halt_poll_invalid", VCPU_STAT(halt_poll_invalid) },
A
Alexander Graf 已提交
62 63 64 65 66 67 68 69 70
	{ "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) },
71 72 73
	{ "pthru_all",       VCPU_STAT(pthru_all) },
	{ "pthru_host",      VCPU_STAT(pthru_host) },
	{ "pthru_bad_aff",   VCPU_STAT(pthru_bad_aff) },
A
Alexander Graf 已提交
74 75 76
	{ NULL }
};

77 78 79 80 81 82 83 84 85 86 87
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);

88 89
static inline unsigned long kvmppc_interrupt_offset(struct kvm_vcpu *vcpu)
{
90
	if (!is_kvmppc_hv_enabled(vcpu->kvm))
91 92 93 94 95 96 97
		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)
{
98
	if (is_kvmppc_hv_enabled(vcpu->kvm))
99 100
		return;
	if (pending_now)
101
		kvmppc_set_int_pending(vcpu, 1);
102
	else if (old_pending)
103
		kvmppc_set_int_pending(vcpu, 0);
104 105 106 107 108 109 110 111
}

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

112
	if (is_kvmppc_hv_enabled(vcpu->kvm))
113 114
		return false;

115
	crit_raw = kvmppc_get_critical(vcpu);
116 117 118
	crit_r1 = kvmppc_get_gpr(vcpu, 1);

	/* Truncate crit indicators in 32 bit mode */
119
	if (!(kvmppc_get_msr(vcpu) & MSR_SF)) {
120 121 122 123 124 125 126
		crit_raw &= 0xffffffff;
		crit_r1 &= 0xffffffff;
	}

	/* Critical section when crit == r1 */
	crit = (crit_raw == crit_r1);
	/* ... and we're in supervisor mode */
127
	crit = crit && !(kvmppc_get_msr(vcpu) & MSR_PR);
128 129 130 131

	return crit;
}

A
Alexander Graf 已提交
132 133
void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
{
134
	kvmppc_unfixup_split_real(vcpu);
135 136
	kvmppc_set_srr0(vcpu, kvmppc_get_pc(vcpu));
	kvmppc_set_srr1(vcpu, kvmppc_get_msr(vcpu) | flags);
137
	kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
A
Alexander Graf 已提交
138 139 140
	vcpu->arch.mmu.reset_msr(vcpu);
}

141
static int kvmppc_book3s_vec2irqprio(unsigned int vec)
A
Alexander Graf 已提交
142 143 144 145 146 147 148 149 150 151 152
{
	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;
153
	case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL;	break;
A
Alexander Graf 已提交
154 155 156 157 158 159 160 161
	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;
162
	case 0xf60: prio = BOOK3S_IRQPRIO_FAC_UNAVAIL;		break;
A
Alexander Graf 已提交
163 164 165
	default:    prio = BOOK3S_IRQPRIO_MAX;			break;
	}

166 167 168
	return prio;
}

169
void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
170 171
					  unsigned int vec)
{
172 173
	unsigned long old_pending = vcpu->arch.pending_exceptions;

174 175
	clear_bit(kvmppc_book3s_vec2irqprio(vec),
		  &vcpu->arch.pending_exceptions);
176

177 178
	kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
				  old_pending);
179 180
}

181 182 183 184 185 186
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 已提交
187 188 189 190
#ifdef EXIT_DEBUG
	printk(KERN_INFO "Queueing interrupt %x\n", vec);
#endif
}
191
EXPORT_SYMBOL_GPL(kvmppc_book3s_queue_irqprio);
A
Alexander Graf 已提交
192

193
void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
A
Alexander Graf 已提交
194
{
195 196
	/* might as well deliver this straight away */
	kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_PROGRAM, flags);
A
Alexander Graf 已提交
197
}
198
EXPORT_SYMBOL_GPL(kvmppc_core_queue_program);
A
Alexander Graf 已提交
199 200 201 202 203

void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}
204
EXPORT_SYMBOL_GPL(kvmppc_core_queue_dec);
A
Alexander Graf 已提交
205 206 207

int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
{
208
	return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
A
Alexander Graf 已提交
209
}
210
EXPORT_SYMBOL_GPL(kvmppc_core_pending_dec);
A
Alexander Graf 已提交
211

212 213 214 215
void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}
216
EXPORT_SYMBOL_GPL(kvmppc_core_dequeue_dec);
217

A
Alexander Graf 已提交
218 219 220
void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
                                struct kvm_interrupt *irq)
{
221 222 223 224 225 226
	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 已提交
227 228
}

229
void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu)
230 231
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
232
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL_LEVEL);
233 234
}

235 236 237 238 239 240 241 242 243 244 245 246 247 248 249 250 251
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 已提交
252 253
static int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu,
					 unsigned int priority)
A
Alexander Graf 已提交
254 255 256
{
	int deliver = 1;
	int vec = 0;
257
	bool crit = kvmppc_critical_section(vcpu);
A
Alexander Graf 已提交
258 259 260

	switch (priority) {
	case BOOK3S_IRQPRIO_DECREMENTER:
261
		deliver = (kvmppc_get_msr(vcpu) & MSR_EE) && !crit;
A
Alexander Graf 已提交
262 263 264
		vec = BOOK3S_INTERRUPT_DECREMENTER;
		break;
	case BOOK3S_IRQPRIO_EXTERNAL:
265
	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
266
		deliver = (kvmppc_get_msr(vcpu) & MSR_EE) && !crit;
A
Alexander Graf 已提交
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 304 305 306 307 308 309 310
		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;
311 312 313
	case BOOK3S_IRQPRIO_FAC_UNAVAIL:
		vec = BOOK3S_INTERRUPT_FAC_UNAVAIL;
		break;
A
Alexander Graf 已提交
314 315 316 317 318 319 320 321 322 323 324
	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)
325
		kvmppc_inject_interrupt(vcpu, vec, 0);
A
Alexander Graf 已提交
326 327 328 329

	return deliver;
}

330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346
/*
 * 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;
}

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

		priority = find_next_bit(pending,
					 BITS_PER_BYTE * sizeof(*pending),
					 priority + 1);
	}
369 370

	/* Tell the guest about our interrupt status */
371
	kvmppc_update_int_pending(vcpu, *pending, old_pending);
372 373

	return 0;
A
Alexander Graf 已提交
374
}
375
EXPORT_SYMBOL_GPL(kvmppc_core_prepare_to_enter);
A
Alexander Graf 已提交
376

D
Dan Williams 已提交
377
kvm_pfn_t kvmppc_gpa_to_pfn(struct kvm_vcpu *vcpu, gpa_t gpa, bool writing,
378
			bool *writable)
379
{
380 381
	ulong mp_pa = vcpu->arch.magic_page_pa & KVM_PAM;
	gfn_t gfn = gpa >> PAGE_SHIFT;
382

383
	if (!(kvmppc_get_msr(vcpu) & MSR_SF))
384 385
		mp_pa = (uint32_t)mp_pa;

386
	/* Magic page override */
387 388
	gpa &= ~0xFFFULL;
	if (unlikely(mp_pa) && unlikely((gpa & KVM_PAM) == mp_pa)) {
389
		ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK;
D
Dan Williams 已提交
390
		kvm_pfn_t pfn;
391

D
Dan Williams 已提交
392
		pfn = (kvm_pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT;
393
		get_page(pfn_to_page(pfn));
394 395
		if (writable)
			*writable = true;
396 397 398
		return pfn;
	}

399
	return gfn_to_pfn_prot(vcpu->kvm, gfn, writing, writable);
400
}
401
EXPORT_SYMBOL_GPL(kvmppc_gpa_to_pfn);
402

403 404
int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, enum xlate_instdata xlid,
		 enum xlate_readwrite xlrw, struct kvmppc_pte *pte)
A
Alexander Graf 已提交
405
{
406 407
	bool data = (xlid == XLATE_DATA);
	bool iswrite = (xlrw == XLATE_WRITE);
408
	int relocated = (kvmppc_get_msr(vcpu) & (data ? MSR_DR : MSR_IR));
A
Alexander Graf 已提交
409 410 411
	int r;

	if (relocated) {
412
		r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data, iswrite);
A
Alexander Graf 已提交
413 414
	} else {
		pte->eaddr = eaddr;
A
Alexander Graf 已提交
415
		pte->raddr = eaddr & KVM_PAM;
416
		pte->vpage = VSID_REAL | eaddr >> 12;
A
Alexander Graf 已提交
417 418 419 420
		pte->may_read = true;
		pte->may_write = true;
		pte->may_execute = true;
		r = 0;
421 422 423 424 425 426 427

		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 已提交
428 429 430 431 432
	}

	return r;
}

433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449
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 已提交
450 451 452 453 454
int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
{
	return 0;
}

455 456 457 458 459 460 461 462 463
int kvmppc_subarch_vcpu_init(struct kvm_vcpu *vcpu)
{
	return 0;
}

void kvmppc_subarch_vcpu_uninit(struct kvm_vcpu *vcpu)
{
}

464 465 466
int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
				  struct kvm_sregs *sregs)
{
467
	return vcpu->kvm->arch.kvm_ops->get_sregs(vcpu, sregs);
468 469 470 471 472
}

int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
				  struct kvm_sregs *sregs)
{
473
	return vcpu->kvm->arch.kvm_ops->set_sregs(vcpu, sregs);
474 475
}

A
Alexander Graf 已提交
476 477 478 479
int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
{
	int i;

480
	regs->pc = kvmppc_get_pc(vcpu);
481
	regs->cr = kvmppc_get_cr(vcpu);
482 483
	regs->ctr = kvmppc_get_ctr(vcpu);
	regs->lr = kvmppc_get_lr(vcpu);
484
	regs->xer = kvmppc_get_xer(vcpu);
485 486 487
	regs->msr = kvmppc_get_msr(vcpu);
	regs->srr0 = kvmppc_get_srr0(vcpu);
	regs->srr1 = kvmppc_get_srr1(vcpu);
A
Alexander Graf 已提交
488
	regs->pid = vcpu->arch.pid;
489 490 491 492 493 494 495 496
	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 已提交
497 498

	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
499
		regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
A
Alexander Graf 已提交
500 501 502 503 504 505 506 507

	return 0;
}

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

508
	kvmppc_set_pc(vcpu, regs->pc);
509
	kvmppc_set_cr(vcpu, regs->cr);
510 511
	kvmppc_set_ctr(vcpu, regs->ctr);
	kvmppc_set_lr(vcpu, regs->lr);
512
	kvmppc_set_xer(vcpu, regs->xer);
A
Alexander Graf 已提交
513
	kvmppc_set_msr(vcpu, regs->msr);
514 515 516 517 518 519 520 521 522 523
	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 已提交
524

525 526
	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
		kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
A
Alexander Graf 已提交
527 528 529 530 531 532 533 534 535 536 537 538 539 540

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

541 542
int kvmppc_get_one_reg(struct kvm_vcpu *vcpu, u64 id,
			union kvmppc_one_reg *val)
543
{
544
	int r = 0;
545
	long int i;
546

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

	return r;
}

614 615
int kvmppc_set_one_reg(struct kvm_vcpu *vcpu, u64 id,
			union kvmppc_one_reg *val)
616
{
617
	int r = 0;
618
	long int i;
619

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

	return r;
}

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

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

int kvmppc_core_init_vm(struct kvm *kvm)
{

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

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

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

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

829 830 831 832 833
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;
834
	int srcu_idx;
835 836 837 838 839
	int ret;

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

840
	srcu_idx = srcu_read_lock(&vcpu->kvm->srcu);
841
	ret = kvm_io_bus_read(vcpu, KVM_MMIO_BUS, addr, size, &buf);
842
	srcu_read_unlock(&vcpu->kvm->srcu, srcu_idx);
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 876
	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;
877
	int srcu_idx;
878 879 880 881 882 883 884 885 886 887 888 889 890 891 892 893 894 895 896 897 898 899 900
	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;
	}

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

	return H_SUCCESS;
}
EXPORT_SYMBOL_GPL(kvmppc_h_logical_ci_store);

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

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

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

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

}

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

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

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