Statistics
| Branch: | Revision:

root / kvm-all.c @ 8b7968f7

History | View | Annotate | Download (32.3 kB)

1 05330448 aliguori
/*
2 05330448 aliguori
 * QEMU KVM support
3 05330448 aliguori
 *
4 05330448 aliguori
 * Copyright IBM, Corp. 2008
5 5832d1f2 aliguori
 *           Red Hat, Inc. 2008
6 05330448 aliguori
 *
7 05330448 aliguori
 * Authors:
8 05330448 aliguori
 *  Anthony Liguori   <aliguori@us.ibm.com>
9 5832d1f2 aliguori
 *  Glauber Costa     <gcosta@redhat.com>
10 05330448 aliguori
 *
11 05330448 aliguori
 * This work is licensed under the terms of the GNU GPL, version 2 or later.
12 05330448 aliguori
 * See the COPYING file in the top-level directory.
13 05330448 aliguori
 *
14 05330448 aliguori
 */
15 05330448 aliguori
16 05330448 aliguori
#include <sys/types.h>
17 05330448 aliguori
#include <sys/ioctl.h>
18 05330448 aliguori
#include <sys/mman.h>
19 984b5181 aliguori
#include <stdarg.h>
20 05330448 aliguori
21 05330448 aliguori
#include <linux/kvm.h>
22 05330448 aliguori
23 05330448 aliguori
#include "qemu-common.h"
24 85199474 Marcelo Tosatti
#include "qemu-barrier.h"
25 05330448 aliguori
#include "sysemu.h"
26 d33a1810 Jan Kiszka
#include "hw/hw.h"
27 e22a25c9 aliguori
#include "gdbstub.h"
28 05330448 aliguori
#include "kvm.h"
29 8369e01c Marcelo Tosatti
#include "bswap.h"
30 05330448 aliguori
31 f65ed4c1 aliguori
/* KVM uses PAGE_SIZE in it's definition of COALESCED_MMIO_MAX */
32 f65ed4c1 aliguori
#define PAGE_SIZE TARGET_PAGE_SIZE
33 f65ed4c1 aliguori
34 05330448 aliguori
//#define DEBUG_KVM
35 05330448 aliguori
36 05330448 aliguori
#ifdef DEBUG_KVM
37 8c0d577e Blue Swirl
#define DPRINTF(fmt, ...) \
38 05330448 aliguori
    do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
39 05330448 aliguori
#else
40 8c0d577e Blue Swirl
#define DPRINTF(fmt, ...) \
41 05330448 aliguori
    do { } while (0)
42 05330448 aliguori
#endif
43 05330448 aliguori
44 34fc643f aliguori
typedef struct KVMSlot
45 34fc643f aliguori
{
46 c227f099 Anthony Liguori
    target_phys_addr_t start_addr;
47 c227f099 Anthony Liguori
    ram_addr_t memory_size;
48 c227f099 Anthony Liguori
    ram_addr_t phys_offset;
49 34fc643f aliguori
    int slot;
50 34fc643f aliguori
    int flags;
51 34fc643f aliguori
} KVMSlot;
52 05330448 aliguori
53 5832d1f2 aliguori
typedef struct kvm_dirty_log KVMDirtyLog;
54 5832d1f2 aliguori
55 05330448 aliguori
struct KVMState
56 05330448 aliguori
{
57 05330448 aliguori
    KVMSlot slots[32];
58 05330448 aliguori
    int fd;
59 05330448 aliguori
    int vmfd;
60 f65ed4c1 aliguori
    int coalesced_mmio;
61 62a2744c Sheng Yang
#ifdef KVM_CAP_COALESCED_MMIO
62 62a2744c Sheng Yang
    struct kvm_coalesced_mmio_ring *coalesced_mmio_ring;
63 62a2744c Sheng Yang
#endif
64 e69917e2 Jan Kiszka
    int broken_set_mem_region;
65 4495d6a7 Jan Kiszka
    int migration_log;
66 a0fb002c Jan Kiszka
    int vcpu_events;
67 b0b1d690 Jan Kiszka
    int robust_singlestep;
68 ff44f1a3 Jan Kiszka
    int debugregs;
69 e22a25c9 aliguori
#ifdef KVM_CAP_SET_GUEST_DEBUG
70 e22a25c9 aliguori
    struct kvm_sw_breakpoint_head kvm_sw_breakpoints;
71 e22a25c9 aliguori
#endif
72 6f725c13 Glauber Costa
    int irqchip_in_kernel;
73 6f725c13 Glauber Costa
    int pit_in_kernel;
74 f1665b21 Sheng Yang
    int xsave, xcrs;
75 05330448 aliguori
};
76 05330448 aliguori
77 05330448 aliguori
static KVMState *kvm_state;
78 05330448 aliguori
79 05330448 aliguori
static KVMSlot *kvm_alloc_slot(KVMState *s)
80 05330448 aliguori
{
81 05330448 aliguori
    int i;
82 05330448 aliguori
83 05330448 aliguori
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
84 62d60e8c aliguori
        /* KVM private memory slots */
85 62d60e8c aliguori
        if (i >= 8 && i < 12)
86 62d60e8c aliguori
            continue;
87 05330448 aliguori
        if (s->slots[i].memory_size == 0)
88 05330448 aliguori
            return &s->slots[i];
89 05330448 aliguori
    }
90 05330448 aliguori
91 d3f8d37f aliguori
    fprintf(stderr, "%s: no free slot available\n", __func__);
92 d3f8d37f aliguori
    abort();
93 d3f8d37f aliguori
}
94 d3f8d37f aliguori
95 d3f8d37f aliguori
static KVMSlot *kvm_lookup_matching_slot(KVMState *s,
96 c227f099 Anthony Liguori
                                         target_phys_addr_t start_addr,
97 c227f099 Anthony Liguori
                                         target_phys_addr_t end_addr)
98 d3f8d37f aliguori
{
99 d3f8d37f aliguori
    int i;
100 d3f8d37f aliguori
101 d3f8d37f aliguori
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
102 d3f8d37f aliguori
        KVMSlot *mem = &s->slots[i];
103 d3f8d37f aliguori
104 d3f8d37f aliguori
        if (start_addr == mem->start_addr &&
105 d3f8d37f aliguori
            end_addr == mem->start_addr + mem->memory_size) {
106 d3f8d37f aliguori
            return mem;
107 d3f8d37f aliguori
        }
108 d3f8d37f aliguori
    }
109 d3f8d37f aliguori
110 05330448 aliguori
    return NULL;
111 05330448 aliguori
}
112 05330448 aliguori
113 6152e2ae aliguori
/*
114 6152e2ae aliguori
 * Find overlapping slot with lowest start address
115 6152e2ae aliguori
 */
116 6152e2ae aliguori
static KVMSlot *kvm_lookup_overlapping_slot(KVMState *s,
117 c227f099 Anthony Liguori
                                            target_phys_addr_t start_addr,
118 c227f099 Anthony Liguori
                                            target_phys_addr_t end_addr)
119 05330448 aliguori
{
120 6152e2ae aliguori
    KVMSlot *found = NULL;
121 05330448 aliguori
    int i;
122 05330448 aliguori
123 05330448 aliguori
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
124 05330448 aliguori
        KVMSlot *mem = &s->slots[i];
125 05330448 aliguori
126 6152e2ae aliguori
        if (mem->memory_size == 0 ||
127 6152e2ae aliguori
            (found && found->start_addr < mem->start_addr)) {
128 6152e2ae aliguori
            continue;
129 6152e2ae aliguori
        }
130 6152e2ae aliguori
131 6152e2ae aliguori
        if (end_addr > mem->start_addr &&
132 6152e2ae aliguori
            start_addr < mem->start_addr + mem->memory_size) {
133 6152e2ae aliguori
            found = mem;
134 6152e2ae aliguori
        }
135 05330448 aliguori
    }
136 05330448 aliguori
137 6152e2ae aliguori
    return found;
138 05330448 aliguori
}
139 05330448 aliguori
140 5832d1f2 aliguori
static int kvm_set_user_memory_region(KVMState *s, KVMSlot *slot)
141 5832d1f2 aliguori
{
142 5832d1f2 aliguori
    struct kvm_userspace_memory_region mem;
143 5832d1f2 aliguori
144 5832d1f2 aliguori
    mem.slot = slot->slot;
145 5832d1f2 aliguori
    mem.guest_phys_addr = slot->start_addr;
146 5832d1f2 aliguori
    mem.memory_size = slot->memory_size;
147 5579c7f3 pbrook
    mem.userspace_addr = (unsigned long)qemu_get_ram_ptr(slot->phys_offset);
148 5832d1f2 aliguori
    mem.flags = slot->flags;
149 4495d6a7 Jan Kiszka
    if (s->migration_log) {
150 4495d6a7 Jan Kiszka
        mem.flags |= KVM_MEM_LOG_DIRTY_PAGES;
151 4495d6a7 Jan Kiszka
    }
152 5832d1f2 aliguori
    return kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
153 5832d1f2 aliguori
}
154 5832d1f2 aliguori
155 8d2ba1fb Jan Kiszka
static void kvm_reset_vcpu(void *opaque)
156 8d2ba1fb Jan Kiszka
{
157 8d2ba1fb Jan Kiszka
    CPUState *env = opaque;
158 8d2ba1fb Jan Kiszka
159 caa5af0f Jan Kiszka
    kvm_arch_reset_vcpu(env);
160 8d2ba1fb Jan Kiszka
}
161 5832d1f2 aliguori
162 6f725c13 Glauber Costa
int kvm_irqchip_in_kernel(void)
163 6f725c13 Glauber Costa
{
164 6f725c13 Glauber Costa
    return kvm_state->irqchip_in_kernel;
165 6f725c13 Glauber Costa
}
166 6f725c13 Glauber Costa
167 6f725c13 Glauber Costa
int kvm_pit_in_kernel(void)
168 6f725c13 Glauber Costa
{
169 6f725c13 Glauber Costa
    return kvm_state->pit_in_kernel;
170 6f725c13 Glauber Costa
}
171 6f725c13 Glauber Costa
172 6f725c13 Glauber Costa
173 05330448 aliguori
int kvm_init_vcpu(CPUState *env)
174 05330448 aliguori
{
175 05330448 aliguori
    KVMState *s = kvm_state;
176 05330448 aliguori
    long mmap_size;
177 05330448 aliguori
    int ret;
178 05330448 aliguori
179 8c0d577e Blue Swirl
    DPRINTF("kvm_init_vcpu\n");
180 05330448 aliguori
181 984b5181 aliguori
    ret = kvm_vm_ioctl(s, KVM_CREATE_VCPU, env->cpu_index);
182 05330448 aliguori
    if (ret < 0) {
183 8c0d577e Blue Swirl
        DPRINTF("kvm_create_vcpu failed\n");
184 05330448 aliguori
        goto err;
185 05330448 aliguori
    }
186 05330448 aliguori
187 05330448 aliguori
    env->kvm_fd = ret;
188 05330448 aliguori
    env->kvm_state = s;
189 05330448 aliguori
190 05330448 aliguori
    mmap_size = kvm_ioctl(s, KVM_GET_VCPU_MMAP_SIZE, 0);
191 05330448 aliguori
    if (mmap_size < 0) {
192 8c0d577e Blue Swirl
        DPRINTF("KVM_GET_VCPU_MMAP_SIZE failed\n");
193 05330448 aliguori
        goto err;
194 05330448 aliguori
    }
195 05330448 aliguori
196 05330448 aliguori
    env->kvm_run = mmap(NULL, mmap_size, PROT_READ | PROT_WRITE, MAP_SHARED,
197 05330448 aliguori
                        env->kvm_fd, 0);
198 05330448 aliguori
    if (env->kvm_run == MAP_FAILED) {
199 05330448 aliguori
        ret = -errno;
200 8c0d577e Blue Swirl
        DPRINTF("mmap'ing vcpu state failed\n");
201 05330448 aliguori
        goto err;
202 05330448 aliguori
    }
203 05330448 aliguori
204 62a2744c Sheng Yang
#ifdef KVM_CAP_COALESCED_MMIO
205 62a2744c Sheng Yang
    if (s->coalesced_mmio && !s->coalesced_mmio_ring)
206 62a2744c Sheng Yang
        s->coalesced_mmio_ring = (void *) env->kvm_run +
207 62a2744c Sheng Yang
                s->coalesced_mmio * PAGE_SIZE;
208 62a2744c Sheng Yang
#endif
209 62a2744c Sheng Yang
210 05330448 aliguori
    ret = kvm_arch_init_vcpu(env);
211 8d2ba1fb Jan Kiszka
    if (ret == 0) {
212 a08d4367 Jan Kiszka
        qemu_register_reset(kvm_reset_vcpu, env);
213 caa5af0f Jan Kiszka
        kvm_arch_reset_vcpu(env);
214 8d2ba1fb Jan Kiszka
    }
215 05330448 aliguori
err:
216 05330448 aliguori
    return ret;
217 05330448 aliguori
}
218 05330448 aliguori
219 5832d1f2 aliguori
/*
220 5832d1f2 aliguori
 * dirty pages logging control
221 5832d1f2 aliguori
 */
222 c227f099 Anthony Liguori
static int kvm_dirty_pages_log_change(target_phys_addr_t phys_addr,
223 c227f099 Anthony Liguori
                                      ram_addr_t size, int flags, int mask)
224 5832d1f2 aliguori
{
225 5832d1f2 aliguori
    KVMState *s = kvm_state;
226 d3f8d37f aliguori
    KVMSlot *mem = kvm_lookup_matching_slot(s, phys_addr, phys_addr + size);
227 4495d6a7 Jan Kiszka
    int old_flags;
228 4495d6a7 Jan Kiszka
229 5832d1f2 aliguori
    if (mem == NULL)  {
230 d3f8d37f aliguori
            fprintf(stderr, "BUG: %s: invalid parameters " TARGET_FMT_plx "-"
231 d3f8d37f aliguori
                    TARGET_FMT_plx "\n", __func__, phys_addr,
232 c227f099 Anthony Liguori
                    (target_phys_addr_t)(phys_addr + size - 1));
233 5832d1f2 aliguori
            return -EINVAL;
234 5832d1f2 aliguori
    }
235 5832d1f2 aliguori
236 4495d6a7 Jan Kiszka
    old_flags = mem->flags;
237 5832d1f2 aliguori
238 4495d6a7 Jan Kiszka
    flags = (mem->flags & ~mask) | flags;
239 5832d1f2 aliguori
    mem->flags = flags;
240 5832d1f2 aliguori
241 4495d6a7 Jan Kiszka
    /* If nothing changed effectively, no need to issue ioctl */
242 4495d6a7 Jan Kiszka
    if (s->migration_log) {
243 4495d6a7 Jan Kiszka
        flags |= KVM_MEM_LOG_DIRTY_PAGES;
244 4495d6a7 Jan Kiszka
    }
245 4495d6a7 Jan Kiszka
    if (flags == old_flags) {
246 4495d6a7 Jan Kiszka
            return 0;
247 4495d6a7 Jan Kiszka
    }
248 4495d6a7 Jan Kiszka
249 5832d1f2 aliguori
    return kvm_set_user_memory_region(s, mem);
250 5832d1f2 aliguori
}
251 5832d1f2 aliguori
252 c227f099 Anthony Liguori
int kvm_log_start(target_phys_addr_t phys_addr, ram_addr_t size)
253 5832d1f2 aliguori
{
254 d3f8d37f aliguori
        return kvm_dirty_pages_log_change(phys_addr, size,
255 5832d1f2 aliguori
                                          KVM_MEM_LOG_DIRTY_PAGES,
256 5832d1f2 aliguori
                                          KVM_MEM_LOG_DIRTY_PAGES);
257 5832d1f2 aliguori
}
258 5832d1f2 aliguori
259 c227f099 Anthony Liguori
int kvm_log_stop(target_phys_addr_t phys_addr, ram_addr_t size)
260 5832d1f2 aliguori
{
261 d3f8d37f aliguori
        return kvm_dirty_pages_log_change(phys_addr, size,
262 5832d1f2 aliguori
                                          0,
263 5832d1f2 aliguori
                                          KVM_MEM_LOG_DIRTY_PAGES);
264 5832d1f2 aliguori
}
265 5832d1f2 aliguori
266 7b8f3b78 Michael S. Tsirkin
static int kvm_set_migration_log(int enable)
267 4495d6a7 Jan Kiszka
{
268 4495d6a7 Jan Kiszka
    KVMState *s = kvm_state;
269 4495d6a7 Jan Kiszka
    KVMSlot *mem;
270 4495d6a7 Jan Kiszka
    int i, err;
271 4495d6a7 Jan Kiszka
272 4495d6a7 Jan Kiszka
    s->migration_log = enable;
273 4495d6a7 Jan Kiszka
274 4495d6a7 Jan Kiszka
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
275 4495d6a7 Jan Kiszka
        mem = &s->slots[i];
276 4495d6a7 Jan Kiszka
277 70fedd76 Alex Williamson
        if (!mem->memory_size) {
278 70fedd76 Alex Williamson
            continue;
279 70fedd76 Alex Williamson
        }
280 4495d6a7 Jan Kiszka
        if (!!(mem->flags & KVM_MEM_LOG_DIRTY_PAGES) == enable) {
281 4495d6a7 Jan Kiszka
            continue;
282 4495d6a7 Jan Kiszka
        }
283 4495d6a7 Jan Kiszka
        err = kvm_set_user_memory_region(s, mem);
284 4495d6a7 Jan Kiszka
        if (err) {
285 4495d6a7 Jan Kiszka
            return err;
286 4495d6a7 Jan Kiszka
        }
287 4495d6a7 Jan Kiszka
    }
288 4495d6a7 Jan Kiszka
    return 0;
289 4495d6a7 Jan Kiszka
}
290 4495d6a7 Jan Kiszka
291 8369e01c Marcelo Tosatti
/* get kvm's dirty pages bitmap and update qemu's */
292 8369e01c Marcelo Tosatti
static int kvm_get_dirty_pages_log_range(unsigned long start_addr,
293 8369e01c Marcelo Tosatti
                                         unsigned long *bitmap,
294 8369e01c Marcelo Tosatti
                                         unsigned long offset,
295 8369e01c Marcelo Tosatti
                                         unsigned long mem_size)
296 96c1606b Alexander Graf
{
297 8369e01c Marcelo Tosatti
    unsigned int i, j;
298 8369e01c Marcelo Tosatti
    unsigned long page_number, addr, addr1, c;
299 8369e01c Marcelo Tosatti
    ram_addr_t ram_addr;
300 8369e01c Marcelo Tosatti
    unsigned int len = ((mem_size / TARGET_PAGE_SIZE) + HOST_LONG_BITS - 1) /
301 8369e01c Marcelo Tosatti
        HOST_LONG_BITS;
302 8369e01c Marcelo Tosatti
303 8369e01c Marcelo Tosatti
    /*
304 8369e01c Marcelo Tosatti
     * bitmap-traveling is faster than memory-traveling (for addr...)
305 8369e01c Marcelo Tosatti
     * especially when most of the memory is not dirty.
306 8369e01c Marcelo Tosatti
     */
307 8369e01c Marcelo Tosatti
    for (i = 0; i < len; i++) {
308 8369e01c Marcelo Tosatti
        if (bitmap[i] != 0) {
309 8369e01c Marcelo Tosatti
            c = leul_to_cpu(bitmap[i]);
310 8369e01c Marcelo Tosatti
            do {
311 8369e01c Marcelo Tosatti
                j = ffsl(c) - 1;
312 8369e01c Marcelo Tosatti
                c &= ~(1ul << j);
313 8369e01c Marcelo Tosatti
                page_number = i * HOST_LONG_BITS + j;
314 8369e01c Marcelo Tosatti
                addr1 = page_number * TARGET_PAGE_SIZE;
315 8369e01c Marcelo Tosatti
                addr = offset + addr1;
316 8369e01c Marcelo Tosatti
                ram_addr = cpu_get_physical_page_desc(addr);
317 8369e01c Marcelo Tosatti
                cpu_physical_memory_set_dirty(ram_addr);
318 8369e01c Marcelo Tosatti
            } while (c != 0);
319 8369e01c Marcelo Tosatti
        }
320 8369e01c Marcelo Tosatti
    }
321 8369e01c Marcelo Tosatti
    return 0;
322 96c1606b Alexander Graf
}
323 96c1606b Alexander Graf
324 8369e01c Marcelo Tosatti
#define ALIGN(x, y)  (((x)+(y)-1) & ~((y)-1))
325 8369e01c Marcelo Tosatti
326 5832d1f2 aliguori
/**
327 5832d1f2 aliguori
 * kvm_physical_sync_dirty_bitmap - Grab dirty bitmap from kernel space
328 5832d1f2 aliguori
 * This function updates qemu's dirty bitmap using cpu_physical_memory_set_dirty().
329 5832d1f2 aliguori
 * This means all bits are set to dirty.
330 5832d1f2 aliguori
 *
331 d3f8d37f aliguori
 * @start_add: start of logged region.
332 5832d1f2 aliguori
 * @end_addr: end of logged region.
333 5832d1f2 aliguori
 */
334 7b8f3b78 Michael S. Tsirkin
static int kvm_physical_sync_dirty_bitmap(target_phys_addr_t start_addr,
335 7b8f3b78 Michael S. Tsirkin
                                          target_phys_addr_t end_addr)
336 5832d1f2 aliguori
{
337 5832d1f2 aliguori
    KVMState *s = kvm_state;
338 151f7749 Jan Kiszka
    unsigned long size, allocated_size = 0;
339 151f7749 Jan Kiszka
    KVMDirtyLog d;
340 151f7749 Jan Kiszka
    KVMSlot *mem;
341 151f7749 Jan Kiszka
    int ret = 0;
342 5832d1f2 aliguori
343 151f7749 Jan Kiszka
    d.dirty_bitmap = NULL;
344 151f7749 Jan Kiszka
    while (start_addr < end_addr) {
345 151f7749 Jan Kiszka
        mem = kvm_lookup_overlapping_slot(s, start_addr, end_addr);
346 151f7749 Jan Kiszka
        if (mem == NULL) {
347 151f7749 Jan Kiszka
            break;
348 151f7749 Jan Kiszka
        }
349 5832d1f2 aliguori
350 8369e01c Marcelo Tosatti
        size = ALIGN(((mem->memory_size) >> TARGET_PAGE_BITS), HOST_LONG_BITS) / 8;
351 151f7749 Jan Kiszka
        if (!d.dirty_bitmap) {
352 151f7749 Jan Kiszka
            d.dirty_bitmap = qemu_malloc(size);
353 151f7749 Jan Kiszka
        } else if (size > allocated_size) {
354 151f7749 Jan Kiszka
            d.dirty_bitmap = qemu_realloc(d.dirty_bitmap, size);
355 151f7749 Jan Kiszka
        }
356 151f7749 Jan Kiszka
        allocated_size = size;
357 151f7749 Jan Kiszka
        memset(d.dirty_bitmap, 0, allocated_size);
358 5832d1f2 aliguori
359 151f7749 Jan Kiszka
        d.slot = mem->slot;
360 5832d1f2 aliguori
361 6e489f3f Anthony Liguori
        if (kvm_vm_ioctl(s, KVM_GET_DIRTY_LOG, &d) == -1) {
362 8c0d577e Blue Swirl
            DPRINTF("ioctl failed %d\n", errno);
363 151f7749 Jan Kiszka
            ret = -1;
364 151f7749 Jan Kiszka
            break;
365 151f7749 Jan Kiszka
        }
366 5832d1f2 aliguori
367 8369e01c Marcelo Tosatti
        kvm_get_dirty_pages_log_range(mem->start_addr, d.dirty_bitmap,
368 8369e01c Marcelo Tosatti
                                      mem->start_addr, mem->memory_size);
369 8369e01c Marcelo Tosatti
        start_addr = mem->start_addr + mem->memory_size;
370 5832d1f2 aliguori
    }
371 5832d1f2 aliguori
    qemu_free(d.dirty_bitmap);
372 151f7749 Jan Kiszka
373 151f7749 Jan Kiszka
    return ret;
374 5832d1f2 aliguori
}
375 5832d1f2 aliguori
376 c227f099 Anthony Liguori
int kvm_coalesce_mmio_region(target_phys_addr_t start, ram_addr_t size)
377 f65ed4c1 aliguori
{
378 f65ed4c1 aliguori
    int ret = -ENOSYS;
379 f65ed4c1 aliguori
#ifdef KVM_CAP_COALESCED_MMIO
380 f65ed4c1 aliguori
    KVMState *s = kvm_state;
381 f65ed4c1 aliguori
382 f65ed4c1 aliguori
    if (s->coalesced_mmio) {
383 f65ed4c1 aliguori
        struct kvm_coalesced_mmio_zone zone;
384 f65ed4c1 aliguori
385 f65ed4c1 aliguori
        zone.addr = start;
386 f65ed4c1 aliguori
        zone.size = size;
387 f65ed4c1 aliguori
388 f65ed4c1 aliguori
        ret = kvm_vm_ioctl(s, KVM_REGISTER_COALESCED_MMIO, &zone);
389 f65ed4c1 aliguori
    }
390 f65ed4c1 aliguori
#endif
391 f65ed4c1 aliguori
392 f65ed4c1 aliguori
    return ret;
393 f65ed4c1 aliguori
}
394 f65ed4c1 aliguori
395 c227f099 Anthony Liguori
int kvm_uncoalesce_mmio_region(target_phys_addr_t start, ram_addr_t size)
396 f65ed4c1 aliguori
{
397 f65ed4c1 aliguori
    int ret = -ENOSYS;
398 f65ed4c1 aliguori
#ifdef KVM_CAP_COALESCED_MMIO
399 f65ed4c1 aliguori
    KVMState *s = kvm_state;
400 f65ed4c1 aliguori
401 f65ed4c1 aliguori
    if (s->coalesced_mmio) {
402 f65ed4c1 aliguori
        struct kvm_coalesced_mmio_zone zone;
403 f65ed4c1 aliguori
404 f65ed4c1 aliguori
        zone.addr = start;
405 f65ed4c1 aliguori
        zone.size = size;
406 f65ed4c1 aliguori
407 f65ed4c1 aliguori
        ret = kvm_vm_ioctl(s, KVM_UNREGISTER_COALESCED_MMIO, &zone);
408 f65ed4c1 aliguori
    }
409 f65ed4c1 aliguori
#endif
410 f65ed4c1 aliguori
411 f65ed4c1 aliguori
    return ret;
412 f65ed4c1 aliguori
}
413 f65ed4c1 aliguori
414 ad7b8b33 Anthony Liguori
int kvm_check_extension(KVMState *s, unsigned int extension)
415 ad7b8b33 Anthony Liguori
{
416 ad7b8b33 Anthony Liguori
    int ret;
417 ad7b8b33 Anthony Liguori
418 ad7b8b33 Anthony Liguori
    ret = kvm_ioctl(s, KVM_CHECK_EXTENSION, extension);
419 ad7b8b33 Anthony Liguori
    if (ret < 0) {
420 ad7b8b33 Anthony Liguori
        ret = 0;
421 ad7b8b33 Anthony Liguori
    }
422 ad7b8b33 Anthony Liguori
423 ad7b8b33 Anthony Liguori
    return ret;
424 ad7b8b33 Anthony Liguori
}
425 ad7b8b33 Anthony Liguori
426 7b8f3b78 Michael S. Tsirkin
static void kvm_set_phys_mem(target_phys_addr_t start_addr,
427 7b8f3b78 Michael S. Tsirkin
                             ram_addr_t size,
428 7b8f3b78 Michael S. Tsirkin
                             ram_addr_t phys_offset)
429 46dbef6a Michael S. Tsirkin
{
430 46dbef6a Michael S. Tsirkin
    KVMState *s = kvm_state;
431 46dbef6a Michael S. Tsirkin
    ram_addr_t flags = phys_offset & ~TARGET_PAGE_MASK;
432 46dbef6a Michael S. Tsirkin
    KVMSlot *mem, old;
433 46dbef6a Michael S. Tsirkin
    int err;
434 46dbef6a Michael S. Tsirkin
435 14542fea Gleb Natapov
    /* kvm works in page size chunks, but the function may be called
436 14542fea Gleb Natapov
       with sub-page size and unaligned start address. */
437 14542fea Gleb Natapov
    size = TARGET_PAGE_ALIGN(size);
438 14542fea Gleb Natapov
    start_addr = TARGET_PAGE_ALIGN(start_addr);
439 46dbef6a Michael S. Tsirkin
440 46dbef6a Michael S. Tsirkin
    /* KVM does not support read-only slots */
441 46dbef6a Michael S. Tsirkin
    phys_offset &= ~IO_MEM_ROM;
442 46dbef6a Michael S. Tsirkin
443 46dbef6a Michael S. Tsirkin
    while (1) {
444 46dbef6a Michael S. Tsirkin
        mem = kvm_lookup_overlapping_slot(s, start_addr, start_addr + size);
445 46dbef6a Michael S. Tsirkin
        if (!mem) {
446 46dbef6a Michael S. Tsirkin
            break;
447 46dbef6a Michael S. Tsirkin
        }
448 46dbef6a Michael S. Tsirkin
449 46dbef6a Michael S. Tsirkin
        if (flags < IO_MEM_UNASSIGNED && start_addr >= mem->start_addr &&
450 46dbef6a Michael S. Tsirkin
            (start_addr + size <= mem->start_addr + mem->memory_size) &&
451 46dbef6a Michael S. Tsirkin
            (phys_offset - start_addr == mem->phys_offset - mem->start_addr)) {
452 46dbef6a Michael S. Tsirkin
            /* The new slot fits into the existing one and comes with
453 46dbef6a Michael S. Tsirkin
             * identical parameters - nothing to be done. */
454 46dbef6a Michael S. Tsirkin
            return;
455 46dbef6a Michael S. Tsirkin
        }
456 46dbef6a Michael S. Tsirkin
457 46dbef6a Michael S. Tsirkin
        old = *mem;
458 46dbef6a Michael S. Tsirkin
459 46dbef6a Michael S. Tsirkin
        /* unregister the overlapping slot */
460 46dbef6a Michael S. Tsirkin
        mem->memory_size = 0;
461 46dbef6a Michael S. Tsirkin
        err = kvm_set_user_memory_region(s, mem);
462 46dbef6a Michael S. Tsirkin
        if (err) {
463 46dbef6a Michael S. Tsirkin
            fprintf(stderr, "%s: error unregistering overlapping slot: %s\n",
464 46dbef6a Michael S. Tsirkin
                    __func__, strerror(-err));
465 46dbef6a Michael S. Tsirkin
            abort();
466 46dbef6a Michael S. Tsirkin
        }
467 46dbef6a Michael S. Tsirkin
468 46dbef6a Michael S. Tsirkin
        /* Workaround for older KVM versions: we can't join slots, even not by
469 46dbef6a Michael S. Tsirkin
         * unregistering the previous ones and then registering the larger
470 46dbef6a Michael S. Tsirkin
         * slot. We have to maintain the existing fragmentation. Sigh.
471 46dbef6a Michael S. Tsirkin
         *
472 46dbef6a Michael S. Tsirkin
         * This workaround assumes that the new slot starts at the same
473 46dbef6a Michael S. Tsirkin
         * address as the first existing one. If not or if some overlapping
474 46dbef6a Michael S. Tsirkin
         * slot comes around later, we will fail (not seen in practice so far)
475 46dbef6a Michael S. Tsirkin
         * - and actually require a recent KVM version. */
476 46dbef6a Michael S. Tsirkin
        if (s->broken_set_mem_region &&
477 46dbef6a Michael S. Tsirkin
            old.start_addr == start_addr && old.memory_size < size &&
478 46dbef6a Michael S. Tsirkin
            flags < IO_MEM_UNASSIGNED) {
479 46dbef6a Michael S. Tsirkin
            mem = kvm_alloc_slot(s);
480 46dbef6a Michael S. Tsirkin
            mem->memory_size = old.memory_size;
481 46dbef6a Michael S. Tsirkin
            mem->start_addr = old.start_addr;
482 46dbef6a Michael S. Tsirkin
            mem->phys_offset = old.phys_offset;
483 46dbef6a Michael S. Tsirkin
            mem->flags = 0;
484 46dbef6a Michael S. Tsirkin
485 46dbef6a Michael S. Tsirkin
            err = kvm_set_user_memory_region(s, mem);
486 46dbef6a Michael S. Tsirkin
            if (err) {
487 46dbef6a Michael S. Tsirkin
                fprintf(stderr, "%s: error updating slot: %s\n", __func__,
488 46dbef6a Michael S. Tsirkin
                        strerror(-err));
489 46dbef6a Michael S. Tsirkin
                abort();
490 46dbef6a Michael S. Tsirkin
            }
491 46dbef6a Michael S. Tsirkin
492 46dbef6a Michael S. Tsirkin
            start_addr += old.memory_size;
493 46dbef6a Michael S. Tsirkin
            phys_offset += old.memory_size;
494 46dbef6a Michael S. Tsirkin
            size -= old.memory_size;
495 46dbef6a Michael S. Tsirkin
            continue;
496 46dbef6a Michael S. Tsirkin
        }
497 46dbef6a Michael S. Tsirkin
498 46dbef6a Michael S. Tsirkin
        /* register prefix slot */
499 46dbef6a Michael S. Tsirkin
        if (old.start_addr < start_addr) {
500 46dbef6a Michael S. Tsirkin
            mem = kvm_alloc_slot(s);
501 46dbef6a Michael S. Tsirkin
            mem->memory_size = start_addr - old.start_addr;
502 46dbef6a Michael S. Tsirkin
            mem->start_addr = old.start_addr;
503 46dbef6a Michael S. Tsirkin
            mem->phys_offset = old.phys_offset;
504 46dbef6a Michael S. Tsirkin
            mem->flags = 0;
505 46dbef6a Michael S. Tsirkin
506 46dbef6a Michael S. Tsirkin
            err = kvm_set_user_memory_region(s, mem);
507 46dbef6a Michael S. Tsirkin
            if (err) {
508 46dbef6a Michael S. Tsirkin
                fprintf(stderr, "%s: error registering prefix slot: %s\n",
509 46dbef6a Michael S. Tsirkin
                        __func__, strerror(-err));
510 46dbef6a Michael S. Tsirkin
                abort();
511 46dbef6a Michael S. Tsirkin
            }
512 46dbef6a Michael S. Tsirkin
        }
513 46dbef6a Michael S. Tsirkin
514 46dbef6a Michael S. Tsirkin
        /* register suffix slot */
515 46dbef6a Michael S. Tsirkin
        if (old.start_addr + old.memory_size > start_addr + size) {
516 46dbef6a Michael S. Tsirkin
            ram_addr_t size_delta;
517 46dbef6a Michael S. Tsirkin
518 46dbef6a Michael S. Tsirkin
            mem = kvm_alloc_slot(s);
519 46dbef6a Michael S. Tsirkin
            mem->start_addr = start_addr + size;
520 46dbef6a Michael S. Tsirkin
            size_delta = mem->start_addr - old.start_addr;
521 46dbef6a Michael S. Tsirkin
            mem->memory_size = old.memory_size - size_delta;
522 46dbef6a Michael S. Tsirkin
            mem->phys_offset = old.phys_offset + size_delta;
523 46dbef6a Michael S. Tsirkin
            mem->flags = 0;
524 46dbef6a Michael S. Tsirkin
525 46dbef6a Michael S. Tsirkin
            err = kvm_set_user_memory_region(s, mem);
526 46dbef6a Michael S. Tsirkin
            if (err) {
527 46dbef6a Michael S. Tsirkin
                fprintf(stderr, "%s: error registering suffix slot: %s\n",
528 46dbef6a Michael S. Tsirkin
                        __func__, strerror(-err));
529 46dbef6a Michael S. Tsirkin
                abort();
530 46dbef6a Michael S. Tsirkin
            }
531 46dbef6a Michael S. Tsirkin
        }
532 46dbef6a Michael S. Tsirkin
    }
533 46dbef6a Michael S. Tsirkin
534 46dbef6a Michael S. Tsirkin
    /* in case the KVM bug workaround already "consumed" the new slot */
535 46dbef6a Michael S. Tsirkin
    if (!size)
536 46dbef6a Michael S. Tsirkin
        return;
537 46dbef6a Michael S. Tsirkin
538 46dbef6a Michael S. Tsirkin
    /* KVM does not need to know about this memory */
539 46dbef6a Michael S. Tsirkin
    if (flags >= IO_MEM_UNASSIGNED)
540 46dbef6a Michael S. Tsirkin
        return;
541 46dbef6a Michael S. Tsirkin
542 46dbef6a Michael S. Tsirkin
    mem = kvm_alloc_slot(s);
543 46dbef6a Michael S. Tsirkin
    mem->memory_size = size;
544 46dbef6a Michael S. Tsirkin
    mem->start_addr = start_addr;
545 46dbef6a Michael S. Tsirkin
    mem->phys_offset = phys_offset;
546 46dbef6a Michael S. Tsirkin
    mem->flags = 0;
547 46dbef6a Michael S. Tsirkin
548 46dbef6a Michael S. Tsirkin
    err = kvm_set_user_memory_region(s, mem);
549 46dbef6a Michael S. Tsirkin
    if (err) {
550 46dbef6a Michael S. Tsirkin
        fprintf(stderr, "%s: error registering slot: %s\n", __func__,
551 46dbef6a Michael S. Tsirkin
                strerror(-err));
552 46dbef6a Michael S. Tsirkin
        abort();
553 46dbef6a Michael S. Tsirkin
    }
554 46dbef6a Michael S. Tsirkin
}
555 46dbef6a Michael S. Tsirkin
556 7b8f3b78 Michael S. Tsirkin
static void kvm_client_set_memory(struct CPUPhysMemoryClient *client,
557 7b8f3b78 Michael S. Tsirkin
                                  target_phys_addr_t start_addr,
558 7b8f3b78 Michael S. Tsirkin
                                  ram_addr_t size,
559 7b8f3b78 Michael S. Tsirkin
                                  ram_addr_t phys_offset)
560 7b8f3b78 Michael S. Tsirkin
{
561 7b8f3b78 Michael S. Tsirkin
        kvm_set_phys_mem(start_addr, size, phys_offset);
562 7b8f3b78 Michael S. Tsirkin
}
563 7b8f3b78 Michael S. Tsirkin
564 7b8f3b78 Michael S. Tsirkin
static int kvm_client_sync_dirty_bitmap(struct CPUPhysMemoryClient *client,
565 7b8f3b78 Michael S. Tsirkin
                                        target_phys_addr_t start_addr,
566 7b8f3b78 Michael S. Tsirkin
                                        target_phys_addr_t end_addr)
567 7b8f3b78 Michael S. Tsirkin
{
568 7b8f3b78 Michael S. Tsirkin
        return kvm_physical_sync_dirty_bitmap(start_addr, end_addr);
569 7b8f3b78 Michael S. Tsirkin
}
570 7b8f3b78 Michael S. Tsirkin
571 7b8f3b78 Michael S. Tsirkin
static int kvm_client_migration_log(struct CPUPhysMemoryClient *client,
572 7b8f3b78 Michael S. Tsirkin
                                    int enable)
573 7b8f3b78 Michael S. Tsirkin
{
574 7b8f3b78 Michael S. Tsirkin
        return kvm_set_migration_log(enable);
575 7b8f3b78 Michael S. Tsirkin
}
576 7b8f3b78 Michael S. Tsirkin
577 7b8f3b78 Michael S. Tsirkin
static CPUPhysMemoryClient kvm_cpu_phys_memory_client = {
578 7b8f3b78 Michael S. Tsirkin
        .set_memory = kvm_client_set_memory,
579 7b8f3b78 Michael S. Tsirkin
        .sync_dirty_bitmap = kvm_client_sync_dirty_bitmap,
580 7b8f3b78 Michael S. Tsirkin
        .migration_log = kvm_client_migration_log,
581 7b8f3b78 Michael S. Tsirkin
};
582 7b8f3b78 Michael S. Tsirkin
583 05330448 aliguori
int kvm_init(int smp_cpus)
584 05330448 aliguori
{
585 168ccc11 Jan Kiszka
    static const char upgrade_note[] =
586 168ccc11 Jan Kiszka
        "Please upgrade to at least kernel 2.6.29 or recent kvm-kmod\n"
587 168ccc11 Jan Kiszka
        "(see http://sourceforge.net/projects/kvm).\n";
588 05330448 aliguori
    KVMState *s;
589 05330448 aliguori
    int ret;
590 05330448 aliguori
    int i;
591 05330448 aliguori
592 05330448 aliguori
    s = qemu_mallocz(sizeof(KVMState));
593 05330448 aliguori
594 e22a25c9 aliguori
#ifdef KVM_CAP_SET_GUEST_DEBUG
595 72cf2d4f Blue Swirl
    QTAILQ_INIT(&s->kvm_sw_breakpoints);
596 e22a25c9 aliguori
#endif
597 05330448 aliguori
    for (i = 0; i < ARRAY_SIZE(s->slots); i++)
598 05330448 aliguori
        s->slots[i].slot = i;
599 05330448 aliguori
600 05330448 aliguori
    s->vmfd = -1;
601 40ff6d7e Kevin Wolf
    s->fd = qemu_open("/dev/kvm", O_RDWR);
602 05330448 aliguori
    if (s->fd == -1) {
603 05330448 aliguori
        fprintf(stderr, "Could not access KVM kernel module: %m\n");
604 05330448 aliguori
        ret = -errno;
605 05330448 aliguori
        goto err;
606 05330448 aliguori
    }
607 05330448 aliguori
608 05330448 aliguori
    ret = kvm_ioctl(s, KVM_GET_API_VERSION, 0);
609 05330448 aliguori
    if (ret < KVM_API_VERSION) {
610 05330448 aliguori
        if (ret > 0)
611 05330448 aliguori
            ret = -EINVAL;
612 05330448 aliguori
        fprintf(stderr, "kvm version too old\n");
613 05330448 aliguori
        goto err;
614 05330448 aliguori
    }
615 05330448 aliguori
616 05330448 aliguori
    if (ret > KVM_API_VERSION) {
617 05330448 aliguori
        ret = -EINVAL;
618 05330448 aliguori
        fprintf(stderr, "kvm version not supported\n");
619 05330448 aliguori
        goto err;
620 05330448 aliguori
    }
621 05330448 aliguori
622 05330448 aliguori
    s->vmfd = kvm_ioctl(s, KVM_CREATE_VM, 0);
623 0104dcac Alexander Graf
    if (s->vmfd < 0) {
624 0104dcac Alexander Graf
#ifdef TARGET_S390X
625 0104dcac Alexander Graf
        fprintf(stderr, "Please add the 'switch_amode' kernel parameter to "
626 0104dcac Alexander Graf
                        "your host kernel command line\n");
627 0104dcac Alexander Graf
#endif
628 05330448 aliguori
        goto err;
629 0104dcac Alexander Graf
    }
630 05330448 aliguori
631 05330448 aliguori
    /* initially, KVM allocated its own memory and we had to jump through
632 05330448 aliguori
     * hooks to make phys_ram_base point to this.  Modern versions of KVM
633 5579c7f3 pbrook
     * just use a user allocated buffer so we can use regular pages
634 05330448 aliguori
     * unmodified.  Make sure we have a sufficiently modern version of KVM.
635 05330448 aliguori
     */
636 ad7b8b33 Anthony Liguori
    if (!kvm_check_extension(s, KVM_CAP_USER_MEMORY)) {
637 ad7b8b33 Anthony Liguori
        ret = -EINVAL;
638 168ccc11 Jan Kiszka
        fprintf(stderr, "kvm does not support KVM_CAP_USER_MEMORY\n%s",
639 168ccc11 Jan Kiszka
                upgrade_note);
640 05330448 aliguori
        goto err;
641 05330448 aliguori
    }
642 05330448 aliguori
643 d85dc283 aliguori
    /* There was a nasty bug in < kvm-80 that prevents memory slots from being
644 d85dc283 aliguori
     * destroyed properly.  Since we rely on this capability, refuse to work
645 d85dc283 aliguori
     * with any kernel without this capability. */
646 ad7b8b33 Anthony Liguori
    if (!kvm_check_extension(s, KVM_CAP_DESTROY_MEMORY_REGION_WORKS)) {
647 ad7b8b33 Anthony Liguori
        ret = -EINVAL;
648 d85dc283 aliguori
649 d85dc283 aliguori
        fprintf(stderr,
650 168ccc11 Jan Kiszka
                "KVM kernel module broken (DESTROY_MEMORY_REGION).\n%s",
651 168ccc11 Jan Kiszka
                upgrade_note);
652 d85dc283 aliguori
        goto err;
653 d85dc283 aliguori
    }
654 d85dc283 aliguori
655 62a2744c Sheng Yang
    s->coalesced_mmio = 0;
656 f65ed4c1 aliguori
#ifdef KVM_CAP_COALESCED_MMIO
657 ad7b8b33 Anthony Liguori
    s->coalesced_mmio = kvm_check_extension(s, KVM_CAP_COALESCED_MMIO);
658 62a2744c Sheng Yang
    s->coalesced_mmio_ring = NULL;
659 f65ed4c1 aliguori
#endif
660 f65ed4c1 aliguori
661 e69917e2 Jan Kiszka
    s->broken_set_mem_region = 1;
662 e69917e2 Jan Kiszka
#ifdef KVM_CAP_JOIN_MEMORY_REGIONS_WORKS
663 e69917e2 Jan Kiszka
    ret = kvm_ioctl(s, KVM_CHECK_EXTENSION, KVM_CAP_JOIN_MEMORY_REGIONS_WORKS);
664 e69917e2 Jan Kiszka
    if (ret > 0) {
665 e69917e2 Jan Kiszka
        s->broken_set_mem_region = 0;
666 e69917e2 Jan Kiszka
    }
667 e69917e2 Jan Kiszka
#endif
668 e69917e2 Jan Kiszka
669 a0fb002c Jan Kiszka
    s->vcpu_events = 0;
670 a0fb002c Jan Kiszka
#ifdef KVM_CAP_VCPU_EVENTS
671 a0fb002c Jan Kiszka
    s->vcpu_events = kvm_check_extension(s, KVM_CAP_VCPU_EVENTS);
672 a0fb002c Jan Kiszka
#endif
673 a0fb002c Jan Kiszka
674 b0b1d690 Jan Kiszka
    s->robust_singlestep = 0;
675 b0b1d690 Jan Kiszka
#ifdef KVM_CAP_X86_ROBUST_SINGLESTEP
676 b0b1d690 Jan Kiszka
    s->robust_singlestep =
677 b0b1d690 Jan Kiszka
        kvm_check_extension(s, KVM_CAP_X86_ROBUST_SINGLESTEP);
678 b0b1d690 Jan Kiszka
#endif
679 b0b1d690 Jan Kiszka
680 ff44f1a3 Jan Kiszka
    s->debugregs = 0;
681 ff44f1a3 Jan Kiszka
#ifdef KVM_CAP_DEBUGREGS
682 ff44f1a3 Jan Kiszka
    s->debugregs = kvm_check_extension(s, KVM_CAP_DEBUGREGS);
683 ff44f1a3 Jan Kiszka
#endif
684 ff44f1a3 Jan Kiszka
685 f1665b21 Sheng Yang
    s->xsave = 0;
686 f1665b21 Sheng Yang
#ifdef KVM_CAP_XSAVE
687 f1665b21 Sheng Yang
    s->xsave = kvm_check_extension(s, KVM_CAP_XSAVE);
688 f1665b21 Sheng Yang
#endif
689 f1665b21 Sheng Yang
690 f1665b21 Sheng Yang
    s->xcrs = 0;
691 f1665b21 Sheng Yang
#ifdef KVM_CAP_XCRS
692 f1665b21 Sheng Yang
    s->xcrs = kvm_check_extension(s, KVM_CAP_XCRS);
693 f1665b21 Sheng Yang
#endif
694 f1665b21 Sheng Yang
695 05330448 aliguori
    ret = kvm_arch_init(s, smp_cpus);
696 05330448 aliguori
    if (ret < 0)
697 05330448 aliguori
        goto err;
698 05330448 aliguori
699 05330448 aliguori
    kvm_state = s;
700 7b8f3b78 Michael S. Tsirkin
    cpu_register_phys_memory_client(&kvm_cpu_phys_memory_client);
701 05330448 aliguori
702 05330448 aliguori
    return 0;
703 05330448 aliguori
704 05330448 aliguori
err:
705 05330448 aliguori
    if (s) {
706 05330448 aliguori
        if (s->vmfd != -1)
707 05330448 aliguori
            close(s->vmfd);
708 05330448 aliguori
        if (s->fd != -1)
709 05330448 aliguori
            close(s->fd);
710 05330448 aliguori
    }
711 05330448 aliguori
    qemu_free(s);
712 05330448 aliguori
713 05330448 aliguori
    return ret;
714 05330448 aliguori
}
715 05330448 aliguori
716 afcea8cb Blue Swirl
static int kvm_handle_io(uint16_t port, void *data, int direction, int size,
717 afcea8cb Blue Swirl
                         uint32_t count)
718 05330448 aliguori
{
719 05330448 aliguori
    int i;
720 05330448 aliguori
    uint8_t *ptr = data;
721 05330448 aliguori
722 05330448 aliguori
    for (i = 0; i < count; i++) {
723 05330448 aliguori
        if (direction == KVM_EXIT_IO_IN) {
724 05330448 aliguori
            switch (size) {
725 05330448 aliguori
            case 1:
726 afcea8cb Blue Swirl
                stb_p(ptr, cpu_inb(port));
727 05330448 aliguori
                break;
728 05330448 aliguori
            case 2:
729 afcea8cb Blue Swirl
                stw_p(ptr, cpu_inw(port));
730 05330448 aliguori
                break;
731 05330448 aliguori
            case 4:
732 afcea8cb Blue Swirl
                stl_p(ptr, cpu_inl(port));
733 05330448 aliguori
                break;
734 05330448 aliguori
            }
735 05330448 aliguori
        } else {
736 05330448 aliguori
            switch (size) {
737 05330448 aliguori
            case 1:
738 afcea8cb Blue Swirl
                cpu_outb(port, ldub_p(ptr));
739 05330448 aliguori
                break;
740 05330448 aliguori
            case 2:
741 afcea8cb Blue Swirl
                cpu_outw(port, lduw_p(ptr));
742 05330448 aliguori
                break;
743 05330448 aliguori
            case 4:
744 afcea8cb Blue Swirl
                cpu_outl(port, ldl_p(ptr));
745 05330448 aliguori
                break;
746 05330448 aliguori
            }
747 05330448 aliguori
        }
748 05330448 aliguori
749 05330448 aliguori
        ptr += size;
750 05330448 aliguori
    }
751 05330448 aliguori
752 05330448 aliguori
    return 1;
753 05330448 aliguori
}
754 05330448 aliguori
755 7c80eef8 Marcelo Tosatti
#ifdef KVM_CAP_INTERNAL_ERROR_DATA
756 7c80eef8 Marcelo Tosatti
static void kvm_handle_internal_error(CPUState *env, struct kvm_run *run)
757 7c80eef8 Marcelo Tosatti
{
758 7c80eef8 Marcelo Tosatti
759 7c80eef8 Marcelo Tosatti
    if (kvm_check_extension(kvm_state, KVM_CAP_INTERNAL_ERROR_DATA)) {
760 7c80eef8 Marcelo Tosatti
        int i;
761 7c80eef8 Marcelo Tosatti
762 7c80eef8 Marcelo Tosatti
        fprintf(stderr, "KVM internal error. Suberror: %d\n",
763 7c80eef8 Marcelo Tosatti
                run->internal.suberror);
764 7c80eef8 Marcelo Tosatti
765 7c80eef8 Marcelo Tosatti
        for (i = 0; i < run->internal.ndata; ++i) {
766 7c80eef8 Marcelo Tosatti
            fprintf(stderr, "extra data[%d]: %"PRIx64"\n",
767 7c80eef8 Marcelo Tosatti
                    i, (uint64_t)run->internal.data[i]);
768 7c80eef8 Marcelo Tosatti
        }
769 7c80eef8 Marcelo Tosatti
    }
770 7c80eef8 Marcelo Tosatti
    cpu_dump_state(env, stderr, fprintf, 0);
771 7c80eef8 Marcelo Tosatti
    if (run->internal.suberror == KVM_INTERNAL_ERROR_EMULATION) {
772 7c80eef8 Marcelo Tosatti
        fprintf(stderr, "emulation failure\n");
773 4513d923 Gleb Natapov
        if (!kvm_arch_stop_on_emulation_error(env))
774 4513d923 Gleb Natapov
                return;
775 7c80eef8 Marcelo Tosatti
    }
776 7c80eef8 Marcelo Tosatti
    /* FIXME: Should trigger a qmp message to let management know
777 7c80eef8 Marcelo Tosatti
     * something went wrong.
778 7c80eef8 Marcelo Tosatti
     */
779 7c80eef8 Marcelo Tosatti
    vm_stop(0);
780 7c80eef8 Marcelo Tosatti
}
781 7c80eef8 Marcelo Tosatti
#endif
782 7c80eef8 Marcelo Tosatti
783 62a2744c Sheng Yang
void kvm_flush_coalesced_mmio_buffer(void)
784 f65ed4c1 aliguori
{
785 f65ed4c1 aliguori
#ifdef KVM_CAP_COALESCED_MMIO
786 f65ed4c1 aliguori
    KVMState *s = kvm_state;
787 62a2744c Sheng Yang
    if (s->coalesced_mmio_ring) {
788 62a2744c Sheng Yang
        struct kvm_coalesced_mmio_ring *ring = s->coalesced_mmio_ring;
789 f65ed4c1 aliguori
        while (ring->first != ring->last) {
790 f65ed4c1 aliguori
            struct kvm_coalesced_mmio *ent;
791 f65ed4c1 aliguori
792 f65ed4c1 aliguori
            ent = &ring->coalesced_mmio[ring->first];
793 f65ed4c1 aliguori
794 f65ed4c1 aliguori
            cpu_physical_memory_write(ent->phys_addr, ent->data, ent->len);
795 85199474 Marcelo Tosatti
            smp_wmb();
796 f65ed4c1 aliguori
            ring->first = (ring->first + 1) % KVM_COALESCED_MMIO_MAX;
797 f65ed4c1 aliguori
        }
798 f65ed4c1 aliguori
    }
799 f65ed4c1 aliguori
#endif
800 f65ed4c1 aliguori
}
801 f65ed4c1 aliguori
802 2705d56a Jan Kiszka
static void do_kvm_cpu_synchronize_state(void *_env)
803 4c0960c0 Avi Kivity
{
804 2705d56a Jan Kiszka
    CPUState *env = _env;
805 2705d56a Jan Kiszka
806 9ded2744 Jan Kiszka
    if (!env->kvm_vcpu_dirty) {
807 4c0960c0 Avi Kivity
        kvm_arch_get_registers(env);
808 9ded2744 Jan Kiszka
        env->kvm_vcpu_dirty = 1;
809 4c0960c0 Avi Kivity
    }
810 4c0960c0 Avi Kivity
}
811 4c0960c0 Avi Kivity
812 2705d56a Jan Kiszka
void kvm_cpu_synchronize_state(CPUState *env)
813 2705d56a Jan Kiszka
{
814 2705d56a Jan Kiszka
    if (!env->kvm_vcpu_dirty)
815 2705d56a Jan Kiszka
        run_on_cpu(env, do_kvm_cpu_synchronize_state, env);
816 2705d56a Jan Kiszka
}
817 2705d56a Jan Kiszka
818 ea375f9a Jan Kiszka
void kvm_cpu_synchronize_post_reset(CPUState *env)
819 ea375f9a Jan Kiszka
{
820 ea375f9a Jan Kiszka
    kvm_arch_put_registers(env, KVM_PUT_RESET_STATE);
821 ea375f9a Jan Kiszka
    env->kvm_vcpu_dirty = 0;
822 ea375f9a Jan Kiszka
}
823 ea375f9a Jan Kiszka
824 ea375f9a Jan Kiszka
void kvm_cpu_synchronize_post_init(CPUState *env)
825 ea375f9a Jan Kiszka
{
826 ea375f9a Jan Kiszka
    kvm_arch_put_registers(env, KVM_PUT_FULL_STATE);
827 ea375f9a Jan Kiszka
    env->kvm_vcpu_dirty = 0;
828 ea375f9a Jan Kiszka
}
829 ea375f9a Jan Kiszka
830 05330448 aliguori
int kvm_cpu_exec(CPUState *env)
831 05330448 aliguori
{
832 05330448 aliguori
    struct kvm_run *run = env->kvm_run;
833 05330448 aliguori
    int ret;
834 05330448 aliguori
835 8c0d577e Blue Swirl
    DPRINTF("kvm_cpu_exec()\n");
836 05330448 aliguori
837 05330448 aliguori
    do {
838 6312b928 Marcelo Tosatti
#ifndef CONFIG_IOTHREAD
839 be214e6c aurel32
        if (env->exit_request) {
840 8c0d577e Blue Swirl
            DPRINTF("interrupt exit requested\n");
841 05330448 aliguori
            ret = 0;
842 05330448 aliguori
            break;
843 05330448 aliguori
        }
844 6312b928 Marcelo Tosatti
#endif
845 05330448 aliguori
846 0af691d7 Marcelo Tosatti
        if (kvm_arch_process_irqchip_events(env)) {
847 0af691d7 Marcelo Tosatti
            ret = 0;
848 0af691d7 Marcelo Tosatti
            break;
849 0af691d7 Marcelo Tosatti
        }
850 0af691d7 Marcelo Tosatti
851 9ded2744 Jan Kiszka
        if (env->kvm_vcpu_dirty) {
852 ea375f9a Jan Kiszka
            kvm_arch_put_registers(env, KVM_PUT_RUNTIME_STATE);
853 9ded2744 Jan Kiszka
            env->kvm_vcpu_dirty = 0;
854 4c0960c0 Avi Kivity
        }
855 4c0960c0 Avi Kivity
856 8c14c173 Jan Kiszka
        kvm_arch_pre_run(env, run);
857 273faf1b Marcelo Tosatti
        cpu_single_env = NULL;
858 d549db5a Glauber Costa
        qemu_mutex_unlock_iothread();
859 05330448 aliguori
        ret = kvm_vcpu_ioctl(env, KVM_RUN, 0);
860 d549db5a Glauber Costa
        qemu_mutex_lock_iothread();
861 273faf1b Marcelo Tosatti
        cpu_single_env = env;
862 05330448 aliguori
        kvm_arch_post_run(env, run);
863 05330448 aliguori
864 05330448 aliguori
        if (ret == -EINTR || ret == -EAGAIN) {
865 cc84de95 Marcelo Tosatti
            cpu_exit(env);
866 8c0d577e Blue Swirl
            DPRINTF("io window exit\n");
867 05330448 aliguori
            ret = 0;
868 05330448 aliguori
            break;
869 05330448 aliguori
        }
870 05330448 aliguori
871 05330448 aliguori
        if (ret < 0) {
872 8c0d577e Blue Swirl
            DPRINTF("kvm run failed %s\n", strerror(-ret));
873 05330448 aliguori
            abort();
874 05330448 aliguori
        }
875 05330448 aliguori
876 62a2744c Sheng Yang
        kvm_flush_coalesced_mmio_buffer();
877 f65ed4c1 aliguori
878 05330448 aliguori
        ret = 0; /* exit loop */
879 05330448 aliguori
        switch (run->exit_reason) {
880 05330448 aliguori
        case KVM_EXIT_IO:
881 8c0d577e Blue Swirl
            DPRINTF("handle_io\n");
882 afcea8cb Blue Swirl
            ret = kvm_handle_io(run->io.port,
883 05330448 aliguori
                                (uint8_t *)run + run->io.data_offset,
884 05330448 aliguori
                                run->io.direction,
885 05330448 aliguori
                                run->io.size,
886 05330448 aliguori
                                run->io.count);
887 05330448 aliguori
            break;
888 05330448 aliguori
        case KVM_EXIT_MMIO:
889 8c0d577e Blue Swirl
            DPRINTF("handle_mmio\n");
890 05330448 aliguori
            cpu_physical_memory_rw(run->mmio.phys_addr,
891 05330448 aliguori
                                   run->mmio.data,
892 05330448 aliguori
                                   run->mmio.len,
893 05330448 aliguori
                                   run->mmio.is_write);
894 05330448 aliguori
            ret = 1;
895 05330448 aliguori
            break;
896 05330448 aliguori
        case KVM_EXIT_IRQ_WINDOW_OPEN:
897 8c0d577e Blue Swirl
            DPRINTF("irq_window_open\n");
898 05330448 aliguori
            break;
899 05330448 aliguori
        case KVM_EXIT_SHUTDOWN:
900 8c0d577e Blue Swirl
            DPRINTF("shutdown\n");
901 05330448 aliguori
            qemu_system_reset_request();
902 05330448 aliguori
            ret = 1;
903 05330448 aliguori
            break;
904 05330448 aliguori
        case KVM_EXIT_UNKNOWN:
905 8c0d577e Blue Swirl
            DPRINTF("kvm_exit_unknown\n");
906 05330448 aliguori
            break;
907 05330448 aliguori
        case KVM_EXIT_FAIL_ENTRY:
908 8c0d577e Blue Swirl
            DPRINTF("kvm_exit_fail_entry\n");
909 05330448 aliguori
            break;
910 05330448 aliguori
        case KVM_EXIT_EXCEPTION:
911 8c0d577e Blue Swirl
            DPRINTF("kvm_exit_exception\n");
912 05330448 aliguori
            break;
913 7c80eef8 Marcelo Tosatti
#ifdef KVM_CAP_INTERNAL_ERROR_DATA
914 7c80eef8 Marcelo Tosatti
        case KVM_EXIT_INTERNAL_ERROR:
915 7c80eef8 Marcelo Tosatti
            kvm_handle_internal_error(env, run);
916 7c80eef8 Marcelo Tosatti
            break;
917 7c80eef8 Marcelo Tosatti
#endif
918 05330448 aliguori
        case KVM_EXIT_DEBUG:
919 8c0d577e Blue Swirl
            DPRINTF("kvm_exit_debug\n");
920 e22a25c9 aliguori
#ifdef KVM_CAP_SET_GUEST_DEBUG
921 e22a25c9 aliguori
            if (kvm_arch_debug(&run->debug.arch)) {
922 e22a25c9 aliguori
                env->exception_index = EXCP_DEBUG;
923 e22a25c9 aliguori
                return 0;
924 e22a25c9 aliguori
            }
925 e22a25c9 aliguori
            /* re-enter, this exception was guest-internal */
926 e22a25c9 aliguori
            ret = 1;
927 e22a25c9 aliguori
#endif /* KVM_CAP_SET_GUEST_DEBUG */
928 05330448 aliguori
            break;
929 05330448 aliguori
        default:
930 8c0d577e Blue Swirl
            DPRINTF("kvm_arch_handle_exit\n");
931 05330448 aliguori
            ret = kvm_arch_handle_exit(env, run);
932 05330448 aliguori
            break;
933 05330448 aliguori
        }
934 05330448 aliguori
    } while (ret > 0);
935 05330448 aliguori
936 be214e6c aurel32
    if (env->exit_request) {
937 be214e6c aurel32
        env->exit_request = 0;
938 becfc390 aliguori
        env->exception_index = EXCP_INTERRUPT;
939 becfc390 aliguori
    }
940 becfc390 aliguori
941 05330448 aliguori
    return ret;
942 05330448 aliguori
}
943 05330448 aliguori
944 984b5181 aliguori
int kvm_ioctl(KVMState *s, int type, ...)
945 05330448 aliguori
{
946 05330448 aliguori
    int ret;
947 984b5181 aliguori
    void *arg;
948 984b5181 aliguori
    va_list ap;
949 05330448 aliguori
950 984b5181 aliguori
    va_start(ap, type);
951 984b5181 aliguori
    arg = va_arg(ap, void *);
952 984b5181 aliguori
    va_end(ap);
953 984b5181 aliguori
954 984b5181 aliguori
    ret = ioctl(s->fd, type, arg);
955 05330448 aliguori
    if (ret == -1)
956 05330448 aliguori
        ret = -errno;
957 05330448 aliguori
958 05330448 aliguori
    return ret;
959 05330448 aliguori
}
960 05330448 aliguori
961 984b5181 aliguori
int kvm_vm_ioctl(KVMState *s, int type, ...)
962 05330448 aliguori
{
963 05330448 aliguori
    int ret;
964 984b5181 aliguori
    void *arg;
965 984b5181 aliguori
    va_list ap;
966 984b5181 aliguori
967 984b5181 aliguori
    va_start(ap, type);
968 984b5181 aliguori
    arg = va_arg(ap, void *);
969 984b5181 aliguori
    va_end(ap);
970 05330448 aliguori
971 984b5181 aliguori
    ret = ioctl(s->vmfd, type, arg);
972 05330448 aliguori
    if (ret == -1)
973 05330448 aliguori
        ret = -errno;
974 05330448 aliguori
975 05330448 aliguori
    return ret;
976 05330448 aliguori
}
977 05330448 aliguori
978 984b5181 aliguori
int kvm_vcpu_ioctl(CPUState *env, int type, ...)
979 05330448 aliguori
{
980 05330448 aliguori
    int ret;
981 984b5181 aliguori
    void *arg;
982 984b5181 aliguori
    va_list ap;
983 984b5181 aliguori
984 984b5181 aliguori
    va_start(ap, type);
985 984b5181 aliguori
    arg = va_arg(ap, void *);
986 984b5181 aliguori
    va_end(ap);
987 05330448 aliguori
988 984b5181 aliguori
    ret = ioctl(env->kvm_fd, type, arg);
989 05330448 aliguori
    if (ret == -1)
990 05330448 aliguori
        ret = -errno;
991 05330448 aliguori
992 05330448 aliguori
    return ret;
993 05330448 aliguori
}
994 bd322087 aliguori
995 bd322087 aliguori
int kvm_has_sync_mmu(void)
996 bd322087 aliguori
{
997 a9c11522 aurel32
#ifdef KVM_CAP_SYNC_MMU
998 bd322087 aliguori
    KVMState *s = kvm_state;
999 bd322087 aliguori
1000 ad7b8b33 Anthony Liguori
    return kvm_check_extension(s, KVM_CAP_SYNC_MMU);
1001 ad7b8b33 Anthony Liguori
#else
1002 bd322087 aliguori
    return 0;
1003 ad7b8b33 Anthony Liguori
#endif
1004 bd322087 aliguori
}
1005 e22a25c9 aliguori
1006 a0fb002c Jan Kiszka
int kvm_has_vcpu_events(void)
1007 a0fb002c Jan Kiszka
{
1008 a0fb002c Jan Kiszka
    return kvm_state->vcpu_events;
1009 a0fb002c Jan Kiszka
}
1010 a0fb002c Jan Kiszka
1011 b0b1d690 Jan Kiszka
int kvm_has_robust_singlestep(void)
1012 b0b1d690 Jan Kiszka
{
1013 b0b1d690 Jan Kiszka
    return kvm_state->robust_singlestep;
1014 b0b1d690 Jan Kiszka
}
1015 b0b1d690 Jan Kiszka
1016 ff44f1a3 Jan Kiszka
int kvm_has_debugregs(void)
1017 ff44f1a3 Jan Kiszka
{
1018 ff44f1a3 Jan Kiszka
    return kvm_state->debugregs;
1019 ff44f1a3 Jan Kiszka
}
1020 ff44f1a3 Jan Kiszka
1021 f1665b21 Sheng Yang
int kvm_has_xsave(void)
1022 f1665b21 Sheng Yang
{
1023 f1665b21 Sheng Yang
    return kvm_state->xsave;
1024 f1665b21 Sheng Yang
}
1025 f1665b21 Sheng Yang
1026 f1665b21 Sheng Yang
int kvm_has_xcrs(void)
1027 f1665b21 Sheng Yang
{
1028 f1665b21 Sheng Yang
    return kvm_state->xcrs;
1029 f1665b21 Sheng Yang
}
1030 f1665b21 Sheng Yang
1031 6f0437e8 Jan Kiszka
void kvm_setup_guest_memory(void *start, size_t size)
1032 6f0437e8 Jan Kiszka
{
1033 6f0437e8 Jan Kiszka
    if (!kvm_has_sync_mmu()) {
1034 e78815a5 Andreas Fรคrber
        int ret = qemu_madvise(start, size, QEMU_MADV_DONTFORK);
1035 6f0437e8 Jan Kiszka
1036 6f0437e8 Jan Kiszka
        if (ret) {
1037 e78815a5 Andreas Fรคrber
            perror("qemu_madvise");
1038 e78815a5 Andreas Fรคrber
            fprintf(stderr,
1039 e78815a5 Andreas Fรคrber
                    "Need MADV_DONTFORK in absence of synchronous KVM MMU\n");
1040 6f0437e8 Jan Kiszka
            exit(1);
1041 6f0437e8 Jan Kiszka
        }
1042 6f0437e8 Jan Kiszka
    }
1043 6f0437e8 Jan Kiszka
}
1044 6f0437e8 Jan Kiszka
1045 e22a25c9 aliguori
#ifdef KVM_CAP_SET_GUEST_DEBUG
1046 e22a25c9 aliguori
struct kvm_sw_breakpoint *kvm_find_sw_breakpoint(CPUState *env,
1047 e22a25c9 aliguori
                                                 target_ulong pc)
1048 e22a25c9 aliguori
{
1049 e22a25c9 aliguori
    struct kvm_sw_breakpoint *bp;
1050 e22a25c9 aliguori
1051 72cf2d4f Blue Swirl
    QTAILQ_FOREACH(bp, &env->kvm_state->kvm_sw_breakpoints, entry) {
1052 e22a25c9 aliguori
        if (bp->pc == pc)
1053 e22a25c9 aliguori
            return bp;
1054 e22a25c9 aliguori
    }
1055 e22a25c9 aliguori
    return NULL;
1056 e22a25c9 aliguori
}
1057 e22a25c9 aliguori
1058 e22a25c9 aliguori
int kvm_sw_breakpoints_active(CPUState *env)
1059 e22a25c9 aliguori
{
1060 72cf2d4f Blue Swirl
    return !QTAILQ_EMPTY(&env->kvm_state->kvm_sw_breakpoints);
1061 e22a25c9 aliguori
}
1062 e22a25c9 aliguori
1063 452e4751 Glauber Costa
struct kvm_set_guest_debug_data {
1064 452e4751 Glauber Costa
    struct kvm_guest_debug dbg;
1065 452e4751 Glauber Costa
    CPUState *env;
1066 452e4751 Glauber Costa
    int err;
1067 452e4751 Glauber Costa
};
1068 452e4751 Glauber Costa
1069 452e4751 Glauber Costa
static void kvm_invoke_set_guest_debug(void *data)
1070 452e4751 Glauber Costa
{
1071 452e4751 Glauber Costa
    struct kvm_set_guest_debug_data *dbg_data = data;
1072 b3807725 Jan Kiszka
    CPUState *env = dbg_data->env;
1073 b3807725 Jan Kiszka
1074 b3807725 Jan Kiszka
    dbg_data->err = kvm_vcpu_ioctl(env, KVM_SET_GUEST_DEBUG, &dbg_data->dbg);
1075 452e4751 Glauber Costa
}
1076 452e4751 Glauber Costa
1077 e22a25c9 aliguori
int kvm_update_guest_debug(CPUState *env, unsigned long reinject_trap)
1078 e22a25c9 aliguori
{
1079 452e4751 Glauber Costa
    struct kvm_set_guest_debug_data data;
1080 e22a25c9 aliguori
1081 b0b1d690 Jan Kiszka
    data.dbg.control = reinject_trap;
1082 e22a25c9 aliguori
1083 b0b1d690 Jan Kiszka
    if (env->singlestep_enabled) {
1084 b0b1d690 Jan Kiszka
        data.dbg.control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP;
1085 b0b1d690 Jan Kiszka
    }
1086 452e4751 Glauber Costa
    kvm_arch_update_guest_debug(env, &data.dbg);
1087 452e4751 Glauber Costa
    data.env = env;
1088 e22a25c9 aliguori
1089 be41cbe0 Jan Kiszka
    run_on_cpu(env, kvm_invoke_set_guest_debug, &data);
1090 452e4751 Glauber Costa
    return data.err;
1091 e22a25c9 aliguori
}
1092 e22a25c9 aliguori
1093 e22a25c9 aliguori
int kvm_insert_breakpoint(CPUState *current_env, target_ulong addr,
1094 e22a25c9 aliguori
                          target_ulong len, int type)
1095 e22a25c9 aliguori
{
1096 e22a25c9 aliguori
    struct kvm_sw_breakpoint *bp;
1097 e22a25c9 aliguori
    CPUState *env;
1098 e22a25c9 aliguori
    int err;
1099 e22a25c9 aliguori
1100 e22a25c9 aliguori
    if (type == GDB_BREAKPOINT_SW) {
1101 e22a25c9 aliguori
        bp = kvm_find_sw_breakpoint(current_env, addr);
1102 e22a25c9 aliguori
        if (bp) {
1103 e22a25c9 aliguori
            bp->use_count++;
1104 e22a25c9 aliguori
            return 0;
1105 e22a25c9 aliguori
        }
1106 e22a25c9 aliguori
1107 e22a25c9 aliguori
        bp = qemu_malloc(sizeof(struct kvm_sw_breakpoint));
1108 e22a25c9 aliguori
        if (!bp)
1109 e22a25c9 aliguori
            return -ENOMEM;
1110 e22a25c9 aliguori
1111 e22a25c9 aliguori
        bp->pc = addr;
1112 e22a25c9 aliguori
        bp->use_count = 1;
1113 e22a25c9 aliguori
        err = kvm_arch_insert_sw_breakpoint(current_env, bp);
1114 e22a25c9 aliguori
        if (err) {
1115 e22a25c9 aliguori
            free(bp);
1116 e22a25c9 aliguori
            return err;
1117 e22a25c9 aliguori
        }
1118 e22a25c9 aliguori
1119 72cf2d4f Blue Swirl
        QTAILQ_INSERT_HEAD(&current_env->kvm_state->kvm_sw_breakpoints,
1120 e22a25c9 aliguori
                          bp, entry);
1121 e22a25c9 aliguori
    } else {
1122 e22a25c9 aliguori
        err = kvm_arch_insert_hw_breakpoint(addr, len, type);
1123 e22a25c9 aliguori
        if (err)
1124 e22a25c9 aliguori
            return err;
1125 e22a25c9 aliguori
    }
1126 e22a25c9 aliguori
1127 e22a25c9 aliguori
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
1128 e22a25c9 aliguori
        err = kvm_update_guest_debug(env, 0);
1129 e22a25c9 aliguori
        if (err)
1130 e22a25c9 aliguori
            return err;
1131 e22a25c9 aliguori
    }
1132 e22a25c9 aliguori
    return 0;
1133 e22a25c9 aliguori
}
1134 e22a25c9 aliguori
1135 e22a25c9 aliguori
int kvm_remove_breakpoint(CPUState *current_env, target_ulong addr,
1136 e22a25c9 aliguori
                          target_ulong len, int type)
1137 e22a25c9 aliguori
{
1138 e22a25c9 aliguori
    struct kvm_sw_breakpoint *bp;
1139 e22a25c9 aliguori
    CPUState *env;
1140 e22a25c9 aliguori
    int err;
1141 e22a25c9 aliguori
1142 e22a25c9 aliguori
    if (type == GDB_BREAKPOINT_SW) {
1143 e22a25c9 aliguori
        bp = kvm_find_sw_breakpoint(current_env, addr);
1144 e22a25c9 aliguori
        if (!bp)
1145 e22a25c9 aliguori
            return -ENOENT;
1146 e22a25c9 aliguori
1147 e22a25c9 aliguori
        if (bp->use_count > 1) {
1148 e22a25c9 aliguori
            bp->use_count--;
1149 e22a25c9 aliguori
            return 0;
1150 e22a25c9 aliguori
        }
1151 e22a25c9 aliguori
1152 e22a25c9 aliguori
        err = kvm_arch_remove_sw_breakpoint(current_env, bp);
1153 e22a25c9 aliguori
        if (err)
1154 e22a25c9 aliguori
            return err;
1155 e22a25c9 aliguori
1156 72cf2d4f Blue Swirl
        QTAILQ_REMOVE(&current_env->kvm_state->kvm_sw_breakpoints, bp, entry);
1157 e22a25c9 aliguori
        qemu_free(bp);
1158 e22a25c9 aliguori
    } else {
1159 e22a25c9 aliguori
        err = kvm_arch_remove_hw_breakpoint(addr, len, type);
1160 e22a25c9 aliguori
        if (err)
1161 e22a25c9 aliguori
            return err;
1162 e22a25c9 aliguori
    }
1163 e22a25c9 aliguori
1164 e22a25c9 aliguori
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
1165 e22a25c9 aliguori
        err = kvm_update_guest_debug(env, 0);
1166 e22a25c9 aliguori
        if (err)
1167 e22a25c9 aliguori
            return err;
1168 e22a25c9 aliguori
    }
1169 e22a25c9 aliguori
    return 0;
1170 e22a25c9 aliguori
}
1171 e22a25c9 aliguori
1172 e22a25c9 aliguori
void kvm_remove_all_breakpoints(CPUState *current_env)
1173 e22a25c9 aliguori
{
1174 e22a25c9 aliguori
    struct kvm_sw_breakpoint *bp, *next;
1175 e22a25c9 aliguori
    KVMState *s = current_env->kvm_state;
1176 e22a25c9 aliguori
    CPUState *env;
1177 e22a25c9 aliguori
1178 72cf2d4f Blue Swirl
    QTAILQ_FOREACH_SAFE(bp, &s->kvm_sw_breakpoints, entry, next) {
1179 e22a25c9 aliguori
        if (kvm_arch_remove_sw_breakpoint(current_env, bp) != 0) {
1180 e22a25c9 aliguori
            /* Try harder to find a CPU that currently sees the breakpoint. */
1181 e22a25c9 aliguori
            for (env = first_cpu; env != NULL; env = env->next_cpu) {
1182 e22a25c9 aliguori
                if (kvm_arch_remove_sw_breakpoint(env, bp) == 0)
1183 e22a25c9 aliguori
                    break;
1184 e22a25c9 aliguori
            }
1185 e22a25c9 aliguori
        }
1186 e22a25c9 aliguori
    }
1187 e22a25c9 aliguori
    kvm_arch_remove_all_hw_breakpoints();
1188 e22a25c9 aliguori
1189 e22a25c9 aliguori
    for (env = first_cpu; env != NULL; env = env->next_cpu)
1190 e22a25c9 aliguori
        kvm_update_guest_debug(env, 0);
1191 e22a25c9 aliguori
}
1192 e22a25c9 aliguori
1193 e22a25c9 aliguori
#else /* !KVM_CAP_SET_GUEST_DEBUG */
1194 e22a25c9 aliguori
1195 e22a25c9 aliguori
int kvm_update_guest_debug(CPUState *env, unsigned long reinject_trap)
1196 e22a25c9 aliguori
{
1197 e22a25c9 aliguori
    return -EINVAL;
1198 e22a25c9 aliguori
}
1199 e22a25c9 aliguori
1200 e22a25c9 aliguori
int kvm_insert_breakpoint(CPUState *current_env, target_ulong addr,
1201 e22a25c9 aliguori
                          target_ulong len, int type)
1202 e22a25c9 aliguori
{
1203 e22a25c9 aliguori
    return -EINVAL;
1204 e22a25c9 aliguori
}
1205 e22a25c9 aliguori
1206 e22a25c9 aliguori
int kvm_remove_breakpoint(CPUState *current_env, target_ulong addr,
1207 e22a25c9 aliguori
                          target_ulong len, int type)
1208 e22a25c9 aliguori
{
1209 e22a25c9 aliguori
    return -EINVAL;
1210 e22a25c9 aliguori
}
1211 e22a25c9 aliguori
1212 e22a25c9 aliguori
void kvm_remove_all_breakpoints(CPUState *current_env)
1213 e22a25c9 aliguori
{
1214 e22a25c9 aliguori
}
1215 e22a25c9 aliguori
#endif /* !KVM_CAP_SET_GUEST_DEBUG */
1216 cc84de95 Marcelo Tosatti
1217 cc84de95 Marcelo Tosatti
int kvm_set_signal_mask(CPUState *env, const sigset_t *sigset)
1218 cc84de95 Marcelo Tosatti
{
1219 cc84de95 Marcelo Tosatti
    struct kvm_signal_mask *sigmask;
1220 cc84de95 Marcelo Tosatti
    int r;
1221 cc84de95 Marcelo Tosatti
1222 cc84de95 Marcelo Tosatti
    if (!sigset)
1223 cc84de95 Marcelo Tosatti
        return kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, NULL);
1224 cc84de95 Marcelo Tosatti
1225 cc84de95 Marcelo Tosatti
    sigmask = qemu_malloc(sizeof(*sigmask) + sizeof(*sigset));
1226 cc84de95 Marcelo Tosatti
1227 cc84de95 Marcelo Tosatti
    sigmask->len = 8;
1228 cc84de95 Marcelo Tosatti
    memcpy(sigmask->sigset, sigset, sizeof(*sigset));
1229 cc84de95 Marcelo Tosatti
    r = kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, sigmask);
1230 cc84de95 Marcelo Tosatti
    free(sigmask);
1231 cc84de95 Marcelo Tosatti
1232 cc84de95 Marcelo Tosatti
    return r;
1233 cc84de95 Marcelo Tosatti
}
1234 ca821806 Michael S. Tsirkin
1235 44f1a3d8 Cam Macdonell
int kvm_set_ioeventfd_mmio_long(int fd, uint32_t addr, uint32_t val, bool assign)
1236 44f1a3d8 Cam Macdonell
{
1237 44f1a3d8 Cam Macdonell
#ifdef KVM_IOEVENTFD
1238 44f1a3d8 Cam Macdonell
    int ret;
1239 44f1a3d8 Cam Macdonell
    struct kvm_ioeventfd iofd;
1240 44f1a3d8 Cam Macdonell
1241 44f1a3d8 Cam Macdonell
    iofd.datamatch = val;
1242 44f1a3d8 Cam Macdonell
    iofd.addr = addr;
1243 44f1a3d8 Cam Macdonell
    iofd.len = 4;
1244 44f1a3d8 Cam Macdonell
    iofd.flags = KVM_IOEVENTFD_FLAG_DATAMATCH;
1245 44f1a3d8 Cam Macdonell
    iofd.fd = fd;
1246 44f1a3d8 Cam Macdonell
1247 44f1a3d8 Cam Macdonell
    if (!kvm_enabled()) {
1248 44f1a3d8 Cam Macdonell
        return -ENOSYS;
1249 44f1a3d8 Cam Macdonell
    }
1250 44f1a3d8 Cam Macdonell
1251 44f1a3d8 Cam Macdonell
    if (!assign) {
1252 44f1a3d8 Cam Macdonell
        iofd.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
1253 44f1a3d8 Cam Macdonell
    }
1254 44f1a3d8 Cam Macdonell
1255 44f1a3d8 Cam Macdonell
    ret = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &iofd);
1256 44f1a3d8 Cam Macdonell
1257 44f1a3d8 Cam Macdonell
    if (ret < 0) {
1258 44f1a3d8 Cam Macdonell
        return -errno;
1259 44f1a3d8 Cam Macdonell
    }
1260 44f1a3d8 Cam Macdonell
1261 44f1a3d8 Cam Macdonell
    return 0;
1262 44f1a3d8 Cam Macdonell
#else
1263 44f1a3d8 Cam Macdonell
    return -ENOSYS;
1264 44f1a3d8 Cam Macdonell
#endif
1265 44f1a3d8 Cam Macdonell
}
1266 44f1a3d8 Cam Macdonell
1267 ca821806 Michael S. Tsirkin
int kvm_set_ioeventfd_pio_word(int fd, uint16_t addr, uint16_t val, bool assign)
1268 ca821806 Michael S. Tsirkin
{
1269 98c8573e Paolo Bonzini
#ifdef KVM_IOEVENTFD
1270 ca821806 Michael S. Tsirkin
    struct kvm_ioeventfd kick = {
1271 ca821806 Michael S. Tsirkin
        .datamatch = val,
1272 ca821806 Michael S. Tsirkin
        .addr = addr,
1273 ca821806 Michael S. Tsirkin
        .len = 2,
1274 ca821806 Michael S. Tsirkin
        .flags = KVM_IOEVENTFD_FLAG_DATAMATCH | KVM_IOEVENTFD_FLAG_PIO,
1275 ca821806 Michael S. Tsirkin
        .fd = fd,
1276 ca821806 Michael S. Tsirkin
    };
1277 ca821806 Michael S. Tsirkin
    int r;
1278 ca821806 Michael S. Tsirkin
    if (!kvm_enabled())
1279 ca821806 Michael S. Tsirkin
        return -ENOSYS;
1280 ca821806 Michael S. Tsirkin
    if (!assign)
1281 ca821806 Michael S. Tsirkin
        kick.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
1282 ca821806 Michael S. Tsirkin
    r = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &kick);
1283 ca821806 Michael S. Tsirkin
    if (r < 0)
1284 ca821806 Michael S. Tsirkin
        return r;
1285 ca821806 Michael S. Tsirkin
    return 0;
1286 98c8573e Paolo Bonzini
#else
1287 98c8573e Paolo Bonzini
    return -ENOSYS;
1288 ca821806 Michael S. Tsirkin
#endif
1289 98c8573e Paolo Bonzini
}