Loading...
1/*
2 * Copyright (C) 2012 - Virtual Open Systems and Columbia University
3 * Author: Christoffer Dall <c.dall@virtualopensystems.com>
4 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License, version 2, as
7 * published by the Free Software Foundation.
8 *
9 * This program is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
12 * GNU General Public License for more details.
13 *
14 * You should have received a copy of the GNU General Public License
15 * along with this program; if not, write to the Free Software
16 * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
17 */
18
19#include <linux/errno.h>
20#include <linux/err.h>
21#include <linux/kvm_host.h>
22#include <linux/module.h>
23#include <linux/vmalloc.h>
24#include <linux/fs.h>
25#include <kvm/arm_psci.h>
26#include <asm/cputype.h>
27#include <linux/uaccess.h>
28#include <asm/kvm.h>
29#include <asm/kvm_emulate.h>
30#include <asm/kvm_coproc.h>
31
32#define VM_STAT(x) { #x, offsetof(struct kvm, stat.x), KVM_STAT_VM }
33#define VCPU_STAT(x) { #x, offsetof(struct kvm_vcpu, stat.x), KVM_STAT_VCPU }
34
35struct kvm_stats_debugfs_item debugfs_entries[] = {
36 VCPU_STAT(hvc_exit_stat),
37 VCPU_STAT(wfe_exit_stat),
38 VCPU_STAT(wfi_exit_stat),
39 VCPU_STAT(mmio_exit_user),
40 VCPU_STAT(mmio_exit_kernel),
41 VCPU_STAT(exits),
42 { NULL }
43};
44
45int kvm_arch_vcpu_setup(struct kvm_vcpu *vcpu)
46{
47 return 0;
48}
49
50static u64 core_reg_offset_from_id(u64 id)
51{
52 return id & ~(KVM_REG_ARCH_MASK | KVM_REG_SIZE_MASK | KVM_REG_ARM_CORE);
53}
54
55static int get_core_reg(struct kvm_vcpu *vcpu, const struct kvm_one_reg *reg)
56{
57 u32 __user *uaddr = (u32 __user *)(long)reg->addr;
58 struct kvm_regs *regs = &vcpu->arch.ctxt.gp_regs;
59 u64 off;
60
61 if (KVM_REG_SIZE(reg->id) != 4)
62 return -ENOENT;
63
64 /* Our ID is an index into the kvm_regs struct. */
65 off = core_reg_offset_from_id(reg->id);
66 if (off >= sizeof(*regs) / KVM_REG_SIZE(reg->id))
67 return -ENOENT;
68
69 return put_user(((u32 *)regs)[off], uaddr);
70}
71
72static int set_core_reg(struct kvm_vcpu *vcpu, const struct kvm_one_reg *reg)
73{
74 u32 __user *uaddr = (u32 __user *)(long)reg->addr;
75 struct kvm_regs *regs = &vcpu->arch.ctxt.gp_regs;
76 u64 off, val;
77
78 if (KVM_REG_SIZE(reg->id) != 4)
79 return -ENOENT;
80
81 /* Our ID is an index into the kvm_regs struct. */
82 off = core_reg_offset_from_id(reg->id);
83 if (off >= sizeof(*regs) / KVM_REG_SIZE(reg->id))
84 return -ENOENT;
85
86 if (get_user(val, uaddr) != 0)
87 return -EFAULT;
88
89 if (off == KVM_REG_ARM_CORE_REG(usr_regs.ARM_cpsr)) {
90 unsigned long mode = val & MODE_MASK;
91 switch (mode) {
92 case USR_MODE:
93 case FIQ_MODE:
94 case IRQ_MODE:
95 case SVC_MODE:
96 case ABT_MODE:
97 case UND_MODE:
98 break;
99 default:
100 return -EINVAL;
101 }
102 }
103
104 ((u32 *)regs)[off] = val;
105 return 0;
106}
107
108int kvm_arch_vcpu_ioctl_get_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
109{
110 return -EINVAL;
111}
112
113int kvm_arch_vcpu_ioctl_set_regs(struct kvm_vcpu *vcpu, struct kvm_regs *regs)
114{
115 return -EINVAL;
116}
117
118#define NUM_TIMER_REGS 3
119
120static bool is_timer_reg(u64 index)
121{
122 switch (index) {
123 case KVM_REG_ARM_TIMER_CTL:
124 case KVM_REG_ARM_TIMER_CNT:
125 case KVM_REG_ARM_TIMER_CVAL:
126 return true;
127 }
128 return false;
129}
130
131static int copy_timer_indices(struct kvm_vcpu *vcpu, u64 __user *uindices)
132{
133 if (put_user(KVM_REG_ARM_TIMER_CTL, uindices))
134 return -EFAULT;
135 uindices++;
136 if (put_user(KVM_REG_ARM_TIMER_CNT, uindices))
137 return -EFAULT;
138 uindices++;
139 if (put_user(KVM_REG_ARM_TIMER_CVAL, uindices))
140 return -EFAULT;
141
142 return 0;
143}
144
145static int set_timer_reg(struct kvm_vcpu *vcpu, const struct kvm_one_reg *reg)
146{
147 void __user *uaddr = (void __user *)(long)reg->addr;
148 u64 val;
149 int ret;
150
151 ret = copy_from_user(&val, uaddr, KVM_REG_SIZE(reg->id));
152 if (ret != 0)
153 return -EFAULT;
154
155 return kvm_arm_timer_set_reg(vcpu, reg->id, val);
156}
157
158static int get_timer_reg(struct kvm_vcpu *vcpu, const struct kvm_one_reg *reg)
159{
160 void __user *uaddr = (void __user *)(long)reg->addr;
161 u64 val;
162
163 val = kvm_arm_timer_get_reg(vcpu, reg->id);
164 return copy_to_user(uaddr, &val, KVM_REG_SIZE(reg->id)) ? -EFAULT : 0;
165}
166
167static unsigned long num_core_regs(void)
168{
169 return sizeof(struct kvm_regs) / sizeof(u32);
170}
171
172/**
173 * kvm_arm_num_regs - how many registers do we present via KVM_GET_ONE_REG
174 *
175 * This is for all registers.
176 */
177unsigned long kvm_arm_num_regs(struct kvm_vcpu *vcpu)
178{
179 return num_core_regs() + kvm_arm_num_coproc_regs(vcpu)
180 + kvm_arm_get_fw_num_regs(vcpu)
181 + NUM_TIMER_REGS;
182}
183
184/**
185 * kvm_arm_copy_reg_indices - get indices of all registers.
186 *
187 * We do core registers right here, then we append coproc regs.
188 */
189int kvm_arm_copy_reg_indices(struct kvm_vcpu *vcpu, u64 __user *uindices)
190{
191 unsigned int i;
192 const u64 core_reg = KVM_REG_ARM | KVM_REG_SIZE_U32 | KVM_REG_ARM_CORE;
193 int ret;
194
195 for (i = 0; i < sizeof(struct kvm_regs)/sizeof(u32); i++) {
196 if (put_user(core_reg | i, uindices))
197 return -EFAULT;
198 uindices++;
199 }
200
201 ret = kvm_arm_copy_fw_reg_indices(vcpu, uindices);
202 if (ret)
203 return ret;
204 uindices += kvm_arm_get_fw_num_regs(vcpu);
205
206 ret = copy_timer_indices(vcpu, uindices);
207 if (ret)
208 return ret;
209 uindices += NUM_TIMER_REGS;
210
211 return kvm_arm_copy_coproc_indices(vcpu, uindices);
212}
213
214int kvm_arm_get_reg(struct kvm_vcpu *vcpu, const struct kvm_one_reg *reg)
215{
216 /* We currently use nothing arch-specific in upper 32 bits */
217 if ((reg->id & ~KVM_REG_SIZE_MASK) >> 32 != KVM_REG_ARM >> 32)
218 return -EINVAL;
219
220 /* Register group 16 means we want a core register. */
221 if ((reg->id & KVM_REG_ARM_COPROC_MASK) == KVM_REG_ARM_CORE)
222 return get_core_reg(vcpu, reg);
223
224 if ((reg->id & KVM_REG_ARM_COPROC_MASK) == KVM_REG_ARM_FW)
225 return kvm_arm_get_fw_reg(vcpu, reg);
226
227 if (is_timer_reg(reg->id))
228 return get_timer_reg(vcpu, reg);
229
230 return kvm_arm_coproc_get_reg(vcpu, reg);
231}
232
233int kvm_arm_set_reg(struct kvm_vcpu *vcpu, const struct kvm_one_reg *reg)
234{
235 /* We currently use nothing arch-specific in upper 32 bits */
236 if ((reg->id & ~KVM_REG_SIZE_MASK) >> 32 != KVM_REG_ARM >> 32)
237 return -EINVAL;
238
239 /* Register group 16 means we set a core register. */
240 if ((reg->id & KVM_REG_ARM_COPROC_MASK) == KVM_REG_ARM_CORE)
241 return set_core_reg(vcpu, reg);
242
243 if ((reg->id & KVM_REG_ARM_COPROC_MASK) == KVM_REG_ARM_FW)
244 return kvm_arm_set_fw_reg(vcpu, reg);
245
246 if (is_timer_reg(reg->id))
247 return set_timer_reg(vcpu, reg);
248
249 return kvm_arm_coproc_set_reg(vcpu, reg);
250}
251
252int kvm_arch_vcpu_ioctl_get_sregs(struct kvm_vcpu *vcpu,
253 struct kvm_sregs *sregs)
254{
255 return -EINVAL;
256}
257
258int kvm_arch_vcpu_ioctl_set_sregs(struct kvm_vcpu *vcpu,
259 struct kvm_sregs *sregs)
260{
261 return -EINVAL;
262}
263
264int __attribute_const__ kvm_target_cpu(void)
265{
266 switch (read_cpuid_part()) {
267 case ARM_CPU_PART_CORTEX_A7:
268 return KVM_ARM_TARGET_CORTEX_A7;
269 case ARM_CPU_PART_CORTEX_A15:
270 return KVM_ARM_TARGET_CORTEX_A15;
271 default:
272 return -EINVAL;
273 }
274}
275
276int kvm_vcpu_preferred_target(struct kvm_vcpu_init *init)
277{
278 int target = kvm_target_cpu();
279
280 if (target < 0)
281 return -ENODEV;
282
283 memset(init, 0, sizeof(*init));
284
285 /*
286 * For now, we don't return any features.
287 * In future, we might use features to return target
288 * specific features available for the preferred
289 * target type.
290 */
291 init->target = (__u32)target;
292
293 return 0;
294}
295
296int kvm_arch_vcpu_ioctl_get_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
297{
298 return -EINVAL;
299}
300
301int kvm_arch_vcpu_ioctl_set_fpu(struct kvm_vcpu *vcpu, struct kvm_fpu *fpu)
302{
303 return -EINVAL;
304}
305
306int kvm_arch_vcpu_ioctl_translate(struct kvm_vcpu *vcpu,
307 struct kvm_translation *tr)
308{
309 return -EINVAL;
310}
311
312int kvm_arch_vcpu_ioctl_set_guest_debug(struct kvm_vcpu *vcpu,
313 struct kvm_guest_debug *dbg)
314{
315 return -EINVAL;
316}
317
318int kvm_arm_vcpu_arch_set_attr(struct kvm_vcpu *vcpu,
319 struct kvm_device_attr *attr)
320{
321 int ret;
322
323 switch (attr->group) {
324 case KVM_ARM_VCPU_TIMER_CTRL:
325 ret = kvm_arm_timer_set_attr(vcpu, attr);
326 break;
327 default:
328 ret = -ENXIO;
329 break;
330 }
331
332 return ret;
333}
334
335int kvm_arm_vcpu_arch_get_attr(struct kvm_vcpu *vcpu,
336 struct kvm_device_attr *attr)
337{
338 int ret;
339
340 switch (attr->group) {
341 case KVM_ARM_VCPU_TIMER_CTRL:
342 ret = kvm_arm_timer_get_attr(vcpu, attr);
343 break;
344 default:
345 ret = -ENXIO;
346 break;
347 }
348
349 return ret;
350}
351
352int kvm_arm_vcpu_arch_has_attr(struct kvm_vcpu *vcpu,
353 struct kvm_device_attr *attr)
354{
355 int ret;
356
357 switch (attr->group) {
358 case KVM_ARM_VCPU_TIMER_CTRL:
359 ret = kvm_arm_timer_has_attr(vcpu, attr);
360 break;
361 default:
362 ret = -ENXIO;
363 break;
364 }
365
366 return ret;
367}