Statistics
| Branch: | Revision:

root / kvm-all.c @ c09b437b

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