[mirror_ubuntu-jammy-kernel.git] / arch / powerpc / kvm / book3s.c

/*
 * 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>
#include <linux/slab.h>

#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>
#include <asm/page.h>
#include <linux/gfp.h>
#include <linux/sched.h>
#include <linux/vmalloc.h>
#include <linux/highmem.h>

#include "trace.h"

#define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU

/* #define EXIT_DEBUG */

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)
{
}

void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
{
	vcpu->arch.shared->srr0 = kvmppc_get_pc(vcpu);
	vcpu->arch.shared->srr1 = vcpu->arch.shared->msr | flags;
	kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
	vcpu->arch.mmu.reset_msr(vcpu);
}

static int kvmppc_book3s_vec2irqprio(unsigned int vec)
{
	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;
	case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL;	break;
	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;
	}

	return prio;
}

static void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
					  unsigned int vec)
{
	unsigned long old_pending = vcpu->arch.pending_exceptions;

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

	kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
				  old_pending);
}

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);
#ifdef EXIT_DEBUG
	printk(KERN_INFO "Queueing interrupt %x\n", vec);
#endif
}


void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
{
	to_book3s(vcpu)->prog_flags = flags;
	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_PROGRAM);
}

void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}

int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
{
	return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
}

void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
}

void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
                                struct kvm_interrupt *irq)
{
	unsigned int vec = BOOK3S_INTERRUPT_EXTERNAL;

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

	kvmppc_book3s_queue_irqprio(vcpu, vec);
}

void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu,
                                  struct kvm_interrupt *irq)
{
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL_LEVEL);
}

int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu, unsigned int priority)
{
	int deliver = 1;
	int vec = 0;
	ulong flags = 0ULL;
	bool crit = kvmppc_critical_section(vcpu);

	switch (priority) {
	case BOOK3S_IRQPRIO_DECREMENTER:
		deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
		vec = BOOK3S_INTERRUPT_DECREMENTER;
		break;
	case BOOK3S_IRQPRIO_EXTERNAL:
	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
		deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
		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;
		flags = to_book3s(vcpu)->prog_flags;
		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)
		kvmppc_inject_interrupt(vcpu, vec, flags);

	return deliver;
}

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

void kvmppc_core_deliver_interrupts(struct kvm_vcpu *vcpu)
{
	unsigned long *pending = &vcpu->arch.pending_exceptions;
	unsigned long old_pending = vcpu->arch.pending_exceptions;
	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);
	while (priority < BOOK3S_IRQPRIO_MAX) {
		if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
		    clear_irqprio(vcpu, priority)) {
			clear_bit(priority, &vcpu->arch.pending_exceptions);
			break;
		}

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

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

pfn_t kvmppc_gfn_to_pfn(struct kvm_vcpu *vcpu, gfn_t gfn)
{
	ulong mp_pa = vcpu->arch.magic_page_pa;

	/* 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));
		return pfn;
	}

	return gfn_to_pfn(vcpu->kvm, gfn);
}

static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data,
			 struct kvmppc_pte *pte)
{
	int relocated = (vcpu->arch.shared->msr & (data ? MSR_DR : MSR_IR));
	int r;

	if (relocated) {
		r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data);
	} else {
		pte->eaddr = eaddr;
		pte->raddr = eaddr & KVM_PAM;
		pte->vpage = VSID_REAL | eaddr >> 12;
		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();
}

int kvmppc_st(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
	      bool data)
{
	struct kvmppc_pte pte;

	vcpu->stat.st++;

	if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
		return -ENOENT;

	*eaddr = pte.raddr;

	if (!pte.may_write)
		return -EPERM;

	if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size))
		return EMULATE_DO_MMIO;

	return EMULATE_DONE;
}

int kvmppc_ld(struct kvm_vcpu *vcpu, ulong *eaddr, int size, void *ptr,
		      bool data)
{
	struct kvmppc_pte pte;
	hva_t hva = *eaddr;

	vcpu->stat.ld++;

	if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
		goto nopte;

	*eaddr = pte.raddr;

	hva = kvmppc_pte_to_hva(vcpu, &pte, true);
	if (kvm_is_error_hva(hva))
		goto mmio;

	if (copy_from_user(ptr, (void __user *)hva, size)) {
		printk(KERN_INFO "kvmppc_ld at 0x%lx failed\n", hva);
		goto mmio;
	}

	return EMULATE_DONE;

nopte:
	return -ENOENT;
mmio:
	return EMULATE_DO_MMIO;
}

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

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

	regs->pc = kvmppc_get_pc(vcpu);
	regs->cr = kvmppc_get_cr(vcpu);
	regs->ctr = kvmppc_get_ctr(vcpu);
	regs->lr = kvmppc_get_lr(vcpu);
	regs->xer = kvmppc_get_xer(vcpu);
	regs->msr = vcpu->arch.shared->msr;
	regs->srr0 = vcpu->arch.shared->srr0;
	regs->srr1 = vcpu->arch.shared->srr1;
	regs->pid = vcpu->arch.pid;
	regs->sprg0 = vcpu->arch.shared->sprg0;
	regs->sprg1 = vcpu->arch.shared->sprg1;
	regs->sprg2 = vcpu->arch.shared->sprg2;
	regs->sprg3 = vcpu->arch.shared->sprg3;
	regs->sprg4 = vcpu->arch.sprg4;
	regs->sprg5 = vcpu->arch.sprg5;
	regs->sprg6 = vcpu->arch.sprg6;
	regs->sprg7 = vcpu->arch.sprg7;

	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
		regs->gpr[i] = kvmppc_get_gpr(vcpu, i);

	return 0;
}

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

	kvmppc_set_pc(vcpu, regs->pc);
	kvmppc_set_cr(vcpu, regs->cr);
	kvmppc_set_ctr(vcpu, regs->ctr);
	kvmppc_set_lr(vcpu, regs->lr);
	kvmppc_set_xer(vcpu, regs->xer);
	kvmppc_set_msr(vcpu, regs->msr);
	vcpu->arch.shared->srr0 = regs->srr0;
	vcpu->arch.shared->srr1 = regs->srr1;
	vcpu->arch.shared->sprg0 = regs->sprg0;
	vcpu->arch.shared->sprg1 = regs->sprg1;
	vcpu->arch.shared->sprg2 = regs->sprg2;
	vcpu->arch.shared->sprg3 = regs->sprg3;
	vcpu->arch.sprg4 = regs->sprg4;
	vcpu->arch.sprg5 = regs->sprg5;
	vcpu->arch.sprg6 = regs->sprg6;
	vcpu->arch.sprg7 = regs->sprg7;

	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
		kvmppc_set_gpr(vcpu, i, regs->gpr[i]);

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

int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
                                  struct kvm_translation *tr)
{
	return 0;
}

/*
 * Get (and clear) the dirty memory log for a memory slot.
 */
int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm,
				      struct kvm_dirty_log *log)
{
	struct kvm_memory_slot *memslot;
	struct kvm_vcpu *vcpu;
	ulong ga, ga_end;
	int is_dirty = 0;
	int r;
	unsigned long n;

	mutex_lock(&kvm->slots_lock);

	r = kvm_get_dirty_log(kvm, log, &is_dirty);
	if (r)
		goto out;

	/* If nothing is dirty, don't bother messing with page tables. */
	if (is_dirty) {
		memslot = &kvm->memslots->memslots[log->slot];

		ga = memslot->base_gfn << PAGE_SHIFT;
		ga_end = ga + (memslot->npages << PAGE_SHIFT);

		kvm_for_each_vcpu(n, vcpu, kvm)
			kvmppc_mmu_pte_pflush(vcpu, ga, ga_end);

		n = kvm_dirty_bitmap_bytes(memslot);
		memset(memslot->dirty_bitmap, 0, n);
	}

	r = 0;
out:
	mutex_unlock(&kvm->slots_lock);
	return r;
}
Commit	Line	Data
2f4cf5e4 AG	1	/*
	2	* Copyright (C) 2009. SUSE Linux Products GmbH. All rights reserved.
	3	*
	4	* Authors:
	5	* Alexander Graf <agraf@suse.de>
	6	* Kevin Wolf <mail@kevin-wolf.de>
	7	*
	8	* Description:
	9	* This file is derived from arch/powerpc/kvm/44x.c,
	10	* by Hollis Blanchard <hollisb@us.ibm.com>.
	11	*
	12	* This program is free software; you can redistribute it and/or modify
	13	* it under the terms of the GNU General Public License, version 2, as
	14	* published by the Free Software Foundation.
	15	*/
	16
	17	#include <linux/kvm_host.h>
	18	#include <linux/err.h>
329d20ba	19	#include <linux/slab.h>
2f4cf5e4 AG	20
	21	#include <asm/reg.h>
	22	#include <asm/cputable.h>
	23	#include <asm/cacheflush.h>
	24	#include <asm/tlbflush.h>
	25	#include <asm/uaccess.h>
	26	#include <asm/io.h>
	27	#include <asm/kvm_ppc.h>
	28	#include <asm/kvm_book3s.h>
	29	#include <asm/mmu_context.h>
149dbdb1	30	#include <asm/page.h>
5a0e3ad6	31	#include <linux/gfp.h>
2f4cf5e4 AG	32	#include <linux/sched.h>
2f4cf5e4 AG	33	#include <linux/vmalloc.h>
9fb244a2	34	#include <linux/highmem.h>
2f4cf5e4	35
c4befc58 PM	36	#include "trace.h"
c4befc58 PM	37
2f4cf5e4 AG	38	#define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU
	39
	40	/* #define EXIT_DEBUG */
07b0907d	41
2f4cf5e4 AG	42	struct kvm_stats_debugfs_item debugfs_entries[] = {
	43	{ "exits", VCPU_STAT(sum_exits) },
	44	{ "mmio", VCPU_STAT(mmio_exits) },
	45	{ "sig", VCPU_STAT(signal_exits) },
	46	{ "sysc", VCPU_STAT(syscall_exits) },
	47	{ "inst_emu", VCPU_STAT(emulated_inst_exits) },
	48	{ "dec", VCPU_STAT(dec_exits) },
	49	{ "ext_intr", VCPU_STAT(ext_intr_exits) },
	50	{ "queue_intr", VCPU_STAT(queue_intr) },
	51	{ "halt_wakeup", VCPU_STAT(halt_wakeup) },
	52	{ "pf_storage", VCPU_STAT(pf_storage) },
	53	{ "sp_storage", VCPU_STAT(sp_storage) },
	54	{ "pf_instruc", VCPU_STAT(pf_instruc) },
	55	{ "sp_instruc", VCPU_STAT(sp_instruc) },
	56	{ "ld", VCPU_STAT(ld) },
	57	{ "ld_slow", VCPU_STAT(ld_slow) },
	58	{ "st", VCPU_STAT(st) },
	59	{ "st_slow", VCPU_STAT(st_slow) },
	60	{ NULL }
	61	};
	62
	63	void kvmppc_core_load_host_debugstate(struct kvm_vcpu *vcpu)
	64	{
	65	}
	66
	67	void kvmppc_core_load_guest_debugstate(struct kvm_vcpu *vcpu)
	68	{
	69	}
	70
2f4cf5e4 AG	71	void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
2f4cf5e4 AG	72	{
de7906c3 AG	73	vcpu->arch.shared->srr0 = kvmppc_get_pc(vcpu);
de7906c3 AG	74	vcpu->arch.shared->srr1 = vcpu->arch.shared->msr \| flags;
f05ed4d5	75	kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
2f4cf5e4 AG	76	vcpu->arch.mmu.reset_msr(vcpu);
	77	}
	78
583617b7	79	static int kvmppc_book3s_vec2irqprio(unsigned int vec)
2f4cf5e4 AG	80	{
	81	unsigned int prio;
	82
2f4cf5e4 AG	83	switch (vec) {
	84	case 0x100: prio = BOOK3S_IRQPRIO_SYSTEM_RESET; break;
	85	case 0x200: prio = BOOK3S_IRQPRIO_MACHINE_CHECK; break;
	86	case 0x300: prio = BOOK3S_IRQPRIO_DATA_STORAGE; break;
	87	case 0x380: prio = BOOK3S_IRQPRIO_DATA_SEGMENT; break;
	88	case 0x400: prio = BOOK3S_IRQPRIO_INST_STORAGE; break;
	89	case 0x480: prio = BOOK3S_IRQPRIO_INST_SEGMENT; break;
	90	case 0x500: prio = BOOK3S_IRQPRIO_EXTERNAL; break;
17bd1580	91	case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL; break;
2f4cf5e4 AG	92	case 0x600: prio = BOOK3S_IRQPRIO_ALIGNMENT; break;
	93	case 0x700: prio = BOOK3S_IRQPRIO_PROGRAM; break;
	94	case 0x800: prio = BOOK3S_IRQPRIO_FP_UNAVAIL; break;
	95	case 0x900: prio = BOOK3S_IRQPRIO_DECREMENTER; break;
	96	case 0xc00: prio = BOOK3S_IRQPRIO_SYSCALL; break;
	97	case 0xd00: prio = BOOK3S_IRQPRIO_DEBUG; break;
	98	case 0xf20: prio = BOOK3S_IRQPRIO_ALTIVEC; break;
	99	case 0xf40: prio = BOOK3S_IRQPRIO_VSX; break;
	100	default: prio = BOOK3S_IRQPRIO_MAX; break;
	101	}
	102
583617b7 AG	103	return prio;
	104	}
	105
7706664d AG	106	static void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
	107	unsigned int vec)
	108	{
f05ed4d5 PM	109	unsigned long old_pending = vcpu->arch.pending_exceptions;
f05ed4d5 PM	110
7706664d AG	111	clear_bit(kvmppc_book3s_vec2irqprio(vec),
7706664d AG	112	&vcpu->arch.pending_exceptions);
9ee18b1e	113
f05ed4d5 PM	114	kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
f05ed4d5 PM	115	old_pending);
7706664d AG	116	}
7706664d AG	117
583617b7 AG	118	void kvmppc_book3s_queue_irqprio(struct kvm_vcpu *vcpu, unsigned int vec)
	119	{
	120	vcpu->stat.queue_intr++;
	121
	122	set_bit(kvmppc_book3s_vec2irqprio(vec),
	123	&vcpu->arch.pending_exceptions);
2f4cf5e4 AG	124	#ifdef EXIT_DEBUG
	125	printk(KERN_INFO "Queueing interrupt %x\n", vec);
	126	#endif
	127	}
	128
	129
25a8a02d	130	void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
2f4cf5e4	131	{
25a8a02d	132	to_book3s(vcpu)->prog_flags = flags;
2f4cf5e4 AG	133	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_PROGRAM);
	134	}
	135
	136	void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
	137	{
	138	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
	139	}
	140
	141	int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
	142	{
44075d95	143	return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
2f4cf5e4 AG	144	}
2f4cf5e4 AG	145
7706664d AG	146	void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
	147	{
	148	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
	149	}
	150
2f4cf5e4 AG	151	void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
	152	struct kvm_interrupt *irq)
	153	{
17bd1580 AG	154	unsigned int vec = BOOK3S_INTERRUPT_EXTERNAL;
	155
	156	if (irq->irq == KVM_INTERRUPT_SET_LEVEL)
	157	vec = BOOK3S_INTERRUPT_EXTERNAL_LEVEL;
	158
	159	kvmppc_book3s_queue_irqprio(vcpu, vec);
2f4cf5e4 AG	160	}
2f4cf5e4 AG	161
18978768 AG	162	void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu,
	163	struct kvm_interrupt *irq)
	164	{
	165	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL);
17bd1580	166	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_EXTERNAL_LEVEL);
18978768 AG	167	}
18978768 AG	168
2f4cf5e4 AG	169	int kvmppc_book3s_irqprio_deliver(struct kvm_vcpu *vcpu, unsigned int priority)
	170	{
	171	int deliver = 1;
	172	int vec = 0;
25a8a02d	173	ulong flags = 0ULL;
f05ed4d5	174	bool crit = kvmppc_critical_section(vcpu);
2f4cf5e4 AG	175
	176	switch (priority) {
	177	case BOOK3S_IRQPRIO_DECREMENTER:
5c6cedf4	178	deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
2f4cf5e4 AG	179	vec = BOOK3S_INTERRUPT_DECREMENTER;
	180	break;
	181	case BOOK3S_IRQPRIO_EXTERNAL:
17bd1580	182	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
5c6cedf4	183	deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
2f4cf5e4 AG	184	vec = BOOK3S_INTERRUPT_EXTERNAL;
	185	break;
	186	case BOOK3S_IRQPRIO_SYSTEM_RESET:
	187	vec = BOOK3S_INTERRUPT_SYSTEM_RESET;
	188	break;
	189	case BOOK3S_IRQPRIO_MACHINE_CHECK:
	190	vec = BOOK3S_INTERRUPT_MACHINE_CHECK;
	191	break;
	192	case BOOK3S_IRQPRIO_DATA_STORAGE:
	193	vec = BOOK3S_INTERRUPT_DATA_STORAGE;
	194	break;
	195	case BOOK3S_IRQPRIO_INST_STORAGE:
	196	vec = BOOK3S_INTERRUPT_INST_STORAGE;
	197	break;
	198	case BOOK3S_IRQPRIO_DATA_SEGMENT:
	199	vec = BOOK3S_INTERRUPT_DATA_SEGMENT;
	200	break;
	201	case BOOK3S_IRQPRIO_INST_SEGMENT:
	202	vec = BOOK3S_INTERRUPT_INST_SEGMENT;
	203	break;
	204	case BOOK3S_IRQPRIO_ALIGNMENT:
	205	vec = BOOK3S_INTERRUPT_ALIGNMENT;
	206	break;
	207	case BOOK3S_IRQPRIO_PROGRAM:
	208	vec = BOOK3S_INTERRUPT_PROGRAM;
25a8a02d	209	flags = to_book3s(vcpu)->prog_flags;
2f4cf5e4 AG	210	break;
	211	case BOOK3S_IRQPRIO_VSX:
	212	vec = BOOK3S_INTERRUPT_VSX;
	213	break;
	214	case BOOK3S_IRQPRIO_ALTIVEC:
	215	vec = BOOK3S_INTERRUPT_ALTIVEC;
	216	break;
	217	case BOOK3S_IRQPRIO_FP_UNAVAIL:
	218	vec = BOOK3S_INTERRUPT_FP_UNAVAIL;
	219	break;
	220	case BOOK3S_IRQPRIO_SYSCALL:
	221	vec = BOOK3S_INTERRUPT_SYSCALL;
	222	break;
	223	case BOOK3S_IRQPRIO_DEBUG:
	224	vec = BOOK3S_INTERRUPT_TRACE;
	225	break;
	226	case BOOK3S_IRQPRIO_PERFORMANCE_MONITOR:
	227	vec = BOOK3S_INTERRUPT_PERFMON;
	228	break;
	229	default:
	230	deliver = 0;
	231	printk(KERN_ERR "KVM: Unknown interrupt: 0x%x\n", priority);
	232	break;
	233	}
	234
	235	#if 0
	236	printk(KERN_INFO "Deliver interrupt 0x%x? %x\n", vec, deliver);
	237	#endif
	238
	239	if (deliver)
25a8a02d	240	kvmppc_inject_interrupt(vcpu, vec, flags);
2f4cf5e4 AG	241
	242	return deliver;
	243	}
	244
17bd1580 AG	245	/*
	246	* This function determines if an irqprio should be cleared once issued.
	247	*/
	248	static bool clear_irqprio(struct kvm_vcpu *vcpu, unsigned int priority)
	249	{
	250	switch (priority) {
	251	case BOOK3S_IRQPRIO_DECREMENTER:
	252	/* DEC interrupts get cleared by mtdec */
	253	return false;
	254	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
	255	/* External interrupts get cleared by userspace */
	256	return false;
	257	}
	258
	259	return true;
	260	}
	261
2f4cf5e4 AG	262	void kvmppc_core_deliver_interrupts(struct kvm_vcpu *vcpu)
	263	{
	264	unsigned long *pending = &vcpu->arch.pending_exceptions;
90bba358	265	unsigned long old_pending = vcpu->arch.pending_exceptions;
2f4cf5e4 AG	266	unsigned int priority;
2f4cf5e4 AG	267
2f4cf5e4 AG	268	#ifdef EXIT_DEBUG
	269	if (vcpu->arch.pending_exceptions)
	270	printk(KERN_EMERG "KVM: Check pending: %lx\n", vcpu->arch.pending_exceptions);
	271	#endif
	272	priority = __ffs(*pending);
ada7ba17	273	while (priority < BOOK3S_IRQPRIO_MAX) {
7706664d	274	if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
17bd1580	275	clear_irqprio(vcpu, priority)) {
2f4cf5e4 AG	276	clear_bit(priority, &vcpu->arch.pending_exceptions);
	277	break;
	278	}
	279
	280	priority = find_next_bit(pending,
	281	BITS_PER_BYTE * sizeof(*pending),
	282	priority + 1);
	283	}
90bba358 AG	284
90bba358 AG	285	/* Tell the guest about our interrupt status */
f05ed4d5	286	kvmppc_update_int_pending(vcpu, *pending, old_pending);
2f4cf5e4 AG	287	}
2f4cf5e4 AG	288
e8508940 AG	289	pfn_t kvmppc_gfn_to_pfn(struct kvm_vcpu *vcpu, gfn_t gfn)
	290	{
	291	ulong mp_pa = vcpu->arch.magic_page_pa;
	292
	293	/* Magic page override */
	294	if (unlikely(mp_pa) &&
	295	unlikely(((gfn << PAGE_SHIFT) & KVM_PAM) ==
	296	((mp_pa & PAGE_MASK) & KVM_PAM))) {
	297	ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK;
	298	pfn_t pfn;
	299
	300	pfn = (pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT;
	301	get_page(pfn_to_page(pfn));
	302	return pfn;
	303	}
	304
	305	return gfn_to_pfn(vcpu->kvm, gfn);
	306	}
	307
2f4cf5e4 AG	308	static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data,
	309	struct kvmppc_pte *pte)
	310	{
666e7252	311	int relocated = (vcpu->arch.shared->msr & (data ? MSR_DR : MSR_IR));
2f4cf5e4 AG	312	int r;
	313
	314	if (relocated) {
	315	r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data);
	316	} else {
	317	pte->eaddr = eaddr;
28e83b4f	318	pte->raddr = eaddr & KVM_PAM;
3eeafd7d	319	pte->vpage = VSID_REAL \| eaddr >> 12;
2f4cf5e4 AG	320	pte->may_read = true;
	321	pte->may_write = true;
	322	pte->may_execute = true;
	323	r = 0;
	324	}
	325
	326	return r;
	327	}
	328
	329	static hva_t kvmppc_bad_hva(void)
	330	{
	331	return PAGE_OFFSET;
	332	}
	333
	334	static hva_t kvmppc_pte_to_hva(struct kvm_vcpu vcpu, struct kvmppc_pte pte,
	335	bool read)
	336	{
	337	hva_t hpage;
	338
	339	if (read && !pte->may_read)
	340	goto err;
	341
	342	if (!read && !pte->may_write)
	343	goto err;
	344
	345	hpage = gfn_to_hva(vcpu->kvm, pte->raddr >> PAGE_SHIFT);
	346	if (kvm_is_error_hva(hpage))
	347	goto err;
	348
	349	return hpage \| (pte->raddr & ~PAGE_MASK);
	350	err:
	351	return kvmppc_bad_hva();
	352	}
	353
5467a97d AG	354	int kvmppc_st(struct kvm_vcpu vcpu, ulong eaddr, int size, void *ptr,
5467a97d AG	355	bool data)
2f4cf5e4 AG	356	{
2f4cf5e4 AG	357	struct kvmppc_pte pte;
2f4cf5e4 AG	358
	359	vcpu->stat.st++;
	360
5467a97d	361	if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
9fb244a2	362	return -ENOENT;
5467a97d AG	363
5467a97d AG	364	*eaddr = pte.raddr;
2f4cf5e4	365
9fb244a2 AG	366	if (!pte.may_write)
9fb244a2 AG	367	return -EPERM;
2f4cf5e4	368
9fb244a2 AG	369	if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size))
9fb244a2 AG	370	return EMULATE_DO_MMIO;
2f4cf5e4	371
5467a97d	372	return EMULATE_DONE;
2f4cf5e4 AG	373	}
2f4cf5e4 AG	374
5467a97d	375	int kvmppc_ld(struct kvm_vcpu vcpu, ulong eaddr, int size, void *ptr,
2f4cf5e4 AG	376	bool data)
	377	{
	378	struct kvmppc_pte pte;
5467a97d	379	hva_t hva = *eaddr;
2f4cf5e4 AG	380
	381	vcpu->stat.ld++;
	382
5467a97d AG	383	if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
	384	goto nopte;
	385
	386	*eaddr = pte.raddr;
2f4cf5e4 AG	387
	388	hva = kvmppc_pte_to_hva(vcpu, &pte, true);
	389	if (kvm_is_error_hva(hva))
5467a97d	390	goto mmio;
2f4cf5e4 AG	391
	392	if (copy_from_user(ptr, (void __user *)hva, size)) {
	393	printk(KERN_INFO "kvmppc_ld at 0x%lx failed\n", hva);
5467a97d	394	goto mmio;
2f4cf5e4 AG	395	}
2f4cf5e4 AG	396
5467a97d	397	return EMULATE_DONE;
2f4cf5e4	398
5467a97d	399	nopte:
2f4cf5e4	400	return -ENOENT;
5467a97d AG	401	mmio:
5467a97d AG	402	return EMULATE_DO_MMIO;
2f4cf5e4 AG	403	}
2f4cf5e4 AG	404
2f4cf5e4 AG	405	int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
	406	{
	407	return 0;
	408	}
	409
	410	int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu vcpu, struct kvm_regs regs)
	411	{
	412	int i;
	413
c7f38f46	414	regs->pc = kvmppc_get_pc(vcpu);
992b5b29	415	regs->cr = kvmppc_get_cr(vcpu);
c7f38f46 AG	416	regs->ctr = kvmppc_get_ctr(vcpu);
c7f38f46 AG	417	regs->lr = kvmppc_get_lr(vcpu);
992b5b29	418	regs->xer = kvmppc_get_xer(vcpu);
666e7252	419	regs->msr = vcpu->arch.shared->msr;
de7906c3 AG	420	regs->srr0 = vcpu->arch.shared->srr0;
de7906c3 AG	421	regs->srr1 = vcpu->arch.shared->srr1;
2f4cf5e4	422	regs->pid = vcpu->arch.pid;
a73a9599 AG	423	regs->sprg0 = vcpu->arch.shared->sprg0;
	424	regs->sprg1 = vcpu->arch.shared->sprg1;
	425	regs->sprg2 = vcpu->arch.shared->sprg2;
	426	regs->sprg3 = vcpu->arch.shared->sprg3;
bc9c1933 PT	427	regs->sprg4 = vcpu->arch.sprg4;
	428	regs->sprg5 = vcpu->arch.sprg5;
	429	regs->sprg6 = vcpu->arch.sprg6;
	430	regs->sprg7 = vcpu->arch.sprg7;
2f4cf5e4 AG	431
2f4cf5e4 AG	432	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
8e5b26b5	433	regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
2f4cf5e4 AG	434
	435	return 0;
	436	}
	437
	438	int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu vcpu, struct kvm_regs regs)
	439	{
	440	int i;
	441
c7f38f46	442	kvmppc_set_pc(vcpu, regs->pc);
992b5b29	443	kvmppc_set_cr(vcpu, regs->cr);
c7f38f46 AG	444	kvmppc_set_ctr(vcpu, regs->ctr);
c7f38f46 AG	445	kvmppc_set_lr(vcpu, regs->lr);
992b5b29	446	kvmppc_set_xer(vcpu, regs->xer);
2f4cf5e4	447	kvmppc_set_msr(vcpu, regs->msr);
de7906c3 AG	448	vcpu->arch.shared->srr0 = regs->srr0;
de7906c3 AG	449	vcpu->arch.shared->srr1 = regs->srr1;
a73a9599 AG	450	vcpu->arch.shared->sprg0 = regs->sprg0;
	451	vcpu->arch.shared->sprg1 = regs->sprg1;
	452	vcpu->arch.shared->sprg2 = regs->sprg2;
	453	vcpu->arch.shared->sprg3 = regs->sprg3;
bc9c1933 PT	454	vcpu->arch.sprg4 = regs->sprg4;
	455	vcpu->arch.sprg5 = regs->sprg5;
	456	vcpu->arch.sprg6 = regs->sprg6;
	457	vcpu->arch.sprg7 = regs->sprg7;
2f4cf5e4	458
8e5b26b5 AG	459	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
8e5b26b5 AG	460	kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
2f4cf5e4 AG	461
	462	return 0;
	463	}
	464
2f4cf5e4 AG	465	int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu vcpu, struct kvm_fpu fpu)
	466	{
	467	return -ENOTSUPP;
	468	}
	469
	470	int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu vcpu, struct kvm_fpu fpu)
	471	{
	472	return -ENOTSUPP;
	473	}
	474
	475	int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
	476	struct kvm_translation *tr)
	477	{
	478	return 0;
	479	}
	480
	481	/*
	482	* Get (and clear) the dirty memory log for a memory slot.
	483	*/
	484	int kvm_vm_ioctl_get_dirty_log(struct kvm *kvm,
	485	struct kvm_dirty_log *log)
	486	{
	487	struct kvm_memory_slot *memslot;
	488	struct kvm_vcpu *vcpu;
	489	ulong ga, ga_end;
	490	int is_dirty = 0;
87bf6e7d TY	491	int r;
87bf6e7d TY	492	unsigned long n;
2f4cf5e4	493
79fac95e	494	mutex_lock(&kvm->slots_lock);
2f4cf5e4 AG	495
	496	r = kvm_get_dirty_log(kvm, log, &is_dirty);
	497	if (r)
	498	goto out;
	499
	500	/* If nothing is dirty, don't bother messing with page tables. */
	501	if (is_dirty) {
46a26bf5	502	memslot = &kvm->memslots->memslots[log->slot];
2f4cf5e4 AG	503
	504	ga = memslot->base_gfn << PAGE_SHIFT;
	505	ga_end = ga + (memslot->npages << PAGE_SHIFT);
	506
	507	kvm_for_each_vcpu(n, vcpu, kvm)
	508	kvmppc_mmu_pte_pflush(vcpu, ga, ga_end);
	509
87bf6e7d	510	n = kvm_dirty_bitmap_bytes(memslot);
2f4cf5e4 AG	511	memset(memslot->dirty_bitmap, 0, n);
	512	}
	513
	514	r = 0;
	515	out:
79fac95e	516	mutex_unlock(&kvm->slots_lock);
2f4cf5e4 AG	517	return r;
2f4cf5e4 AG	518	}