Statistics
| Branch: | Revision:

root / kvm-all.c @ e7b43f7e

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