[deliverable/linux.git] / arch / arm / kvm / coproc_a15.c

/*
 * Copyright (C) 2012 - Virtual Open Systems and Columbia University
 * Authors: Rusty Russell <rusty@rustcorp.au>
 *          Christoffer Dall <c.dall@virtualopensystems.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.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 */
#include <linux/kvm_host.h>
#include <asm/cputype.h>
#include <asm/kvm_arm.h>
#include <asm/kvm_host.h>
#include <asm/kvm_emulate.h>
#include <asm/kvm_coproc.h>
#include <linux/init.h>

static void reset_mpidr(struct kvm_vcpu *vcpu, const struct coproc_reg *r)
{
	/*
	 * Compute guest MPIDR:
	 * (Even if we present only one VCPU to the guest on an SMP
	 * host we don't set the U bit in the MPIDR, or vice versa, as
	 * revealing the underlying hardware properties is likely to
	 * be the best choice).
	 */
	vcpu->arch.cp15[c0_MPIDR] = (read_cpuid_mpidr() & ~MPIDR_LEVEL_MASK)
		| (vcpu->vcpu_id & MPIDR_LEVEL_MASK);
}

#include "coproc.h"

/* A15 TRM 4.3.28: RO WI */
static bool access_actlr(struct kvm_vcpu *vcpu,
			 const struct coproc_params *p,
			 const struct coproc_reg *r)
{
	if (p->is_write)
		return ignore_write(vcpu, p);

	*vcpu_reg(vcpu, p->Rt1) = vcpu->arch.cp15[c1_ACTLR];
	return true;
}

/* A15 TRM 4.3.60: R/O. */
static bool access_cbar(struct kvm_vcpu *vcpu,
			const struct coproc_params *p,
			const struct coproc_reg *r)
{
	if (p->is_write)
		return write_to_read_only(vcpu, p);
	return read_zero(vcpu, p);
}

/* A15 TRM 4.3.48: R/O WI. */
static bool access_l2ctlr(struct kvm_vcpu *vcpu,
			  const struct coproc_params *p,
			  const struct coproc_reg *r)
{
	if (p->is_write)
		return ignore_write(vcpu, p);

	*vcpu_reg(vcpu, p->Rt1) = vcpu->arch.cp15[c9_L2CTLR];
	return true;
}

static void reset_l2ctlr(struct kvm_vcpu *vcpu, const struct coproc_reg *r)
{
	u32 l2ctlr, ncores;

	asm volatile("mrc p15, 1, %0, c9, c0, 2\n" : "=r" (l2ctlr));
	l2ctlr &= ~(3 << 24);
	ncores = atomic_read(&vcpu->kvm->online_vcpus) - 1;
	l2ctlr |= (ncores & 3) << 24;

	vcpu->arch.cp15[c9_L2CTLR] = l2ctlr;
}

static void reset_actlr(struct kvm_vcpu *vcpu, const struct coproc_reg *r)
{
	u32 actlr;

	/* ACTLR contains SMP bit: make sure you create all cpus first! */
	asm volatile("mrc p15, 0, %0, c1, c0, 1\n" : "=r" (actlr));
	/* Make the SMP bit consistent with the guest configuration */
	if (atomic_read(&vcpu->kvm->online_vcpus) > 1)
		actlr |= 1U << 6;
	else
		actlr &= ~(1U << 6);

	vcpu->arch.cp15[c1_ACTLR] = actlr;
}

/* A15 TRM 4.3.49: R/O WI (even if NSACR.NS_L2ERR, a write of 1 is ignored). */
static bool access_l2ectlr(struct kvm_vcpu *vcpu,
			   const struct coproc_params *p,
			   const struct coproc_reg *r)
{
	if (p->is_write)
		return ignore_write(vcpu, p);

	*vcpu_reg(vcpu, p->Rt1) = 0;
	return true;
}

/*
 * A15-specific CP15 registers.
 * Important: Must be sorted ascending by CRn, CRM, Op1, Op2
 */
static const struct coproc_reg a15_regs[] = {
	/* MPIDR: we use VMPIDR for guest access. */
	{ CRn( 0), CRm( 0), Op1( 0), Op2( 5), is32,
			NULL, reset_mpidr, c0_MPIDR },

	/* SCTLR: swapped by interrupt.S. */
	{ CRn( 1), CRm( 0), Op1( 0), Op2( 0), is32,
			NULL, reset_val, c1_SCTLR, 0x00C50078 },
	/* ACTLR: trapped by HCR.TAC bit. */
	{ CRn( 1), CRm( 0), Op1( 0), Op2( 1), is32,
			access_actlr, reset_actlr, c1_ACTLR },
	/* CPACR: swapped by interrupt.S. */
	{ CRn( 1), CRm( 0), Op1( 0), Op2( 2), is32,
			NULL, reset_val, c1_CPACR, 0x00000000 },

	/*
	 * L2CTLR access (guest wants to know #CPUs).
	 */
	{ CRn( 9), CRm( 0), Op1( 1), Op2( 2), is32,
			access_l2ctlr, reset_l2ctlr, c9_L2CTLR },
	{ CRn( 9), CRm( 0), Op1( 1), Op2( 3), is32, access_l2ectlr},

	/* The Configuration Base Address Register. */
	{ CRn(15), CRm( 0), Op1( 4), Op2( 0), is32, access_cbar},
};

static struct kvm_coproc_target_table a15_target_table = {
	.target = KVM_ARM_TARGET_CORTEX_A15,
	.table = a15_regs,
	.num = ARRAY_SIZE(a15_regs),
};

static int __init coproc_a15_init(void)
{
	unsigned int i;

	for (i = 1; i < ARRAY_SIZE(a15_regs); i++)
		BUG_ON(cmp_reg(&a15_regs[i-1],
			       &a15_regs[i]) >= 0);

	kvm_register_target_coproc_table(&a15_target_table);
	return 0;
}
late_initcall(coproc_a15_init);
Commit	Line	Data
5b3e5e5b CD	1	/*
	2	* Copyright (C) 2012 - Virtual Open Systems and Columbia University
	3	* Authors: Rusty Russell <rusty@rustcorp.au>
	4	* Christoffer Dall <c.dall@virtualopensystems.com>
	5	*
	6	* This program is free software; you can redistribute it and/or modify
	7	* it under the terms of the GNU General Public License, version 2, as
	8	* published by the Free Software Foundation.
	9	*
	10	* This program is distributed in the hope that it will be useful,
	11	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	12	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	13	* GNU General Public License for more details.
	14	*
	15	* You should have received a copy of the GNU General Public License
	16	* along with this program; if not, write to the Free Software
	17	* Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
	18	*/
	19	#include <linux/kvm_host.h>
	20	#include <asm/cputype.h>
	21	#include <asm/kvm_arm.h>
	22	#include <asm/kvm_host.h>
	23	#include <asm/kvm_emulate.h>
	24	#include <asm/kvm_coproc.h>
	25	#include <linux/init.h>
	26
	27	static void reset_mpidr(struct kvm_vcpu vcpu, const struct coproc_reg r)
	28	{
	29	/*
	30	* Compute guest MPIDR:
	31	* (Even if we present only one VCPU to the guest on an SMP
	32	* host we don't set the U bit in the MPIDR, or vice versa, as
	33	* revealing the underlying hardware properties is likely to
	34	* be the best choice).
	35	*/
	36	vcpu->arch.cp15[c0_MPIDR] = (read_cpuid_mpidr() & ~MPIDR_LEVEL_MASK)
	37	\| (vcpu->vcpu_id & MPIDR_LEVEL_MASK);
	38	}
	39
	40	#include "coproc.h"
	41
	42	/* A15 TRM 4.3.28: RO WI */
	43	static bool access_actlr(struct kvm_vcpu *vcpu,
	44	const struct coproc_params *p,
	45	const struct coproc_reg *r)
	46	{
	47	if (p->is_write)
	48	return ignore_write(vcpu, p);
	49
	50	*vcpu_reg(vcpu, p->Rt1) = vcpu->arch.cp15[c1_ACTLR];
	51	return true;
	52	}
	53
	54	/* A15 TRM 4.3.60: R/O. */
	55	static bool access_cbar(struct kvm_vcpu *vcpu,
	56	const struct coproc_params *p,
	57	const struct coproc_reg *r)
	58	{
	59	if (p->is_write)
	60	return write_to_read_only(vcpu, p);
	61	return read_zero(vcpu, p);
	62	}
	63
	64	/* A15 TRM 4.3.48: R/O WI. */
65	static bool access_l2ctlr(struct kvm_vcpu *vcpu,
66	const struct coproc_params *p,
67	const struct coproc_reg *r)
68	{
69	if (p->is_write)
70	return ignore_write(vcpu, p);
71
72	*vcpu_reg(vcpu, p->Rt1) = vcpu->arch.cp15[c9_L2CTLR];
73	return true;
74	}
75
76	static void reset_l2ctlr(struct kvm_vcpu vcpu, const struct coproc_reg r)
77	{
78	u32 l2ctlr, ncores;
79
80	asm volatile("mrc p15, 1, %0, c9, c0, 2\n" : "=r" (l2ctlr));
81	l2ctlr &= ~(3 << 24);
82	ncores = atomic_read(&vcpu->kvm->online_vcpus) - 1;
83	l2ctlr \|= (ncores & 3) << 24;
84
85	vcpu->arch.cp15[c9_L2CTLR] = l2ctlr;
86	}
87
88	static void reset_actlr(struct kvm_vcpu vcpu, const struct coproc_reg r)
89	{
90	u32 actlr;
91
92	/* ACTLR contains SMP bit: make sure you create all cpus first! */
93	asm volatile("mrc p15, 0, %0, c1, c0, 1\n" : "=r" (actlr));
94	/* Make the SMP bit consistent with the guest configuration */
95	if (atomic_read(&vcpu->kvm->online_vcpus) > 1)
96	actlr \|= 1U << 6;
97	else
98	actlr &= ~(1U << 6);
99
100	vcpu->arch.cp15[c1_ACTLR] = actlr;
101	}
102
103	/* A15 TRM 4.3.49: R/O WI (even if NSACR.NS_L2ERR, a write of 1 is ignored). */
104	static bool access_l2ectlr(struct kvm_vcpu *vcpu,
105	const struct coproc_params *p,
106	const struct coproc_reg *r)
107	{
108	if (p->is_write)
109	return ignore_write(vcpu, p);
110
111	*vcpu_reg(vcpu, p->Rt1) = 0;
112	return true;
113	}
114
115	/*
116	* A15-specific CP15 registers.
117	* Important: Must be sorted ascending by CRn, CRM, Op1, Op2
118	*/
119	static const struct coproc_reg a15_regs[] = {
120	/* MPIDR: we use VMPIDR for guest access. */
121	{ CRn( 0), CRm( 0), Op1( 0), Op2( 5), is32,
122	NULL, reset_mpidr, c0_MPIDR },
123
124	/* SCTLR: swapped by interrupt.S. */
125	{ CRn( 1), CRm( 0), Op1( 0), Op2( 0), is32,
126	NULL, reset_val, c1_SCTLR, 0x00C50078 },
127	/* ACTLR: trapped by HCR.TAC bit. */
128	{ CRn( 1), CRm( 0), Op1( 0), Op2( 1), is32,
129	access_actlr, reset_actlr, c1_ACTLR },
130	/* CPACR: swapped by interrupt.S. */
131	{ CRn( 1), CRm( 0), Op1( 0), Op2( 2), is32,
132	NULL, reset_val, c1_CPACR, 0x00000000 },
133
134	/*
135	* L2CTLR access (guest wants to know #CPUs).
136	*/
137	{ CRn( 9), CRm( 0), Op1( 1), Op2( 2), is32,
138	access_l2ctlr, reset_l2ctlr, c9_L2CTLR },
139	{ CRn( 9), CRm( 0), Op1( 1), Op2( 3), is32, access_l2ectlr},
140
141	/* The Configuration Base Address Register. */
142	{ CRn(15), CRm( 0), Op1( 4), Op2( 0), is32, access_cbar},
143	};
144
145	static struct kvm_coproc_target_table a15_target_table = {
146	.target = KVM_ARM_TARGET_CORTEX_A15,
147	.table = a15_regs,
148	.num = ARRAY_SIZE(a15_regs),
149	};
150
151	static int __init coproc_a15_init(void)
152	{
153	unsigned int i;
154
155	for (i = 1; i < ARRAY_SIZE(a15_regs); i++)
156	BUG_ON(cmp_reg(&a15_regs[i-1],
157	&a15_regs[i]) >= 0);
158
159	kvm_register_target_coproc_table(&a15_target_table);
160	return 0;
161	}
162	late_initcall(coproc_a15_init);