Statistics
| Branch: | Revision:

root / kvm-all.c @ dc1c13d9

History | View | Annotate | Download (50.7 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 ebd063d1 Paolo Bonzini
#include "qemu-option.h"
26 ebd063d1 Paolo Bonzini
#include "qemu-config.h"
27 05330448 aliguori
#include "sysemu.h"
28 d33a1810 Jan Kiszka
#include "hw/hw.h"
29 04fa27f5 Jan Kiszka
#include "hw/msi.h"
30 e22a25c9 aliguori
#include "gdbstub.h"
31 05330448 aliguori
#include "kvm.h"
32 8369e01c Marcelo Tosatti
#include "bswap.h"
33 a01672d3 Avi Kivity
#include "memory.h"
34 80a1ea37 Avi Kivity
#include "exec-memory.h"
35 753d5e14 Paolo Bonzini
#include "event_notifier.h"
36 05330448 aliguori
37 d2f2b8a7 Stefan Hajnoczi
/* This check must be after config-host.h is included */
38 d2f2b8a7 Stefan Hajnoczi
#ifdef CONFIG_EVENTFD
39 d2f2b8a7 Stefan Hajnoczi
#include <sys/eventfd.h>
40 d2f2b8a7 Stefan Hajnoczi
#endif
41 d2f2b8a7 Stefan Hajnoczi
42 62fe8331 Christian Borntraeger
#ifdef CONFIG_VALGRIND_H
43 62fe8331 Christian Borntraeger
#include <valgrind/memcheck.h>
44 62fe8331 Christian Borntraeger
#endif
45 62fe8331 Christian Borntraeger
46 93148aa5 Stefan Weil
/* KVM uses PAGE_SIZE in its definition of COALESCED_MMIO_MAX */
47 f65ed4c1 aliguori
#define PAGE_SIZE TARGET_PAGE_SIZE
48 f65ed4c1 aliguori
49 05330448 aliguori
//#define DEBUG_KVM
50 05330448 aliguori
51 05330448 aliguori
#ifdef DEBUG_KVM
52 8c0d577e Blue Swirl
#define DPRINTF(fmt, ...) \
53 05330448 aliguori
    do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
54 05330448 aliguori
#else
55 8c0d577e Blue Swirl
#define DPRINTF(fmt, ...) \
56 05330448 aliguori
    do { } while (0)
57 05330448 aliguori
#endif
58 05330448 aliguori
59 04fa27f5 Jan Kiszka
#define KVM_MSI_HASHTAB_SIZE    256
60 04fa27f5 Jan Kiszka
61 34fc643f aliguori
typedef struct KVMSlot
62 34fc643f aliguori
{
63 c227f099 Anthony Liguori
    target_phys_addr_t start_addr;
64 c227f099 Anthony Liguori
    ram_addr_t memory_size;
65 9f213ed9 Avi Kivity
    void *ram;
66 34fc643f aliguori
    int slot;
67 34fc643f aliguori
    int flags;
68 34fc643f aliguori
} KVMSlot;
69 05330448 aliguori
70 5832d1f2 aliguori
typedef struct kvm_dirty_log KVMDirtyLog;
71 5832d1f2 aliguori
72 05330448 aliguori
struct KVMState
73 05330448 aliguori
{
74 05330448 aliguori
    KVMSlot slots[32];
75 05330448 aliguori
    int fd;
76 05330448 aliguori
    int vmfd;
77 f65ed4c1 aliguori
    int coalesced_mmio;
78 62a2744c Sheng Yang
    struct kvm_coalesced_mmio_ring *coalesced_mmio_ring;
79 1cae88b9 Avi Kivity
    bool coalesced_flush_in_progress;
80 e69917e2 Jan Kiszka
    int broken_set_mem_region;
81 4495d6a7 Jan Kiszka
    int migration_log;
82 a0fb002c Jan Kiszka
    int vcpu_events;
83 b0b1d690 Jan Kiszka
    int robust_singlestep;
84 ff44f1a3 Jan Kiszka
    int debugregs;
85 e22a25c9 aliguori
#ifdef KVM_CAP_SET_GUEST_DEBUG
86 e22a25c9 aliguori
    struct kvm_sw_breakpoint_head kvm_sw_breakpoints;
87 e22a25c9 aliguori
#endif
88 8a7c7393 Jan Kiszka
    int pit_state2;
89 f1665b21 Sheng Yang
    int xsave, xcrs;
90 d2f2b8a7 Stefan Hajnoczi
    int many_ioeventfds;
91 3ab73842 Jan Kiszka
    int intx_set_mask;
92 92e4b519 David Gibson
    /* The man page (and posix) say ioctl numbers are signed int, but
93 92e4b519 David Gibson
     * they're not.  Linux, glibc and *BSD all treat ioctl numbers as
94 92e4b519 David Gibson
     * unsigned, and treating them as signed here can break things */
95 e333cd69 Jan Kiszka
    unsigned irq_set_ioctl;
96 84b058d7 Jan Kiszka
#ifdef KVM_CAP_IRQ_ROUTING
97 84b058d7 Jan Kiszka
    struct kvm_irq_routing *irq_routes;
98 84b058d7 Jan Kiszka
    int nr_allocated_irq_routes;
99 84b058d7 Jan Kiszka
    uint32_t *used_gsi_bitmap;
100 4e2e4e63 Jan Kiszka
    unsigned int gsi_count;
101 04fa27f5 Jan Kiszka
    QTAILQ_HEAD(msi_hashtab, KVMMSIRoute) msi_hashtab[KVM_MSI_HASHTAB_SIZE];
102 4a3adebb Jan Kiszka
    bool direct_msi;
103 84b058d7 Jan Kiszka
#endif
104 05330448 aliguori
};
105 05330448 aliguori
106 6a7af8cb Jan Kiszka
KVMState *kvm_state;
107 3d4b2649 Jan Kiszka
bool kvm_kernel_irqchip;
108 7ae26bd4 Peter Maydell
bool kvm_async_interrupts_allowed;
109 cc7e0ddf Peter Maydell
bool kvm_irqfds_allowed;
110 614e41bc Peter Maydell
bool kvm_msi_via_irqfd_allowed;
111 f3e1bed8 Peter Maydell
bool kvm_gsi_routing_allowed;
112 05330448 aliguori
113 94a8d39a Jan Kiszka
static const KVMCapabilityInfo kvm_required_capabilites[] = {
114 94a8d39a Jan Kiszka
    KVM_CAP_INFO(USER_MEMORY),
115 94a8d39a Jan Kiszka
    KVM_CAP_INFO(DESTROY_MEMORY_REGION_WORKS),
116 94a8d39a Jan Kiszka
    KVM_CAP_LAST_INFO
117 94a8d39a Jan Kiszka
};
118 94a8d39a Jan Kiszka
119 05330448 aliguori
static KVMSlot *kvm_alloc_slot(KVMState *s)
120 05330448 aliguori
{
121 05330448 aliguori
    int i;
122 05330448 aliguori
123 05330448 aliguori
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
124 a426e122 Jan Kiszka
        if (s->slots[i].memory_size == 0) {
125 05330448 aliguori
            return &s->slots[i];
126 a426e122 Jan Kiszka
        }
127 05330448 aliguori
    }
128 05330448 aliguori
129 d3f8d37f aliguori
    fprintf(stderr, "%s: no free slot available\n", __func__);
130 d3f8d37f aliguori
    abort();
131 d3f8d37f aliguori
}
132 d3f8d37f aliguori
133 d3f8d37f aliguori
static KVMSlot *kvm_lookup_matching_slot(KVMState *s,
134 c227f099 Anthony Liguori
                                         target_phys_addr_t start_addr,
135 c227f099 Anthony Liguori
                                         target_phys_addr_t end_addr)
136 d3f8d37f aliguori
{
137 d3f8d37f aliguori
    int i;
138 d3f8d37f aliguori
139 d3f8d37f aliguori
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
140 d3f8d37f aliguori
        KVMSlot *mem = &s->slots[i];
141 d3f8d37f aliguori
142 d3f8d37f aliguori
        if (start_addr == mem->start_addr &&
143 d3f8d37f aliguori
            end_addr == mem->start_addr + mem->memory_size) {
144 d3f8d37f aliguori
            return mem;
145 d3f8d37f aliguori
        }
146 d3f8d37f aliguori
    }
147 d3f8d37f aliguori
148 05330448 aliguori
    return NULL;
149 05330448 aliguori
}
150 05330448 aliguori
151 6152e2ae aliguori
/*
152 6152e2ae aliguori
 * Find overlapping slot with lowest start address
153 6152e2ae aliguori
 */
154 6152e2ae aliguori
static KVMSlot *kvm_lookup_overlapping_slot(KVMState *s,
155 c227f099 Anthony Liguori
                                            target_phys_addr_t start_addr,
156 c227f099 Anthony Liguori
                                            target_phys_addr_t end_addr)
157 05330448 aliguori
{
158 6152e2ae aliguori
    KVMSlot *found = NULL;
159 05330448 aliguori
    int i;
160 05330448 aliguori
161 05330448 aliguori
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
162 05330448 aliguori
        KVMSlot *mem = &s->slots[i];
163 05330448 aliguori
164 6152e2ae aliguori
        if (mem->memory_size == 0 ||
165 6152e2ae aliguori
            (found && found->start_addr < mem->start_addr)) {
166 6152e2ae aliguori
            continue;
167 6152e2ae aliguori
        }
168 6152e2ae aliguori
169 6152e2ae aliguori
        if (end_addr > mem->start_addr &&
170 6152e2ae aliguori
            start_addr < mem->start_addr + mem->memory_size) {
171 6152e2ae aliguori
            found = mem;
172 6152e2ae aliguori
        }
173 05330448 aliguori
    }
174 05330448 aliguori
175 6152e2ae aliguori
    return found;
176 05330448 aliguori
}
177 05330448 aliguori
178 9f213ed9 Avi Kivity
int kvm_physical_memory_addr_from_host(KVMState *s, void *ram,
179 9f213ed9 Avi Kivity
                                       target_phys_addr_t *phys_addr)
180 983dfc3b Huang Ying
{
181 983dfc3b Huang Ying
    int i;
182 983dfc3b Huang Ying
183 983dfc3b Huang Ying
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
184 983dfc3b Huang Ying
        KVMSlot *mem = &s->slots[i];
185 983dfc3b Huang Ying
186 9f213ed9 Avi Kivity
        if (ram >= mem->ram && ram < mem->ram + mem->memory_size) {
187 9f213ed9 Avi Kivity
            *phys_addr = mem->start_addr + (ram - mem->ram);
188 983dfc3b Huang Ying
            return 1;
189 983dfc3b Huang Ying
        }
190 983dfc3b Huang Ying
    }
191 983dfc3b Huang Ying
192 983dfc3b Huang Ying
    return 0;
193 983dfc3b Huang Ying
}
194 983dfc3b Huang Ying
195 5832d1f2 aliguori
static int kvm_set_user_memory_region(KVMState *s, KVMSlot *slot)
196 5832d1f2 aliguori
{
197 5832d1f2 aliguori
    struct kvm_userspace_memory_region mem;
198 5832d1f2 aliguori
199 5832d1f2 aliguori
    mem.slot = slot->slot;
200 5832d1f2 aliguori
    mem.guest_phys_addr = slot->start_addr;
201 5832d1f2 aliguori
    mem.memory_size = slot->memory_size;
202 9f213ed9 Avi Kivity
    mem.userspace_addr = (unsigned long)slot->ram;
203 5832d1f2 aliguori
    mem.flags = slot->flags;
204 4495d6a7 Jan Kiszka
    if (s->migration_log) {
205 4495d6a7 Jan Kiszka
        mem.flags |= KVM_MEM_LOG_DIRTY_PAGES;
206 4495d6a7 Jan Kiszka
    }
207 5832d1f2 aliguori
    return kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
208 5832d1f2 aliguori
}
209 5832d1f2 aliguori
210 8d2ba1fb Jan Kiszka
static void kvm_reset_vcpu(void *opaque)
211 8d2ba1fb Jan Kiszka
{
212 9349b4f9 Andreas Färber
    CPUArchState *env = opaque;
213 8d2ba1fb Jan Kiszka
214 caa5af0f Jan Kiszka
    kvm_arch_reset_vcpu(env);
215 8d2ba1fb Jan Kiszka
}
216 5832d1f2 aliguori
217 9349b4f9 Andreas Färber
int kvm_init_vcpu(CPUArchState *env)
218 05330448 aliguori
{
219 05330448 aliguori
    KVMState *s = kvm_state;
220 05330448 aliguori
    long mmap_size;
221 05330448 aliguori
    int ret;
222 05330448 aliguori
223 8c0d577e Blue Swirl
    DPRINTF("kvm_init_vcpu\n");
224 05330448 aliguori
225 984b5181 aliguori
    ret = kvm_vm_ioctl(s, KVM_CREATE_VCPU, env->cpu_index);
226 05330448 aliguori
    if (ret < 0) {
227 8c0d577e Blue Swirl
        DPRINTF("kvm_create_vcpu failed\n");
228 05330448 aliguori
        goto err;
229 05330448 aliguori
    }
230 05330448 aliguori
231 05330448 aliguori
    env->kvm_fd = ret;
232 05330448 aliguori
    env->kvm_state = s;
233 d841b6c4 Jan Kiszka
    env->kvm_vcpu_dirty = 1;
234 05330448 aliguori
235 05330448 aliguori
    mmap_size = kvm_ioctl(s, KVM_GET_VCPU_MMAP_SIZE, 0);
236 05330448 aliguori
    if (mmap_size < 0) {
237 748a680b Jan Kiszka
        ret = mmap_size;
238 8c0d577e Blue Swirl
        DPRINTF("KVM_GET_VCPU_MMAP_SIZE failed\n");
239 05330448 aliguori
        goto err;
240 05330448 aliguori
    }
241 05330448 aliguori
242 05330448 aliguori
    env->kvm_run = mmap(NULL, mmap_size, PROT_READ | PROT_WRITE, MAP_SHARED,
243 05330448 aliguori
                        env->kvm_fd, 0);
244 05330448 aliguori
    if (env->kvm_run == MAP_FAILED) {
245 05330448 aliguori
        ret = -errno;
246 8c0d577e Blue Swirl
        DPRINTF("mmap'ing vcpu state failed\n");
247 05330448 aliguori
        goto err;
248 05330448 aliguori
    }
249 05330448 aliguori
250 a426e122 Jan Kiszka
    if (s->coalesced_mmio && !s->coalesced_mmio_ring) {
251 a426e122 Jan Kiszka
        s->coalesced_mmio_ring =
252 a426e122 Jan Kiszka
            (void *)env->kvm_run + s->coalesced_mmio * PAGE_SIZE;
253 a426e122 Jan Kiszka
    }
254 62a2744c Sheng Yang
255 05330448 aliguori
    ret = kvm_arch_init_vcpu(env);
256 8d2ba1fb Jan Kiszka
    if (ret == 0) {
257 a08d4367 Jan Kiszka
        qemu_register_reset(kvm_reset_vcpu, env);
258 caa5af0f Jan Kiszka
        kvm_arch_reset_vcpu(env);
259 8d2ba1fb Jan Kiszka
    }
260 05330448 aliguori
err:
261 05330448 aliguori
    return ret;
262 05330448 aliguori
}
263 05330448 aliguori
264 5832d1f2 aliguori
/*
265 5832d1f2 aliguori
 * dirty pages logging control
266 5832d1f2 aliguori
 */
267 25254bbc Michael S. Tsirkin
268 25254bbc Michael S. Tsirkin
static int kvm_mem_flags(KVMState *s, bool log_dirty)
269 25254bbc Michael S. Tsirkin
{
270 25254bbc Michael S. Tsirkin
    return log_dirty ? KVM_MEM_LOG_DIRTY_PAGES : 0;
271 25254bbc Michael S. Tsirkin
}
272 25254bbc Michael S. Tsirkin
273 25254bbc Michael S. Tsirkin
static int kvm_slot_dirty_pages_log_change(KVMSlot *mem, bool log_dirty)
274 5832d1f2 aliguori
{
275 5832d1f2 aliguori
    KVMState *s = kvm_state;
276 25254bbc Michael S. Tsirkin
    int flags, mask = KVM_MEM_LOG_DIRTY_PAGES;
277 4495d6a7 Jan Kiszka
    int old_flags;
278 4495d6a7 Jan Kiszka
279 4495d6a7 Jan Kiszka
    old_flags = mem->flags;
280 5832d1f2 aliguori
281 25254bbc Michael S. Tsirkin
    flags = (mem->flags & ~mask) | kvm_mem_flags(s, log_dirty);
282 5832d1f2 aliguori
    mem->flags = flags;
283 5832d1f2 aliguori
284 4495d6a7 Jan Kiszka
    /* If nothing changed effectively, no need to issue ioctl */
285 4495d6a7 Jan Kiszka
    if (s->migration_log) {
286 4495d6a7 Jan Kiszka
        flags |= KVM_MEM_LOG_DIRTY_PAGES;
287 4495d6a7 Jan Kiszka
    }
288 25254bbc Michael S. Tsirkin
289 4495d6a7 Jan Kiszka
    if (flags == old_flags) {
290 25254bbc Michael S. Tsirkin
        return 0;
291 4495d6a7 Jan Kiszka
    }
292 4495d6a7 Jan Kiszka
293 5832d1f2 aliguori
    return kvm_set_user_memory_region(s, mem);
294 5832d1f2 aliguori
}
295 5832d1f2 aliguori
296 25254bbc Michael S. Tsirkin
static int kvm_dirty_pages_log_change(target_phys_addr_t phys_addr,
297 25254bbc Michael S. Tsirkin
                                      ram_addr_t size, bool log_dirty)
298 25254bbc Michael S. Tsirkin
{
299 25254bbc Michael S. Tsirkin
    KVMState *s = kvm_state;
300 25254bbc Michael S. Tsirkin
    KVMSlot *mem = kvm_lookup_matching_slot(s, phys_addr, phys_addr + size);
301 25254bbc Michael S. Tsirkin
302 25254bbc Michael S. Tsirkin
    if (mem == NULL)  {
303 25254bbc Michael S. Tsirkin
        fprintf(stderr, "BUG: %s: invalid parameters " TARGET_FMT_plx "-"
304 25254bbc Michael S. Tsirkin
                TARGET_FMT_plx "\n", __func__, phys_addr,
305 25254bbc Michael S. Tsirkin
                (target_phys_addr_t)(phys_addr + size - 1));
306 25254bbc Michael S. Tsirkin
        return -EINVAL;
307 25254bbc Michael S. Tsirkin
    }
308 25254bbc Michael S. Tsirkin
    return kvm_slot_dirty_pages_log_change(mem, log_dirty);
309 25254bbc Michael S. Tsirkin
}
310 25254bbc Michael S. Tsirkin
311 a01672d3 Avi Kivity
static void kvm_log_start(MemoryListener *listener,
312 a01672d3 Avi Kivity
                          MemoryRegionSection *section)
313 5832d1f2 aliguori
{
314 a01672d3 Avi Kivity
    int r;
315 a01672d3 Avi Kivity
316 a01672d3 Avi Kivity
    r = kvm_dirty_pages_log_change(section->offset_within_address_space,
317 a01672d3 Avi Kivity
                                   section->size, true);
318 a01672d3 Avi Kivity
    if (r < 0) {
319 a01672d3 Avi Kivity
        abort();
320 a01672d3 Avi Kivity
    }
321 5832d1f2 aliguori
}
322 5832d1f2 aliguori
323 a01672d3 Avi Kivity
static void kvm_log_stop(MemoryListener *listener,
324 a01672d3 Avi Kivity
                          MemoryRegionSection *section)
325 5832d1f2 aliguori
{
326 a01672d3 Avi Kivity
    int r;
327 a01672d3 Avi Kivity
328 a01672d3 Avi Kivity
    r = kvm_dirty_pages_log_change(section->offset_within_address_space,
329 a01672d3 Avi Kivity
                                   section->size, false);
330 a01672d3 Avi Kivity
    if (r < 0) {
331 a01672d3 Avi Kivity
        abort();
332 a01672d3 Avi Kivity
    }
333 5832d1f2 aliguori
}
334 5832d1f2 aliguori
335 7b8f3b78 Michael S. Tsirkin
static int kvm_set_migration_log(int enable)
336 4495d6a7 Jan Kiszka
{
337 4495d6a7 Jan Kiszka
    KVMState *s = kvm_state;
338 4495d6a7 Jan Kiszka
    KVMSlot *mem;
339 4495d6a7 Jan Kiszka
    int i, err;
340 4495d6a7 Jan Kiszka
341 4495d6a7 Jan Kiszka
    s->migration_log = enable;
342 4495d6a7 Jan Kiszka
343 4495d6a7 Jan Kiszka
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
344 4495d6a7 Jan Kiszka
        mem = &s->slots[i];
345 4495d6a7 Jan Kiszka
346 70fedd76 Alex Williamson
        if (!mem->memory_size) {
347 70fedd76 Alex Williamson
            continue;
348 70fedd76 Alex Williamson
        }
349 4495d6a7 Jan Kiszka
        if (!!(mem->flags & KVM_MEM_LOG_DIRTY_PAGES) == enable) {
350 4495d6a7 Jan Kiszka
            continue;
351 4495d6a7 Jan Kiszka
        }
352 4495d6a7 Jan Kiszka
        err = kvm_set_user_memory_region(s, mem);
353 4495d6a7 Jan Kiszka
        if (err) {
354 4495d6a7 Jan Kiszka
            return err;
355 4495d6a7 Jan Kiszka
        }
356 4495d6a7 Jan Kiszka
    }
357 4495d6a7 Jan Kiszka
    return 0;
358 4495d6a7 Jan Kiszka
}
359 4495d6a7 Jan Kiszka
360 8369e01c Marcelo Tosatti
/* get kvm's dirty pages bitmap and update qemu's */
361 ffcde12f Avi Kivity
static int kvm_get_dirty_pages_log_range(MemoryRegionSection *section,
362 ffcde12f Avi Kivity
                                         unsigned long *bitmap)
363 96c1606b Alexander Graf
{
364 8369e01c Marcelo Tosatti
    unsigned int i, j;
365 aa90fec7 Benjamin Herrenschmidt
    unsigned long page_number, c;
366 aa90fec7 Benjamin Herrenschmidt
    target_phys_addr_t addr, addr1;
367 ffcde12f Avi Kivity
    unsigned int len = ((section->size / TARGET_PAGE_SIZE) + HOST_LONG_BITS - 1) / HOST_LONG_BITS;
368 3145fcb6 David Gibson
    unsigned long hpratio = getpagesize() / TARGET_PAGE_SIZE;
369 8369e01c Marcelo Tosatti
370 8369e01c Marcelo Tosatti
    /*
371 8369e01c Marcelo Tosatti
     * bitmap-traveling is faster than memory-traveling (for addr...)
372 8369e01c Marcelo Tosatti
     * especially when most of the memory is not dirty.
373 8369e01c Marcelo Tosatti
     */
374 8369e01c Marcelo Tosatti
    for (i = 0; i < len; i++) {
375 8369e01c Marcelo Tosatti
        if (bitmap[i] != 0) {
376 8369e01c Marcelo Tosatti
            c = leul_to_cpu(bitmap[i]);
377 8369e01c Marcelo Tosatti
            do {
378 8369e01c Marcelo Tosatti
                j = ffsl(c) - 1;
379 8369e01c Marcelo Tosatti
                c &= ~(1ul << j);
380 3145fcb6 David Gibson
                page_number = (i * HOST_LONG_BITS + j) * hpratio;
381 8369e01c Marcelo Tosatti
                addr1 = page_number * TARGET_PAGE_SIZE;
382 ffcde12f Avi Kivity
                addr = section->offset_within_region + addr1;
383 3145fcb6 David Gibson
                memory_region_set_dirty(section->mr, addr,
384 3145fcb6 David Gibson
                                        TARGET_PAGE_SIZE * hpratio);
385 8369e01c Marcelo Tosatti
            } while (c != 0);
386 8369e01c Marcelo Tosatti
        }
387 8369e01c Marcelo Tosatti
    }
388 8369e01c Marcelo Tosatti
    return 0;
389 96c1606b Alexander Graf
}
390 96c1606b Alexander Graf
391 8369e01c Marcelo Tosatti
#define ALIGN(x, y)  (((x)+(y)-1) & ~((y)-1))
392 8369e01c Marcelo Tosatti
393 5832d1f2 aliguori
/**
394 5832d1f2 aliguori
 * kvm_physical_sync_dirty_bitmap - Grab dirty bitmap from kernel space
395 fd4aa979 Blue Swirl
 * This function updates qemu's dirty bitmap using
396 fd4aa979 Blue Swirl
 * memory_region_set_dirty().  This means all bits are set
397 fd4aa979 Blue Swirl
 * to dirty.
398 5832d1f2 aliguori
 *
399 d3f8d37f aliguori
 * @start_add: start of logged region.
400 5832d1f2 aliguori
 * @end_addr: end of logged region.
401 5832d1f2 aliguori
 */
402 ffcde12f Avi Kivity
static int kvm_physical_sync_dirty_bitmap(MemoryRegionSection *section)
403 5832d1f2 aliguori
{
404 5832d1f2 aliguori
    KVMState *s = kvm_state;
405 151f7749 Jan Kiszka
    unsigned long size, allocated_size = 0;
406 151f7749 Jan Kiszka
    KVMDirtyLog d;
407 151f7749 Jan Kiszka
    KVMSlot *mem;
408 151f7749 Jan Kiszka
    int ret = 0;
409 ffcde12f Avi Kivity
    target_phys_addr_t start_addr = section->offset_within_address_space;
410 ffcde12f Avi Kivity
    target_phys_addr_t end_addr = start_addr + section->size;
411 5832d1f2 aliguori
412 151f7749 Jan Kiszka
    d.dirty_bitmap = NULL;
413 151f7749 Jan Kiszka
    while (start_addr < end_addr) {
414 151f7749 Jan Kiszka
        mem = kvm_lookup_overlapping_slot(s, start_addr, end_addr);
415 151f7749 Jan Kiszka
        if (mem == NULL) {
416 151f7749 Jan Kiszka
            break;
417 151f7749 Jan Kiszka
        }
418 5832d1f2 aliguori
419 51b0c606 Michael Tokarev
        /* XXX bad kernel interface alert
420 51b0c606 Michael Tokarev
         * For dirty bitmap, kernel allocates array of size aligned to
421 51b0c606 Michael Tokarev
         * bits-per-long.  But for case when the kernel is 64bits and
422 51b0c606 Michael Tokarev
         * the userspace is 32bits, userspace can't align to the same
423 51b0c606 Michael Tokarev
         * bits-per-long, since sizeof(long) is different between kernel
424 51b0c606 Michael Tokarev
         * and user space.  This way, userspace will provide buffer which
425 51b0c606 Michael Tokarev
         * may be 4 bytes less than the kernel will use, resulting in
426 51b0c606 Michael Tokarev
         * userspace memory corruption (which is not detectable by valgrind
427 51b0c606 Michael Tokarev
         * too, in most cases).
428 51b0c606 Michael Tokarev
         * So for now, let's align to 64 instead of HOST_LONG_BITS here, in
429 51b0c606 Michael Tokarev
         * a hope that sizeof(long) wont become >8 any time soon.
430 51b0c606 Michael Tokarev
         */
431 51b0c606 Michael Tokarev
        size = ALIGN(((mem->memory_size) >> TARGET_PAGE_BITS),
432 51b0c606 Michael Tokarev
                     /*HOST_LONG_BITS*/ 64) / 8;
433 151f7749 Jan Kiszka
        if (!d.dirty_bitmap) {
434 7267c094 Anthony Liguori
            d.dirty_bitmap = g_malloc(size);
435 151f7749 Jan Kiszka
        } else if (size > allocated_size) {
436 7267c094 Anthony Liguori
            d.dirty_bitmap = g_realloc(d.dirty_bitmap, size);
437 151f7749 Jan Kiszka
        }
438 151f7749 Jan Kiszka
        allocated_size = size;
439 151f7749 Jan Kiszka
        memset(d.dirty_bitmap, 0, allocated_size);
440 5832d1f2 aliguori
441 151f7749 Jan Kiszka
        d.slot = mem->slot;
442 5832d1f2 aliguori
443 6e489f3f Anthony Liguori
        if (kvm_vm_ioctl(s, KVM_GET_DIRTY_LOG, &d) == -1) {
444 8c0d577e Blue Swirl
            DPRINTF("ioctl failed %d\n", errno);
445 151f7749 Jan Kiszka
            ret = -1;
446 151f7749 Jan Kiszka
            break;
447 151f7749 Jan Kiszka
        }
448 5832d1f2 aliguori
449 ffcde12f Avi Kivity
        kvm_get_dirty_pages_log_range(section, d.dirty_bitmap);
450 8369e01c Marcelo Tosatti
        start_addr = mem->start_addr + mem->memory_size;
451 5832d1f2 aliguori
    }
452 7267c094 Anthony Liguori
    g_free(d.dirty_bitmap);
453 151f7749 Jan Kiszka
454 151f7749 Jan Kiszka
    return ret;
455 5832d1f2 aliguori
}
456 5832d1f2 aliguori
457 c227f099 Anthony Liguori
int kvm_coalesce_mmio_region(target_phys_addr_t start, ram_addr_t size)
458 f65ed4c1 aliguori
{
459 f65ed4c1 aliguori
    int ret = -ENOSYS;
460 f65ed4c1 aliguori
    KVMState *s = kvm_state;
461 f65ed4c1 aliguori
462 f65ed4c1 aliguori
    if (s->coalesced_mmio) {
463 f65ed4c1 aliguori
        struct kvm_coalesced_mmio_zone zone;
464 f65ed4c1 aliguori
465 f65ed4c1 aliguori
        zone.addr = start;
466 f65ed4c1 aliguori
        zone.size = size;
467 7e680753 Michael S. Tsirkin
        zone.pad = 0;
468 f65ed4c1 aliguori
469 f65ed4c1 aliguori
        ret = kvm_vm_ioctl(s, KVM_REGISTER_COALESCED_MMIO, &zone);
470 f65ed4c1 aliguori
    }
471 f65ed4c1 aliguori
472 f65ed4c1 aliguori
    return ret;
473 f65ed4c1 aliguori
}
474 f65ed4c1 aliguori
475 c227f099 Anthony Liguori
int kvm_uncoalesce_mmio_region(target_phys_addr_t start, ram_addr_t size)
476 f65ed4c1 aliguori
{
477 f65ed4c1 aliguori
    int ret = -ENOSYS;
478 f65ed4c1 aliguori
    KVMState *s = kvm_state;
479 f65ed4c1 aliguori
480 f65ed4c1 aliguori
    if (s->coalesced_mmio) {
481 f65ed4c1 aliguori
        struct kvm_coalesced_mmio_zone zone;
482 f65ed4c1 aliguori
483 f65ed4c1 aliguori
        zone.addr = start;
484 f65ed4c1 aliguori
        zone.size = size;
485 7e680753 Michael S. Tsirkin
        zone.pad = 0;
486 f65ed4c1 aliguori
487 f65ed4c1 aliguori
        ret = kvm_vm_ioctl(s, KVM_UNREGISTER_COALESCED_MMIO, &zone);
488 f65ed4c1 aliguori
    }
489 f65ed4c1 aliguori
490 f65ed4c1 aliguori
    return ret;
491 f65ed4c1 aliguori
}
492 f65ed4c1 aliguori
493 ad7b8b33 Anthony Liguori
int kvm_check_extension(KVMState *s, unsigned int extension)
494 ad7b8b33 Anthony Liguori
{
495 ad7b8b33 Anthony Liguori
    int ret;
496 ad7b8b33 Anthony Liguori
497 ad7b8b33 Anthony Liguori
    ret = kvm_ioctl(s, KVM_CHECK_EXTENSION, extension);
498 ad7b8b33 Anthony Liguori
    if (ret < 0) {
499 ad7b8b33 Anthony Liguori
        ret = 0;
500 ad7b8b33 Anthony Liguori
    }
501 ad7b8b33 Anthony Liguori
502 ad7b8b33 Anthony Liguori
    return ret;
503 ad7b8b33 Anthony Liguori
}
504 ad7b8b33 Anthony Liguori
505 d2f2b8a7 Stefan Hajnoczi
static int kvm_check_many_ioeventfds(void)
506 d2f2b8a7 Stefan Hajnoczi
{
507 d0dcac83 Stefan Hajnoczi
    /* Userspace can use ioeventfd for io notification.  This requires a host
508 d0dcac83 Stefan Hajnoczi
     * that supports eventfd(2) and an I/O thread; since eventfd does not
509 d0dcac83 Stefan Hajnoczi
     * support SIGIO it cannot interrupt the vcpu.
510 d0dcac83 Stefan Hajnoczi
     *
511 d0dcac83 Stefan Hajnoczi
     * Older kernels have a 6 device limit on the KVM io bus.  Find out so we
512 d2f2b8a7 Stefan Hajnoczi
     * can avoid creating too many ioeventfds.
513 d2f2b8a7 Stefan Hajnoczi
     */
514 12d4536f Anthony Liguori
#if defined(CONFIG_EVENTFD)
515 d2f2b8a7 Stefan Hajnoczi
    int ioeventfds[7];
516 d2f2b8a7 Stefan Hajnoczi
    int i, ret = 0;
517 d2f2b8a7 Stefan Hajnoczi
    for (i = 0; i < ARRAY_SIZE(ioeventfds); i++) {
518 d2f2b8a7 Stefan Hajnoczi
        ioeventfds[i] = eventfd(0, EFD_CLOEXEC);
519 d2f2b8a7 Stefan Hajnoczi
        if (ioeventfds[i] < 0) {
520 d2f2b8a7 Stefan Hajnoczi
            break;
521 d2f2b8a7 Stefan Hajnoczi
        }
522 d2f2b8a7 Stefan Hajnoczi
        ret = kvm_set_ioeventfd_pio_word(ioeventfds[i], 0, i, true);
523 d2f2b8a7 Stefan Hajnoczi
        if (ret < 0) {
524 d2f2b8a7 Stefan Hajnoczi
            close(ioeventfds[i]);
525 d2f2b8a7 Stefan Hajnoczi
            break;
526 d2f2b8a7 Stefan Hajnoczi
        }
527 d2f2b8a7 Stefan Hajnoczi
    }
528 d2f2b8a7 Stefan Hajnoczi
529 d2f2b8a7 Stefan Hajnoczi
    /* Decide whether many devices are supported or not */
530 d2f2b8a7 Stefan Hajnoczi
    ret = i == ARRAY_SIZE(ioeventfds);
531 d2f2b8a7 Stefan Hajnoczi
532 d2f2b8a7 Stefan Hajnoczi
    while (i-- > 0) {
533 d2f2b8a7 Stefan Hajnoczi
        kvm_set_ioeventfd_pio_word(ioeventfds[i], 0, i, false);
534 d2f2b8a7 Stefan Hajnoczi
        close(ioeventfds[i]);
535 d2f2b8a7 Stefan Hajnoczi
    }
536 d2f2b8a7 Stefan Hajnoczi
    return ret;
537 d2f2b8a7 Stefan Hajnoczi
#else
538 d2f2b8a7 Stefan Hajnoczi
    return 0;
539 d2f2b8a7 Stefan Hajnoczi
#endif
540 d2f2b8a7 Stefan Hajnoczi
}
541 d2f2b8a7 Stefan Hajnoczi
542 94a8d39a Jan Kiszka
static const KVMCapabilityInfo *
543 94a8d39a Jan Kiszka
kvm_check_extension_list(KVMState *s, const KVMCapabilityInfo *list)
544 94a8d39a Jan Kiszka
{
545 94a8d39a Jan Kiszka
    while (list->name) {
546 94a8d39a Jan Kiszka
        if (!kvm_check_extension(s, list->value)) {
547 94a8d39a Jan Kiszka
            return list;
548 94a8d39a Jan Kiszka
        }
549 94a8d39a Jan Kiszka
        list++;
550 94a8d39a Jan Kiszka
    }
551 94a8d39a Jan Kiszka
    return NULL;
552 94a8d39a Jan Kiszka
}
553 94a8d39a Jan Kiszka
554 a01672d3 Avi Kivity
static void kvm_set_phys_mem(MemoryRegionSection *section, bool add)
555 46dbef6a Michael S. Tsirkin
{
556 46dbef6a Michael S. Tsirkin
    KVMState *s = kvm_state;
557 46dbef6a Michael S. Tsirkin
    KVMSlot *mem, old;
558 46dbef6a Michael S. Tsirkin
    int err;
559 a01672d3 Avi Kivity
    MemoryRegion *mr = section->mr;
560 a01672d3 Avi Kivity
    bool log_dirty = memory_region_is_logging(mr);
561 a01672d3 Avi Kivity
    target_phys_addr_t start_addr = section->offset_within_address_space;
562 a01672d3 Avi Kivity
    ram_addr_t size = section->size;
563 9f213ed9 Avi Kivity
    void *ram = NULL;
564 8f6f962b Avi Kivity
    unsigned delta;
565 46dbef6a Michael S. Tsirkin
566 14542fea Gleb Natapov
    /* kvm works in page size chunks, but the function may be called
567 14542fea Gleb Natapov
       with sub-page size and unaligned start address. */
568 8f6f962b Avi Kivity
    delta = TARGET_PAGE_ALIGN(size) - size;
569 8f6f962b Avi Kivity
    if (delta > size) {
570 8f6f962b Avi Kivity
        return;
571 8f6f962b Avi Kivity
    }
572 8f6f962b Avi Kivity
    start_addr += delta;
573 8f6f962b Avi Kivity
    size -= delta;
574 8f6f962b Avi Kivity
    size &= TARGET_PAGE_MASK;
575 8f6f962b Avi Kivity
    if (!size || (start_addr & ~TARGET_PAGE_MASK)) {
576 8f6f962b Avi Kivity
        return;
577 8f6f962b Avi Kivity
    }
578 46dbef6a Michael S. Tsirkin
579 a01672d3 Avi Kivity
    if (!memory_region_is_ram(mr)) {
580 a01672d3 Avi Kivity
        return;
581 9f213ed9 Avi Kivity
    }
582 9f213ed9 Avi Kivity
583 8f6f962b Avi Kivity
    ram = memory_region_get_ram_ptr(mr) + section->offset_within_region + delta;
584 a01672d3 Avi Kivity
585 46dbef6a Michael S. Tsirkin
    while (1) {
586 46dbef6a Michael S. Tsirkin
        mem = kvm_lookup_overlapping_slot(s, start_addr, start_addr + size);
587 46dbef6a Michael S. Tsirkin
        if (!mem) {
588 46dbef6a Michael S. Tsirkin
            break;
589 46dbef6a Michael S. Tsirkin
        }
590 46dbef6a Michael S. Tsirkin
591 a01672d3 Avi Kivity
        if (add && start_addr >= mem->start_addr &&
592 46dbef6a Michael S. Tsirkin
            (start_addr + size <= mem->start_addr + mem->memory_size) &&
593 9f213ed9 Avi Kivity
            (ram - start_addr == mem->ram - mem->start_addr)) {
594 46dbef6a Michael S. Tsirkin
            /* The new slot fits into the existing one and comes with
595 25254bbc Michael S. Tsirkin
             * identical parameters - update flags and done. */
596 25254bbc Michael S. Tsirkin
            kvm_slot_dirty_pages_log_change(mem, log_dirty);
597 46dbef6a Michael S. Tsirkin
            return;
598 46dbef6a Michael S. Tsirkin
        }
599 46dbef6a Michael S. Tsirkin
600 46dbef6a Michael S. Tsirkin
        old = *mem;
601 46dbef6a Michael S. Tsirkin
602 3fbffb62 Avi Kivity
        if (mem->flags & KVM_MEM_LOG_DIRTY_PAGES) {
603 3fbffb62 Avi Kivity
            kvm_physical_sync_dirty_bitmap(section);
604 3fbffb62 Avi Kivity
        }
605 3fbffb62 Avi Kivity
606 46dbef6a Michael S. Tsirkin
        /* unregister the overlapping slot */
607 46dbef6a Michael S. Tsirkin
        mem->memory_size = 0;
608 46dbef6a Michael S. Tsirkin
        err = kvm_set_user_memory_region(s, mem);
609 46dbef6a Michael S. Tsirkin
        if (err) {
610 46dbef6a Michael S. Tsirkin
            fprintf(stderr, "%s: error unregistering overlapping slot: %s\n",
611 46dbef6a Michael S. Tsirkin
                    __func__, strerror(-err));
612 46dbef6a Michael S. Tsirkin
            abort();
613 46dbef6a Michael S. Tsirkin
        }
614 46dbef6a Michael S. Tsirkin
615 46dbef6a Michael S. Tsirkin
        /* Workaround for older KVM versions: we can't join slots, even not by
616 46dbef6a Michael S. Tsirkin
         * unregistering the previous ones and then registering the larger
617 46dbef6a Michael S. Tsirkin
         * slot. We have to maintain the existing fragmentation. Sigh.
618 46dbef6a Michael S. Tsirkin
         *
619 46dbef6a Michael S. Tsirkin
         * This workaround assumes that the new slot starts at the same
620 46dbef6a Michael S. Tsirkin
         * address as the first existing one. If not or if some overlapping
621 46dbef6a Michael S. Tsirkin
         * slot comes around later, we will fail (not seen in practice so far)
622 46dbef6a Michael S. Tsirkin
         * - and actually require a recent KVM version. */
623 46dbef6a Michael S. Tsirkin
        if (s->broken_set_mem_region &&
624 a01672d3 Avi Kivity
            old.start_addr == start_addr && old.memory_size < size && add) {
625 46dbef6a Michael S. Tsirkin
            mem = kvm_alloc_slot(s);
626 46dbef6a Michael S. Tsirkin
            mem->memory_size = old.memory_size;
627 46dbef6a Michael S. Tsirkin
            mem->start_addr = old.start_addr;
628 9f213ed9 Avi Kivity
            mem->ram = old.ram;
629 25254bbc Michael S. Tsirkin
            mem->flags = kvm_mem_flags(s, log_dirty);
630 46dbef6a Michael S. Tsirkin
631 46dbef6a Michael S. Tsirkin
            err = kvm_set_user_memory_region(s, mem);
632 46dbef6a Michael S. Tsirkin
            if (err) {
633 46dbef6a Michael S. Tsirkin
                fprintf(stderr, "%s: error updating slot: %s\n", __func__,
634 46dbef6a Michael S. Tsirkin
                        strerror(-err));
635 46dbef6a Michael S. Tsirkin
                abort();
636 46dbef6a Michael S. Tsirkin
            }
637 46dbef6a Michael S. Tsirkin
638 46dbef6a Michael S. Tsirkin
            start_addr += old.memory_size;
639 9f213ed9 Avi Kivity
            ram += old.memory_size;
640 46dbef6a Michael S. Tsirkin
            size -= old.memory_size;
641 46dbef6a Michael S. Tsirkin
            continue;
642 46dbef6a Michael S. Tsirkin
        }
643 46dbef6a Michael S. Tsirkin
644 46dbef6a Michael S. Tsirkin
        /* register prefix slot */
645 46dbef6a Michael S. Tsirkin
        if (old.start_addr < start_addr) {
646 46dbef6a Michael S. Tsirkin
            mem = kvm_alloc_slot(s);
647 46dbef6a Michael S. Tsirkin
            mem->memory_size = start_addr - old.start_addr;
648 46dbef6a Michael S. Tsirkin
            mem->start_addr = old.start_addr;
649 9f213ed9 Avi Kivity
            mem->ram = old.ram;
650 25254bbc Michael S. Tsirkin
            mem->flags =  kvm_mem_flags(s, log_dirty);
651 46dbef6a Michael S. Tsirkin
652 46dbef6a Michael S. Tsirkin
            err = kvm_set_user_memory_region(s, mem);
653 46dbef6a Michael S. Tsirkin
            if (err) {
654 46dbef6a Michael S. Tsirkin
                fprintf(stderr, "%s: error registering prefix slot: %s\n",
655 46dbef6a Michael S. Tsirkin
                        __func__, strerror(-err));
656 d4d6868f Alexander Graf
#ifdef TARGET_PPC
657 d4d6868f Alexander Graf
                fprintf(stderr, "%s: This is probably because your kernel's " \
658 d4d6868f Alexander Graf
                                "PAGE_SIZE is too big. Please try to use 4k " \
659 d4d6868f Alexander Graf
                                "PAGE_SIZE!\n", __func__);
660 d4d6868f Alexander Graf
#endif
661 46dbef6a Michael S. Tsirkin
                abort();
662 46dbef6a Michael S. Tsirkin
            }
663 46dbef6a Michael S. Tsirkin
        }
664 46dbef6a Michael S. Tsirkin
665 46dbef6a Michael S. Tsirkin
        /* register suffix slot */
666 46dbef6a Michael S. Tsirkin
        if (old.start_addr + old.memory_size > start_addr + size) {
667 46dbef6a Michael S. Tsirkin
            ram_addr_t size_delta;
668 46dbef6a Michael S. Tsirkin
669 46dbef6a Michael S. Tsirkin
            mem = kvm_alloc_slot(s);
670 46dbef6a Michael S. Tsirkin
            mem->start_addr = start_addr + size;
671 46dbef6a Michael S. Tsirkin
            size_delta = mem->start_addr - old.start_addr;
672 46dbef6a Michael S. Tsirkin
            mem->memory_size = old.memory_size - size_delta;
673 9f213ed9 Avi Kivity
            mem->ram = old.ram + size_delta;
674 25254bbc Michael S. Tsirkin
            mem->flags = kvm_mem_flags(s, log_dirty);
675 46dbef6a Michael S. Tsirkin
676 46dbef6a Michael S. Tsirkin
            err = kvm_set_user_memory_region(s, mem);
677 46dbef6a Michael S. Tsirkin
            if (err) {
678 46dbef6a Michael S. Tsirkin
                fprintf(stderr, "%s: error registering suffix slot: %s\n",
679 46dbef6a Michael S. Tsirkin
                        __func__, strerror(-err));
680 46dbef6a Michael S. Tsirkin
                abort();
681 46dbef6a Michael S. Tsirkin
            }
682 46dbef6a Michael S. Tsirkin
        }
683 46dbef6a Michael S. Tsirkin
    }
684 46dbef6a Michael S. Tsirkin
685 46dbef6a Michael S. Tsirkin
    /* in case the KVM bug workaround already "consumed" the new slot */
686 a426e122 Jan Kiszka
    if (!size) {
687 46dbef6a Michael S. Tsirkin
        return;
688 a426e122 Jan Kiszka
    }
689 a01672d3 Avi Kivity
    if (!add) {
690 46dbef6a Michael S. Tsirkin
        return;
691 a426e122 Jan Kiszka
    }
692 46dbef6a Michael S. Tsirkin
    mem = kvm_alloc_slot(s);
693 46dbef6a Michael S. Tsirkin
    mem->memory_size = size;
694 46dbef6a Michael S. Tsirkin
    mem->start_addr = start_addr;
695 9f213ed9 Avi Kivity
    mem->ram = ram;
696 25254bbc Michael S. Tsirkin
    mem->flags = kvm_mem_flags(s, log_dirty);
697 46dbef6a Michael S. Tsirkin
698 46dbef6a Michael S. Tsirkin
    err = kvm_set_user_memory_region(s, mem);
699 46dbef6a Michael S. Tsirkin
    if (err) {
700 46dbef6a Michael S. Tsirkin
        fprintf(stderr, "%s: error registering slot: %s\n", __func__,
701 46dbef6a Michael S. Tsirkin
                strerror(-err));
702 46dbef6a Michael S. Tsirkin
        abort();
703 46dbef6a Michael S. Tsirkin
    }
704 46dbef6a Michael S. Tsirkin
}
705 46dbef6a Michael S. Tsirkin
706 50c1e149 Avi Kivity
static void kvm_begin(MemoryListener *listener)
707 50c1e149 Avi Kivity
{
708 50c1e149 Avi Kivity
}
709 50c1e149 Avi Kivity
710 50c1e149 Avi Kivity
static void kvm_commit(MemoryListener *listener)
711 50c1e149 Avi Kivity
{
712 50c1e149 Avi Kivity
}
713 50c1e149 Avi Kivity
714 a01672d3 Avi Kivity
static void kvm_region_add(MemoryListener *listener,
715 a01672d3 Avi Kivity
                           MemoryRegionSection *section)
716 a01672d3 Avi Kivity
{
717 a01672d3 Avi Kivity
    kvm_set_phys_mem(section, true);
718 a01672d3 Avi Kivity
}
719 a01672d3 Avi Kivity
720 a01672d3 Avi Kivity
static void kvm_region_del(MemoryListener *listener,
721 a01672d3 Avi Kivity
                           MemoryRegionSection *section)
722 a01672d3 Avi Kivity
{
723 a01672d3 Avi Kivity
    kvm_set_phys_mem(section, false);
724 a01672d3 Avi Kivity
}
725 a01672d3 Avi Kivity
726 50c1e149 Avi Kivity
static void kvm_region_nop(MemoryListener *listener,
727 50c1e149 Avi Kivity
                           MemoryRegionSection *section)
728 50c1e149 Avi Kivity
{
729 50c1e149 Avi Kivity
}
730 50c1e149 Avi Kivity
731 a01672d3 Avi Kivity
static void kvm_log_sync(MemoryListener *listener,
732 a01672d3 Avi Kivity
                         MemoryRegionSection *section)
733 7b8f3b78 Michael S. Tsirkin
{
734 a01672d3 Avi Kivity
    int r;
735 a01672d3 Avi Kivity
736 ffcde12f Avi Kivity
    r = kvm_physical_sync_dirty_bitmap(section);
737 a01672d3 Avi Kivity
    if (r < 0) {
738 a01672d3 Avi Kivity
        abort();
739 a01672d3 Avi Kivity
    }
740 7b8f3b78 Michael S. Tsirkin
}
741 7b8f3b78 Michael S. Tsirkin
742 a01672d3 Avi Kivity
static void kvm_log_global_start(struct MemoryListener *listener)
743 7b8f3b78 Michael S. Tsirkin
{
744 a01672d3 Avi Kivity
    int r;
745 a01672d3 Avi Kivity
746 a01672d3 Avi Kivity
    r = kvm_set_migration_log(1);
747 a01672d3 Avi Kivity
    assert(r >= 0);
748 7b8f3b78 Michael S. Tsirkin
}
749 7b8f3b78 Michael S. Tsirkin
750 a01672d3 Avi Kivity
static void kvm_log_global_stop(struct MemoryListener *listener)
751 7b8f3b78 Michael S. Tsirkin
{
752 a01672d3 Avi Kivity
    int r;
753 a01672d3 Avi Kivity
754 a01672d3 Avi Kivity
    r = kvm_set_migration_log(0);
755 a01672d3 Avi Kivity
    assert(r >= 0);
756 7b8f3b78 Michael S. Tsirkin
}
757 7b8f3b78 Michael S. Tsirkin
758 80a1ea37 Avi Kivity
static void kvm_mem_ioeventfd_add(MemoryRegionSection *section,
759 80a1ea37 Avi Kivity
                                  bool match_data, uint64_t data, int fd)
760 80a1ea37 Avi Kivity
{
761 80a1ea37 Avi Kivity
    int r;
762 80a1ea37 Avi Kivity
763 4b8f1c88 Michael S. Tsirkin
    assert(match_data && section->size <= 8);
764 80a1ea37 Avi Kivity
765 4b8f1c88 Michael S. Tsirkin
    r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
766 4b8f1c88 Michael S. Tsirkin
                               data, true, section->size);
767 80a1ea37 Avi Kivity
    if (r < 0) {
768 80a1ea37 Avi Kivity
        abort();
769 80a1ea37 Avi Kivity
    }
770 80a1ea37 Avi Kivity
}
771 80a1ea37 Avi Kivity
772 80a1ea37 Avi Kivity
static void kvm_mem_ioeventfd_del(MemoryRegionSection *section,
773 80a1ea37 Avi Kivity
                                  bool match_data, uint64_t data, int fd)
774 80a1ea37 Avi Kivity
{
775 80a1ea37 Avi Kivity
    int r;
776 80a1ea37 Avi Kivity
777 4b8f1c88 Michael S. Tsirkin
    r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
778 4b8f1c88 Michael S. Tsirkin
                               data, false, section->size);
779 80a1ea37 Avi Kivity
    if (r < 0) {
780 80a1ea37 Avi Kivity
        abort();
781 80a1ea37 Avi Kivity
    }
782 80a1ea37 Avi Kivity
}
783 80a1ea37 Avi Kivity
784 80a1ea37 Avi Kivity
static void kvm_io_ioeventfd_add(MemoryRegionSection *section,
785 80a1ea37 Avi Kivity
                                 bool match_data, uint64_t data, int fd)
786 80a1ea37 Avi Kivity
{
787 80a1ea37 Avi Kivity
    int r;
788 80a1ea37 Avi Kivity
789 80a1ea37 Avi Kivity
    assert(match_data && section->size == 2);
790 80a1ea37 Avi Kivity
791 80a1ea37 Avi Kivity
    r = kvm_set_ioeventfd_pio_word(fd, section->offset_within_address_space,
792 80a1ea37 Avi Kivity
                                   data, true);
793 80a1ea37 Avi Kivity
    if (r < 0) {
794 80a1ea37 Avi Kivity
        abort();
795 80a1ea37 Avi Kivity
    }
796 80a1ea37 Avi Kivity
}
797 80a1ea37 Avi Kivity
798 80a1ea37 Avi Kivity
static void kvm_io_ioeventfd_del(MemoryRegionSection *section,
799 80a1ea37 Avi Kivity
                                 bool match_data, uint64_t data, int fd)
800 80a1ea37 Avi Kivity
801 80a1ea37 Avi Kivity
{
802 80a1ea37 Avi Kivity
    int r;
803 80a1ea37 Avi Kivity
804 80a1ea37 Avi Kivity
    r = kvm_set_ioeventfd_pio_word(fd, section->offset_within_address_space,
805 80a1ea37 Avi Kivity
                                   data, false);
806 80a1ea37 Avi Kivity
    if (r < 0) {
807 80a1ea37 Avi Kivity
        abort();
808 80a1ea37 Avi Kivity
    }
809 80a1ea37 Avi Kivity
}
810 80a1ea37 Avi Kivity
811 80a1ea37 Avi Kivity
static void kvm_eventfd_add(MemoryListener *listener,
812 80a1ea37 Avi Kivity
                            MemoryRegionSection *section,
813 753d5e14 Paolo Bonzini
                            bool match_data, uint64_t data,
814 753d5e14 Paolo Bonzini
                            EventNotifier *e)
815 80a1ea37 Avi Kivity
{
816 80a1ea37 Avi Kivity
    if (section->address_space == get_system_memory()) {
817 753d5e14 Paolo Bonzini
        kvm_mem_ioeventfd_add(section, match_data, data,
818 753d5e14 Paolo Bonzini
                              event_notifier_get_fd(e));
819 80a1ea37 Avi Kivity
    } else {
820 753d5e14 Paolo Bonzini
        kvm_io_ioeventfd_add(section, match_data, data,
821 753d5e14 Paolo Bonzini
                             event_notifier_get_fd(e));
822 80a1ea37 Avi Kivity
    }
823 80a1ea37 Avi Kivity
}
824 80a1ea37 Avi Kivity
825 80a1ea37 Avi Kivity
static void kvm_eventfd_del(MemoryListener *listener,
826 80a1ea37 Avi Kivity
                            MemoryRegionSection *section,
827 753d5e14 Paolo Bonzini
                            bool match_data, uint64_t data,
828 753d5e14 Paolo Bonzini
                            EventNotifier *e)
829 80a1ea37 Avi Kivity
{
830 80a1ea37 Avi Kivity
    if (section->address_space == get_system_memory()) {
831 753d5e14 Paolo Bonzini
        kvm_mem_ioeventfd_del(section, match_data, data,
832 753d5e14 Paolo Bonzini
                              event_notifier_get_fd(e));
833 80a1ea37 Avi Kivity
    } else {
834 753d5e14 Paolo Bonzini
        kvm_io_ioeventfd_del(section, match_data, data,
835 753d5e14 Paolo Bonzini
                             event_notifier_get_fd(e));
836 80a1ea37 Avi Kivity
    }
837 80a1ea37 Avi Kivity
}
838 80a1ea37 Avi Kivity
839 a01672d3 Avi Kivity
static MemoryListener kvm_memory_listener = {
840 50c1e149 Avi Kivity
    .begin = kvm_begin,
841 50c1e149 Avi Kivity
    .commit = kvm_commit,
842 a01672d3 Avi Kivity
    .region_add = kvm_region_add,
843 a01672d3 Avi Kivity
    .region_del = kvm_region_del,
844 50c1e149 Avi Kivity
    .region_nop = kvm_region_nop,
845 e5896b12 Anthony PERARD
    .log_start = kvm_log_start,
846 e5896b12 Anthony PERARD
    .log_stop = kvm_log_stop,
847 a01672d3 Avi Kivity
    .log_sync = kvm_log_sync,
848 a01672d3 Avi Kivity
    .log_global_start = kvm_log_global_start,
849 a01672d3 Avi Kivity
    .log_global_stop = kvm_log_global_stop,
850 80a1ea37 Avi Kivity
    .eventfd_add = kvm_eventfd_add,
851 80a1ea37 Avi Kivity
    .eventfd_del = kvm_eventfd_del,
852 72e22d2f Avi Kivity
    .priority = 10,
853 7b8f3b78 Michael S. Tsirkin
};
854 7b8f3b78 Michael S. Tsirkin
855 9349b4f9 Andreas Färber
static void kvm_handle_interrupt(CPUArchState *env, int mask)
856 aa7f74d1 Jan Kiszka
{
857 aa7f74d1 Jan Kiszka
    env->interrupt_request |= mask;
858 aa7f74d1 Jan Kiszka
859 aa7f74d1 Jan Kiszka
    if (!qemu_cpu_is_self(env)) {
860 aa7f74d1 Jan Kiszka
        qemu_cpu_kick(env);
861 aa7f74d1 Jan Kiszka
    }
862 aa7f74d1 Jan Kiszka
}
863 aa7f74d1 Jan Kiszka
864 3889c3fa Peter Maydell
int kvm_set_irq(KVMState *s, int irq, int level)
865 84b058d7 Jan Kiszka
{
866 84b058d7 Jan Kiszka
    struct kvm_irq_level event;
867 84b058d7 Jan Kiszka
    int ret;
868 84b058d7 Jan Kiszka
869 7ae26bd4 Peter Maydell
    assert(kvm_async_interrupts_enabled());
870 84b058d7 Jan Kiszka
871 84b058d7 Jan Kiszka
    event.level = level;
872 84b058d7 Jan Kiszka
    event.irq = irq;
873 e333cd69 Jan Kiszka
    ret = kvm_vm_ioctl(s, s->irq_set_ioctl, &event);
874 84b058d7 Jan Kiszka
    if (ret < 0) {
875 3889c3fa Peter Maydell
        perror("kvm_set_irq");
876 84b058d7 Jan Kiszka
        abort();
877 84b058d7 Jan Kiszka
    }
878 84b058d7 Jan Kiszka
879 e333cd69 Jan Kiszka
    return (s->irq_set_ioctl == KVM_IRQ_LINE) ? 1 : event.status;
880 84b058d7 Jan Kiszka
}
881 84b058d7 Jan Kiszka
882 84b058d7 Jan Kiszka
#ifdef KVM_CAP_IRQ_ROUTING
883 d3d3bef0 Jan Kiszka
typedef struct KVMMSIRoute {
884 d3d3bef0 Jan Kiszka
    struct kvm_irq_routing_entry kroute;
885 d3d3bef0 Jan Kiszka
    QTAILQ_ENTRY(KVMMSIRoute) entry;
886 d3d3bef0 Jan Kiszka
} KVMMSIRoute;
887 d3d3bef0 Jan Kiszka
888 84b058d7 Jan Kiszka
static void set_gsi(KVMState *s, unsigned int gsi)
889 84b058d7 Jan Kiszka
{
890 84b058d7 Jan Kiszka
    s->used_gsi_bitmap[gsi / 32] |= 1U << (gsi % 32);
891 84b058d7 Jan Kiszka
}
892 84b058d7 Jan Kiszka
893 04fa27f5 Jan Kiszka
static void clear_gsi(KVMState *s, unsigned int gsi)
894 04fa27f5 Jan Kiszka
{
895 04fa27f5 Jan Kiszka
    s->used_gsi_bitmap[gsi / 32] &= ~(1U << (gsi % 32));
896 04fa27f5 Jan Kiszka
}
897 04fa27f5 Jan Kiszka
898 84b058d7 Jan Kiszka
static void kvm_init_irq_routing(KVMState *s)
899 84b058d7 Jan Kiszka
{
900 04fa27f5 Jan Kiszka
    int gsi_count, i;
901 84b058d7 Jan Kiszka
902 84b058d7 Jan Kiszka
    gsi_count = kvm_check_extension(s, KVM_CAP_IRQ_ROUTING);
903 84b058d7 Jan Kiszka
    if (gsi_count > 0) {
904 84b058d7 Jan Kiszka
        unsigned int gsi_bits, i;
905 84b058d7 Jan Kiszka
906 84b058d7 Jan Kiszka
        /* Round up so we can search ints using ffs */
907 bc8c6788 Jason Baron
        gsi_bits = ALIGN(gsi_count, 32);
908 84b058d7 Jan Kiszka
        s->used_gsi_bitmap = g_malloc0(gsi_bits / 8);
909 4e2e4e63 Jan Kiszka
        s->gsi_count = gsi_count;
910 84b058d7 Jan Kiszka
911 84b058d7 Jan Kiszka
        /* Mark any over-allocated bits as already in use */
912 84b058d7 Jan Kiszka
        for (i = gsi_count; i < gsi_bits; i++) {
913 84b058d7 Jan Kiszka
            set_gsi(s, i);
914 84b058d7 Jan Kiszka
        }
915 84b058d7 Jan Kiszka
    }
916 84b058d7 Jan Kiszka
917 84b058d7 Jan Kiszka
    s->irq_routes = g_malloc0(sizeof(*s->irq_routes));
918 84b058d7 Jan Kiszka
    s->nr_allocated_irq_routes = 0;
919 84b058d7 Jan Kiszka
920 4a3adebb Jan Kiszka
    if (!s->direct_msi) {
921 4a3adebb Jan Kiszka
        for (i = 0; i < KVM_MSI_HASHTAB_SIZE; i++) {
922 4a3adebb Jan Kiszka
            QTAILQ_INIT(&s->msi_hashtab[i]);
923 4a3adebb Jan Kiszka
        }
924 04fa27f5 Jan Kiszka
    }
925 04fa27f5 Jan Kiszka
926 84b058d7 Jan Kiszka
    kvm_arch_init_irq_routing(s);
927 84b058d7 Jan Kiszka
}
928 84b058d7 Jan Kiszka
929 e7b20308 Jan Kiszka
static void kvm_irqchip_commit_routes(KVMState *s)
930 e7b20308 Jan Kiszka
{
931 e7b20308 Jan Kiszka
    int ret;
932 e7b20308 Jan Kiszka
933 e7b20308 Jan Kiszka
    s->irq_routes->flags = 0;
934 e7b20308 Jan Kiszka
    ret = kvm_vm_ioctl(s, KVM_SET_GSI_ROUTING, s->irq_routes);
935 e7b20308 Jan Kiszka
    assert(ret == 0);
936 e7b20308 Jan Kiszka
}
937 e7b20308 Jan Kiszka
938 84b058d7 Jan Kiszka
static void kvm_add_routing_entry(KVMState *s,
939 84b058d7 Jan Kiszka
                                  struct kvm_irq_routing_entry *entry)
940 84b058d7 Jan Kiszka
{
941 84b058d7 Jan Kiszka
    struct kvm_irq_routing_entry *new;
942 84b058d7 Jan Kiszka
    int n, size;
943 84b058d7 Jan Kiszka
944 84b058d7 Jan Kiszka
    if (s->irq_routes->nr == s->nr_allocated_irq_routes) {
945 84b058d7 Jan Kiszka
        n = s->nr_allocated_irq_routes * 2;
946 84b058d7 Jan Kiszka
        if (n < 64) {
947 84b058d7 Jan Kiszka
            n = 64;
948 84b058d7 Jan Kiszka
        }
949 84b058d7 Jan Kiszka
        size = sizeof(struct kvm_irq_routing);
950 84b058d7 Jan Kiszka
        size += n * sizeof(*new);
951 84b058d7 Jan Kiszka
        s->irq_routes = g_realloc(s->irq_routes, size);
952 84b058d7 Jan Kiszka
        s->nr_allocated_irq_routes = n;
953 84b058d7 Jan Kiszka
    }
954 84b058d7 Jan Kiszka
    n = s->irq_routes->nr++;
955 84b058d7 Jan Kiszka
    new = &s->irq_routes->entries[n];
956 84b058d7 Jan Kiszka
    memset(new, 0, sizeof(*new));
957 84b058d7 Jan Kiszka
    new->gsi = entry->gsi;
958 84b058d7 Jan Kiszka
    new->type = entry->type;
959 84b058d7 Jan Kiszka
    new->flags = entry->flags;
960 84b058d7 Jan Kiszka
    new->u = entry->u;
961 84b058d7 Jan Kiszka
962 84b058d7 Jan Kiszka
    set_gsi(s, entry->gsi);
963 e7b20308 Jan Kiszka
964 e7b20308 Jan Kiszka
    kvm_irqchip_commit_routes(s);
965 84b058d7 Jan Kiszka
}
966 84b058d7 Jan Kiszka
967 cc57407e Jan Kiszka
static int kvm_update_routing_entry(KVMState *s,
968 cc57407e Jan Kiszka
                                    struct kvm_irq_routing_entry *new_entry)
969 cc57407e Jan Kiszka
{
970 cc57407e Jan Kiszka
    struct kvm_irq_routing_entry *entry;
971 cc57407e Jan Kiszka
    int n;
972 cc57407e Jan Kiszka
973 cc57407e Jan Kiszka
    for (n = 0; n < s->irq_routes->nr; n++) {
974 cc57407e Jan Kiszka
        entry = &s->irq_routes->entries[n];
975 cc57407e Jan Kiszka
        if (entry->gsi != new_entry->gsi) {
976 cc57407e Jan Kiszka
            continue;
977 cc57407e Jan Kiszka
        }
978 cc57407e Jan Kiszka
979 cc57407e Jan Kiszka
        entry->type = new_entry->type;
980 cc57407e Jan Kiszka
        entry->flags = new_entry->flags;
981 cc57407e Jan Kiszka
        entry->u = new_entry->u;
982 cc57407e Jan Kiszka
983 cc57407e Jan Kiszka
        kvm_irqchip_commit_routes(s);
984 cc57407e Jan Kiszka
985 cc57407e Jan Kiszka
        return 0;
986 cc57407e Jan Kiszka
    }
987 cc57407e Jan Kiszka
988 cc57407e Jan Kiszka
    return -ESRCH;
989 cc57407e Jan Kiszka
}
990 cc57407e Jan Kiszka
991 1df186df Jan Kiszka
void kvm_irqchip_add_irq_route(KVMState *s, int irq, int irqchip, int pin)
992 84b058d7 Jan Kiszka
{
993 84b058d7 Jan Kiszka
    struct kvm_irq_routing_entry e;
994 84b058d7 Jan Kiszka
995 4e2e4e63 Jan Kiszka
    assert(pin < s->gsi_count);
996 4e2e4e63 Jan Kiszka
997 84b058d7 Jan Kiszka
    e.gsi = irq;
998 84b058d7 Jan Kiszka
    e.type = KVM_IRQ_ROUTING_IRQCHIP;
999 84b058d7 Jan Kiszka
    e.flags = 0;
1000 84b058d7 Jan Kiszka
    e.u.irqchip.irqchip = irqchip;
1001 84b058d7 Jan Kiszka
    e.u.irqchip.pin = pin;
1002 84b058d7 Jan Kiszka
    kvm_add_routing_entry(s, &e);
1003 84b058d7 Jan Kiszka
}
1004 84b058d7 Jan Kiszka
1005 1e2aa8be Jan Kiszka
void kvm_irqchip_release_virq(KVMState *s, int virq)
1006 04fa27f5 Jan Kiszka
{
1007 04fa27f5 Jan Kiszka
    struct kvm_irq_routing_entry *e;
1008 04fa27f5 Jan Kiszka
    int i;
1009 04fa27f5 Jan Kiszka
1010 04fa27f5 Jan Kiszka
    for (i = 0; i < s->irq_routes->nr; i++) {
1011 04fa27f5 Jan Kiszka
        e = &s->irq_routes->entries[i];
1012 04fa27f5 Jan Kiszka
        if (e->gsi == virq) {
1013 04fa27f5 Jan Kiszka
            s->irq_routes->nr--;
1014 04fa27f5 Jan Kiszka
            *e = s->irq_routes->entries[s->irq_routes->nr];
1015 04fa27f5 Jan Kiszka
        }
1016 04fa27f5 Jan Kiszka
    }
1017 04fa27f5 Jan Kiszka
    clear_gsi(s, virq);
1018 e7b20308 Jan Kiszka
1019 e7b20308 Jan Kiszka
    kvm_irqchip_commit_routes(s);
1020 04fa27f5 Jan Kiszka
}
1021 04fa27f5 Jan Kiszka
1022 04fa27f5 Jan Kiszka
static unsigned int kvm_hash_msi(uint32_t data)
1023 04fa27f5 Jan Kiszka
{
1024 04fa27f5 Jan Kiszka
    /* This is optimized for IA32 MSI layout. However, no other arch shall
1025 04fa27f5 Jan Kiszka
     * repeat the mistake of not providing a direct MSI injection API. */
1026 04fa27f5 Jan Kiszka
    return data & 0xff;
1027 04fa27f5 Jan Kiszka
}
1028 04fa27f5 Jan Kiszka
1029 04fa27f5 Jan Kiszka
static void kvm_flush_dynamic_msi_routes(KVMState *s)
1030 04fa27f5 Jan Kiszka
{
1031 04fa27f5 Jan Kiszka
    KVMMSIRoute *route, *next;
1032 04fa27f5 Jan Kiszka
    unsigned int hash;
1033 04fa27f5 Jan Kiszka
1034 04fa27f5 Jan Kiszka
    for (hash = 0; hash < KVM_MSI_HASHTAB_SIZE; hash++) {
1035 04fa27f5 Jan Kiszka
        QTAILQ_FOREACH_SAFE(route, &s->msi_hashtab[hash], entry, next) {
1036 04fa27f5 Jan Kiszka
            kvm_irqchip_release_virq(s, route->kroute.gsi);
1037 04fa27f5 Jan Kiszka
            QTAILQ_REMOVE(&s->msi_hashtab[hash], route, entry);
1038 04fa27f5 Jan Kiszka
            g_free(route);
1039 04fa27f5 Jan Kiszka
        }
1040 04fa27f5 Jan Kiszka
    }
1041 04fa27f5 Jan Kiszka
}
1042 04fa27f5 Jan Kiszka
1043 04fa27f5 Jan Kiszka
static int kvm_irqchip_get_virq(KVMState *s)
1044 04fa27f5 Jan Kiszka
{
1045 04fa27f5 Jan Kiszka
    uint32_t *word = s->used_gsi_bitmap;
1046 04fa27f5 Jan Kiszka
    int max_words = ALIGN(s->gsi_count, 32) / 32;
1047 04fa27f5 Jan Kiszka
    int i, bit;
1048 04fa27f5 Jan Kiszka
    bool retry = true;
1049 04fa27f5 Jan Kiszka
1050 04fa27f5 Jan Kiszka
again:
1051 04fa27f5 Jan Kiszka
    /* Return the lowest unused GSI in the bitmap */
1052 04fa27f5 Jan Kiszka
    for (i = 0; i < max_words; i++) {
1053 04fa27f5 Jan Kiszka
        bit = ffs(~word[i]);
1054 04fa27f5 Jan Kiszka
        if (!bit) {
1055 04fa27f5 Jan Kiszka
            continue;
1056 04fa27f5 Jan Kiszka
        }
1057 04fa27f5 Jan Kiszka
1058 04fa27f5 Jan Kiszka
        return bit - 1 + i * 32;
1059 04fa27f5 Jan Kiszka
    }
1060 4a3adebb Jan Kiszka
    if (!s->direct_msi && retry) {
1061 04fa27f5 Jan Kiszka
        retry = false;
1062 04fa27f5 Jan Kiszka
        kvm_flush_dynamic_msi_routes(s);
1063 04fa27f5 Jan Kiszka
        goto again;
1064 04fa27f5 Jan Kiszka
    }
1065 04fa27f5 Jan Kiszka
    return -ENOSPC;
1066 04fa27f5 Jan Kiszka
1067 04fa27f5 Jan Kiszka
}
1068 04fa27f5 Jan Kiszka
1069 04fa27f5 Jan Kiszka
static KVMMSIRoute *kvm_lookup_msi_route(KVMState *s, MSIMessage msg)
1070 04fa27f5 Jan Kiszka
{
1071 04fa27f5 Jan Kiszka
    unsigned int hash = kvm_hash_msi(msg.data);
1072 04fa27f5 Jan Kiszka
    KVMMSIRoute *route;
1073 04fa27f5 Jan Kiszka
1074 04fa27f5 Jan Kiszka
    QTAILQ_FOREACH(route, &s->msi_hashtab[hash], entry) {
1075 04fa27f5 Jan Kiszka
        if (route->kroute.u.msi.address_lo == (uint32_t)msg.address &&
1076 04fa27f5 Jan Kiszka
            route->kroute.u.msi.address_hi == (msg.address >> 32) &&
1077 04fa27f5 Jan Kiszka
            route->kroute.u.msi.data == msg.data) {
1078 04fa27f5 Jan Kiszka
            return route;
1079 04fa27f5 Jan Kiszka
        }
1080 04fa27f5 Jan Kiszka
    }
1081 04fa27f5 Jan Kiszka
    return NULL;
1082 04fa27f5 Jan Kiszka
}
1083 04fa27f5 Jan Kiszka
1084 04fa27f5 Jan Kiszka
int kvm_irqchip_send_msi(KVMState *s, MSIMessage msg)
1085 04fa27f5 Jan Kiszka
{
1086 4a3adebb Jan Kiszka
    struct kvm_msi msi;
1087 04fa27f5 Jan Kiszka
    KVMMSIRoute *route;
1088 04fa27f5 Jan Kiszka
1089 4a3adebb Jan Kiszka
    if (s->direct_msi) {
1090 4a3adebb Jan Kiszka
        msi.address_lo = (uint32_t)msg.address;
1091 4a3adebb Jan Kiszka
        msi.address_hi = msg.address >> 32;
1092 4a3adebb Jan Kiszka
        msi.data = msg.data;
1093 4a3adebb Jan Kiszka
        msi.flags = 0;
1094 4a3adebb Jan Kiszka
        memset(msi.pad, 0, sizeof(msi.pad));
1095 4a3adebb Jan Kiszka
1096 4a3adebb Jan Kiszka
        return kvm_vm_ioctl(s, KVM_SIGNAL_MSI, &msi);
1097 4a3adebb Jan Kiszka
    }
1098 4a3adebb Jan Kiszka
1099 04fa27f5 Jan Kiszka
    route = kvm_lookup_msi_route(s, msg);
1100 04fa27f5 Jan Kiszka
    if (!route) {
1101 e7b20308 Jan Kiszka
        int virq;
1102 04fa27f5 Jan Kiszka
1103 04fa27f5 Jan Kiszka
        virq = kvm_irqchip_get_virq(s);
1104 04fa27f5 Jan Kiszka
        if (virq < 0) {
1105 04fa27f5 Jan Kiszka
            return virq;
1106 04fa27f5 Jan Kiszka
        }
1107 04fa27f5 Jan Kiszka
1108 04fa27f5 Jan Kiszka
        route = g_malloc(sizeof(KVMMSIRoute));
1109 04fa27f5 Jan Kiszka
        route->kroute.gsi = virq;
1110 04fa27f5 Jan Kiszka
        route->kroute.type = KVM_IRQ_ROUTING_MSI;
1111 04fa27f5 Jan Kiszka
        route->kroute.flags = 0;
1112 04fa27f5 Jan Kiszka
        route->kroute.u.msi.address_lo = (uint32_t)msg.address;
1113 04fa27f5 Jan Kiszka
        route->kroute.u.msi.address_hi = msg.address >> 32;
1114 04fa27f5 Jan Kiszka
        route->kroute.u.msi.data = msg.data;
1115 04fa27f5 Jan Kiszka
1116 04fa27f5 Jan Kiszka
        kvm_add_routing_entry(s, &route->kroute);
1117 04fa27f5 Jan Kiszka
1118 04fa27f5 Jan Kiszka
        QTAILQ_INSERT_TAIL(&s->msi_hashtab[kvm_hash_msi(msg.data)], route,
1119 04fa27f5 Jan Kiszka
                           entry);
1120 04fa27f5 Jan Kiszka
    }
1121 04fa27f5 Jan Kiszka
1122 04fa27f5 Jan Kiszka
    assert(route->kroute.type == KVM_IRQ_ROUTING_MSI);
1123 04fa27f5 Jan Kiszka
1124 3889c3fa Peter Maydell
    return kvm_set_irq(s, route->kroute.gsi, 1);
1125 04fa27f5 Jan Kiszka
}
1126 04fa27f5 Jan Kiszka
1127 92b4e489 Jan Kiszka
int kvm_irqchip_add_msi_route(KVMState *s, MSIMessage msg)
1128 92b4e489 Jan Kiszka
{
1129 92b4e489 Jan Kiszka
    struct kvm_irq_routing_entry kroute;
1130 92b4e489 Jan Kiszka
    int virq;
1131 92b4e489 Jan Kiszka
1132 f3e1bed8 Peter Maydell
    if (!kvm_gsi_routing_enabled()) {
1133 92b4e489 Jan Kiszka
        return -ENOSYS;
1134 92b4e489 Jan Kiszka
    }
1135 92b4e489 Jan Kiszka
1136 92b4e489 Jan Kiszka
    virq = kvm_irqchip_get_virq(s);
1137 92b4e489 Jan Kiszka
    if (virq < 0) {
1138 92b4e489 Jan Kiszka
        return virq;
1139 92b4e489 Jan Kiszka
    }
1140 92b4e489 Jan Kiszka
1141 92b4e489 Jan Kiszka
    kroute.gsi = virq;
1142 92b4e489 Jan Kiszka
    kroute.type = KVM_IRQ_ROUTING_MSI;
1143 92b4e489 Jan Kiszka
    kroute.flags = 0;
1144 92b4e489 Jan Kiszka
    kroute.u.msi.address_lo = (uint32_t)msg.address;
1145 92b4e489 Jan Kiszka
    kroute.u.msi.address_hi = msg.address >> 32;
1146 92b4e489 Jan Kiszka
    kroute.u.msi.data = msg.data;
1147 92b4e489 Jan Kiszka
1148 92b4e489 Jan Kiszka
    kvm_add_routing_entry(s, &kroute);
1149 92b4e489 Jan Kiszka
1150 92b4e489 Jan Kiszka
    return virq;
1151 92b4e489 Jan Kiszka
}
1152 92b4e489 Jan Kiszka
1153 cc57407e Jan Kiszka
int kvm_irqchip_update_msi_route(KVMState *s, int virq, MSIMessage msg)
1154 cc57407e Jan Kiszka
{
1155 cc57407e Jan Kiszka
    struct kvm_irq_routing_entry kroute;
1156 cc57407e Jan Kiszka
1157 cc57407e Jan Kiszka
    if (!kvm_irqchip_in_kernel()) {
1158 cc57407e Jan Kiszka
        return -ENOSYS;
1159 cc57407e Jan Kiszka
    }
1160 cc57407e Jan Kiszka
1161 cc57407e Jan Kiszka
    kroute.gsi = virq;
1162 cc57407e Jan Kiszka
    kroute.type = KVM_IRQ_ROUTING_MSI;
1163 cc57407e Jan Kiszka
    kroute.flags = 0;
1164 cc57407e Jan Kiszka
    kroute.u.msi.address_lo = (uint32_t)msg.address;
1165 cc57407e Jan Kiszka
    kroute.u.msi.address_hi = msg.address >> 32;
1166 cc57407e Jan Kiszka
    kroute.u.msi.data = msg.data;
1167 cc57407e Jan Kiszka
1168 cc57407e Jan Kiszka
    return kvm_update_routing_entry(s, &kroute);
1169 cc57407e Jan Kiszka
}
1170 cc57407e Jan Kiszka
1171 39853bbc Jan Kiszka
static int kvm_irqchip_assign_irqfd(KVMState *s, int fd, int virq, bool assign)
1172 39853bbc Jan Kiszka
{
1173 39853bbc Jan Kiszka
    struct kvm_irqfd irqfd = {
1174 39853bbc Jan Kiszka
        .fd = fd,
1175 39853bbc Jan Kiszka
        .gsi = virq,
1176 39853bbc Jan Kiszka
        .flags = assign ? 0 : KVM_IRQFD_FLAG_DEASSIGN,
1177 39853bbc Jan Kiszka
    };
1178 39853bbc Jan Kiszka
1179 cc7e0ddf Peter Maydell
    if (!kvm_irqfds_enabled()) {
1180 39853bbc Jan Kiszka
        return -ENOSYS;
1181 39853bbc Jan Kiszka
    }
1182 39853bbc Jan Kiszka
1183 39853bbc Jan Kiszka
    return kvm_vm_ioctl(s, KVM_IRQFD, &irqfd);
1184 39853bbc Jan Kiszka
}
1185 39853bbc Jan Kiszka
1186 84b058d7 Jan Kiszka
#else /* !KVM_CAP_IRQ_ROUTING */
1187 84b058d7 Jan Kiszka
1188 84b058d7 Jan Kiszka
static void kvm_init_irq_routing(KVMState *s)
1189 84b058d7 Jan Kiszka
{
1190 84b058d7 Jan Kiszka
}
1191 04fa27f5 Jan Kiszka
1192 d3d3bef0 Jan Kiszka
void kvm_irqchip_release_virq(KVMState *s, int virq)
1193 d3d3bef0 Jan Kiszka
{
1194 d3d3bef0 Jan Kiszka
}
1195 d3d3bef0 Jan Kiszka
1196 04fa27f5 Jan Kiszka
int kvm_irqchip_send_msi(KVMState *s, MSIMessage msg)
1197 04fa27f5 Jan Kiszka
{
1198 04fa27f5 Jan Kiszka
    abort();
1199 04fa27f5 Jan Kiszka
}
1200 92b4e489 Jan Kiszka
1201 92b4e489 Jan Kiszka
int kvm_irqchip_add_msi_route(KVMState *s, MSIMessage msg)
1202 92b4e489 Jan Kiszka
{
1203 df410675 Alex Williamson
    return -ENOSYS;
1204 92b4e489 Jan Kiszka
}
1205 39853bbc Jan Kiszka
1206 39853bbc Jan Kiszka
static int kvm_irqchip_assign_irqfd(KVMState *s, int fd, int virq, bool assign)
1207 39853bbc Jan Kiszka
{
1208 39853bbc Jan Kiszka
    abort();
1209 39853bbc Jan Kiszka
}
1210 84b058d7 Jan Kiszka
#endif /* !KVM_CAP_IRQ_ROUTING */
1211 84b058d7 Jan Kiszka
1212 b131c74a Jan Kiszka
int kvm_irqchip_add_irqfd_notifier(KVMState *s, EventNotifier *n, int virq)
1213 39853bbc Jan Kiszka
{
1214 b131c74a Jan Kiszka
    return kvm_irqchip_assign_irqfd(s, event_notifier_get_fd(n), virq, true);
1215 39853bbc Jan Kiszka
}
1216 39853bbc Jan Kiszka
1217 b131c74a Jan Kiszka
int kvm_irqchip_remove_irqfd_notifier(KVMState *s, EventNotifier *n, int virq)
1218 15b2bd18 Paolo Bonzini
{
1219 b131c74a Jan Kiszka
    return kvm_irqchip_assign_irqfd(s, event_notifier_get_fd(n), virq, false);
1220 15b2bd18 Paolo Bonzini
}
1221 15b2bd18 Paolo Bonzini
1222 84b058d7 Jan Kiszka
static int kvm_irqchip_create(KVMState *s)
1223 84b058d7 Jan Kiszka
{
1224 84b058d7 Jan Kiszka
    QemuOptsList *list = qemu_find_opts("machine");
1225 84b058d7 Jan Kiszka
    int ret;
1226 84b058d7 Jan Kiszka
1227 84b058d7 Jan Kiszka
    if (QTAILQ_EMPTY(&list->head) ||
1228 84b058d7 Jan Kiszka
        !qemu_opt_get_bool(QTAILQ_FIRST(&list->head),
1229 a24b9106 Jan Kiszka
                           "kernel_irqchip", true) ||
1230 84b058d7 Jan Kiszka
        !kvm_check_extension(s, KVM_CAP_IRQCHIP)) {
1231 84b058d7 Jan Kiszka
        return 0;
1232 84b058d7 Jan Kiszka
    }
1233 84b058d7 Jan Kiszka
1234 84b058d7 Jan Kiszka
    ret = kvm_vm_ioctl(s, KVM_CREATE_IRQCHIP);
1235 84b058d7 Jan Kiszka
    if (ret < 0) {
1236 84b058d7 Jan Kiszka
        fprintf(stderr, "Create kernel irqchip failed\n");
1237 84b058d7 Jan Kiszka
        return ret;
1238 84b058d7 Jan Kiszka
    }
1239 84b058d7 Jan Kiszka
1240 3d4b2649 Jan Kiszka
    kvm_kernel_irqchip = true;
1241 7ae26bd4 Peter Maydell
    /* If we have an in-kernel IRQ chip then we must have asynchronous
1242 7ae26bd4 Peter Maydell
     * interrupt delivery (though the reverse is not necessarily true)
1243 7ae26bd4 Peter Maydell
     */
1244 7ae26bd4 Peter Maydell
    kvm_async_interrupts_allowed = true;
1245 84b058d7 Jan Kiszka
1246 84b058d7 Jan Kiszka
    kvm_init_irq_routing(s);
1247 84b058d7 Jan Kiszka
1248 84b058d7 Jan Kiszka
    return 0;
1249 84b058d7 Jan Kiszka
}
1250 84b058d7 Jan Kiszka
1251 3ed444e9 Dunrong Huang
static int kvm_max_vcpus(KVMState *s)
1252 3ed444e9 Dunrong Huang
{
1253 3ed444e9 Dunrong Huang
    int ret;
1254 3ed444e9 Dunrong Huang
1255 3ed444e9 Dunrong Huang
    /* Find number of supported CPUs using the recommended
1256 3ed444e9 Dunrong Huang
     * procedure from the kernel API documentation to cope with
1257 3ed444e9 Dunrong Huang
     * older kernels that may be missing capabilities.
1258 3ed444e9 Dunrong Huang
     */
1259 3ed444e9 Dunrong Huang
    ret = kvm_check_extension(s, KVM_CAP_MAX_VCPUS);
1260 3ed444e9 Dunrong Huang
    if (ret) {
1261 3ed444e9 Dunrong Huang
        return ret;
1262 3ed444e9 Dunrong Huang
    }
1263 3ed444e9 Dunrong Huang
    ret = kvm_check_extension(s, KVM_CAP_NR_VCPUS);
1264 3ed444e9 Dunrong Huang
    if (ret) {
1265 3ed444e9 Dunrong Huang
        return ret;
1266 3ed444e9 Dunrong Huang
    }
1267 3ed444e9 Dunrong Huang
1268 3ed444e9 Dunrong Huang
    return 4;
1269 3ed444e9 Dunrong Huang
}
1270 3ed444e9 Dunrong Huang
1271 cad1e282 Jan Kiszka
int kvm_init(void)
1272 05330448 aliguori
{
1273 168ccc11 Jan Kiszka
    static const char upgrade_note[] =
1274 168ccc11 Jan Kiszka
        "Please upgrade to at least kernel 2.6.29 or recent kvm-kmod\n"
1275 168ccc11 Jan Kiszka
        "(see http://sourceforge.net/projects/kvm).\n";
1276 05330448 aliguori
    KVMState *s;
1277 94a8d39a Jan Kiszka
    const KVMCapabilityInfo *missing_cap;
1278 05330448 aliguori
    int ret;
1279 05330448 aliguori
    int i;
1280 3ed444e9 Dunrong Huang
    int max_vcpus;
1281 05330448 aliguori
1282 7267c094 Anthony Liguori
    s = g_malloc0(sizeof(KVMState));
1283 05330448 aliguori
1284 3145fcb6 David Gibson
    /*
1285 3145fcb6 David Gibson
     * On systems where the kernel can support different base page
1286 3145fcb6 David Gibson
     * sizes, host page size may be different from TARGET_PAGE_SIZE,
1287 3145fcb6 David Gibson
     * even with KVM.  TARGET_PAGE_SIZE is assumed to be the minimum
1288 3145fcb6 David Gibson
     * page size for the system though.
1289 3145fcb6 David Gibson
     */
1290 3145fcb6 David Gibson
    assert(TARGET_PAGE_SIZE <= getpagesize());
1291 3145fcb6 David Gibson
1292 e22a25c9 aliguori
#ifdef KVM_CAP_SET_GUEST_DEBUG
1293 72cf2d4f Blue Swirl
    QTAILQ_INIT(&s->kvm_sw_breakpoints);
1294 e22a25c9 aliguori
#endif
1295 a426e122 Jan Kiszka
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
1296 05330448 aliguori
        s->slots[i].slot = i;
1297 a426e122 Jan Kiszka
    }
1298 05330448 aliguori
    s->vmfd = -1;
1299 40ff6d7e Kevin Wolf
    s->fd = qemu_open("/dev/kvm", O_RDWR);
1300 05330448 aliguori
    if (s->fd == -1) {
1301 05330448 aliguori
        fprintf(stderr, "Could not access KVM kernel module: %m\n");
1302 05330448 aliguori
        ret = -errno;
1303 05330448 aliguori
        goto err;
1304 05330448 aliguori
    }
1305 05330448 aliguori
1306 05330448 aliguori
    ret = kvm_ioctl(s, KVM_GET_API_VERSION, 0);
1307 05330448 aliguori
    if (ret < KVM_API_VERSION) {
1308 a426e122 Jan Kiszka
        if (ret > 0) {
1309 05330448 aliguori
            ret = -EINVAL;
1310 a426e122 Jan Kiszka
        }
1311 05330448 aliguori
        fprintf(stderr, "kvm version too old\n");
1312 05330448 aliguori
        goto err;
1313 05330448 aliguori
    }
1314 05330448 aliguori
1315 05330448 aliguori
    if (ret > KVM_API_VERSION) {
1316 05330448 aliguori
        ret = -EINVAL;
1317 05330448 aliguori
        fprintf(stderr, "kvm version not supported\n");
1318 05330448 aliguori
        goto err;
1319 05330448 aliguori
    }
1320 05330448 aliguori
1321 3ed444e9 Dunrong Huang
    max_vcpus = kvm_max_vcpus(s);
1322 3ed444e9 Dunrong Huang
    if (smp_cpus > max_vcpus) {
1323 3ed444e9 Dunrong Huang
        ret = -EINVAL;
1324 3ed444e9 Dunrong Huang
        fprintf(stderr, "Number of SMP cpus requested (%d) exceeds max cpus "
1325 3ed444e9 Dunrong Huang
                "supported by KVM (%d)\n", smp_cpus, max_vcpus);
1326 3ed444e9 Dunrong Huang
        goto err;
1327 3ed444e9 Dunrong Huang
    }
1328 3ed444e9 Dunrong Huang
1329 05330448 aliguori
    s->vmfd = kvm_ioctl(s, KVM_CREATE_VM, 0);
1330 0104dcac Alexander Graf
    if (s->vmfd < 0) {
1331 0104dcac Alexander Graf
#ifdef TARGET_S390X
1332 0104dcac Alexander Graf
        fprintf(stderr, "Please add the 'switch_amode' kernel parameter to "
1333 0104dcac Alexander Graf
                        "your host kernel command line\n");
1334 0104dcac Alexander Graf
#endif
1335 db9eae1c Xu He Jie
        ret = s->vmfd;
1336 05330448 aliguori
        goto err;
1337 0104dcac Alexander Graf
    }
1338 05330448 aliguori
1339 94a8d39a Jan Kiszka
    missing_cap = kvm_check_extension_list(s, kvm_required_capabilites);
1340 94a8d39a Jan Kiszka
    if (!missing_cap) {
1341 94a8d39a Jan Kiszka
        missing_cap =
1342 94a8d39a Jan Kiszka
            kvm_check_extension_list(s, kvm_arch_required_capabilities);
1343 05330448 aliguori
    }
1344 94a8d39a Jan Kiszka
    if (missing_cap) {
1345 ad7b8b33 Anthony Liguori
        ret = -EINVAL;
1346 94a8d39a Jan Kiszka
        fprintf(stderr, "kvm does not support %s\n%s",
1347 94a8d39a Jan Kiszka
                missing_cap->name, upgrade_note);
1348 d85dc283 aliguori
        goto err;
1349 d85dc283 aliguori
    }
1350 d85dc283 aliguori
1351 ad7b8b33 Anthony Liguori
    s->coalesced_mmio = kvm_check_extension(s, KVM_CAP_COALESCED_MMIO);
1352 f65ed4c1 aliguori
1353 e69917e2 Jan Kiszka
    s->broken_set_mem_region = 1;
1354 14a09518 Lai Jiangshan
    ret = kvm_check_extension(s, KVM_CAP_JOIN_MEMORY_REGIONS_WORKS);
1355 e69917e2 Jan Kiszka
    if (ret > 0) {
1356 e69917e2 Jan Kiszka
        s->broken_set_mem_region = 0;
1357 e69917e2 Jan Kiszka
    }
1358 e69917e2 Jan Kiszka
1359 a0fb002c Jan Kiszka
#ifdef KVM_CAP_VCPU_EVENTS
1360 a0fb002c Jan Kiszka
    s->vcpu_events = kvm_check_extension(s, KVM_CAP_VCPU_EVENTS);
1361 a0fb002c Jan Kiszka
#endif
1362 a0fb002c Jan Kiszka
1363 b0b1d690 Jan Kiszka
    s->robust_singlestep =
1364 b0b1d690 Jan Kiszka
        kvm_check_extension(s, KVM_CAP_X86_ROBUST_SINGLESTEP);
1365 b0b1d690 Jan Kiszka
1366 ff44f1a3 Jan Kiszka
#ifdef KVM_CAP_DEBUGREGS
1367 ff44f1a3 Jan Kiszka
    s->debugregs = kvm_check_extension(s, KVM_CAP_DEBUGREGS);
1368 ff44f1a3 Jan Kiszka
#endif
1369 ff44f1a3 Jan Kiszka
1370 f1665b21 Sheng Yang
#ifdef KVM_CAP_XSAVE
1371 f1665b21 Sheng Yang
    s->xsave = kvm_check_extension(s, KVM_CAP_XSAVE);
1372 f1665b21 Sheng Yang
#endif
1373 f1665b21 Sheng Yang
1374 f1665b21 Sheng Yang
#ifdef KVM_CAP_XCRS
1375 f1665b21 Sheng Yang
    s->xcrs = kvm_check_extension(s, KVM_CAP_XCRS);
1376 f1665b21 Sheng Yang
#endif
1377 f1665b21 Sheng Yang
1378 8a7c7393 Jan Kiszka
#ifdef KVM_CAP_PIT_STATE2
1379 8a7c7393 Jan Kiszka
    s->pit_state2 = kvm_check_extension(s, KVM_CAP_PIT_STATE2);
1380 8a7c7393 Jan Kiszka
#endif
1381 8a7c7393 Jan Kiszka
1382 d3d3bef0 Jan Kiszka
#ifdef KVM_CAP_IRQ_ROUTING
1383 4a3adebb Jan Kiszka
    s->direct_msi = (kvm_check_extension(s, KVM_CAP_SIGNAL_MSI) > 0);
1384 d3d3bef0 Jan Kiszka
#endif
1385 4a3adebb Jan Kiszka
1386 3ab73842 Jan Kiszka
    s->intx_set_mask = kvm_check_extension(s, KVM_CAP_PCI_2_3);
1387 3ab73842 Jan Kiszka
1388 e333cd69 Jan Kiszka
    s->irq_set_ioctl = KVM_IRQ_LINE;
1389 8732fbd2 Peter Maydell
    if (kvm_check_extension(s, KVM_CAP_IRQ_INJECT_STATUS)) {
1390 e333cd69 Jan Kiszka
        s->irq_set_ioctl = KVM_IRQ_LINE_STATUS;
1391 8732fbd2 Peter Maydell
    }
1392 8732fbd2 Peter Maydell
1393 cad1e282 Jan Kiszka
    ret = kvm_arch_init(s);
1394 a426e122 Jan Kiszka
    if (ret < 0) {
1395 05330448 aliguori
        goto err;
1396 a426e122 Jan Kiszka
    }
1397 05330448 aliguori
1398 84b058d7 Jan Kiszka
    ret = kvm_irqchip_create(s);
1399 84b058d7 Jan Kiszka
    if (ret < 0) {
1400 84b058d7 Jan Kiszka
        goto err;
1401 84b058d7 Jan Kiszka
    }
1402 84b058d7 Jan Kiszka
1403 05330448 aliguori
    kvm_state = s;
1404 7376e582 Avi Kivity
    memory_listener_register(&kvm_memory_listener, NULL);
1405 05330448 aliguori
1406 d2f2b8a7 Stefan Hajnoczi
    s->many_ioeventfds = kvm_check_many_ioeventfds();
1407 d2f2b8a7 Stefan Hajnoczi
1408 aa7f74d1 Jan Kiszka
    cpu_interrupt_handler = kvm_handle_interrupt;
1409 aa7f74d1 Jan Kiszka
1410 05330448 aliguori
    return 0;
1411 05330448 aliguori
1412 05330448 aliguori
err:
1413 6d1cc321 Stefan Weil
    if (s->vmfd >= 0) {
1414 6d1cc321 Stefan Weil
        close(s->vmfd);
1415 6d1cc321 Stefan Weil
    }
1416 6d1cc321 Stefan Weil
    if (s->fd != -1) {
1417 6d1cc321 Stefan Weil
        close(s->fd);
1418 05330448 aliguori
    }
1419 7267c094 Anthony Liguori
    g_free(s);
1420 05330448 aliguori
1421 05330448 aliguori
    return ret;
1422 05330448 aliguori
}
1423 05330448 aliguori
1424 b30e93e9 Jan Kiszka
static void kvm_handle_io(uint16_t port, void *data, int direction, int size,
1425 b30e93e9 Jan Kiszka
                          uint32_t count)
1426 05330448 aliguori
{
1427 05330448 aliguori
    int i;
1428 05330448 aliguori
    uint8_t *ptr = data;
1429 05330448 aliguori
1430 05330448 aliguori
    for (i = 0; i < count; i++) {
1431 05330448 aliguori
        if (direction == KVM_EXIT_IO_IN) {
1432 05330448 aliguori
            switch (size) {
1433 05330448 aliguori
            case 1:
1434 afcea8cb Blue Swirl
                stb_p(ptr, cpu_inb(port));
1435 05330448 aliguori
                break;
1436 05330448 aliguori
            case 2:
1437 afcea8cb Blue Swirl
                stw_p(ptr, cpu_inw(port));
1438 05330448 aliguori
                break;
1439 05330448 aliguori
            case 4:
1440 afcea8cb Blue Swirl
                stl_p(ptr, cpu_inl(port));
1441 05330448 aliguori
                break;
1442 05330448 aliguori
            }
1443 05330448 aliguori
        } else {
1444 05330448 aliguori
            switch (size) {
1445 05330448 aliguori
            case 1:
1446 afcea8cb Blue Swirl
                cpu_outb(port, ldub_p(ptr));
1447 05330448 aliguori
                break;
1448 05330448 aliguori
            case 2:
1449 afcea8cb Blue Swirl
                cpu_outw(port, lduw_p(ptr));
1450 05330448 aliguori
                break;
1451 05330448 aliguori
            case 4:
1452 afcea8cb Blue Swirl
                cpu_outl(port, ldl_p(ptr));
1453 05330448 aliguori
                break;
1454 05330448 aliguori
            }
1455 05330448 aliguori
        }
1456 05330448 aliguori
1457 05330448 aliguori
        ptr += size;
1458 05330448 aliguori
    }
1459 05330448 aliguori
}
1460 05330448 aliguori
1461 9349b4f9 Andreas Färber
static int kvm_handle_internal_error(CPUArchState *env, struct kvm_run *run)
1462 7c80eef8 Marcelo Tosatti
{
1463 bb44e0d1 Jan Kiszka
    fprintf(stderr, "KVM internal error.");
1464 7c80eef8 Marcelo Tosatti
    if (kvm_check_extension(kvm_state, KVM_CAP_INTERNAL_ERROR_DATA)) {
1465 7c80eef8 Marcelo Tosatti
        int i;
1466 7c80eef8 Marcelo Tosatti
1467 bb44e0d1 Jan Kiszka
        fprintf(stderr, " Suberror: %d\n", run->internal.suberror);
1468 7c80eef8 Marcelo Tosatti
        for (i = 0; i < run->internal.ndata; ++i) {
1469 7c80eef8 Marcelo Tosatti
            fprintf(stderr, "extra data[%d]: %"PRIx64"\n",
1470 7c80eef8 Marcelo Tosatti
                    i, (uint64_t)run->internal.data[i]);
1471 7c80eef8 Marcelo Tosatti
        }
1472 bb44e0d1 Jan Kiszka
    } else {
1473 bb44e0d1 Jan Kiszka
        fprintf(stderr, "\n");
1474 7c80eef8 Marcelo Tosatti
    }
1475 7c80eef8 Marcelo Tosatti
    if (run->internal.suberror == KVM_INTERNAL_ERROR_EMULATION) {
1476 7c80eef8 Marcelo Tosatti
        fprintf(stderr, "emulation failure\n");
1477 a426e122 Jan Kiszka
        if (!kvm_arch_stop_on_emulation_error(env)) {
1478 f5c848ee Jan Kiszka
            cpu_dump_state(env, stderr, fprintf, CPU_DUMP_CODE);
1479 d73cd8f4 Jan Kiszka
            return EXCP_INTERRUPT;
1480 a426e122 Jan Kiszka
        }
1481 7c80eef8 Marcelo Tosatti
    }
1482 7c80eef8 Marcelo Tosatti
    /* FIXME: Should trigger a qmp message to let management know
1483 7c80eef8 Marcelo Tosatti
     * something went wrong.
1484 7c80eef8 Marcelo Tosatti
     */
1485 73aaec4a Jan Kiszka
    return -1;
1486 7c80eef8 Marcelo Tosatti
}
1487 7c80eef8 Marcelo Tosatti
1488 62a2744c Sheng Yang
void kvm_flush_coalesced_mmio_buffer(void)
1489 f65ed4c1 aliguori
{
1490 f65ed4c1 aliguori
    KVMState *s = kvm_state;
1491 1cae88b9 Avi Kivity
1492 1cae88b9 Avi Kivity
    if (s->coalesced_flush_in_progress) {
1493 1cae88b9 Avi Kivity
        return;
1494 1cae88b9 Avi Kivity
    }
1495 1cae88b9 Avi Kivity
1496 1cae88b9 Avi Kivity
    s->coalesced_flush_in_progress = true;
1497 1cae88b9 Avi Kivity
1498 62a2744c Sheng Yang
    if (s->coalesced_mmio_ring) {
1499 62a2744c Sheng Yang
        struct kvm_coalesced_mmio_ring *ring = s->coalesced_mmio_ring;
1500 f65ed4c1 aliguori
        while (ring->first != ring->last) {
1501 f65ed4c1 aliguori
            struct kvm_coalesced_mmio *ent;
1502 f65ed4c1 aliguori
1503 f65ed4c1 aliguori
            ent = &ring->coalesced_mmio[ring->first];
1504 f65ed4c1 aliguori
1505 f65ed4c1 aliguori
            cpu_physical_memory_write(ent->phys_addr, ent->data, ent->len);
1506 85199474 Marcelo Tosatti
            smp_wmb();
1507 f65ed4c1 aliguori
            ring->first = (ring->first + 1) % KVM_COALESCED_MMIO_MAX;
1508 f65ed4c1 aliguori
        }
1509 f65ed4c1 aliguori
    }
1510 1cae88b9 Avi Kivity
1511 1cae88b9 Avi Kivity
    s->coalesced_flush_in_progress = false;
1512 f65ed4c1 aliguori
}
1513 f65ed4c1 aliguori
1514 2705d56a Jan Kiszka
static void do_kvm_cpu_synchronize_state(void *_env)
1515 4c0960c0 Avi Kivity
{
1516 9349b4f9 Andreas Färber
    CPUArchState *env = _env;
1517 2705d56a Jan Kiszka
1518 9ded2744 Jan Kiszka
    if (!env->kvm_vcpu_dirty) {
1519 4c0960c0 Avi Kivity
        kvm_arch_get_registers(env);
1520 9ded2744 Jan Kiszka
        env->kvm_vcpu_dirty = 1;
1521 4c0960c0 Avi Kivity
    }
1522 4c0960c0 Avi Kivity
}
1523 4c0960c0 Avi Kivity
1524 9349b4f9 Andreas Färber
void kvm_cpu_synchronize_state(CPUArchState *env)
1525 2705d56a Jan Kiszka
{
1526 a426e122 Jan Kiszka
    if (!env->kvm_vcpu_dirty) {
1527 2705d56a Jan Kiszka
        run_on_cpu(env, do_kvm_cpu_synchronize_state, env);
1528 a426e122 Jan Kiszka
    }
1529 2705d56a Jan Kiszka
}
1530 2705d56a Jan Kiszka
1531 9349b4f9 Andreas Färber
void kvm_cpu_synchronize_post_reset(CPUArchState *env)
1532 ea375f9a Jan Kiszka
{
1533 ea375f9a Jan Kiszka
    kvm_arch_put_registers(env, KVM_PUT_RESET_STATE);
1534 ea375f9a Jan Kiszka
    env->kvm_vcpu_dirty = 0;
1535 ea375f9a Jan Kiszka
}
1536 ea375f9a Jan Kiszka
1537 9349b4f9 Andreas Färber
void kvm_cpu_synchronize_post_init(CPUArchState *env)
1538 ea375f9a Jan Kiszka
{
1539 ea375f9a Jan Kiszka
    kvm_arch_put_registers(env, KVM_PUT_FULL_STATE);
1540 ea375f9a Jan Kiszka
    env->kvm_vcpu_dirty = 0;
1541 ea375f9a Jan Kiszka
}
1542 ea375f9a Jan Kiszka
1543 9349b4f9 Andreas Färber
int kvm_cpu_exec(CPUArchState *env)
1544 05330448 aliguori
{
1545 05330448 aliguori
    struct kvm_run *run = env->kvm_run;
1546 7cbb533f Jan Kiszka
    int ret, run_ret;
1547 05330448 aliguori
1548 8c0d577e Blue Swirl
    DPRINTF("kvm_cpu_exec()\n");
1549 05330448 aliguori
1550 99036865 Jan Kiszka
    if (kvm_arch_process_async_events(env)) {
1551 9ccfac9e Jan Kiszka
        env->exit_request = 0;
1552 6792a57b Jan Kiszka
        return EXCP_HLT;
1553 9ccfac9e Jan Kiszka
    }
1554 0af691d7 Marcelo Tosatti
1555 9ccfac9e Jan Kiszka
    do {
1556 9ded2744 Jan Kiszka
        if (env->kvm_vcpu_dirty) {
1557 ea375f9a Jan Kiszka
            kvm_arch_put_registers(env, KVM_PUT_RUNTIME_STATE);
1558 9ded2744 Jan Kiszka
            env->kvm_vcpu_dirty = 0;
1559 4c0960c0 Avi Kivity
        }
1560 4c0960c0 Avi Kivity
1561 8c14c173 Jan Kiszka
        kvm_arch_pre_run(env, run);
1562 9ccfac9e Jan Kiszka
        if (env->exit_request) {
1563 9ccfac9e Jan Kiszka
            DPRINTF("interrupt exit requested\n");
1564 9ccfac9e Jan Kiszka
            /*
1565 9ccfac9e Jan Kiszka
             * KVM requires us to reenter the kernel after IO exits to complete
1566 9ccfac9e Jan Kiszka
             * instruction emulation. This self-signal will ensure that we
1567 9ccfac9e Jan Kiszka
             * leave ASAP again.
1568 9ccfac9e Jan Kiszka
             */
1569 9ccfac9e Jan Kiszka
            qemu_cpu_kick_self();
1570 9ccfac9e Jan Kiszka
        }
1571 d549db5a Glauber Costa
        qemu_mutex_unlock_iothread();
1572 9ccfac9e Jan Kiszka
1573 7cbb533f Jan Kiszka
        run_ret = kvm_vcpu_ioctl(env, KVM_RUN, 0);
1574 9ccfac9e Jan Kiszka
1575 d549db5a Glauber Costa
        qemu_mutex_lock_iothread();
1576 05330448 aliguori
        kvm_arch_post_run(env, run);
1577 05330448 aliguori
1578 7cbb533f Jan Kiszka
        if (run_ret < 0) {
1579 dc77d341 Jan Kiszka
            if (run_ret == -EINTR || run_ret == -EAGAIN) {
1580 dc77d341 Jan Kiszka
                DPRINTF("io window exit\n");
1581 d73cd8f4 Jan Kiszka
                ret = EXCP_INTERRUPT;
1582 dc77d341 Jan Kiszka
                break;
1583 dc77d341 Jan Kiszka
            }
1584 7b011fbc Michael Ellerman
            fprintf(stderr, "error: kvm run failed %s\n",
1585 7b011fbc Michael Ellerman
                    strerror(-run_ret));
1586 05330448 aliguori
            abort();
1587 05330448 aliguori
        }
1588 05330448 aliguori
1589 05330448 aliguori
        switch (run->exit_reason) {
1590 05330448 aliguori
        case KVM_EXIT_IO:
1591 8c0d577e Blue Swirl
            DPRINTF("handle_io\n");
1592 b30e93e9 Jan Kiszka
            kvm_handle_io(run->io.port,
1593 b30e93e9 Jan Kiszka
                          (uint8_t *)run + run->io.data_offset,
1594 b30e93e9 Jan Kiszka
                          run->io.direction,
1595 b30e93e9 Jan Kiszka
                          run->io.size,
1596 b30e93e9 Jan Kiszka
                          run->io.count);
1597 d73cd8f4 Jan Kiszka
            ret = 0;
1598 05330448 aliguori
            break;
1599 05330448 aliguori
        case KVM_EXIT_MMIO:
1600 8c0d577e Blue Swirl
            DPRINTF("handle_mmio\n");
1601 05330448 aliguori
            cpu_physical_memory_rw(run->mmio.phys_addr,
1602 05330448 aliguori
                                   run->mmio.data,
1603 05330448 aliguori
                                   run->mmio.len,
1604 05330448 aliguori
                                   run->mmio.is_write);
1605 d73cd8f4 Jan Kiszka
            ret = 0;
1606 05330448 aliguori
            break;
1607 05330448 aliguori
        case KVM_EXIT_IRQ_WINDOW_OPEN:
1608 8c0d577e Blue Swirl
            DPRINTF("irq_window_open\n");
1609 d73cd8f4 Jan Kiszka
            ret = EXCP_INTERRUPT;
1610 05330448 aliguori
            break;
1611 05330448 aliguori
        case KVM_EXIT_SHUTDOWN:
1612 8c0d577e Blue Swirl
            DPRINTF("shutdown\n");
1613 05330448 aliguori
            qemu_system_reset_request();
1614 d73cd8f4 Jan Kiszka
            ret = EXCP_INTERRUPT;
1615 05330448 aliguori
            break;
1616 05330448 aliguori
        case KVM_EXIT_UNKNOWN:
1617 bb44e0d1 Jan Kiszka
            fprintf(stderr, "KVM: unknown exit, hardware reason %" PRIx64 "\n",
1618 bb44e0d1 Jan Kiszka
                    (uint64_t)run->hw.hardware_exit_reason);
1619 73aaec4a Jan Kiszka
            ret = -1;
1620 05330448 aliguori
            break;
1621 7c80eef8 Marcelo Tosatti
        case KVM_EXIT_INTERNAL_ERROR:
1622 73aaec4a Jan Kiszka
            ret = kvm_handle_internal_error(env, run);
1623 7c80eef8 Marcelo Tosatti
            break;
1624 05330448 aliguori
        default:
1625 8c0d577e Blue Swirl
            DPRINTF("kvm_arch_handle_exit\n");
1626 05330448 aliguori
            ret = kvm_arch_handle_exit(env, run);
1627 05330448 aliguori
            break;
1628 05330448 aliguori
        }
1629 d73cd8f4 Jan Kiszka
    } while (ret == 0);
1630 05330448 aliguori
1631 73aaec4a Jan Kiszka
    if (ret < 0) {
1632 f5c848ee Jan Kiszka
        cpu_dump_state(env, stderr, fprintf, CPU_DUMP_CODE);
1633 0461d5a6 Luiz Capitulino
        vm_stop(RUN_STATE_INTERNAL_ERROR);
1634 becfc390 aliguori
    }
1635 becfc390 aliguori
1636 6792a57b Jan Kiszka
    env->exit_request = 0;
1637 05330448 aliguori
    return ret;
1638 05330448 aliguori
}
1639 05330448 aliguori
1640 984b5181 aliguori
int kvm_ioctl(KVMState *s, int type, ...)
1641 05330448 aliguori
{
1642 05330448 aliguori
    int ret;
1643 984b5181 aliguori
    void *arg;
1644 984b5181 aliguori
    va_list ap;
1645 05330448 aliguori
1646 984b5181 aliguori
    va_start(ap, type);
1647 984b5181 aliguori
    arg = va_arg(ap, void *);
1648 984b5181 aliguori
    va_end(ap);
1649 984b5181 aliguori
1650 984b5181 aliguori
    ret = ioctl(s->fd, type, arg);
1651 a426e122 Jan Kiszka
    if (ret == -1) {
1652 05330448 aliguori
        ret = -errno;
1653 a426e122 Jan Kiszka
    }
1654 05330448 aliguori
    return ret;
1655 05330448 aliguori
}
1656 05330448 aliguori
1657 984b5181 aliguori
int kvm_vm_ioctl(KVMState *s, int type, ...)
1658 05330448 aliguori
{
1659 05330448 aliguori
    int ret;
1660 984b5181 aliguori
    void *arg;
1661 984b5181 aliguori
    va_list ap;
1662 984b5181 aliguori
1663 984b5181 aliguori
    va_start(ap, type);
1664 984b5181 aliguori
    arg = va_arg(ap, void *);
1665 984b5181 aliguori
    va_end(ap);
1666 05330448 aliguori
1667 984b5181 aliguori
    ret = ioctl(s->vmfd, type, arg);
1668 a426e122 Jan Kiszka
    if (ret == -1) {
1669 05330448 aliguori
        ret = -errno;
1670 a426e122 Jan Kiszka
    }
1671 05330448 aliguori
    return ret;
1672 05330448 aliguori
}
1673 05330448 aliguori
1674 9349b4f9 Andreas Färber
int kvm_vcpu_ioctl(CPUArchState *env, int type, ...)
1675 05330448 aliguori
{
1676 05330448 aliguori
    int ret;
1677 984b5181 aliguori
    void *arg;
1678 984b5181 aliguori
    va_list ap;
1679 984b5181 aliguori
1680 984b5181 aliguori
    va_start(ap, type);
1681 984b5181 aliguori
    arg = va_arg(ap, void *);
1682 984b5181 aliguori
    va_end(ap);
1683 05330448 aliguori
1684 984b5181 aliguori
    ret = ioctl(env->kvm_fd, type, arg);
1685 a426e122 Jan Kiszka
    if (ret == -1) {
1686 05330448 aliguori
        ret = -errno;
1687 a426e122 Jan Kiszka
    }
1688 05330448 aliguori
    return ret;
1689 05330448 aliguori
}
1690 bd322087 aliguori
1691 bd322087 aliguori
int kvm_has_sync_mmu(void)
1692 bd322087 aliguori
{
1693 94a8d39a Jan Kiszka
    return kvm_check_extension(kvm_state, KVM_CAP_SYNC_MMU);
1694 bd322087 aliguori
}
1695 e22a25c9 aliguori
1696 a0fb002c Jan Kiszka
int kvm_has_vcpu_events(void)
1697 a0fb002c Jan Kiszka
{
1698 a0fb002c Jan Kiszka
    return kvm_state->vcpu_events;
1699 a0fb002c Jan Kiszka
}
1700 a0fb002c Jan Kiszka
1701 b0b1d690 Jan Kiszka
int kvm_has_robust_singlestep(void)
1702 b0b1d690 Jan Kiszka
{
1703 b0b1d690 Jan Kiszka
    return kvm_state->robust_singlestep;
1704 b0b1d690 Jan Kiszka
}
1705 b0b1d690 Jan Kiszka
1706 ff44f1a3 Jan Kiszka
int kvm_has_debugregs(void)
1707 ff44f1a3 Jan Kiszka
{
1708 ff44f1a3 Jan Kiszka
    return kvm_state->debugregs;
1709 ff44f1a3 Jan Kiszka
}
1710 ff44f1a3 Jan Kiszka
1711 f1665b21 Sheng Yang
int kvm_has_xsave(void)
1712 f1665b21 Sheng Yang
{
1713 f1665b21 Sheng Yang
    return kvm_state->xsave;
1714 f1665b21 Sheng Yang
}
1715 f1665b21 Sheng Yang
1716 f1665b21 Sheng Yang
int kvm_has_xcrs(void)
1717 f1665b21 Sheng Yang
{
1718 f1665b21 Sheng Yang
    return kvm_state->xcrs;
1719 f1665b21 Sheng Yang
}
1720 f1665b21 Sheng Yang
1721 8a7c7393 Jan Kiszka
int kvm_has_pit_state2(void)
1722 8a7c7393 Jan Kiszka
{
1723 8a7c7393 Jan Kiszka
    return kvm_state->pit_state2;
1724 8a7c7393 Jan Kiszka
}
1725 8a7c7393 Jan Kiszka
1726 d2f2b8a7 Stefan Hajnoczi
int kvm_has_many_ioeventfds(void)
1727 d2f2b8a7 Stefan Hajnoczi
{
1728 d2f2b8a7 Stefan Hajnoczi
    if (!kvm_enabled()) {
1729 d2f2b8a7 Stefan Hajnoczi
        return 0;
1730 d2f2b8a7 Stefan Hajnoczi
    }
1731 d2f2b8a7 Stefan Hajnoczi
    return kvm_state->many_ioeventfds;
1732 d2f2b8a7 Stefan Hajnoczi
}
1733 d2f2b8a7 Stefan Hajnoczi
1734 84b058d7 Jan Kiszka
int kvm_has_gsi_routing(void)
1735 84b058d7 Jan Kiszka
{
1736 a9c5eb0d Alexander Graf
#ifdef KVM_CAP_IRQ_ROUTING
1737 84b058d7 Jan Kiszka
    return kvm_check_extension(kvm_state, KVM_CAP_IRQ_ROUTING);
1738 a9c5eb0d Alexander Graf
#else
1739 a9c5eb0d Alexander Graf
    return false;
1740 a9c5eb0d Alexander Graf
#endif
1741 84b058d7 Jan Kiszka
}
1742 84b058d7 Jan Kiszka
1743 3ab73842 Jan Kiszka
int kvm_has_intx_set_mask(void)
1744 3ab73842 Jan Kiszka
{
1745 3ab73842 Jan Kiszka
    return kvm_state->intx_set_mask;
1746 3ab73842 Jan Kiszka
}
1747 3ab73842 Jan Kiszka
1748 fdec9918 Christian Borntraeger
void *kvm_vmalloc(ram_addr_t size)
1749 fdec9918 Christian Borntraeger
{
1750 fdec9918 Christian Borntraeger
#ifdef TARGET_S390X
1751 fdec9918 Christian Borntraeger
    void *mem;
1752 fdec9918 Christian Borntraeger
1753 fdec9918 Christian Borntraeger
    mem = kvm_arch_vmalloc(size);
1754 fdec9918 Christian Borntraeger
    if (mem) {
1755 fdec9918 Christian Borntraeger
        return mem;
1756 fdec9918 Christian Borntraeger
    }
1757 fdec9918 Christian Borntraeger
#endif
1758 fdec9918 Christian Borntraeger
    return qemu_vmalloc(size);
1759 fdec9918 Christian Borntraeger
}
1760 fdec9918 Christian Borntraeger
1761 6f0437e8 Jan Kiszka
void kvm_setup_guest_memory(void *start, size_t size)
1762 6f0437e8 Jan Kiszka
{
1763 62fe8331 Christian Borntraeger
#ifdef CONFIG_VALGRIND_H
1764 62fe8331 Christian Borntraeger
    VALGRIND_MAKE_MEM_DEFINED(start, size);
1765 62fe8331 Christian Borntraeger
#endif
1766 6f0437e8 Jan Kiszka
    if (!kvm_has_sync_mmu()) {
1767 e78815a5 Andreas Färber
        int ret = qemu_madvise(start, size, QEMU_MADV_DONTFORK);
1768 6f0437e8 Jan Kiszka
1769 6f0437e8 Jan Kiszka
        if (ret) {
1770 e78815a5 Andreas Färber
            perror("qemu_madvise");
1771 e78815a5 Andreas Färber
            fprintf(stderr,
1772 e78815a5 Andreas Färber
                    "Need MADV_DONTFORK in absence of synchronous KVM MMU\n");
1773 6f0437e8 Jan Kiszka
            exit(1);
1774 6f0437e8 Jan Kiszka
        }
1775 6f0437e8 Jan Kiszka
    }
1776 6f0437e8 Jan Kiszka
}
1777 6f0437e8 Jan Kiszka
1778 e22a25c9 aliguori
#ifdef KVM_CAP_SET_GUEST_DEBUG
1779 9349b4f9 Andreas Färber
struct kvm_sw_breakpoint *kvm_find_sw_breakpoint(CPUArchState *env,
1780 e22a25c9 aliguori
                                                 target_ulong pc)
1781 e22a25c9 aliguori
{
1782 e22a25c9 aliguori
    struct kvm_sw_breakpoint *bp;
1783 e22a25c9 aliguori
1784 72cf2d4f Blue Swirl
    QTAILQ_FOREACH(bp, &env->kvm_state->kvm_sw_breakpoints, entry) {
1785 a426e122 Jan Kiszka
        if (bp->pc == pc) {
1786 e22a25c9 aliguori
            return bp;
1787 a426e122 Jan Kiszka
        }
1788 e22a25c9 aliguori
    }
1789 e22a25c9 aliguori
    return NULL;
1790 e22a25c9 aliguori
}
1791 e22a25c9 aliguori
1792 9349b4f9 Andreas Färber
int kvm_sw_breakpoints_active(CPUArchState *env)
1793 e22a25c9 aliguori
{
1794 72cf2d4f Blue Swirl
    return !QTAILQ_EMPTY(&env->kvm_state->kvm_sw_breakpoints);
1795 e22a25c9 aliguori
}
1796 e22a25c9 aliguori
1797 452e4751 Glauber Costa
struct kvm_set_guest_debug_data {
1798 452e4751 Glauber Costa
    struct kvm_guest_debug dbg;
1799 9349b4f9 Andreas Färber
    CPUArchState *env;
1800 452e4751 Glauber Costa
    int err;
1801 452e4751 Glauber Costa
};
1802 452e4751 Glauber Costa
1803 452e4751 Glauber Costa
static void kvm_invoke_set_guest_debug(void *data)
1804 452e4751 Glauber Costa
{
1805 452e4751 Glauber Costa
    struct kvm_set_guest_debug_data *dbg_data = data;
1806 9349b4f9 Andreas Färber
    CPUArchState *env = dbg_data->env;
1807 b3807725 Jan Kiszka
1808 b3807725 Jan Kiszka
    dbg_data->err = kvm_vcpu_ioctl(env, KVM_SET_GUEST_DEBUG, &dbg_data->dbg);
1809 452e4751 Glauber Costa
}
1810 452e4751 Glauber Costa
1811 9349b4f9 Andreas Färber
int kvm_update_guest_debug(CPUArchState *env, unsigned long reinject_trap)
1812 e22a25c9 aliguori
{
1813 452e4751 Glauber Costa
    struct kvm_set_guest_debug_data data;
1814 e22a25c9 aliguori
1815 b0b1d690 Jan Kiszka
    data.dbg.control = reinject_trap;
1816 e22a25c9 aliguori
1817 b0b1d690 Jan Kiszka
    if (env->singlestep_enabled) {
1818 b0b1d690 Jan Kiszka
        data.dbg.control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP;
1819 b0b1d690 Jan Kiszka
    }
1820 452e4751 Glauber Costa
    kvm_arch_update_guest_debug(env, &data.dbg);
1821 452e4751 Glauber Costa
    data.env = env;
1822 e22a25c9 aliguori
1823 be41cbe0 Jan Kiszka
    run_on_cpu(env, kvm_invoke_set_guest_debug, &data);
1824 452e4751 Glauber Costa
    return data.err;
1825 e22a25c9 aliguori
}
1826 e22a25c9 aliguori
1827 9349b4f9 Andreas Färber
int kvm_insert_breakpoint(CPUArchState *current_env, target_ulong addr,
1828 e22a25c9 aliguori
                          target_ulong len, int type)
1829 e22a25c9 aliguori
{
1830 e22a25c9 aliguori
    struct kvm_sw_breakpoint *bp;
1831 9349b4f9 Andreas Färber
    CPUArchState *env;
1832 e22a25c9 aliguori
    int err;
1833 e22a25c9 aliguori
1834 e22a25c9 aliguori
    if (type == GDB_BREAKPOINT_SW) {
1835 e22a25c9 aliguori
        bp = kvm_find_sw_breakpoint(current_env, addr);
1836 e22a25c9 aliguori
        if (bp) {
1837 e22a25c9 aliguori
            bp->use_count++;
1838 e22a25c9 aliguori
            return 0;
1839 e22a25c9 aliguori
        }
1840 e22a25c9 aliguori
1841 7267c094 Anthony Liguori
        bp = g_malloc(sizeof(struct kvm_sw_breakpoint));
1842 a426e122 Jan Kiszka
        if (!bp) {
1843 e22a25c9 aliguori
            return -ENOMEM;
1844 a426e122 Jan Kiszka
        }
1845 e22a25c9 aliguori
1846 e22a25c9 aliguori
        bp->pc = addr;
1847 e22a25c9 aliguori
        bp->use_count = 1;
1848 e22a25c9 aliguori
        err = kvm_arch_insert_sw_breakpoint(current_env, bp);
1849 e22a25c9 aliguori
        if (err) {
1850 7267c094 Anthony Liguori
            g_free(bp);
1851 e22a25c9 aliguori
            return err;
1852 e22a25c9 aliguori
        }
1853 e22a25c9 aliguori
1854 72cf2d4f Blue Swirl
        QTAILQ_INSERT_HEAD(&current_env->kvm_state->kvm_sw_breakpoints,
1855 e22a25c9 aliguori
                          bp, entry);
1856 e22a25c9 aliguori
    } else {
1857 e22a25c9 aliguori
        err = kvm_arch_insert_hw_breakpoint(addr, len, type);
1858 a426e122 Jan Kiszka
        if (err) {
1859 e22a25c9 aliguori
            return err;
1860 a426e122 Jan Kiszka
        }
1861 e22a25c9 aliguori
    }
1862 e22a25c9 aliguori
1863 e22a25c9 aliguori
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
1864 e22a25c9 aliguori
        err = kvm_update_guest_debug(env, 0);
1865 a426e122 Jan Kiszka
        if (err) {
1866 e22a25c9 aliguori
            return err;
1867 a426e122 Jan Kiszka
        }
1868 e22a25c9 aliguori
    }
1869 e22a25c9 aliguori
    return 0;
1870 e22a25c9 aliguori
}
1871 e22a25c9 aliguori
1872 9349b4f9 Andreas Färber
int kvm_remove_breakpoint(CPUArchState *current_env, target_ulong addr,
1873 e22a25c9 aliguori
                          target_ulong len, int type)
1874 e22a25c9 aliguori
{
1875 e22a25c9 aliguori
    struct kvm_sw_breakpoint *bp;
1876 9349b4f9 Andreas Färber
    CPUArchState *env;
1877 e22a25c9 aliguori
    int err;
1878 e22a25c9 aliguori
1879 e22a25c9 aliguori
    if (type == GDB_BREAKPOINT_SW) {
1880 e22a25c9 aliguori
        bp = kvm_find_sw_breakpoint(current_env, addr);
1881 a426e122 Jan Kiszka
        if (!bp) {
1882 e22a25c9 aliguori
            return -ENOENT;
1883 a426e122 Jan Kiszka
        }
1884 e22a25c9 aliguori
1885 e22a25c9 aliguori
        if (bp->use_count > 1) {
1886 e22a25c9 aliguori
            bp->use_count--;
1887 e22a25c9 aliguori
            return 0;
1888 e22a25c9 aliguori
        }
1889 e22a25c9 aliguori
1890 e22a25c9 aliguori
        err = kvm_arch_remove_sw_breakpoint(current_env, bp);
1891 a426e122 Jan Kiszka
        if (err) {
1892 e22a25c9 aliguori
            return err;
1893 a426e122 Jan Kiszka
        }
1894 e22a25c9 aliguori
1895 72cf2d4f Blue Swirl
        QTAILQ_REMOVE(&current_env->kvm_state->kvm_sw_breakpoints, bp, entry);
1896 7267c094 Anthony Liguori
        g_free(bp);
1897 e22a25c9 aliguori
    } else {
1898 e22a25c9 aliguori
        err = kvm_arch_remove_hw_breakpoint(addr, len, type);
1899 a426e122 Jan Kiszka
        if (err) {
1900 e22a25c9 aliguori
            return err;
1901 a426e122 Jan Kiszka
        }
1902 e22a25c9 aliguori
    }
1903 e22a25c9 aliguori
1904 e22a25c9 aliguori
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
1905 e22a25c9 aliguori
        err = kvm_update_guest_debug(env, 0);
1906 a426e122 Jan Kiszka
        if (err) {
1907 e22a25c9 aliguori
            return err;
1908 a426e122 Jan Kiszka
        }
1909 e22a25c9 aliguori
    }
1910 e22a25c9 aliguori
    return 0;
1911 e22a25c9 aliguori
}
1912 e22a25c9 aliguori
1913 9349b4f9 Andreas Färber
void kvm_remove_all_breakpoints(CPUArchState *current_env)
1914 e22a25c9 aliguori
{
1915 e22a25c9 aliguori
    struct kvm_sw_breakpoint *bp, *next;
1916 e22a25c9 aliguori
    KVMState *s = current_env->kvm_state;
1917 9349b4f9 Andreas Färber
    CPUArchState *env;
1918 e22a25c9 aliguori
1919 72cf2d4f Blue Swirl
    QTAILQ_FOREACH_SAFE(bp, &s->kvm_sw_breakpoints, entry, next) {
1920 e22a25c9 aliguori
        if (kvm_arch_remove_sw_breakpoint(current_env, bp) != 0) {
1921 e22a25c9 aliguori
            /* Try harder to find a CPU that currently sees the breakpoint. */
1922 e22a25c9 aliguori
            for (env = first_cpu; env != NULL; env = env->next_cpu) {
1923 a426e122 Jan Kiszka
                if (kvm_arch_remove_sw_breakpoint(env, bp) == 0) {
1924 e22a25c9 aliguori
                    break;
1925 a426e122 Jan Kiszka
                }
1926 e22a25c9 aliguori
            }
1927 e22a25c9 aliguori
        }
1928 e22a25c9 aliguori
    }
1929 e22a25c9 aliguori
    kvm_arch_remove_all_hw_breakpoints();
1930 e22a25c9 aliguori
1931 a426e122 Jan Kiszka
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
1932 e22a25c9 aliguori
        kvm_update_guest_debug(env, 0);
1933 a426e122 Jan Kiszka
    }
1934 e22a25c9 aliguori
}
1935 e22a25c9 aliguori
1936 e22a25c9 aliguori
#else /* !KVM_CAP_SET_GUEST_DEBUG */
1937 e22a25c9 aliguori
1938 9349b4f9 Andreas Färber
int kvm_update_guest_debug(CPUArchState *env, unsigned long reinject_trap)
1939 e22a25c9 aliguori
{
1940 e22a25c9 aliguori
    return -EINVAL;
1941 e22a25c9 aliguori
}
1942 e22a25c9 aliguori
1943 9349b4f9 Andreas Färber
int kvm_insert_breakpoint(CPUArchState *current_env, target_ulong addr,
1944 e22a25c9 aliguori
                          target_ulong len, int type)
1945 e22a25c9 aliguori
{
1946 e22a25c9 aliguori
    return -EINVAL;
1947 e22a25c9 aliguori
}
1948 e22a25c9 aliguori
1949 9349b4f9 Andreas Färber
int kvm_remove_breakpoint(CPUArchState *current_env, target_ulong addr,
1950 e22a25c9 aliguori
                          target_ulong len, int type)
1951 e22a25c9 aliguori
{
1952 e22a25c9 aliguori
    return -EINVAL;
1953 e22a25c9 aliguori
}
1954 e22a25c9 aliguori
1955 9349b4f9 Andreas Färber
void kvm_remove_all_breakpoints(CPUArchState *current_env)
1956 e22a25c9 aliguori
{
1957 e22a25c9 aliguori
}
1958 e22a25c9 aliguori
#endif /* !KVM_CAP_SET_GUEST_DEBUG */
1959 cc84de95 Marcelo Tosatti
1960 9349b4f9 Andreas Färber
int kvm_set_signal_mask(CPUArchState *env, const sigset_t *sigset)
1961 cc84de95 Marcelo Tosatti
{
1962 cc84de95 Marcelo Tosatti
    struct kvm_signal_mask *sigmask;
1963 cc84de95 Marcelo Tosatti
    int r;
1964 cc84de95 Marcelo Tosatti
1965 a426e122 Jan Kiszka
    if (!sigset) {
1966 cc84de95 Marcelo Tosatti
        return kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, NULL);
1967 a426e122 Jan Kiszka
    }
1968 cc84de95 Marcelo Tosatti
1969 7267c094 Anthony Liguori
    sigmask = g_malloc(sizeof(*sigmask) + sizeof(*sigset));
1970 cc84de95 Marcelo Tosatti
1971 cc84de95 Marcelo Tosatti
    sigmask->len = 8;
1972 cc84de95 Marcelo Tosatti
    memcpy(sigmask->sigset, sigset, sizeof(*sigset));
1973 cc84de95 Marcelo Tosatti
    r = kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, sigmask);
1974 7267c094 Anthony Liguori
    g_free(sigmask);
1975 cc84de95 Marcelo Tosatti
1976 cc84de95 Marcelo Tosatti
    return r;
1977 cc84de95 Marcelo Tosatti
}
1978 ca821806 Michael S. Tsirkin
1979 4b8f1c88 Michael S. Tsirkin
int kvm_set_ioeventfd_mmio(int fd, uint32_t addr, uint32_t val, bool assign,
1980 4b8f1c88 Michael S. Tsirkin
                           uint32_t size)
1981 44f1a3d8 Cam Macdonell
{
1982 44f1a3d8 Cam Macdonell
    int ret;
1983 44f1a3d8 Cam Macdonell
    struct kvm_ioeventfd iofd;
1984 44f1a3d8 Cam Macdonell
1985 44f1a3d8 Cam Macdonell
    iofd.datamatch = val;
1986 44f1a3d8 Cam Macdonell
    iofd.addr = addr;
1987 4b8f1c88 Michael S. Tsirkin
    iofd.len = size;
1988 44f1a3d8 Cam Macdonell
    iofd.flags = KVM_IOEVENTFD_FLAG_DATAMATCH;
1989 44f1a3d8 Cam Macdonell
    iofd.fd = fd;
1990 44f1a3d8 Cam Macdonell
1991 44f1a3d8 Cam Macdonell
    if (!kvm_enabled()) {
1992 44f1a3d8 Cam Macdonell
        return -ENOSYS;
1993 44f1a3d8 Cam Macdonell
    }
1994 44f1a3d8 Cam Macdonell
1995 44f1a3d8 Cam Macdonell
    if (!assign) {
1996 44f1a3d8 Cam Macdonell
        iofd.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
1997 44f1a3d8 Cam Macdonell
    }
1998 44f1a3d8 Cam Macdonell
1999 44f1a3d8 Cam Macdonell
    ret = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &iofd);
2000 44f1a3d8 Cam Macdonell
2001 44f1a3d8 Cam Macdonell
    if (ret < 0) {
2002 44f1a3d8 Cam Macdonell
        return -errno;
2003 44f1a3d8 Cam Macdonell
    }
2004 44f1a3d8 Cam Macdonell
2005 44f1a3d8 Cam Macdonell
    return 0;
2006 44f1a3d8 Cam Macdonell
}
2007 44f1a3d8 Cam Macdonell
2008 ca821806 Michael S. Tsirkin
int kvm_set_ioeventfd_pio_word(int fd, uint16_t addr, uint16_t val, bool assign)
2009 ca821806 Michael S. Tsirkin
{
2010 ca821806 Michael S. Tsirkin
    struct kvm_ioeventfd kick = {
2011 ca821806 Michael S. Tsirkin
        .datamatch = val,
2012 ca821806 Michael S. Tsirkin
        .addr = addr,
2013 ca821806 Michael S. Tsirkin
        .len = 2,
2014 ca821806 Michael S. Tsirkin
        .flags = KVM_IOEVENTFD_FLAG_DATAMATCH | KVM_IOEVENTFD_FLAG_PIO,
2015 ca821806 Michael S. Tsirkin
        .fd = fd,
2016 ca821806 Michael S. Tsirkin
    };
2017 ca821806 Michael S. Tsirkin
    int r;
2018 a426e122 Jan Kiszka
    if (!kvm_enabled()) {
2019 ca821806 Michael S. Tsirkin
        return -ENOSYS;
2020 a426e122 Jan Kiszka
    }
2021 a426e122 Jan Kiszka
    if (!assign) {
2022 ca821806 Michael S. Tsirkin
        kick.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
2023 a426e122 Jan Kiszka
    }
2024 ca821806 Michael S. Tsirkin
    r = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &kick);
2025 a426e122 Jan Kiszka
    if (r < 0) {
2026 ca821806 Michael S. Tsirkin
        return r;
2027 a426e122 Jan Kiszka
    }
2028 ca821806 Michael S. Tsirkin
    return 0;
2029 98c8573e Paolo Bonzini
}
2030 a1b87fe0 Jan Kiszka
2031 9349b4f9 Andreas Färber
int kvm_on_sigbus_vcpu(CPUArchState *env, int code, void *addr)
2032 a1b87fe0 Jan Kiszka
{
2033 a1b87fe0 Jan Kiszka
    return kvm_arch_on_sigbus_vcpu(env, code, addr);
2034 a1b87fe0 Jan Kiszka
}
2035 a1b87fe0 Jan Kiszka
2036 a1b87fe0 Jan Kiszka
int kvm_on_sigbus(int code, void *addr)
2037 a1b87fe0 Jan Kiszka
{
2038 a1b87fe0 Jan Kiszka
    return kvm_arch_on_sigbus(code, addr);
2039 a1b87fe0 Jan Kiszka
}