kvm-all.c 50.6 KB
Newer Older
A
aliguori 已提交
1 2 3 4
/*
 * QEMU KVM support
 *
 * Copyright IBM, Corp. 2008
5
 *           Red Hat, Inc. 2008
A
aliguori 已提交
6 7 8
 *
 * Authors:
 *  Anthony Liguori   <aliguori@us.ibm.com>
9
 *  Glauber Costa     <gcosta@redhat.com>
A
aliguori 已提交
10 11 12 13 14 15 16 17 18
 *
 * This work is licensed under the terms of the GNU GPL, version 2 or later.
 * See the COPYING file in the top-level directory.
 *
 */

#include <sys/types.h>
#include <sys/ioctl.h>
#include <sys/mman.h>
19
#include <stdarg.h>
A
aliguori 已提交
20 21 22 23

#include <linux/kvm.h>

#include "qemu-common.h"
24
#include "qemu-barrier.h"
P
Paolo Bonzini 已提交
25 26
#include "qemu-option.h"
#include "qemu-config.h"
A
aliguori 已提交
27
#include "sysemu.h"
J
Jan Kiszka 已提交
28
#include "hw/hw.h"
29
#include "hw/msi.h"
30
#include "gdbstub.h"
A
aliguori 已提交
31
#include "kvm.h"
32
#include "bswap.h"
A
Avi Kivity 已提交
33
#include "memory.h"
34
#include "exec-memory.h"
35
#include "event_notifier.h"
A
aliguori 已提交
36

37 38 39 40 41
/* This check must be after config-host.h is included */
#ifdef CONFIG_EVENTFD
#include <sys/eventfd.h>
#endif

42 43 44 45
#ifdef CONFIG_VALGRIND_H
#include <valgrind/memcheck.h>
#endif

46
/* KVM uses PAGE_SIZE in its definition of COALESCED_MMIO_MAX */
A
aliguori 已提交
47 48
#define PAGE_SIZE TARGET_PAGE_SIZE

A
aliguori 已提交
49 50 51
//#define DEBUG_KVM

#ifdef DEBUG_KVM
52
#define DPRINTF(fmt, ...) \
A
aliguori 已提交
53 54
    do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
#else
55
#define DPRINTF(fmt, ...) \
A
aliguori 已提交
56 57 58
    do { } while (0)
#endif

59 60
#define KVM_MSI_HASHTAB_SIZE    256

A
aliguori 已提交
61 62
typedef struct KVMSlot
{
A
Avi Kivity 已提交
63
    hwaddr start_addr;
A
Anthony Liguori 已提交
64
    ram_addr_t memory_size;
65
    void *ram;
A
aliguori 已提交
66 67 68
    int slot;
    int flags;
} KVMSlot;
A
aliguori 已提交
69

70 71
typedef struct kvm_dirty_log KVMDirtyLog;

A
aliguori 已提交
72 73 74 75 76
struct KVMState
{
    KVMSlot slots[32];
    int fd;
    int vmfd;
A
aliguori 已提交
77
    int coalesced_mmio;
78
    struct kvm_coalesced_mmio_ring *coalesced_mmio_ring;
79
    bool coalesced_flush_in_progress;
80
    int broken_set_mem_region;
81
    int migration_log;
82
    int vcpu_events;
83
    int robust_singlestep;
84
    int debugregs;
85 86 87
#ifdef KVM_CAP_SET_GUEST_DEBUG
    struct kvm_sw_breakpoint_head kvm_sw_breakpoints;
#endif
J
Jan Kiszka 已提交
88
    int pit_state2;
89
    int xsave, xcrs;
90
    int many_ioeventfds;
91
    int intx_set_mask;
92 93 94
    /* The man page (and posix) say ioctl numbers are signed int, but
     * they're not.  Linux, glibc and *BSD all treat ioctl numbers as
     * unsigned, and treating them as signed here can break things */
95
    unsigned irq_set_ioctl;
96 97 98 99
#ifdef KVM_CAP_IRQ_ROUTING
    struct kvm_irq_routing *irq_routes;
    int nr_allocated_irq_routes;
    uint32_t *used_gsi_bitmap;
100
    unsigned int gsi_count;
101
    QTAILQ_HEAD(msi_hashtab, KVMMSIRoute) msi_hashtab[KVM_MSI_HASHTAB_SIZE];
102
    bool direct_msi;
103
#endif
A
aliguori 已提交
104 105
};

106
KVMState *kvm_state;
107
bool kvm_kernel_irqchip;
108
bool kvm_async_interrupts_allowed;
109
bool kvm_irqfds_allowed;
110
bool kvm_msi_via_irqfd_allowed;
111
bool kvm_gsi_routing_allowed;
A
aliguori 已提交
112

113 114 115 116 117 118
static const KVMCapabilityInfo kvm_required_capabilites[] = {
    KVM_CAP_INFO(USER_MEMORY),
    KVM_CAP_INFO(DESTROY_MEMORY_REGION_WORKS),
    KVM_CAP_LAST_INFO
};

A
aliguori 已提交
119 120 121 122 123
static KVMSlot *kvm_alloc_slot(KVMState *s)
{
    int i;

    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
J
Jan Kiszka 已提交
124
        if (s->slots[i].memory_size == 0) {
A
aliguori 已提交
125
            return &s->slots[i];
J
Jan Kiszka 已提交
126
        }
A
aliguori 已提交
127 128
    }

129 130 131 132 133
    fprintf(stderr, "%s: no free slot available\n", __func__);
    abort();
}

static KVMSlot *kvm_lookup_matching_slot(KVMState *s,
A
Avi Kivity 已提交
134 135
                                         hwaddr start_addr,
                                         hwaddr end_addr)
136 137 138 139 140 141 142 143 144 145 146 147
{
    int i;

    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
        KVMSlot *mem = &s->slots[i];

        if (start_addr == mem->start_addr &&
            end_addr == mem->start_addr + mem->memory_size) {
            return mem;
        }
    }

A
aliguori 已提交
148 149 150
    return NULL;
}

151 152 153 154
/*
 * Find overlapping slot with lowest start address
 */
static KVMSlot *kvm_lookup_overlapping_slot(KVMState *s,
A
Avi Kivity 已提交
155 156
                                            hwaddr start_addr,
                                            hwaddr end_addr)
A
aliguori 已提交
157
{
158
    KVMSlot *found = NULL;
A
aliguori 已提交
159 160 161 162 163
    int i;

    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
        KVMSlot *mem = &s->slots[i];

164 165 166 167 168 169 170 171 172
        if (mem->memory_size == 0 ||
            (found && found->start_addr < mem->start_addr)) {
            continue;
        }

        if (end_addr > mem->start_addr &&
            start_addr < mem->start_addr + mem->memory_size) {
            found = mem;
        }
A
aliguori 已提交
173 174
    }

175
    return found;
A
aliguori 已提交
176 177
}

178
int kvm_physical_memory_addr_from_host(KVMState *s, void *ram,
A
Avi Kivity 已提交
179
                                       hwaddr *phys_addr)
180 181 182 183 184 185
{
    int i;

    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
        KVMSlot *mem = &s->slots[i];

186 187
        if (ram >= mem->ram && ram < mem->ram + mem->memory_size) {
            *phys_addr = mem->start_addr + (ram - mem->ram);
188 189 190 191 192 193 194
            return 1;
        }
    }

    return 0;
}

195 196 197 198 199 200 201
static int kvm_set_user_memory_region(KVMState *s, KVMSlot *slot)
{
    struct kvm_userspace_memory_region mem;

    mem.slot = slot->slot;
    mem.guest_phys_addr = slot->start_addr;
    mem.memory_size = slot->memory_size;
202
    mem.userspace_addr = (unsigned long)slot->ram;
203
    mem.flags = slot->flags;
204 205 206
    if (s->migration_log) {
        mem.flags |= KVM_MEM_LOG_DIRTY_PAGES;
    }
207 208 209
    return kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
}

J
Jan Kiszka 已提交
210 211
static void kvm_reset_vcpu(void *opaque)
{
212
    CPUArchState *env = opaque;
J
Jan Kiszka 已提交
213

J
Jan Kiszka 已提交
214
    kvm_arch_reset_vcpu(env);
J
Jan Kiszka 已提交
215
}
216

217
int kvm_init_vcpu(CPUArchState *env)
A
aliguori 已提交
218 219 220 221 222
{
    KVMState *s = kvm_state;
    long mmap_size;
    int ret;

223
    DPRINTF("kvm_init_vcpu\n");
A
aliguori 已提交
224

225
    ret = kvm_vm_ioctl(s, KVM_CREATE_VCPU, env->cpu_index);
A
aliguori 已提交
226
    if (ret < 0) {
227
        DPRINTF("kvm_create_vcpu failed\n");
A
aliguori 已提交
228 229 230 231 232
        goto err;
    }

    env->kvm_fd = ret;
    env->kvm_state = s;
233
    env->kvm_vcpu_dirty = 1;
A
aliguori 已提交
234 235 236

    mmap_size = kvm_ioctl(s, KVM_GET_VCPU_MMAP_SIZE, 0);
    if (mmap_size < 0) {
237
        ret = mmap_size;
238
        DPRINTF("KVM_GET_VCPU_MMAP_SIZE failed\n");
A
aliguori 已提交
239 240 241 242 243 244 245
        goto err;
    }

    env->kvm_run = mmap(NULL, mmap_size, PROT_READ | PROT_WRITE, MAP_SHARED,
                        env->kvm_fd, 0);
    if (env->kvm_run == MAP_FAILED) {
        ret = -errno;
246
        DPRINTF("mmap'ing vcpu state failed\n");
A
aliguori 已提交
247 248 249
        goto err;
    }

J
Jan Kiszka 已提交
250 251 252 253
    if (s->coalesced_mmio && !s->coalesced_mmio_ring) {
        s->coalesced_mmio_ring =
            (void *)env->kvm_run + s->coalesced_mmio * PAGE_SIZE;
    }
254

A
aliguori 已提交
255
    ret = kvm_arch_init_vcpu(env);
J
Jan Kiszka 已提交
256
    if (ret == 0) {
257
        qemu_register_reset(kvm_reset_vcpu, env);
J
Jan Kiszka 已提交
258
        kvm_arch_reset_vcpu(env);
J
Jan Kiszka 已提交
259
    }
A
aliguori 已提交
260 261 262 263
err:
    return ret;
}

264 265 266
/*
 * dirty pages logging control
 */
267 268 269 270 271 272 273

static int kvm_mem_flags(KVMState *s, bool log_dirty)
{
    return log_dirty ? KVM_MEM_LOG_DIRTY_PAGES : 0;
}

static int kvm_slot_dirty_pages_log_change(KVMSlot *mem, bool log_dirty)
274 275
{
    KVMState *s = kvm_state;
276
    int flags, mask = KVM_MEM_LOG_DIRTY_PAGES;
277 278 279
    int old_flags;

    old_flags = mem->flags;
280

281
    flags = (mem->flags & ~mask) | kvm_mem_flags(s, log_dirty);
282 283
    mem->flags = flags;

284 285 286 287
    /* If nothing changed effectively, no need to issue ioctl */
    if (s->migration_log) {
        flags |= KVM_MEM_LOG_DIRTY_PAGES;
    }
288

289
    if (flags == old_flags) {
290
        return 0;
291 292
    }

293 294 295
    return kvm_set_user_memory_region(s, mem);
}

A
Avi Kivity 已提交
296
static int kvm_dirty_pages_log_change(hwaddr phys_addr,
297 298 299 300 301 302 303 304
                                      ram_addr_t size, bool log_dirty)
{
    KVMState *s = kvm_state;
    KVMSlot *mem = kvm_lookup_matching_slot(s, phys_addr, phys_addr + size);

    if (mem == NULL)  {
        fprintf(stderr, "BUG: %s: invalid parameters " TARGET_FMT_plx "-"
                TARGET_FMT_plx "\n", __func__, phys_addr,
A
Avi Kivity 已提交
305
                (hwaddr)(phys_addr + size - 1));
306 307 308 309 310
        return -EINVAL;
    }
    return kvm_slot_dirty_pages_log_change(mem, log_dirty);
}

A
Avi Kivity 已提交
311 312
static void kvm_log_start(MemoryListener *listener,
                          MemoryRegionSection *section)
313
{
A
Avi Kivity 已提交
314 315 316 317 318 319 320
    int r;

    r = kvm_dirty_pages_log_change(section->offset_within_address_space,
                                   section->size, true);
    if (r < 0) {
        abort();
    }
321 322
}

A
Avi Kivity 已提交
323 324
static void kvm_log_stop(MemoryListener *listener,
                          MemoryRegionSection *section)
325
{
A
Avi Kivity 已提交
326 327 328 329 330 331 332
    int r;

    r = kvm_dirty_pages_log_change(section->offset_within_address_space,
                                   section->size, false);
    if (r < 0) {
        abort();
    }
333 334
}

335
static int kvm_set_migration_log(int enable)
336 337 338 339 340 341 342 343 344 345
{
    KVMState *s = kvm_state;
    KVMSlot *mem;
    int i, err;

    s->migration_log = enable;

    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
        mem = &s->slots[i];

346 347 348
        if (!mem->memory_size) {
            continue;
        }
349 350 351 352 353 354 355 356 357 358 359
        if (!!(mem->flags & KVM_MEM_LOG_DIRTY_PAGES) == enable) {
            continue;
        }
        err = kvm_set_user_memory_region(s, mem);
        if (err) {
            return err;
        }
    }
    return 0;
}

360
/* get kvm's dirty pages bitmap and update qemu's */
361 362
static int kvm_get_dirty_pages_log_range(MemoryRegionSection *section,
                                         unsigned long *bitmap)
A
Alexander Graf 已提交
363
{
364
    unsigned int i, j;
365
    unsigned long page_number, c;
A
Avi Kivity 已提交
366
    hwaddr addr, addr1;
367
    unsigned int len = ((section->size / getpagesize()) + HOST_LONG_BITS - 1) / HOST_LONG_BITS;
368
    unsigned long hpratio = getpagesize() / TARGET_PAGE_SIZE;
369 370 371 372 373 374 375 376 377 378 379

    /*
     * bitmap-traveling is faster than memory-traveling (for addr...)
     * especially when most of the memory is not dirty.
     */
    for (i = 0; i < len; i++) {
        if (bitmap[i] != 0) {
            c = leul_to_cpu(bitmap[i]);
            do {
                j = ffsl(c) - 1;
                c &= ~(1ul << j);
380
                page_number = (i * HOST_LONG_BITS + j) * hpratio;
381
                addr1 = page_number * TARGET_PAGE_SIZE;
382
                addr = section->offset_within_region + addr1;
383 384
                memory_region_set_dirty(section->mr, addr,
                                        TARGET_PAGE_SIZE * hpratio);
385 386 387 388
            } while (c != 0);
        }
    }
    return 0;
A
Alexander Graf 已提交
389 390
}

391 392
#define ALIGN(x, y)  (((x)+(y)-1) & ~((y)-1))

393 394
/**
 * kvm_physical_sync_dirty_bitmap - Grab dirty bitmap from kernel space
395 396 397
 * This function updates qemu's dirty bitmap using
 * memory_region_set_dirty().  This means all bits are set
 * to dirty.
398
 *
399
 * @start_add: start of logged region.
400 401
 * @end_addr: end of logged region.
 */
402
static int kvm_physical_sync_dirty_bitmap(MemoryRegionSection *section)
403 404
{
    KVMState *s = kvm_state;
405 406 407 408
    unsigned long size, allocated_size = 0;
    KVMDirtyLog d;
    KVMSlot *mem;
    int ret = 0;
A
Avi Kivity 已提交
409 410
    hwaddr start_addr = section->offset_within_address_space;
    hwaddr end_addr = start_addr + section->size;
411

412 413 414 415 416 417
    d.dirty_bitmap = NULL;
    while (start_addr < end_addr) {
        mem = kvm_lookup_overlapping_slot(s, start_addr, end_addr);
        if (mem == NULL) {
            break;
        }
418

419 420 421 422 423 424 425 426 427 428 429 430 431 432
        /* XXX bad kernel interface alert
         * For dirty bitmap, kernel allocates array of size aligned to
         * bits-per-long.  But for case when the kernel is 64bits and
         * the userspace is 32bits, userspace can't align to the same
         * bits-per-long, since sizeof(long) is different between kernel
         * and user space.  This way, userspace will provide buffer which
         * may be 4 bytes less than the kernel will use, resulting in
         * userspace memory corruption (which is not detectable by valgrind
         * too, in most cases).
         * So for now, let's align to 64 instead of HOST_LONG_BITS here, in
         * a hope that sizeof(long) wont become >8 any time soon.
         */
        size = ALIGN(((mem->memory_size) >> TARGET_PAGE_BITS),
                     /*HOST_LONG_BITS*/ 64) / 8;
433
        if (!d.dirty_bitmap) {
434
            d.dirty_bitmap = g_malloc(size);
435
        } else if (size > allocated_size) {
436
            d.dirty_bitmap = g_realloc(d.dirty_bitmap, size);
437 438 439
        }
        allocated_size = size;
        memset(d.dirty_bitmap, 0, allocated_size);
440

441
        d.slot = mem->slot;
442

443
        if (kvm_vm_ioctl(s, KVM_GET_DIRTY_LOG, &d) == -1) {
444
            DPRINTF("ioctl failed %d\n", errno);
445 446 447
            ret = -1;
            break;
        }
448

449
        kvm_get_dirty_pages_log_range(section, d.dirty_bitmap);
450
        start_addr = mem->start_addr + mem->memory_size;
451
    }
452
    g_free(d.dirty_bitmap);
453 454

    return ret;
455 456
}

457 458
static void kvm_coalesce_mmio_region(MemoryListener *listener,
                                     MemoryRegionSection *secion,
A
Avi Kivity 已提交
459
                                     hwaddr start, hwaddr size)
A
aliguori 已提交
460 461 462 463 464 465 466 467
{
    KVMState *s = kvm_state;

    if (s->coalesced_mmio) {
        struct kvm_coalesced_mmio_zone zone;

        zone.addr = start;
        zone.size = size;
468
        zone.pad = 0;
A
aliguori 已提交
469

470
        (void)kvm_vm_ioctl(s, KVM_REGISTER_COALESCED_MMIO, &zone);
A
aliguori 已提交
471 472 473
    }
}

474 475
static void kvm_uncoalesce_mmio_region(MemoryListener *listener,
                                       MemoryRegionSection *secion,
A
Avi Kivity 已提交
476
                                       hwaddr start, hwaddr size)
A
aliguori 已提交
477 478 479 480 481 482 483 484
{
    KVMState *s = kvm_state;

    if (s->coalesced_mmio) {
        struct kvm_coalesced_mmio_zone zone;

        zone.addr = start;
        zone.size = size;
485
        zone.pad = 0;
A
aliguori 已提交
486

487
        (void)kvm_vm_ioctl(s, KVM_UNREGISTER_COALESCED_MMIO, &zone);
A
aliguori 已提交
488 489 490
    }
}

491 492 493 494 495 496 497 498 499 500 501 502
int kvm_check_extension(KVMState *s, unsigned int extension)
{
    int ret;

    ret = kvm_ioctl(s, KVM_CHECK_EXTENSION, extension);
    if (ret < 0) {
        ret = 0;
    }

    return ret;
}

503 504
static int kvm_check_many_ioeventfds(void)
{
505 506 507 508 509
    /* Userspace can use ioeventfd for io notification.  This requires a host
     * that supports eventfd(2) and an I/O thread; since eventfd does not
     * support SIGIO it cannot interrupt the vcpu.
     *
     * Older kernels have a 6 device limit on the KVM io bus.  Find out so we
510 511
     * can avoid creating too many ioeventfds.
     */
512
#if defined(CONFIG_EVENTFD)
513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534 535 536 537 538 539
    int ioeventfds[7];
    int i, ret = 0;
    for (i = 0; i < ARRAY_SIZE(ioeventfds); i++) {
        ioeventfds[i] = eventfd(0, EFD_CLOEXEC);
        if (ioeventfds[i] < 0) {
            break;
        }
        ret = kvm_set_ioeventfd_pio_word(ioeventfds[i], 0, i, true);
        if (ret < 0) {
            close(ioeventfds[i]);
            break;
        }
    }

    /* Decide whether many devices are supported or not */
    ret = i == ARRAY_SIZE(ioeventfds);

    while (i-- > 0) {
        kvm_set_ioeventfd_pio_word(ioeventfds[i], 0, i, false);
        close(ioeventfds[i]);
    }
    return ret;
#else
    return 0;
#endif
}

540 541 542 543 544 545 546 547 548 549 550 551
static const KVMCapabilityInfo *
kvm_check_extension_list(KVMState *s, const KVMCapabilityInfo *list)
{
    while (list->name) {
        if (!kvm_check_extension(s, list->value)) {
            return list;
        }
        list++;
    }
    return NULL;
}

A
Avi Kivity 已提交
552
static void kvm_set_phys_mem(MemoryRegionSection *section, bool add)
553 554 555 556
{
    KVMState *s = kvm_state;
    KVMSlot *mem, old;
    int err;
A
Avi Kivity 已提交
557 558
    MemoryRegion *mr = section->mr;
    bool log_dirty = memory_region_is_logging(mr);
A
Avi Kivity 已提交
559
    hwaddr start_addr = section->offset_within_address_space;
A
Avi Kivity 已提交
560
    ram_addr_t size = section->size;
561
    void *ram = NULL;
A
Avi Kivity 已提交
562
    unsigned delta;
563

564 565
    /* kvm works in page size chunks, but the function may be called
       with sub-page size and unaligned start address. */
A
Avi Kivity 已提交
566 567 568 569 570 571 572 573 574 575
    delta = TARGET_PAGE_ALIGN(size) - size;
    if (delta > size) {
        return;
    }
    start_addr += delta;
    size -= delta;
    size &= TARGET_PAGE_MASK;
    if (!size || (start_addr & ~TARGET_PAGE_MASK)) {
        return;
    }
576

A
Avi Kivity 已提交
577 578
    if (!memory_region_is_ram(mr)) {
        return;
579 580
    }

A
Avi Kivity 已提交
581
    ram = memory_region_get_ram_ptr(mr) + section->offset_within_region + delta;
A
Avi Kivity 已提交
582

583 584 585 586 587 588
    while (1) {
        mem = kvm_lookup_overlapping_slot(s, start_addr, start_addr + size);
        if (!mem) {
            break;
        }

A
Avi Kivity 已提交
589
        if (add && start_addr >= mem->start_addr &&
590
            (start_addr + size <= mem->start_addr + mem->memory_size) &&
591
            (ram - start_addr == mem->ram - mem->start_addr)) {
592
            /* The new slot fits into the existing one and comes with
593 594
             * identical parameters - update flags and done. */
            kvm_slot_dirty_pages_log_change(mem, log_dirty);
595 596 597 598 599
            return;
        }

        old = *mem;

600 601 602 603
        if (mem->flags & KVM_MEM_LOG_DIRTY_PAGES) {
            kvm_physical_sync_dirty_bitmap(section);
        }

604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621
        /* unregister the overlapping slot */
        mem->memory_size = 0;
        err = kvm_set_user_memory_region(s, mem);
        if (err) {
            fprintf(stderr, "%s: error unregistering overlapping slot: %s\n",
                    __func__, strerror(-err));
            abort();
        }

        /* Workaround for older KVM versions: we can't join slots, even not by
         * unregistering the previous ones and then registering the larger
         * slot. We have to maintain the existing fragmentation. Sigh.
         *
         * This workaround assumes that the new slot starts at the same
         * address as the first existing one. If not or if some overlapping
         * slot comes around later, we will fail (not seen in practice so far)
         * - and actually require a recent KVM version. */
        if (s->broken_set_mem_region &&
A
Avi Kivity 已提交
622
            old.start_addr == start_addr && old.memory_size < size && add) {
623 624 625
            mem = kvm_alloc_slot(s);
            mem->memory_size = old.memory_size;
            mem->start_addr = old.start_addr;
626
            mem->ram = old.ram;
627
            mem->flags = kvm_mem_flags(s, log_dirty);
628 629 630 631 632 633 634 635 636

            err = kvm_set_user_memory_region(s, mem);
            if (err) {
                fprintf(stderr, "%s: error updating slot: %s\n", __func__,
                        strerror(-err));
                abort();
            }

            start_addr += old.memory_size;
637
            ram += old.memory_size;
638 639 640 641 642 643 644 645 646
            size -= old.memory_size;
            continue;
        }

        /* register prefix slot */
        if (old.start_addr < start_addr) {
            mem = kvm_alloc_slot(s);
            mem->memory_size = start_addr - old.start_addr;
            mem->start_addr = old.start_addr;
647
            mem->ram = old.ram;
648
            mem->flags =  kvm_mem_flags(s, log_dirty);
649 650 651 652 653

            err = kvm_set_user_memory_region(s, mem);
            if (err) {
                fprintf(stderr, "%s: error registering prefix slot: %s\n",
                        __func__, strerror(-err));
654 655 656 657 658
#ifdef TARGET_PPC
                fprintf(stderr, "%s: This is probably because your kernel's " \
                                "PAGE_SIZE is too big. Please try to use 4k " \
                                "PAGE_SIZE!\n", __func__);
#endif
659 660 661 662 663 664 665 666 667 668 669 670
                abort();
            }
        }

        /* register suffix slot */
        if (old.start_addr + old.memory_size > start_addr + size) {
            ram_addr_t size_delta;

            mem = kvm_alloc_slot(s);
            mem->start_addr = start_addr + size;
            size_delta = mem->start_addr - old.start_addr;
            mem->memory_size = old.memory_size - size_delta;
671
            mem->ram = old.ram + size_delta;
672
            mem->flags = kvm_mem_flags(s, log_dirty);
673 674 675 676 677 678 679 680 681 682 683

            err = kvm_set_user_memory_region(s, mem);
            if (err) {
                fprintf(stderr, "%s: error registering suffix slot: %s\n",
                        __func__, strerror(-err));
                abort();
            }
        }
    }

    /* in case the KVM bug workaround already "consumed" the new slot */
J
Jan Kiszka 已提交
684
    if (!size) {
685
        return;
J
Jan Kiszka 已提交
686
    }
A
Avi Kivity 已提交
687
    if (!add) {
688
        return;
J
Jan Kiszka 已提交
689
    }
690 691 692
    mem = kvm_alloc_slot(s);
    mem->memory_size = size;
    mem->start_addr = start_addr;
693
    mem->ram = ram;
694
    mem->flags = kvm_mem_flags(s, log_dirty);
695 696 697 698 699 700 701 702 703

    err = kvm_set_user_memory_region(s, mem);
    if (err) {
        fprintf(stderr, "%s: error registering slot: %s\n", __func__,
                strerror(-err));
        abort();
    }
}

A
Avi Kivity 已提交
704 705 706 707 708 709 710 711 712 713 714 715 716 717
static void kvm_region_add(MemoryListener *listener,
                           MemoryRegionSection *section)
{
    kvm_set_phys_mem(section, true);
}

static void kvm_region_del(MemoryListener *listener,
                           MemoryRegionSection *section)
{
    kvm_set_phys_mem(section, false);
}

static void kvm_log_sync(MemoryListener *listener,
                         MemoryRegionSection *section)
718
{
A
Avi Kivity 已提交
719 720
    int r;

721
    r = kvm_physical_sync_dirty_bitmap(section);
A
Avi Kivity 已提交
722 723 724
    if (r < 0) {
        abort();
    }
725 726
}

A
Avi Kivity 已提交
727
static void kvm_log_global_start(struct MemoryListener *listener)
728
{
A
Avi Kivity 已提交
729 730 731 732
    int r;

    r = kvm_set_migration_log(1);
    assert(r >= 0);
733 734
}

A
Avi Kivity 已提交
735
static void kvm_log_global_stop(struct MemoryListener *listener)
736
{
A
Avi Kivity 已提交
737 738 739 740
    int r;

    r = kvm_set_migration_log(0);
    assert(r >= 0);
741 742
}

743 744 745 746 747 748
static void kvm_mem_ioeventfd_add(MemoryListener *listener,
                                  MemoryRegionSection *section,
                                  bool match_data, uint64_t data,
                                  EventNotifier *e)
{
    int fd = event_notifier_get_fd(e);
749 750
    int r;

751
    assert(match_data && section->size <= 8);
752

753 754
    r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
                               data, true, section->size);
755 756 757 758 759
    if (r < 0) {
        abort();
    }
}

760 761 762 763
static void kvm_mem_ioeventfd_del(MemoryListener *listener,
                                  MemoryRegionSection *section,
                                  bool match_data, uint64_t data,
                                  EventNotifier *e)
764
{
765
    int fd = event_notifier_get_fd(e);
766 767
    int r;

768 769
    r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
                               data, false, section->size);
770 771 772 773 774
    if (r < 0) {
        abort();
    }
}

775 776 777 778
static void kvm_io_ioeventfd_add(MemoryListener *listener,
                                 MemoryRegionSection *section,
                                 bool match_data, uint64_t data,
                                 EventNotifier *e)
779
{
780
    int fd = event_notifier_get_fd(e);
781 782 783 784 785 786 787 788 789 790 791
    int r;

    assert(match_data && section->size == 2);

    r = kvm_set_ioeventfd_pio_word(fd, section->offset_within_address_space,
                                   data, true);
    if (r < 0) {
        abort();
    }
}

792 793 794 795
static void kvm_io_ioeventfd_del(MemoryListener *listener,
                                 MemoryRegionSection *section,
                                 bool match_data, uint64_t data,
                                 EventNotifier *e)
796 797

{
798
    int fd = event_notifier_get_fd(e);
799 800 801 802 803 804 805 806 807
    int r;

    r = kvm_set_ioeventfd_pio_word(fd, section->offset_within_address_space,
                                   data, false);
    if (r < 0) {
        abort();
    }
}

A
Avi Kivity 已提交
808 809 810
static MemoryListener kvm_memory_listener = {
    .region_add = kvm_region_add,
    .region_del = kvm_region_del,
811 812
    .log_start = kvm_log_start,
    .log_stop = kvm_log_stop,
A
Avi Kivity 已提交
813 814 815
    .log_sync = kvm_log_sync,
    .log_global_start = kvm_log_global_start,
    .log_global_stop = kvm_log_global_stop,
816 817
    .eventfd_add = kvm_mem_ioeventfd_add,
    .eventfd_del = kvm_mem_ioeventfd_del,
818 819
    .coalesced_mmio_add = kvm_coalesce_mmio_region,
    .coalesced_mmio_del = kvm_uncoalesce_mmio_region,
820 821 822 823 824 825
    .priority = 10,
};

static MemoryListener kvm_io_listener = {
    .eventfd_add = kvm_io_ioeventfd_add,
    .eventfd_del = kvm_io_ioeventfd_del,
826
    .priority = 10,
827 828
};

829
static void kvm_handle_interrupt(CPUArchState *env, int mask)
830
{
831 832
    CPUState *cpu = ENV_GET_CPU(env);

833 834
    env->interrupt_request |= mask;

835
    if (!qemu_cpu_is_self(cpu)) {
836
        qemu_cpu_kick(cpu);
837 838 839
    }
}

840
int kvm_set_irq(KVMState *s, int irq, int level)
841 842 843 844
{
    struct kvm_irq_level event;
    int ret;

845
    assert(kvm_async_interrupts_enabled());
846 847 848

    event.level = level;
    event.irq = irq;
849
    ret = kvm_vm_ioctl(s, s->irq_set_ioctl, &event);
850
    if (ret < 0) {
851
        perror("kvm_set_irq");
852 853 854
        abort();
    }

855
    return (s->irq_set_ioctl == KVM_IRQ_LINE) ? 1 : event.status;
856 857 858
}

#ifdef KVM_CAP_IRQ_ROUTING
859 860 861 862 863
typedef struct KVMMSIRoute {
    struct kvm_irq_routing_entry kroute;
    QTAILQ_ENTRY(KVMMSIRoute) entry;
} KVMMSIRoute;

864 865 866 867 868
static void set_gsi(KVMState *s, unsigned int gsi)
{
    s->used_gsi_bitmap[gsi / 32] |= 1U << (gsi % 32);
}

869 870 871 872 873
static void clear_gsi(KVMState *s, unsigned int gsi)
{
    s->used_gsi_bitmap[gsi / 32] &= ~(1U << (gsi % 32));
}

874 875
static void kvm_init_irq_routing(KVMState *s)
{
876
    int gsi_count, i;
877 878 879 880 881 882

    gsi_count = kvm_check_extension(s, KVM_CAP_IRQ_ROUTING);
    if (gsi_count > 0) {
        unsigned int gsi_bits, i;

        /* Round up so we can search ints using ffs */
883
        gsi_bits = ALIGN(gsi_count, 32);
884
        s->used_gsi_bitmap = g_malloc0(gsi_bits / 8);
885
        s->gsi_count = gsi_count;
886 887 888 889 890 891 892 893 894 895

        /* Mark any over-allocated bits as already in use */
        for (i = gsi_count; i < gsi_bits; i++) {
            set_gsi(s, i);
        }
    }

    s->irq_routes = g_malloc0(sizeof(*s->irq_routes));
    s->nr_allocated_irq_routes = 0;

896 897 898 899
    if (!s->direct_msi) {
        for (i = 0; i < KVM_MSI_HASHTAB_SIZE; i++) {
            QTAILQ_INIT(&s->msi_hashtab[i]);
        }
900 901
    }

902 903 904
    kvm_arch_init_irq_routing(s);
}

905 906 907 908 909 910 911 912 913
static void kvm_irqchip_commit_routes(KVMState *s)
{
    int ret;

    s->irq_routes->flags = 0;
    ret = kvm_vm_ioctl(s, KVM_SET_GSI_ROUTING, s->irq_routes);
    assert(ret == 0);
}

914 915 916 917 918 919 920 921 922 923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 938
static void kvm_add_routing_entry(KVMState *s,
                                  struct kvm_irq_routing_entry *entry)
{
    struct kvm_irq_routing_entry *new;
    int n, size;

    if (s->irq_routes->nr == s->nr_allocated_irq_routes) {
        n = s->nr_allocated_irq_routes * 2;
        if (n < 64) {
            n = 64;
        }
        size = sizeof(struct kvm_irq_routing);
        size += n * sizeof(*new);
        s->irq_routes = g_realloc(s->irq_routes, size);
        s->nr_allocated_irq_routes = n;
    }
    n = s->irq_routes->nr++;
    new = &s->irq_routes->entries[n];
    memset(new, 0, sizeof(*new));
    new->gsi = entry->gsi;
    new->type = entry->type;
    new->flags = entry->flags;
    new->u = entry->u;

    set_gsi(s, entry->gsi);
939 940

    kvm_irqchip_commit_routes(s);
941 942
}

943 944 945 946 947 948 949 950 951 952 953 954 955 956 957 958 959 960 961 962 963 964 965 966
static int kvm_update_routing_entry(KVMState *s,
                                    struct kvm_irq_routing_entry *new_entry)
{
    struct kvm_irq_routing_entry *entry;
    int n;

    for (n = 0; n < s->irq_routes->nr; n++) {
        entry = &s->irq_routes->entries[n];
        if (entry->gsi != new_entry->gsi) {
            continue;
        }

        entry->type = new_entry->type;
        entry->flags = new_entry->flags;
        entry->u = new_entry->u;

        kvm_irqchip_commit_routes(s);

        return 0;
    }

    return -ESRCH;
}

967
void kvm_irqchip_add_irq_route(KVMState *s, int irq, int irqchip, int pin)
968 969 970
{
    struct kvm_irq_routing_entry e;

971 972
    assert(pin < s->gsi_count);

973 974 975 976 977 978 979 980
    e.gsi = irq;
    e.type = KVM_IRQ_ROUTING_IRQCHIP;
    e.flags = 0;
    e.u.irqchip.irqchip = irqchip;
    e.u.irqchip.pin = pin;
    kvm_add_routing_entry(s, &e);
}

981
void kvm_irqchip_release_virq(KVMState *s, int virq)
982 983 984 985 986 987 988 989 990 991 992 993
{
    struct kvm_irq_routing_entry *e;
    int i;

    for (i = 0; i < s->irq_routes->nr; i++) {
        e = &s->irq_routes->entries[i];
        if (e->gsi == virq) {
            s->irq_routes->nr--;
            *e = s->irq_routes->entries[s->irq_routes->nr];
        }
    }
    clear_gsi(s, virq);
994 995

    kvm_irqchip_commit_routes(s);
996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035
}

static unsigned int kvm_hash_msi(uint32_t data)
{
    /* This is optimized for IA32 MSI layout. However, no other arch shall
     * repeat the mistake of not providing a direct MSI injection API. */
    return data & 0xff;
}

static void kvm_flush_dynamic_msi_routes(KVMState *s)
{
    KVMMSIRoute *route, *next;
    unsigned int hash;

    for (hash = 0; hash < KVM_MSI_HASHTAB_SIZE; hash++) {
        QTAILQ_FOREACH_SAFE(route, &s->msi_hashtab[hash], entry, next) {
            kvm_irqchip_release_virq(s, route->kroute.gsi);
            QTAILQ_REMOVE(&s->msi_hashtab[hash], route, entry);
            g_free(route);
        }
    }
}

static int kvm_irqchip_get_virq(KVMState *s)
{
    uint32_t *word = s->used_gsi_bitmap;
    int max_words = ALIGN(s->gsi_count, 32) / 32;
    int i, bit;
    bool retry = true;

again:
    /* Return the lowest unused GSI in the bitmap */
    for (i = 0; i < max_words; i++) {
        bit = ffs(~word[i]);
        if (!bit) {
            continue;
        }

        return bit - 1 + i * 32;
    }
1036
    if (!s->direct_msi && retry) {
1037 1038 1039 1040 1041 1042 1043 1044 1045 1046 1047 1048 1049 1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061
        retry = false;
        kvm_flush_dynamic_msi_routes(s);
        goto again;
    }
    return -ENOSPC;

}

static KVMMSIRoute *kvm_lookup_msi_route(KVMState *s, MSIMessage msg)
{
    unsigned int hash = kvm_hash_msi(msg.data);
    KVMMSIRoute *route;

    QTAILQ_FOREACH(route, &s->msi_hashtab[hash], entry) {
        if (route->kroute.u.msi.address_lo == (uint32_t)msg.address &&
            route->kroute.u.msi.address_hi == (msg.address >> 32) &&
            route->kroute.u.msi.data == msg.data) {
            return route;
        }
    }
    return NULL;
}

int kvm_irqchip_send_msi(KVMState *s, MSIMessage msg)
{
1062
    struct kvm_msi msi;
1063 1064
    KVMMSIRoute *route;

1065 1066 1067 1068 1069 1070 1071 1072 1073 1074
    if (s->direct_msi) {
        msi.address_lo = (uint32_t)msg.address;
        msi.address_hi = msg.address >> 32;
        msi.data = msg.data;
        msi.flags = 0;
        memset(msi.pad, 0, sizeof(msi.pad));

        return kvm_vm_ioctl(s, KVM_SIGNAL_MSI, &msi);
    }

1075 1076
    route = kvm_lookup_msi_route(s, msg);
    if (!route) {
1077
        int virq;
1078 1079 1080 1081 1082 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099

        virq = kvm_irqchip_get_virq(s);
        if (virq < 0) {
            return virq;
        }

        route = g_malloc(sizeof(KVMMSIRoute));
        route->kroute.gsi = virq;
        route->kroute.type = KVM_IRQ_ROUTING_MSI;
        route->kroute.flags = 0;
        route->kroute.u.msi.address_lo = (uint32_t)msg.address;
        route->kroute.u.msi.address_hi = msg.address >> 32;
        route->kroute.u.msi.data = msg.data;

        kvm_add_routing_entry(s, &route->kroute);

        QTAILQ_INSERT_TAIL(&s->msi_hashtab[kvm_hash_msi(msg.data)], route,
                           entry);
    }

    assert(route->kroute.type == KVM_IRQ_ROUTING_MSI);

1100
    return kvm_set_irq(s, route->kroute.gsi, 1);
1101 1102
}

1103 1104 1105 1106 1107
int kvm_irqchip_add_msi_route(KVMState *s, MSIMessage msg)
{
    struct kvm_irq_routing_entry kroute;
    int virq;

1108
    if (!kvm_gsi_routing_enabled()) {
1109 1110 1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128
        return -ENOSYS;
    }

    virq = kvm_irqchip_get_virq(s);
    if (virq < 0) {
        return virq;
    }

    kroute.gsi = virq;
    kroute.type = KVM_IRQ_ROUTING_MSI;
    kroute.flags = 0;
    kroute.u.msi.address_lo = (uint32_t)msg.address;
    kroute.u.msi.address_hi = msg.address >> 32;
    kroute.u.msi.data = msg.data;

    kvm_add_routing_entry(s, &kroute);

    return virq;
}

1129 1130 1131 1132 1133 1134 1135 1136 1137 1138 1139 1140 1141 1142 1143 1144 1145 1146
int kvm_irqchip_update_msi_route(KVMState *s, int virq, MSIMessage msg)
{
    struct kvm_irq_routing_entry kroute;

    if (!kvm_irqchip_in_kernel()) {
        return -ENOSYS;
    }

    kroute.gsi = virq;
    kroute.type = KVM_IRQ_ROUTING_MSI;
    kroute.flags = 0;
    kroute.u.msi.address_lo = (uint32_t)msg.address;
    kroute.u.msi.address_hi = msg.address >> 32;
    kroute.u.msi.data = msg.data;

    return kvm_update_routing_entry(s, &kroute);
}

1147 1148 1149 1150 1151 1152 1153 1154
static int kvm_irqchip_assign_irqfd(KVMState *s, int fd, int virq, bool assign)
{
    struct kvm_irqfd irqfd = {
        .fd = fd,
        .gsi = virq,
        .flags = assign ? 0 : KVM_IRQFD_FLAG_DEASSIGN,
    };

1155
    if (!kvm_irqfds_enabled()) {
1156 1157 1158 1159 1160 1161
        return -ENOSYS;
    }

    return kvm_vm_ioctl(s, KVM_IRQFD, &irqfd);
}

1162 1163 1164 1165 1166
#else /* !KVM_CAP_IRQ_ROUTING */

static void kvm_init_irq_routing(KVMState *s)
{
}
1167

1168 1169 1170 1171
void kvm_irqchip_release_virq(KVMState *s, int virq)
{
}

1172 1173 1174 1175
int kvm_irqchip_send_msi(KVMState *s, MSIMessage msg)
{
    abort();
}
1176 1177 1178

int kvm_irqchip_add_msi_route(KVMState *s, MSIMessage msg)
{
1179
    return -ENOSYS;
1180
}
1181 1182 1183 1184 1185

static int kvm_irqchip_assign_irqfd(KVMState *s, int fd, int virq, bool assign)
{
    abort();
}
1186 1187
#endif /* !KVM_CAP_IRQ_ROUTING */

J
Jan Kiszka 已提交
1188
int kvm_irqchip_add_irqfd_notifier(KVMState *s, EventNotifier *n, int virq)
1189
{
J
Jan Kiszka 已提交
1190
    return kvm_irqchip_assign_irqfd(s, event_notifier_get_fd(n), virq, true);
1191 1192
}

J
Jan Kiszka 已提交
1193
int kvm_irqchip_remove_irqfd_notifier(KVMState *s, EventNotifier *n, int virq)
1194
{
J
Jan Kiszka 已提交
1195
    return kvm_irqchip_assign_irqfd(s, event_notifier_get_fd(n), virq, false);
1196 1197
}

1198 1199 1200 1201 1202 1203 1204
static int kvm_irqchip_create(KVMState *s)
{
    QemuOptsList *list = qemu_find_opts("machine");
    int ret;

    if (QTAILQ_EMPTY(&list->head) ||
        !qemu_opt_get_bool(QTAILQ_FIRST(&list->head),
1205
                           "kernel_irqchip", true) ||
1206 1207 1208 1209 1210 1211 1212 1213 1214 1215
        !kvm_check_extension(s, KVM_CAP_IRQCHIP)) {
        return 0;
    }

    ret = kvm_vm_ioctl(s, KVM_CREATE_IRQCHIP);
    if (ret < 0) {
        fprintf(stderr, "Create kernel irqchip failed\n");
        return ret;
    }

1216
    kvm_kernel_irqchip = true;
1217 1218 1219 1220
    /* If we have an in-kernel IRQ chip then we must have asynchronous
     * interrupt delivery (though the reverse is not necessarily true)
     */
    kvm_async_interrupts_allowed = true;
1221 1222 1223 1224 1225 1226

    kvm_init_irq_routing(s);

    return 0;
}

1227 1228 1229 1230 1231 1232 1233 1234 1235 1236 1237 1238 1239 1240 1241 1242 1243 1244 1245 1246
static int kvm_max_vcpus(KVMState *s)
{
    int ret;

    /* Find number of supported CPUs using the recommended
     * procedure from the kernel API documentation to cope with
     * older kernels that may be missing capabilities.
     */
    ret = kvm_check_extension(s, KVM_CAP_MAX_VCPUS);
    if (ret) {
        return ret;
    }
    ret = kvm_check_extension(s, KVM_CAP_NR_VCPUS);
    if (ret) {
        return ret;
    }

    return 4;
}

1247
int kvm_init(void)
A
aliguori 已提交
1248
{
1249 1250 1251
    static const char upgrade_note[] =
        "Please upgrade to at least kernel 2.6.29 or recent kvm-kmod\n"
        "(see http://sourceforge.net/projects/kvm).\n";
A
aliguori 已提交
1252
    KVMState *s;
1253
    const KVMCapabilityInfo *missing_cap;
A
aliguori 已提交
1254 1255
    int ret;
    int i;
1256
    int max_vcpus;
A
aliguori 已提交
1257

1258
    s = g_malloc0(sizeof(KVMState));
A
aliguori 已提交
1259

1260 1261 1262 1263 1264 1265 1266 1267
    /*
     * On systems where the kernel can support different base page
     * sizes, host page size may be different from TARGET_PAGE_SIZE,
     * even with KVM.  TARGET_PAGE_SIZE is assumed to be the minimum
     * page size for the system though.
     */
    assert(TARGET_PAGE_SIZE <= getpagesize());

1268
#ifdef KVM_CAP_SET_GUEST_DEBUG
B
Blue Swirl 已提交
1269
    QTAILQ_INIT(&s->kvm_sw_breakpoints);
1270
#endif
J
Jan Kiszka 已提交
1271
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
A
aliguori 已提交
1272
        s->slots[i].slot = i;
J
Jan Kiszka 已提交
1273
    }
A
aliguori 已提交
1274
    s->vmfd = -1;
K
Kevin Wolf 已提交
1275
    s->fd = qemu_open("/dev/kvm", O_RDWR);
A
aliguori 已提交
1276 1277 1278 1279 1280 1281 1282 1283
    if (s->fd == -1) {
        fprintf(stderr, "Could not access KVM kernel module: %m\n");
        ret = -errno;
        goto err;
    }

    ret = kvm_ioctl(s, KVM_GET_API_VERSION, 0);
    if (ret < KVM_API_VERSION) {
J
Jan Kiszka 已提交
1284
        if (ret > 0) {
A
aliguori 已提交
1285
            ret = -EINVAL;
J
Jan Kiszka 已提交
1286
        }
A
aliguori 已提交
1287 1288 1289 1290 1291 1292 1293 1294 1295 1296
        fprintf(stderr, "kvm version too old\n");
        goto err;
    }

    if (ret > KVM_API_VERSION) {
        ret = -EINVAL;
        fprintf(stderr, "kvm version not supported\n");
        goto err;
    }

1297 1298 1299 1300 1301 1302 1303 1304
    max_vcpus = kvm_max_vcpus(s);
    if (smp_cpus > max_vcpus) {
        ret = -EINVAL;
        fprintf(stderr, "Number of SMP cpus requested (%d) exceeds max cpus "
                "supported by KVM (%d)\n", smp_cpus, max_vcpus);
        goto err;
    }

A
aliguori 已提交
1305
    s->vmfd = kvm_ioctl(s, KVM_CREATE_VM, 0);
1306 1307 1308 1309 1310
    if (s->vmfd < 0) {
#ifdef TARGET_S390X
        fprintf(stderr, "Please add the 'switch_amode' kernel parameter to "
                        "your host kernel command line\n");
#endif
1311
        ret = s->vmfd;
A
aliguori 已提交
1312
        goto err;
1313
    }
A
aliguori 已提交
1314

1315 1316 1317 1318
    missing_cap = kvm_check_extension_list(s, kvm_required_capabilites);
    if (!missing_cap) {
        missing_cap =
            kvm_check_extension_list(s, kvm_arch_required_capabilities);
A
aliguori 已提交
1319
    }
1320
    if (missing_cap) {
1321
        ret = -EINVAL;
1322 1323
        fprintf(stderr, "kvm does not support %s\n%s",
                missing_cap->name, upgrade_note);
1324 1325 1326
        goto err;
    }

1327
    s->coalesced_mmio = kvm_check_extension(s, KVM_CAP_COALESCED_MMIO);
A
aliguori 已提交
1328

1329
    s->broken_set_mem_region = 1;
1330
    ret = kvm_check_extension(s, KVM_CAP_JOIN_MEMORY_REGIONS_WORKS);
1331 1332 1333 1334
    if (ret > 0) {
        s->broken_set_mem_region = 0;
    }

1335 1336 1337 1338
#ifdef KVM_CAP_VCPU_EVENTS
    s->vcpu_events = kvm_check_extension(s, KVM_CAP_VCPU_EVENTS);
#endif

1339 1340 1341
    s->robust_singlestep =
        kvm_check_extension(s, KVM_CAP_X86_ROBUST_SINGLESTEP);

1342 1343 1344 1345
#ifdef KVM_CAP_DEBUGREGS
    s->debugregs = kvm_check_extension(s, KVM_CAP_DEBUGREGS);
#endif

1346 1347 1348 1349 1350 1351 1352 1353
#ifdef KVM_CAP_XSAVE
    s->xsave = kvm_check_extension(s, KVM_CAP_XSAVE);
#endif

#ifdef KVM_CAP_XCRS
    s->xcrs = kvm_check_extension(s, KVM_CAP_XCRS);
#endif

J
Jan Kiszka 已提交
1354 1355 1356 1357
#ifdef KVM_CAP_PIT_STATE2
    s->pit_state2 = kvm_check_extension(s, KVM_CAP_PIT_STATE2);
#endif

1358
#ifdef KVM_CAP_IRQ_ROUTING
1359
    s->direct_msi = (kvm_check_extension(s, KVM_CAP_SIGNAL_MSI) > 0);
1360
#endif
1361

1362 1363
    s->intx_set_mask = kvm_check_extension(s, KVM_CAP_PCI_2_3);

1364
    s->irq_set_ioctl = KVM_IRQ_LINE;
1365
    if (kvm_check_extension(s, KVM_CAP_IRQ_INJECT_STATUS)) {
1366
        s->irq_set_ioctl = KVM_IRQ_LINE_STATUS;
1367 1368
    }

1369
    ret = kvm_arch_init(s);
J
Jan Kiszka 已提交
1370
    if (ret < 0) {
A
aliguori 已提交
1371
        goto err;
J
Jan Kiszka 已提交
1372
    }
A
aliguori 已提交
1373

1374 1375 1376 1377 1378
    ret = kvm_irqchip_create(s);
    if (ret < 0) {
        goto err;
    }

A
aliguori 已提交
1379
    kvm_state = s;
1380 1381
    memory_listener_register(&kvm_memory_listener, &address_space_memory);
    memory_listener_register(&kvm_io_listener, &address_space_io);
A
aliguori 已提交
1382

1383 1384
    s->many_ioeventfds = kvm_check_many_ioeventfds();

1385 1386
    cpu_interrupt_handler = kvm_handle_interrupt;

A
aliguori 已提交
1387 1388 1389
    return 0;

err:
1390 1391 1392 1393 1394
    if (s->vmfd >= 0) {
        close(s->vmfd);
    }
    if (s->fd != -1) {
        close(s->fd);
A
aliguori 已提交
1395
    }
1396
    g_free(s);
A
aliguori 已提交
1397 1398 1399 1400

    return ret;
}

1401 1402
static void kvm_handle_io(uint16_t port, void *data, int direction, int size,
                          uint32_t count)
A
aliguori 已提交
1403 1404 1405 1406 1407 1408 1409 1410
{
    int i;
    uint8_t *ptr = data;

    for (i = 0; i < count; i++) {
        if (direction == KVM_EXIT_IO_IN) {
            switch (size) {
            case 1:
1411
                stb_p(ptr, cpu_inb(port));
A
aliguori 已提交
1412 1413
                break;
            case 2:
1414
                stw_p(ptr, cpu_inw(port));
A
aliguori 已提交
1415 1416
                break;
            case 4:
1417
                stl_p(ptr, cpu_inl(port));
A
aliguori 已提交
1418 1419 1420 1421 1422
                break;
            }
        } else {
            switch (size) {
            case 1:
1423
                cpu_outb(port, ldub_p(ptr));
A
aliguori 已提交
1424 1425
                break;
            case 2:
1426
                cpu_outw(port, lduw_p(ptr));
A
aliguori 已提交
1427 1428
                break;
            case 4:
1429
                cpu_outl(port, ldl_p(ptr));
A
aliguori 已提交
1430 1431 1432 1433 1434 1435 1436 1437
                break;
            }
        }

        ptr += size;
    }
}

1438
static int kvm_handle_internal_error(CPUArchState *env, struct kvm_run *run)
M
Marcelo Tosatti 已提交
1439
{
1440
    fprintf(stderr, "KVM internal error.");
M
Marcelo Tosatti 已提交
1441 1442 1443
    if (kvm_check_extension(kvm_state, KVM_CAP_INTERNAL_ERROR_DATA)) {
        int i;

1444
        fprintf(stderr, " Suberror: %d\n", run->internal.suberror);
M
Marcelo Tosatti 已提交
1445 1446 1447 1448
        for (i = 0; i < run->internal.ndata; ++i) {
            fprintf(stderr, "extra data[%d]: %"PRIx64"\n",
                    i, (uint64_t)run->internal.data[i]);
        }
1449 1450
    } else {
        fprintf(stderr, "\n");
M
Marcelo Tosatti 已提交
1451 1452 1453
    }
    if (run->internal.suberror == KVM_INTERNAL_ERROR_EMULATION) {
        fprintf(stderr, "emulation failure\n");
J
Jan Kiszka 已提交
1454
        if (!kvm_arch_stop_on_emulation_error(env)) {
1455
            cpu_dump_state(env, stderr, fprintf, CPU_DUMP_CODE);
1456
            return EXCP_INTERRUPT;
J
Jan Kiszka 已提交
1457
        }
M
Marcelo Tosatti 已提交
1458 1459 1460 1461
    }
    /* FIXME: Should trigger a qmp message to let management know
     * something went wrong.
     */
J
Jan Kiszka 已提交
1462
    return -1;
M
Marcelo Tosatti 已提交
1463 1464
}

1465
void kvm_flush_coalesced_mmio_buffer(void)
A
aliguori 已提交
1466 1467
{
    KVMState *s = kvm_state;
1468 1469 1470 1471 1472 1473 1474

    if (s->coalesced_flush_in_progress) {
        return;
    }

    s->coalesced_flush_in_progress = true;

1475 1476
    if (s->coalesced_mmio_ring) {
        struct kvm_coalesced_mmio_ring *ring = s->coalesced_mmio_ring;
A
aliguori 已提交
1477 1478 1479 1480 1481 1482
        while (ring->first != ring->last) {
            struct kvm_coalesced_mmio *ent;

            ent = &ring->coalesced_mmio[ring->first];

            cpu_physical_memory_write(ent->phys_addr, ent->data, ent->len);
1483
            smp_wmb();
A
aliguori 已提交
1484 1485 1486
            ring->first = (ring->first + 1) % KVM_COALESCED_MMIO_MAX;
        }
    }
1487 1488

    s->coalesced_flush_in_progress = false;
A
aliguori 已提交
1489 1490
}

1491
static void do_kvm_cpu_synchronize_state(void *_env)
1492
{
1493
    CPUArchState *env = _env;
1494

J
Jan Kiszka 已提交
1495
    if (!env->kvm_vcpu_dirty) {
1496
        kvm_arch_get_registers(env);
J
Jan Kiszka 已提交
1497
        env->kvm_vcpu_dirty = 1;
1498 1499 1500
    }
}

1501
void kvm_cpu_synchronize_state(CPUArchState *env)
1502
{
1503 1504
    CPUState *cpu = ENV_GET_CPU(env);

J
Jan Kiszka 已提交
1505
    if (!env->kvm_vcpu_dirty) {
1506
        run_on_cpu(cpu, do_kvm_cpu_synchronize_state, env);
J
Jan Kiszka 已提交
1507
    }
1508 1509
}

1510
void kvm_cpu_synchronize_post_reset(CPUArchState *env)
1511 1512 1513 1514 1515
{
    kvm_arch_put_registers(env, KVM_PUT_RESET_STATE);
    env->kvm_vcpu_dirty = 0;
}

1516
void kvm_cpu_synchronize_post_init(CPUArchState *env)
1517 1518 1519 1520 1521
{
    kvm_arch_put_registers(env, KVM_PUT_FULL_STATE);
    env->kvm_vcpu_dirty = 0;
}

1522
int kvm_cpu_exec(CPUArchState *env)
A
aliguori 已提交
1523 1524
{
    struct kvm_run *run = env->kvm_run;
1525
    int ret, run_ret;
A
aliguori 已提交
1526

1527
    DPRINTF("kvm_cpu_exec()\n");
A
aliguori 已提交
1528

1529
    if (kvm_arch_process_async_events(env)) {
1530
        env->exit_request = 0;
1531
        return EXCP_HLT;
1532
    }
M
Marcelo Tosatti 已提交
1533

1534
    do {
J
Jan Kiszka 已提交
1535
        if (env->kvm_vcpu_dirty) {
1536
            kvm_arch_put_registers(env, KVM_PUT_RUNTIME_STATE);
J
Jan Kiszka 已提交
1537
            env->kvm_vcpu_dirty = 0;
1538 1539
        }

1540
        kvm_arch_pre_run(env, run);
1541 1542 1543 1544 1545 1546 1547 1548 1549
        if (env->exit_request) {
            DPRINTF("interrupt exit requested\n");
            /*
             * KVM requires us to reenter the kernel after IO exits to complete
             * instruction emulation. This self-signal will ensure that we
             * leave ASAP again.
             */
            qemu_cpu_kick_self();
        }
1550
        qemu_mutex_unlock_iothread();
1551

1552
        run_ret = kvm_vcpu_ioctl(env, KVM_RUN, 0);
1553

1554
        qemu_mutex_lock_iothread();
A
aliguori 已提交
1555 1556
        kvm_arch_post_run(env, run);

1557
        if (run_ret < 0) {
1558 1559
            if (run_ret == -EINTR || run_ret == -EAGAIN) {
                DPRINTF("io window exit\n");
1560
                ret = EXCP_INTERRUPT;
1561 1562
                break;
            }
1563 1564
            fprintf(stderr, "error: kvm run failed %s\n",
                    strerror(-run_ret));
A
aliguori 已提交
1565 1566 1567 1568 1569
            abort();
        }

        switch (run->exit_reason) {
        case KVM_EXIT_IO:
1570
            DPRINTF("handle_io\n");
1571 1572 1573 1574 1575
            kvm_handle_io(run->io.port,
                          (uint8_t *)run + run->io.data_offset,
                          run->io.direction,
                          run->io.size,
                          run->io.count);
1576
            ret = 0;
A
aliguori 已提交
1577 1578
            break;
        case KVM_EXIT_MMIO:
1579
            DPRINTF("handle_mmio\n");
A
aliguori 已提交
1580 1581 1582 1583
            cpu_physical_memory_rw(run->mmio.phys_addr,
                                   run->mmio.data,
                                   run->mmio.len,
                                   run->mmio.is_write);
1584
            ret = 0;
A
aliguori 已提交
1585 1586
            break;
        case KVM_EXIT_IRQ_WINDOW_OPEN:
1587
            DPRINTF("irq_window_open\n");
1588
            ret = EXCP_INTERRUPT;
A
aliguori 已提交
1589 1590
            break;
        case KVM_EXIT_SHUTDOWN:
1591
            DPRINTF("shutdown\n");
A
aliguori 已提交
1592
            qemu_system_reset_request();
1593
            ret = EXCP_INTERRUPT;
A
aliguori 已提交
1594 1595
            break;
        case KVM_EXIT_UNKNOWN:
1596 1597
            fprintf(stderr, "KVM: unknown exit, hardware reason %" PRIx64 "\n",
                    (uint64_t)run->hw.hardware_exit_reason);
J
Jan Kiszka 已提交
1598
            ret = -1;
A
aliguori 已提交
1599
            break;
M
Marcelo Tosatti 已提交
1600
        case KVM_EXIT_INTERNAL_ERROR:
J
Jan Kiszka 已提交
1601
            ret = kvm_handle_internal_error(env, run);
M
Marcelo Tosatti 已提交
1602
            break;
A
aliguori 已提交
1603
        default:
1604
            DPRINTF("kvm_arch_handle_exit\n");
A
aliguori 已提交
1605 1606 1607
            ret = kvm_arch_handle_exit(env, run);
            break;
        }
1608
    } while (ret == 0);
A
aliguori 已提交
1609

J
Jan Kiszka 已提交
1610
    if (ret < 0) {
1611
        cpu_dump_state(env, stderr, fprintf, CPU_DUMP_CODE);
1612
        vm_stop(RUN_STATE_INTERNAL_ERROR);
A
aliguori 已提交
1613 1614
    }

1615
    env->exit_request = 0;
A
aliguori 已提交
1616 1617 1618
    return ret;
}

1619
int kvm_ioctl(KVMState *s, int type, ...)
A
aliguori 已提交
1620 1621
{
    int ret;
1622 1623
    void *arg;
    va_list ap;
A
aliguori 已提交
1624

1625 1626 1627 1628 1629
    va_start(ap, type);
    arg = va_arg(ap, void *);
    va_end(ap);

    ret = ioctl(s->fd, type, arg);
J
Jan Kiszka 已提交
1630
    if (ret == -1) {
A
aliguori 已提交
1631
        ret = -errno;
J
Jan Kiszka 已提交
1632
    }
A
aliguori 已提交
1633 1634 1635
    return ret;
}

1636
int kvm_vm_ioctl(KVMState *s, int type, ...)
A
aliguori 已提交
1637 1638
{
    int ret;
1639 1640 1641 1642 1643 1644
    void *arg;
    va_list ap;

    va_start(ap, type);
    arg = va_arg(ap, void *);
    va_end(ap);
A
aliguori 已提交
1645

1646
    ret = ioctl(s->vmfd, type, arg);
J
Jan Kiszka 已提交
1647
    if (ret == -1) {
A
aliguori 已提交
1648
        ret = -errno;
J
Jan Kiszka 已提交
1649
    }
A
aliguori 已提交
1650 1651 1652
    return ret;
}

1653
int kvm_vcpu_ioctl(CPUArchState *env, int type, ...)
A
aliguori 已提交
1654 1655
{
    int ret;
1656 1657 1658 1659 1660 1661
    void *arg;
    va_list ap;

    va_start(ap, type);
    arg = va_arg(ap, void *);
    va_end(ap);
A
aliguori 已提交
1662

1663
    ret = ioctl(env->kvm_fd, type, arg);
J
Jan Kiszka 已提交
1664
    if (ret == -1) {
A
aliguori 已提交
1665
        ret = -errno;
J
Jan Kiszka 已提交
1666
    }
A
aliguori 已提交
1667 1668
    return ret;
}
A
aliguori 已提交
1669 1670 1671

int kvm_has_sync_mmu(void)
{
1672
    return kvm_check_extension(kvm_state, KVM_CAP_SYNC_MMU);
A
aliguori 已提交
1673
}
1674

1675 1676 1677 1678 1679
int kvm_has_vcpu_events(void)
{
    return kvm_state->vcpu_events;
}

1680 1681 1682 1683 1684
int kvm_has_robust_singlestep(void)
{
    return kvm_state->robust_singlestep;
}

1685 1686 1687 1688 1689
int kvm_has_debugregs(void)
{
    return kvm_state->debugregs;
}

1690 1691 1692 1693 1694 1695 1696 1697 1698 1699
int kvm_has_xsave(void)
{
    return kvm_state->xsave;
}

int kvm_has_xcrs(void)
{
    return kvm_state->xcrs;
}

J
Jan Kiszka 已提交
1700 1701 1702 1703 1704
int kvm_has_pit_state2(void)
{
    return kvm_state->pit_state2;
}

1705 1706 1707 1708 1709 1710 1711 1712
int kvm_has_many_ioeventfds(void)
{
    if (!kvm_enabled()) {
        return 0;
    }
    return kvm_state->many_ioeventfds;
}

1713 1714
int kvm_has_gsi_routing(void)
{
A
Alexander Graf 已提交
1715
#ifdef KVM_CAP_IRQ_ROUTING
1716
    return kvm_check_extension(kvm_state, KVM_CAP_IRQ_ROUTING);
A
Alexander Graf 已提交
1717 1718 1719
#else
    return false;
#endif
1720 1721
}

1722 1723 1724 1725 1726
int kvm_has_intx_set_mask(void)
{
    return kvm_state->intx_set_mask;
}

1727 1728 1729 1730 1731 1732 1733 1734 1735 1736 1737 1738 1739
void *kvm_vmalloc(ram_addr_t size)
{
#ifdef TARGET_S390X
    void *mem;

    mem = kvm_arch_vmalloc(size);
    if (mem) {
        return mem;
    }
#endif
    return qemu_vmalloc(size);
}

1740 1741
void kvm_setup_guest_memory(void *start, size_t size)
{
1742 1743 1744
#ifdef CONFIG_VALGRIND_H
    VALGRIND_MAKE_MEM_DEFINED(start, size);
#endif
1745
    if (!kvm_has_sync_mmu()) {
A
Andreas Färber 已提交
1746
        int ret = qemu_madvise(start, size, QEMU_MADV_DONTFORK);
1747 1748

        if (ret) {
A
Andreas Färber 已提交
1749 1750 1751
            perror("qemu_madvise");
            fprintf(stderr,
                    "Need MADV_DONTFORK in absence of synchronous KVM MMU\n");
1752 1753 1754 1755 1756
            exit(1);
        }
    }
}

1757
#ifdef KVM_CAP_SET_GUEST_DEBUG
1758
struct kvm_sw_breakpoint *kvm_find_sw_breakpoint(CPUArchState *env,
1759 1760 1761 1762
                                                 target_ulong pc)
{
    struct kvm_sw_breakpoint *bp;

B
Blue Swirl 已提交
1763
    QTAILQ_FOREACH(bp, &env->kvm_state->kvm_sw_breakpoints, entry) {
J
Jan Kiszka 已提交
1764
        if (bp->pc == pc) {
1765
            return bp;
J
Jan Kiszka 已提交
1766
        }
1767 1768 1769 1770
    }
    return NULL;
}

1771
int kvm_sw_breakpoints_active(CPUArchState *env)
1772
{
B
Blue Swirl 已提交
1773
    return !QTAILQ_EMPTY(&env->kvm_state->kvm_sw_breakpoints);
1774 1775
}

G
Glauber Costa 已提交
1776 1777
struct kvm_set_guest_debug_data {
    struct kvm_guest_debug dbg;
1778
    CPUArchState *env;
G
Glauber Costa 已提交
1779 1780 1781 1782 1783 1784
    int err;
};

static void kvm_invoke_set_guest_debug(void *data)
{
    struct kvm_set_guest_debug_data *dbg_data = data;
1785
    CPUArchState *env = dbg_data->env;
J
Jan Kiszka 已提交
1786 1787

    dbg_data->err = kvm_vcpu_ioctl(env, KVM_SET_GUEST_DEBUG, &dbg_data->dbg);
G
Glauber Costa 已提交
1788 1789
}

1790
int kvm_update_guest_debug(CPUArchState *env, unsigned long reinject_trap)
1791
{
1792
    CPUState *cpu = ENV_GET_CPU(env);
G
Glauber Costa 已提交
1793
    struct kvm_set_guest_debug_data data;
1794

1795
    data.dbg.control = reinject_trap;
1796

1797 1798 1799
    if (env->singlestep_enabled) {
        data.dbg.control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP;
    }
G
Glauber Costa 已提交
1800 1801
    kvm_arch_update_guest_debug(env, &data.dbg);
    data.env = env;
1802

1803
    run_on_cpu(cpu, kvm_invoke_set_guest_debug, &data);
G
Glauber Costa 已提交
1804
    return data.err;
1805 1806
}

1807
int kvm_insert_breakpoint(CPUArchState *current_env, target_ulong addr,
1808 1809 1810
                          target_ulong len, int type)
{
    struct kvm_sw_breakpoint *bp;
1811
    CPUArchState *env;
1812 1813 1814 1815 1816 1817 1818 1819 1820
    int err;

    if (type == GDB_BREAKPOINT_SW) {
        bp = kvm_find_sw_breakpoint(current_env, addr);
        if (bp) {
            bp->use_count++;
            return 0;
        }

1821
        bp = g_malloc(sizeof(struct kvm_sw_breakpoint));
J
Jan Kiszka 已提交
1822
        if (!bp) {
1823
            return -ENOMEM;
J
Jan Kiszka 已提交
1824
        }
1825 1826 1827 1828 1829

        bp->pc = addr;
        bp->use_count = 1;
        err = kvm_arch_insert_sw_breakpoint(current_env, bp);
        if (err) {
1830
            g_free(bp);
1831 1832 1833
            return err;
        }

B
Blue Swirl 已提交
1834
        QTAILQ_INSERT_HEAD(&current_env->kvm_state->kvm_sw_breakpoints,
1835 1836 1837
                          bp, entry);
    } else {
        err = kvm_arch_insert_hw_breakpoint(addr, len, type);
J
Jan Kiszka 已提交
1838
        if (err) {
1839
            return err;
J
Jan Kiszka 已提交
1840
        }
1841 1842 1843 1844
    }

    for (env = first_cpu; env != NULL; env = env->next_cpu) {
        err = kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
1845
        if (err) {
1846
            return err;
J
Jan Kiszka 已提交
1847
        }
1848 1849 1850 1851
    }
    return 0;
}

1852
int kvm_remove_breakpoint(CPUArchState *current_env, target_ulong addr,
1853 1854 1855
                          target_ulong len, int type)
{
    struct kvm_sw_breakpoint *bp;
1856
    CPUArchState *env;
1857 1858 1859 1860
    int err;

    if (type == GDB_BREAKPOINT_SW) {
        bp = kvm_find_sw_breakpoint(current_env, addr);
J
Jan Kiszka 已提交
1861
        if (!bp) {
1862
            return -ENOENT;
J
Jan Kiszka 已提交
1863
        }
1864 1865 1866 1867 1868 1869 1870

        if (bp->use_count > 1) {
            bp->use_count--;
            return 0;
        }

        err = kvm_arch_remove_sw_breakpoint(current_env, bp);
J
Jan Kiszka 已提交
1871
        if (err) {
1872
            return err;
J
Jan Kiszka 已提交
1873
        }
1874

B
Blue Swirl 已提交
1875
        QTAILQ_REMOVE(&current_env->kvm_state->kvm_sw_breakpoints, bp, entry);
1876
        g_free(bp);
1877 1878
    } else {
        err = kvm_arch_remove_hw_breakpoint(addr, len, type);
J
Jan Kiszka 已提交
1879
        if (err) {
1880
            return err;
J
Jan Kiszka 已提交
1881
        }
1882 1883 1884 1885
    }

    for (env = first_cpu; env != NULL; env = env->next_cpu) {
        err = kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
1886
        if (err) {
1887
            return err;
J
Jan Kiszka 已提交
1888
        }
1889 1890 1891 1892
    }
    return 0;
}

1893
void kvm_remove_all_breakpoints(CPUArchState *current_env)
1894 1895 1896
{
    struct kvm_sw_breakpoint *bp, *next;
    KVMState *s = current_env->kvm_state;
1897
    CPUArchState *env;
1898

B
Blue Swirl 已提交
1899
    QTAILQ_FOREACH_SAFE(bp, &s->kvm_sw_breakpoints, entry, next) {
1900 1901 1902
        if (kvm_arch_remove_sw_breakpoint(current_env, bp) != 0) {
            /* Try harder to find a CPU that currently sees the breakpoint. */
            for (env = first_cpu; env != NULL; env = env->next_cpu) {
J
Jan Kiszka 已提交
1903
                if (kvm_arch_remove_sw_breakpoint(env, bp) == 0) {
1904
                    break;
J
Jan Kiszka 已提交
1905
                }
1906 1907
            }
        }
1908 1909
        QTAILQ_REMOVE(&s->kvm_sw_breakpoints, bp, entry);
        g_free(bp);
1910 1911 1912
    }
    kvm_arch_remove_all_hw_breakpoints();

J
Jan Kiszka 已提交
1913
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
1914
        kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
1915
    }
1916 1917 1918 1919
}

#else /* !KVM_CAP_SET_GUEST_DEBUG */

1920
int kvm_update_guest_debug(CPUArchState *env, unsigned long reinject_trap)
1921 1922 1923 1924
{
    return -EINVAL;
}

1925
int kvm_insert_breakpoint(CPUArchState *current_env, target_ulong addr,
1926 1927 1928 1929 1930
                          target_ulong len, int type)
{
    return -EINVAL;
}

1931
int kvm_remove_breakpoint(CPUArchState *current_env, target_ulong addr,
1932 1933 1934 1935 1936
                          target_ulong len, int type)
{
    return -EINVAL;
}

1937
void kvm_remove_all_breakpoints(CPUArchState *current_env)
1938 1939 1940
{
}
#endif /* !KVM_CAP_SET_GUEST_DEBUG */
1941

1942
int kvm_set_signal_mask(CPUArchState *env, const sigset_t *sigset)
1943 1944 1945 1946
{
    struct kvm_signal_mask *sigmask;
    int r;

J
Jan Kiszka 已提交
1947
    if (!sigset) {
1948
        return kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, NULL);
J
Jan Kiszka 已提交
1949
    }
1950

1951
    sigmask = g_malloc(sizeof(*sigmask) + sizeof(*sigset));
1952 1953 1954 1955

    sigmask->len = 8;
    memcpy(sigmask->sigset, sigset, sizeof(*sigset));
    r = kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, sigmask);
1956
    g_free(sigmask);
1957 1958 1959

    return r;
}
1960

1961 1962
int kvm_set_ioeventfd_mmio(int fd, uint32_t addr, uint32_t val, bool assign,
                           uint32_t size)
1963 1964 1965 1966 1967 1968
{
    int ret;
    struct kvm_ioeventfd iofd;

    iofd.datamatch = val;
    iofd.addr = addr;
1969
    iofd.len = size;
1970 1971 1972 1973 1974 1975 1976 1977 1978 1979 1980 1981 1982 1983 1984 1985 1986 1987 1988 1989
    iofd.flags = KVM_IOEVENTFD_FLAG_DATAMATCH;
    iofd.fd = fd;

    if (!kvm_enabled()) {
        return -ENOSYS;
    }

    if (!assign) {
        iofd.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
    }

    ret = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &iofd);

    if (ret < 0) {
        return -errno;
    }

    return 0;
}

1990 1991 1992 1993 1994 1995 1996 1997 1998 1999
int kvm_set_ioeventfd_pio_word(int fd, uint16_t addr, uint16_t val, bool assign)
{
    struct kvm_ioeventfd kick = {
        .datamatch = val,
        .addr = addr,
        .len = 2,
        .flags = KVM_IOEVENTFD_FLAG_DATAMATCH | KVM_IOEVENTFD_FLAG_PIO,
        .fd = fd,
    };
    int r;
J
Jan Kiszka 已提交
2000
    if (!kvm_enabled()) {
2001
        return -ENOSYS;
J
Jan Kiszka 已提交
2002 2003
    }
    if (!assign) {
2004
        kick.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
J
Jan Kiszka 已提交
2005
    }
2006
    r = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &kick);
J
Jan Kiszka 已提交
2007
    if (r < 0) {
2008
        return r;
J
Jan Kiszka 已提交
2009
    }
2010
    return 0;
2011
}
2012

2013
int kvm_on_sigbus_vcpu(CPUArchState *env, int code, void *addr)
2014 2015 2016 2017 2018 2019 2020 2021
{
    return kvm_arch_on_sigbus_vcpu(env, code, addr);
}

int kvm_on_sigbus(int code, void *addr)
{
    return kvm_arch_on_sigbus(code, addr);
}