[linux-2.6-block.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/export.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;
}

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)
{
	/* might as well deliver this straight away */
	kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_PROGRAM, flags);
}

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)
{
	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;
	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;
		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, 0);

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

int kvmppc_core_prepare_to_enter(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);

	return 0;
}

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

	if (!(vcpu->arch.shared->msr & MSR_SF))
		mp_pa = (uint32_t)mp_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 kvmppc_subarch_vcpu_init(struct kvm_vcpu *vcpu)
{
	return 0;
}

void kvmppc_subarch_vcpu_uninit(struct kvm_vcpu *vcpu)
{
}

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.shared->sprg4;
	regs->sprg5 = vcpu->arch.shared->sprg5;
	regs->sprg6 = vcpu->arch.shared->sprg6;
	regs->sprg7 = vcpu->arch.shared->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.shared->sprg4 = regs->sprg4;
	vcpu->arch.shared->sprg5 = regs->sprg5;
	vcpu->arch.shared->sprg6 = regs->sprg6;
	vcpu->arch.shared->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_vcpu_ioctl_get_one_reg(struct kvm_vcpu *vcpu, struct kvm_one_reg *reg)
{
	int r;
	union kvmppc_one_reg val;
	int size;
	long int i;

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

	r = kvmppc_get_one_reg(vcpu, reg->id, &val);

	if (r == -EINVAL) {
		r = 0;
		switch (reg->id) {
		case KVM_REG_PPC_DAR:
			val = get_reg_val(reg->id, vcpu->arch.shared->dar);
			break;
		case KVM_REG_PPC_DSISR:
			val = get_reg_val(reg->id, vcpu->arch.shared->dsisr);
			break;
		case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
			i = reg->id - KVM_REG_PPC_FPR0;
			val = get_reg_val(reg->id, vcpu->arch.fpr[i]);
			break;
		case KVM_REG_PPC_FPSCR:
			val = get_reg_val(reg->id, vcpu->arch.fpscr);
			break;
#ifdef CONFIG_ALTIVEC
		case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			val.vval = vcpu->arch.vr[reg->id - KVM_REG_PPC_VR0];
			break;
		case KVM_REG_PPC_VSCR:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			val = get_reg_val(reg->id, vcpu->arch.vscr.u[3]);
			break;
		case KVM_REG_PPC_VRSAVE:
			val = get_reg_val(reg->id, vcpu->arch.vrsave);
			break;
#endif /* CONFIG_ALTIVEC */
		case KVM_REG_PPC_DEBUG_INST: {
			u32 opcode = INS_TW;
			r = copy_to_user((u32 __user *)(long)reg->addr,
					 &opcode, sizeof(u32));
			break;
		}
#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 */
		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;
	long int i;

	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;

	r = kvmppc_set_one_reg(vcpu, reg->id, &val);

	if (r == -EINVAL) {
		r = 0;
		switch (reg->id) {
		case KVM_REG_PPC_DAR:
			vcpu->arch.shared->dar = set_reg_val(reg->id, val);
			break;
		case KVM_REG_PPC_DSISR:
			vcpu->arch.shared->dsisr = set_reg_val(reg->id, val);
			break;
		case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
			i = reg->id - KVM_REG_PPC_FPR0;
			vcpu->arch.fpr[i] = set_reg_val(reg->id, val);
			break;
		case KVM_REG_PPC_FPSCR:
			vcpu->arch.fpscr = set_reg_val(reg->id, val);
			break;
#ifdef CONFIG_ALTIVEC
		case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			vcpu->arch.vr[reg->id - KVM_REG_PPC_VR0] = val.vval;
			break;
		case KVM_REG_PPC_VSCR:
			if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
				r = -ENXIO;
				break;
			}
			vcpu->arch.vscr.u[3] = set_reg_val(reg->id, val);
			break;
		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;
#endif /* CONFIG_ALTIVEC */
#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 */
		default:
			r = -EINVAL;
			break;
		}
	}

	return r;
}

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

int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
					struct kvm_guest_debug *dbg)
{
	return -EINVAL;
}

void kvmppc_decrementer_func(unsigned long data)
{
	struct kvm_vcpu *vcpu = (struct kvm_vcpu *)data;

	kvmppc_core_queue_dec(vcpu);
	kvm_vcpu_kick(vcpu);
}
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>
66b15db6	19	#include <linux/export.h>
329d20ba	20	#include <linux/slab.h>
2f4cf5e4 AG	21
	22	#include <asm/reg.h>
	23	#include <asm/cputable.h>
	24	#include <asm/cacheflush.h>
	25	#include <asm/tlbflush.h>
	26	#include <asm/uaccess.h>
	27	#include <asm/io.h>
	28	#include <asm/kvm_ppc.h>
	29	#include <asm/kvm_book3s.h>
	30	#include <asm/mmu_context.h>
149dbdb1	31	#include <asm/page.h>
5a0e3ad6	32	#include <linux/gfp.h>
2f4cf5e4 AG	33	#include <linux/sched.h>
2f4cf5e4 AG	34	#include <linux/vmalloc.h>
9fb244a2	35	#include <linux/highmem.h>
2f4cf5e4	36
c4befc58 PM	37	#include "trace.h"
c4befc58 PM	38
2f4cf5e4 AG	39	#define VCPU_STAT(x) offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU
	40
	41	/* #define EXIT_DEBUG */
07b0907d	42
2f4cf5e4 AG	43	struct kvm_stats_debugfs_item debugfs_entries[] = {
	44	{ "exits", VCPU_STAT(sum_exits) },
	45	{ "mmio", VCPU_STAT(mmio_exits) },
	46	{ "sig", VCPU_STAT(signal_exits) },
	47	{ "sysc", VCPU_STAT(syscall_exits) },
	48	{ "inst_emu", VCPU_STAT(emulated_inst_exits) },
	49	{ "dec", VCPU_STAT(dec_exits) },
	50	{ "ext_intr", VCPU_STAT(ext_intr_exits) },
	51	{ "queue_intr", VCPU_STAT(queue_intr) },
	52	{ "halt_wakeup", VCPU_STAT(halt_wakeup) },
	53	{ "pf_storage", VCPU_STAT(pf_storage) },
	54	{ "sp_storage", VCPU_STAT(sp_storage) },
	55	{ "pf_instruc", VCPU_STAT(pf_instruc) },
	56	{ "sp_instruc", VCPU_STAT(sp_instruc) },
	57	{ "ld", VCPU_STAT(ld) },
	58	{ "ld_slow", VCPU_STAT(ld_slow) },
	59	{ "st", VCPU_STAT(st) },
	60	{ "st_slow", VCPU_STAT(st_slow) },
	61	{ NULL }
	62	};
	63
	64	void kvmppc_core_load_host_debugstate(struct kvm_vcpu *vcpu)
	65	{
	66	}
	67
	68	void kvmppc_core_load_guest_debugstate(struct kvm_vcpu *vcpu)
	69	{
	70	}
	71
2f4cf5e4 AG	72	void kvmppc_inject_interrupt(struct kvm_vcpu *vcpu, int vec, u64 flags)
2f4cf5e4 AG	73	{
de7906c3 AG	74	vcpu->arch.shared->srr0 = kvmppc_get_pc(vcpu);
de7906c3 AG	75	vcpu->arch.shared->srr1 = vcpu->arch.shared->msr \| flags;
f05ed4d5	76	kvmppc_set_pc(vcpu, kvmppc_interrupt_offset(vcpu) + vec);
2f4cf5e4 AG	77	vcpu->arch.mmu.reset_msr(vcpu);
	78	}
	79
583617b7	80	static int kvmppc_book3s_vec2irqprio(unsigned int vec)
2f4cf5e4 AG	81	{
	82	unsigned int prio;
	83
2f4cf5e4 AG	84	switch (vec) {
	85	case 0x100: prio = BOOK3S_IRQPRIO_SYSTEM_RESET; break;
	86	case 0x200: prio = BOOK3S_IRQPRIO_MACHINE_CHECK; break;
	87	case 0x300: prio = BOOK3S_IRQPRIO_DATA_STORAGE; break;
	88	case 0x380: prio = BOOK3S_IRQPRIO_DATA_SEGMENT; break;
	89	case 0x400: prio = BOOK3S_IRQPRIO_INST_STORAGE; break;
	90	case 0x480: prio = BOOK3S_IRQPRIO_INST_SEGMENT; break;
	91	case 0x500: prio = BOOK3S_IRQPRIO_EXTERNAL; break;
17bd1580	92	case 0x501: prio = BOOK3S_IRQPRIO_EXTERNAL_LEVEL; break;
2f4cf5e4 AG	93	case 0x600: prio = BOOK3S_IRQPRIO_ALIGNMENT; break;
	94	case 0x700: prio = BOOK3S_IRQPRIO_PROGRAM; break;
	95	case 0x800: prio = BOOK3S_IRQPRIO_FP_UNAVAIL; break;
	96	case 0x900: prio = BOOK3S_IRQPRIO_DECREMENTER; break;
	97	case 0xc00: prio = BOOK3S_IRQPRIO_SYSCALL; break;
	98	case 0xd00: prio = BOOK3S_IRQPRIO_DEBUG; break;
	99	case 0xf20: prio = BOOK3S_IRQPRIO_ALTIVEC; break;
	100	case 0xf40: prio = BOOK3S_IRQPRIO_VSX; break;
	101	default: prio = BOOK3S_IRQPRIO_MAX; break;
	102	}
	103
583617b7 AG	104	return prio;
	105	}
	106
bc5ad3f3	107	void kvmppc_book3s_dequeue_irqprio(struct kvm_vcpu *vcpu,
7706664d AG	108	unsigned int vec)
7706664d AG	109	{
f05ed4d5 PM	110	unsigned long old_pending = vcpu->arch.pending_exceptions;
f05ed4d5 PM	111
7706664d AG	112	clear_bit(kvmppc_book3s_vec2irqprio(vec),
7706664d AG	113	&vcpu->arch.pending_exceptions);
9ee18b1e	114
f05ed4d5 PM	115	kvmppc_update_int_pending(vcpu, vcpu->arch.pending_exceptions,
f05ed4d5 PM	116	old_pending);
7706664d AG	117	}
7706664d AG	118
583617b7 AG	119	void kvmppc_book3s_queue_irqprio(struct kvm_vcpu *vcpu, unsigned int vec)
	120	{
	121	vcpu->stat.queue_intr++;
	122
	123	set_bit(kvmppc_book3s_vec2irqprio(vec),
	124	&vcpu->arch.pending_exceptions);
2f4cf5e4 AG	125	#ifdef EXIT_DEBUG
	126	printk(KERN_INFO "Queueing interrupt %x\n", vec);
	127	#endif
	128	}
	129
	130
25a8a02d	131	void kvmppc_core_queue_program(struct kvm_vcpu *vcpu, ulong flags)
2f4cf5e4	132	{
3cf658b6 PM	133	/* might as well deliver this straight away */
3cf658b6 PM	134	kvmppc_inject_interrupt(vcpu, BOOK3S_INTERRUPT_PROGRAM, flags);
2f4cf5e4 AG	135	}
	136
	137	void kvmppc_core_queue_dec(struct kvm_vcpu *vcpu)
	138	{
	139	kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
	140	}
	141
	142	int kvmppc_core_pending_dec(struct kvm_vcpu *vcpu)
	143	{
44075d95	144	return test_bit(BOOK3S_IRQPRIO_DECREMENTER, &vcpu->arch.pending_exceptions);
2f4cf5e4 AG	145	}
2f4cf5e4 AG	146
7706664d AG	147	void kvmppc_core_dequeue_dec(struct kvm_vcpu *vcpu)
	148	{
	149	kvmppc_book3s_dequeue_irqprio(vcpu, BOOK3S_INTERRUPT_DECREMENTER);
	150	}
	151
2f4cf5e4 AG	152	void kvmppc_core_queue_external(struct kvm_vcpu *vcpu,
	153	struct kvm_interrupt *irq)
	154	{
17bd1580 AG	155	unsigned int vec = BOOK3S_INTERRUPT_EXTERNAL;
	156
	157	if (irq->irq == KVM_INTERRUPT_SET_LEVEL)
	158	vec = BOOK3S_INTERRUPT_EXTERNAL_LEVEL;
	159
	160	kvmppc_book3s_queue_irqprio(vcpu, vec);
2f4cf5e4 AG	161	}
2f4cf5e4 AG	162
4fe27d2a	163	void kvmppc_core_dequeue_external(struct kvm_vcpu *vcpu)
18978768 AG	164	{
18978768 AG	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;
f05ed4d5	173	bool crit = kvmppc_critical_section(vcpu);
2f4cf5e4 AG	174
	175	switch (priority) {
	176	case BOOK3S_IRQPRIO_DECREMENTER:
5c6cedf4	177	deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
2f4cf5e4 AG	178	vec = BOOK3S_INTERRUPT_DECREMENTER;
	179	break;
	180	case BOOK3S_IRQPRIO_EXTERNAL:
17bd1580	181	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
5c6cedf4	182	deliver = (vcpu->arch.shared->msr & MSR_EE) && !crit;
2f4cf5e4 AG	183	vec = BOOK3S_INTERRUPT_EXTERNAL;
	184	break;
	185	case BOOK3S_IRQPRIO_SYSTEM_RESET:
	186	vec = BOOK3S_INTERRUPT_SYSTEM_RESET;
	187	break;
	188	case BOOK3S_IRQPRIO_MACHINE_CHECK:
	189	vec = BOOK3S_INTERRUPT_MACHINE_CHECK;
	190	break;
	191	case BOOK3S_IRQPRIO_DATA_STORAGE:
	192	vec = BOOK3S_INTERRUPT_DATA_STORAGE;
	193	break;
	194	case BOOK3S_IRQPRIO_INST_STORAGE:
	195	vec = BOOK3S_INTERRUPT_INST_STORAGE;
	196	break;
	197	case BOOK3S_IRQPRIO_DATA_SEGMENT:
	198	vec = BOOK3S_INTERRUPT_DATA_SEGMENT;
	199	break;
	200	case BOOK3S_IRQPRIO_INST_SEGMENT:
	201	vec = BOOK3S_INTERRUPT_INST_SEGMENT;
	202	break;
	203	case BOOK3S_IRQPRIO_ALIGNMENT:
	204	vec = BOOK3S_INTERRUPT_ALIGNMENT;
	205	break;
	206	case BOOK3S_IRQPRIO_PROGRAM:
	207	vec = BOOK3S_INTERRUPT_PROGRAM;
	208	break;
	209	case BOOK3S_IRQPRIO_VSX:
	210	vec = BOOK3S_INTERRUPT_VSX;
	211	break;
	212	case BOOK3S_IRQPRIO_ALTIVEC:
	213	vec = BOOK3S_INTERRUPT_ALTIVEC;
	214	break;
	215	case BOOK3S_IRQPRIO_FP_UNAVAIL:
	216	vec = BOOK3S_INTERRUPT_FP_UNAVAIL;
	217	break;
	218	case BOOK3S_IRQPRIO_SYSCALL:
	219	vec = BOOK3S_INTERRUPT_SYSCALL;
	220	break;
	221	case BOOK3S_IRQPRIO_DEBUG:
	222	vec = BOOK3S_INTERRUPT_TRACE;
	223	break;
	224	case BOOK3S_IRQPRIO_PERFORMANCE_MONITOR:
	225	vec = BOOK3S_INTERRUPT_PERFMON;
	226	break;
	227	default:
	228	deliver = 0;
	229	printk(KERN_ERR "KVM: Unknown interrupt: 0x%x\n", priority);
	230	break;
	231	}
	232
	233	#if 0
	234	printk(KERN_INFO "Deliver interrupt 0x%x? %x\n", vec, deliver);
	235	#endif
	236
	237	if (deliver)
3cf658b6	238	kvmppc_inject_interrupt(vcpu, vec, 0);
2f4cf5e4 AG	239
	240	return deliver;
	241	}
	242
17bd1580 AG	243	/*
	244	* This function determines if an irqprio should be cleared once issued.
	245	*/
	246	static bool clear_irqprio(struct kvm_vcpu *vcpu, unsigned int priority)
	247	{
	248	switch (priority) {
	249	case BOOK3S_IRQPRIO_DECREMENTER:
	250	/* DEC interrupts get cleared by mtdec */
	251	return false;
	252	case BOOK3S_IRQPRIO_EXTERNAL_LEVEL:
	253	/* External interrupts get cleared by userspace */
	254	return false;
	255	}
	256
	257	return true;
	258	}
	259
a8e4ef84	260	int kvmppc_core_prepare_to_enter(struct kvm_vcpu *vcpu)
2f4cf5e4 AG	261	{
2f4cf5e4 AG	262	unsigned long *pending = &vcpu->arch.pending_exceptions;
90bba358	263	unsigned long old_pending = vcpu->arch.pending_exceptions;
2f4cf5e4 AG	264	unsigned int priority;
2f4cf5e4 AG	265
2f4cf5e4 AG	266	#ifdef EXIT_DEBUG
	267	if (vcpu->arch.pending_exceptions)
	268	printk(KERN_EMERG "KVM: Check pending: %lx\n", vcpu->arch.pending_exceptions);
	269	#endif
	270	priority = __ffs(*pending);
ada7ba17	271	while (priority < BOOK3S_IRQPRIO_MAX) {
7706664d	272	if (kvmppc_book3s_irqprio_deliver(vcpu, priority) &&
17bd1580	273	clear_irqprio(vcpu, priority)) {
2f4cf5e4 AG	274	clear_bit(priority, &vcpu->arch.pending_exceptions);
	275	break;
	276	}
	277
	278	priority = find_next_bit(pending,
	279	BITS_PER_BYTE * sizeof(*pending),
	280	priority + 1);
	281	}
90bba358 AG	282
90bba358 AG	283	/* Tell the guest about our interrupt status */
f05ed4d5	284	kvmppc_update_int_pending(vcpu, *pending, old_pending);
a8e4ef84 AG	285
a8e4ef84 AG	286	return 0;
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
bbcc9c06 BH	293	if (!(vcpu->arch.shared->msr & MSR_SF))
	294	mp_pa = (uint32_t)mp_pa;
	295
e8508940 AG	296	/* Magic page override */
	297	if (unlikely(mp_pa) &&
	298	unlikely(((gfn << PAGE_SHIFT) & KVM_PAM) ==
	299	((mp_pa & PAGE_MASK) & KVM_PAM))) {
	300	ulong shared_page = ((ulong)vcpu->arch.shared) & PAGE_MASK;
	301	pfn_t pfn;
	302
	303	pfn = (pfn_t)virt_to_phys((void*)shared_page) >> PAGE_SHIFT;
	304	get_page(pfn_to_page(pfn));
	305	return pfn;
	306	}
	307
	308	return gfn_to_pfn(vcpu->kvm, gfn);
	309	}
	310
2f4cf5e4 AG	311	static int kvmppc_xlate(struct kvm_vcpu *vcpu, ulong eaddr, bool data,
	312	struct kvmppc_pte *pte)
	313	{
666e7252	314	int relocated = (vcpu->arch.shared->msr & (data ? MSR_DR : MSR_IR));
2f4cf5e4 AG	315	int r;
	316
	317	if (relocated) {
	318	r = vcpu->arch.mmu.xlate(vcpu, eaddr, pte, data);
	319	} else {
	320	pte->eaddr = eaddr;
28e83b4f	321	pte->raddr = eaddr & KVM_PAM;
3eeafd7d	322	pte->vpage = VSID_REAL \| eaddr >> 12;
2f4cf5e4 AG	323	pte->may_read = true;
	324	pte->may_write = true;
	325	pte->may_execute = true;
	326	r = 0;
	327	}
	328
	329	return r;
	330	}
	331
	332	static hva_t kvmppc_bad_hva(void)
	333	{
	334	return PAGE_OFFSET;
	335	}
	336
	337	static hva_t kvmppc_pte_to_hva(struct kvm_vcpu vcpu, struct kvmppc_pte pte,
	338	bool read)
	339	{
	340	hva_t hpage;
	341
	342	if (read && !pte->may_read)
	343	goto err;
	344
	345	if (!read && !pte->may_write)
	346	goto err;
	347
	348	hpage = gfn_to_hva(vcpu->kvm, pte->raddr >> PAGE_SHIFT);
	349	if (kvm_is_error_hva(hpage))
	350	goto err;
	351
	352	return hpage \| (pte->raddr & ~PAGE_MASK);
	353	err:
	354	return kvmppc_bad_hva();
	355	}
	356
5467a97d AG	357	int kvmppc_st(struct kvm_vcpu vcpu, ulong eaddr, int size, void *ptr,
5467a97d AG	358	bool data)
2f4cf5e4 AG	359	{
2f4cf5e4 AG	360	struct kvmppc_pte pte;
2f4cf5e4 AG	361
	362	vcpu->stat.st++;
	363
5467a97d	364	if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
9fb244a2	365	return -ENOENT;
5467a97d AG	366
5467a97d AG	367	*eaddr = pte.raddr;
2f4cf5e4	368
9fb244a2 AG	369	if (!pte.may_write)
9fb244a2 AG	370	return -EPERM;
2f4cf5e4	371
9fb244a2 AG	372	if (kvm_write_guest(vcpu->kvm, pte.raddr, ptr, size))
9fb244a2 AG	373	return EMULATE_DO_MMIO;
2f4cf5e4	374
5467a97d	375	return EMULATE_DONE;
2f4cf5e4 AG	376	}
2f4cf5e4 AG	377
5467a97d	378	int kvmppc_ld(struct kvm_vcpu vcpu, ulong eaddr, int size, void *ptr,
2f4cf5e4 AG	379	bool data)
	380	{
	381	struct kvmppc_pte pte;
5467a97d	382	hva_t hva = *eaddr;
2f4cf5e4 AG	383
	384	vcpu->stat.ld++;
	385
5467a97d AG	386	if (kvmppc_xlate(vcpu, *eaddr, data, &pte))
	387	goto nopte;
	388
	389	*eaddr = pte.raddr;
2f4cf5e4 AG	390
	391	hva = kvmppc_pte_to_hva(vcpu, &pte, true);
	392	if (kvm_is_error_hva(hva))
5467a97d	393	goto mmio;
2f4cf5e4 AG	394
	395	if (copy_from_user(ptr, (void __user *)hva, size)) {
	396	printk(KERN_INFO "kvmppc_ld at 0x%lx failed\n", hva);
5467a97d	397	goto mmio;
2f4cf5e4 AG	398	}
2f4cf5e4 AG	399
5467a97d	400	return EMULATE_DONE;
2f4cf5e4	401
5467a97d	402	nopte:
2f4cf5e4	403	return -ENOENT;
5467a97d AG	404	mmio:
5467a97d AG	405	return EMULATE_DO_MMIO;
2f4cf5e4 AG	406	}
2f4cf5e4 AG	407
2f4cf5e4 AG	408	int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
	409	{
	410	return 0;
	411	}
	412
f61c94bb BB	413	int kvmppc_subarch_vcpu_init(struct kvm_vcpu *vcpu)
	414	{
	415	return 0;
	416	}
	417
	418	void kvmppc_subarch_vcpu_uninit(struct kvm_vcpu *vcpu)
	419	{
	420	}
	421
2f4cf5e4 AG	422	int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu vcpu, struct kvm_regs regs)
	423	{
	424	int i;
	425
c7f38f46	426	regs->pc = kvmppc_get_pc(vcpu);
992b5b29	427	regs->cr = kvmppc_get_cr(vcpu);
c7f38f46 AG	428	regs->ctr = kvmppc_get_ctr(vcpu);
c7f38f46 AG	429	regs->lr = kvmppc_get_lr(vcpu);
992b5b29	430	regs->xer = kvmppc_get_xer(vcpu);
666e7252	431	regs->msr = vcpu->arch.shared->msr;
de7906c3 AG	432	regs->srr0 = vcpu->arch.shared->srr0;
de7906c3 AG	433	regs->srr1 = vcpu->arch.shared->srr1;
2f4cf5e4	434	regs->pid = vcpu->arch.pid;
a73a9599 AG	435	regs->sprg0 = vcpu->arch.shared->sprg0;
	436	regs->sprg1 = vcpu->arch.shared->sprg1;
	437	regs->sprg2 = vcpu->arch.shared->sprg2;
	438	regs->sprg3 = vcpu->arch.shared->sprg3;
b5904972 SW	439	regs->sprg4 = vcpu->arch.shared->sprg4;
	440	regs->sprg5 = vcpu->arch.shared->sprg5;
	441	regs->sprg6 = vcpu->arch.shared->sprg6;
	442	regs->sprg7 = vcpu->arch.shared->sprg7;
2f4cf5e4 AG	443
2f4cf5e4 AG	444	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
8e5b26b5	445	regs->gpr[i] = kvmppc_get_gpr(vcpu, i);
2f4cf5e4 AG	446
	447	return 0;
	448	}
	449
	450	int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu vcpu, struct kvm_regs regs)
	451	{
	452	int i;
	453
c7f38f46	454	kvmppc_set_pc(vcpu, regs->pc);
992b5b29	455	kvmppc_set_cr(vcpu, regs->cr);
c7f38f46 AG	456	kvmppc_set_ctr(vcpu, regs->ctr);
c7f38f46 AG	457	kvmppc_set_lr(vcpu, regs->lr);
992b5b29	458	kvmppc_set_xer(vcpu, regs->xer);
2f4cf5e4	459	kvmppc_set_msr(vcpu, regs->msr);
de7906c3 AG	460	vcpu->arch.shared->srr0 = regs->srr0;
de7906c3 AG	461	vcpu->arch.shared->srr1 = regs->srr1;
a73a9599 AG	462	vcpu->arch.shared->sprg0 = regs->sprg0;
	463	vcpu->arch.shared->sprg1 = regs->sprg1;
	464	vcpu->arch.shared->sprg2 = regs->sprg2;
	465	vcpu->arch.shared->sprg3 = regs->sprg3;
b5904972 SW	466	vcpu->arch.shared->sprg4 = regs->sprg4;
	467	vcpu->arch.shared->sprg5 = regs->sprg5;
	468	vcpu->arch.shared->sprg6 = regs->sprg6;
	469	vcpu->arch.shared->sprg7 = regs->sprg7;
2f4cf5e4	470
8e5b26b5 AG	471	for (i = 0; i < ARRAY_SIZE(regs->gpr); i++)
8e5b26b5 AG	472	kvmppc_set_gpr(vcpu, i, regs->gpr[i]);
2f4cf5e4 AG	473
	474	return 0;
	475	}
	476
2f4cf5e4 AG	477	int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu vcpu, struct kvm_fpu fpu)
	478	{
	479	return -ENOTSUPP;
	480	}
	481
	482	int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu vcpu, struct kvm_fpu fpu)
	483	{
	484	return -ENOTSUPP;
	485	}
	486
a136a8bd PM	487	int kvm_vcpu_ioctl_get_one_reg(struct kvm_vcpu vcpu, struct kvm_one_reg reg)
	488	{
	489	int r;
	490	union kvmppc_one_reg val;
	491	int size;
a8bd19ef	492	long int i;
a136a8bd PM	493
	494	size = one_reg_size(reg->id);
	495	if (size > sizeof(val))
	496	return -EINVAL;
	497
	498	r = kvmppc_get_one_reg(vcpu, reg->id, &val);
	499
	500	if (r == -EINVAL) {
	501	r = 0;
	502	switch (reg->id) {
	503	case KVM_REG_PPC_DAR:
	504	val = get_reg_val(reg->id, vcpu->arch.shared->dar);
	505	break;
	506	case KVM_REG_PPC_DSISR:
	507	val = get_reg_val(reg->id, vcpu->arch.shared->dsisr);
	508	break;
a8bd19ef PM	509	case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
	510	i = reg->id - KVM_REG_PPC_FPR0;
	511	val = get_reg_val(reg->id, vcpu->arch.fpr[i]);
	512	break;
	513	case KVM_REG_PPC_FPSCR:
	514	val = get_reg_val(reg->id, vcpu->arch.fpscr);
	515	break;
	516	#ifdef CONFIG_ALTIVEC
	517	case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
	518	if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
	519	r = -ENXIO;
	520	break;
	521	}
	522	val.vval = vcpu->arch.vr[reg->id - KVM_REG_PPC_VR0];
	523	break;
	524	case KVM_REG_PPC_VSCR:
	525	if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
	526	r = -ENXIO;
	527	break;
	528	}
	529	val = get_reg_val(reg->id, vcpu->arch.vscr.u[3]);
	530	break;
c0867fd5 PM	531	case KVM_REG_PPC_VRSAVE:
	532	val = get_reg_val(reg->id, vcpu->arch.vrsave);
	533	break;
a8bd19ef	534	#endif /* CONFIG_ALTIVEC */
8c32a2ea BB	535	case KVM_REG_PPC_DEBUG_INST: {
	536	u32 opcode = INS_TW;
	537	r = copy_to_user((u32 __user *)(long)reg->addr,
	538	&opcode, sizeof(u32));
	539	break;
	540	}
8b78645c PM	541	#ifdef CONFIG_KVM_XICS
	542	case KVM_REG_PPC_ICP_STATE:
	543	if (!vcpu->arch.icp) {
	544	r = -ENXIO;
	545	break;
	546	}
	547	val = get_reg_val(reg->id, kvmppc_xics_get_icp(vcpu));
	548	break;
	549	#endif /* CONFIG_KVM_XICS */
a136a8bd PM	550	default:
	551	r = -EINVAL;
	552	break;
	553	}
	554	}
	555	if (r)
	556	return r;
	557
	558	if (copy_to_user((char __user *)(unsigned long)reg->addr, &val, size))
	559	r = -EFAULT;
	560
	561	return r;
	562	}
	563
	564	int kvm_vcpu_ioctl_set_one_reg(struct kvm_vcpu vcpu, struct kvm_one_reg reg)
	565	{
	566	int r;
	567	union kvmppc_one_reg val;
	568	int size;
a8bd19ef	569	long int i;
a136a8bd PM	570
	571	size = one_reg_size(reg->id);
	572	if (size > sizeof(val))
	573	return -EINVAL;
	574
	575	if (copy_from_user(&val, (char __user *)(unsigned long)reg->addr, size))
	576	return -EFAULT;
	577
	578	r = kvmppc_set_one_reg(vcpu, reg->id, &val);
	579
	580	if (r == -EINVAL) {
	581	r = 0;
	582	switch (reg->id) {
	583	case KVM_REG_PPC_DAR:
	584	vcpu->arch.shared->dar = set_reg_val(reg->id, val);
	585	break;
	586	case KVM_REG_PPC_DSISR:
	587	vcpu->arch.shared->dsisr = set_reg_val(reg->id, val);
	588	break;
a8bd19ef PM	589	case KVM_REG_PPC_FPR0 ... KVM_REG_PPC_FPR31:
	590	i = reg->id - KVM_REG_PPC_FPR0;
	591	vcpu->arch.fpr[i] = set_reg_val(reg->id, val);
	592	break;
	593	case KVM_REG_PPC_FPSCR:
	594	vcpu->arch.fpscr = set_reg_val(reg->id, val);
	595	break;
	596	#ifdef CONFIG_ALTIVEC
	597	case KVM_REG_PPC_VR0 ... KVM_REG_PPC_VR31:
	598	if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
	599	r = -ENXIO;
	600	break;
	601	}
	602	vcpu->arch.vr[reg->id - KVM_REG_PPC_VR0] = val.vval;
	603	break;
	604	case KVM_REG_PPC_VSCR:
	605	if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
	606	r = -ENXIO;
	607	break;
	608	}
	609	vcpu->arch.vscr.u[3] = set_reg_val(reg->id, val);
	610	break;
c0867fd5 PM	611	case KVM_REG_PPC_VRSAVE:
	612	if (!cpu_has_feature(CPU_FTR_ALTIVEC)) {
	613	r = -ENXIO;
	614	break;
	615	}
	616	vcpu->arch.vrsave = set_reg_val(reg->id, val);
	617	break;
a8bd19ef	618	#endif /* CONFIG_ALTIVEC */
8b78645c PM	619	#ifdef CONFIG_KVM_XICS
	620	case KVM_REG_PPC_ICP_STATE:
	621	if (!vcpu->arch.icp) {
	622	r = -ENXIO;
	623	break;
	624	}
	625	r = kvmppc_xics_set_icp(vcpu,
	626	set_reg_val(reg->id, val));
	627	break;
	628	#endif /* CONFIG_KVM_XICS */
a136a8bd PM	629	default:
	630	r = -EINVAL;
	631	break;
	632	}
	633	}
	634
	635	return r;
	636	}
	637
2f4cf5e4 AG	638	int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
	639	struct kvm_translation *tr)
	640	{
	641	return 0;
	642	}
	643
092d62ee BB	644	int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
	645	struct kvm_guest_debug *dbg)
	646	{
	647	return -EINVAL;
	648	}
	649
dfd4d47e SW	650	void kvmppc_decrementer_func(unsigned long data)
	651	{
	652	struct kvm_vcpu vcpu = (struct kvm_vcpu )data;
	653
	654	kvmppc_core_queue_dec(vcpu);
	655	kvm_vcpu_kick(vcpu);
	656	}