kvm-all.c 46.8 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"
A
aliguori 已提交
25
#include "sysemu.h"
J
Jan Kiszka 已提交
26
#include "hw/hw.h"
27
#include "hw/msi.h"
28
#include "gdbstub.h"
A
aliguori 已提交
29
#include "kvm.h"
30
#include "bswap.h"
A
Avi Kivity 已提交
31
#include "memory.h"
32
#include "exec-memory.h"
A
aliguori 已提交
33

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

39
/* KVM uses PAGE_SIZE in its definition of COALESCED_MMIO_MAX */
A
aliguori 已提交
40 41
#define PAGE_SIZE TARGET_PAGE_SIZE

A
aliguori 已提交
42 43 44
//#define DEBUG_KVM

#ifdef DEBUG_KVM
45
#define DPRINTF(fmt, ...) \
A
aliguori 已提交
46 47
    do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
#else
48
#define DPRINTF(fmt, ...) \
A
aliguori 已提交
49 50 51
    do { } while (0)
#endif

52 53
#define KVM_MSI_HASHTAB_SIZE    256

A
aliguori 已提交
54 55
typedef struct KVMSlot
{
A
Anthony Liguori 已提交
56 57
    target_phys_addr_t start_addr;
    ram_addr_t memory_size;
58
    void *ram;
A
aliguori 已提交
59 60 61
    int slot;
    int flags;
} KVMSlot;
A
aliguori 已提交
62

63 64
typedef struct kvm_dirty_log KVMDirtyLog;

65 66 67 68 69
typedef struct KVMMSIRoute {
    struct kvm_irq_routing_entry kroute;
    QTAILQ_ENTRY(KVMMSIRoute) entry;
} KVMMSIRoute;

A
aliguori 已提交
70 71 72 73 74
struct KVMState
{
    KVMSlot slots[32];
    int fd;
    int vmfd;
A
aliguori 已提交
75
    int coalesced_mmio;
76
    struct kvm_coalesced_mmio_ring *coalesced_mmio_ring;
77
    bool coalesced_flush_in_progress;
78
    int broken_set_mem_region;
79
    int migration_log;
80
    int vcpu_events;
81
    int robust_singlestep;
82
    int debugregs;
83 84 85
#ifdef KVM_CAP_SET_GUEST_DEBUG
    struct kvm_sw_breakpoint_head kvm_sw_breakpoints;
#endif
J
Jan Kiszka 已提交
86
    int pit_state2;
87
    int xsave, xcrs;
88
    int many_ioeventfds;
89 90 91 92
    /* 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 */
    unsigned irqchip_inject_ioctl;
93 94 95 96
#ifdef KVM_CAP_IRQ_ROUTING
    struct kvm_irq_routing *irq_routes;
    int nr_allocated_irq_routes;
    uint32_t *used_gsi_bitmap;
97
    unsigned int gsi_count;
98
    QTAILQ_HEAD(msi_hashtab, KVMMSIRoute) msi_hashtab[KVM_MSI_HASHTAB_SIZE];
99
    bool direct_msi;
100
#endif
A
aliguori 已提交
101 102
};

103
KVMState *kvm_state;
104
bool kvm_kernel_irqchip;
A
aliguori 已提交
105

106 107 108 109 110 111
static const KVMCapabilityInfo kvm_required_capabilites[] = {
    KVM_CAP_INFO(USER_MEMORY),
    KVM_CAP_INFO(DESTROY_MEMORY_REGION_WORKS),
    KVM_CAP_LAST_INFO
};

A
aliguori 已提交
112 113 114 115 116
static KVMSlot *kvm_alloc_slot(KVMState *s)
{
    int i;

    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
J
Jan Kiszka 已提交
117
        if (s->slots[i].memory_size == 0) {
A
aliguori 已提交
118
            return &s->slots[i];
J
Jan Kiszka 已提交
119
        }
A
aliguori 已提交
120 121
    }

122 123 124 125 126
    fprintf(stderr, "%s: no free slot available\n", __func__);
    abort();
}

static KVMSlot *kvm_lookup_matching_slot(KVMState *s,
A
Anthony Liguori 已提交
127 128
                                         target_phys_addr_t start_addr,
                                         target_phys_addr_t end_addr)
129 130 131 132 133 134 135 136 137 138 139 140
{
    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 已提交
141 142 143
    return NULL;
}

144 145 146 147
/*
 * Find overlapping slot with lowest start address
 */
static KVMSlot *kvm_lookup_overlapping_slot(KVMState *s,
A
Anthony Liguori 已提交
148 149
                                            target_phys_addr_t start_addr,
                                            target_phys_addr_t end_addr)
A
aliguori 已提交
150
{
151
    KVMSlot *found = NULL;
A
aliguori 已提交
152 153 154 155 156
    int i;

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

157 158 159 160 161 162 163 164 165
        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 已提交
166 167
    }

168
    return found;
A
aliguori 已提交
169 170
}

171 172
int kvm_physical_memory_addr_from_host(KVMState *s, void *ram,
                                       target_phys_addr_t *phys_addr)
173 174 175 176 177 178
{
    int i;

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

179 180
        if (ram >= mem->ram && ram < mem->ram + mem->memory_size) {
            *phys_addr = mem->start_addr + (ram - mem->ram);
181 182 183 184 185 186 187
            return 1;
        }
    }

    return 0;
}

188 189 190 191 192 193 194
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;
195
    mem.userspace_addr = (unsigned long)slot->ram;
196
    mem.flags = slot->flags;
197 198 199
    if (s->migration_log) {
        mem.flags |= KVM_MEM_LOG_DIRTY_PAGES;
    }
200 201 202
    return kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
}

J
Jan Kiszka 已提交
203 204
static void kvm_reset_vcpu(void *opaque)
{
205
    CPUArchState *env = opaque;
J
Jan Kiszka 已提交
206

J
Jan Kiszka 已提交
207
    kvm_arch_reset_vcpu(env);
J
Jan Kiszka 已提交
208
}
209

210
int kvm_init_vcpu(CPUArchState *env)
A
aliguori 已提交
211 212 213 214 215
{
    KVMState *s = kvm_state;
    long mmap_size;
    int ret;

216
    DPRINTF("kvm_init_vcpu\n");
A
aliguori 已提交
217

218
    ret = kvm_vm_ioctl(s, KVM_CREATE_VCPU, env->cpu_index);
A
aliguori 已提交
219
    if (ret < 0) {
220
        DPRINTF("kvm_create_vcpu failed\n");
A
aliguori 已提交
221 222 223 224 225
        goto err;
    }

    env->kvm_fd = ret;
    env->kvm_state = s;
226
    env->kvm_vcpu_dirty = 1;
A
aliguori 已提交
227 228 229

    mmap_size = kvm_ioctl(s, KVM_GET_VCPU_MMAP_SIZE, 0);
    if (mmap_size < 0) {
230
        ret = mmap_size;
231
        DPRINTF("KVM_GET_VCPU_MMAP_SIZE failed\n");
A
aliguori 已提交
232 233 234 235 236 237 238
        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;
239
        DPRINTF("mmap'ing vcpu state failed\n");
A
aliguori 已提交
240 241 242
        goto err;
    }

J
Jan Kiszka 已提交
243 244 245 246
    if (s->coalesced_mmio && !s->coalesced_mmio_ring) {
        s->coalesced_mmio_ring =
            (void *)env->kvm_run + s->coalesced_mmio * PAGE_SIZE;
    }
247

A
aliguori 已提交
248
    ret = kvm_arch_init_vcpu(env);
J
Jan Kiszka 已提交
249
    if (ret == 0) {
250
        qemu_register_reset(kvm_reset_vcpu, env);
J
Jan Kiszka 已提交
251
        kvm_arch_reset_vcpu(env);
J
Jan Kiszka 已提交
252
    }
A
aliguori 已提交
253 254 255 256
err:
    return ret;
}

257 258 259
/*
 * dirty pages logging control
 */
260 261 262 263 264 265 266

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)
267 268
{
    KVMState *s = kvm_state;
269
    int flags, mask = KVM_MEM_LOG_DIRTY_PAGES;
270 271 272
    int old_flags;

    old_flags = mem->flags;
273

274
    flags = (mem->flags & ~mask) | kvm_mem_flags(s, log_dirty);
275 276
    mem->flags = flags;

277 278 279 280
    /* If nothing changed effectively, no need to issue ioctl */
    if (s->migration_log) {
        flags |= KVM_MEM_LOG_DIRTY_PAGES;
    }
281

282
    if (flags == old_flags) {
283
        return 0;
284 285
    }

286 287 288
    return kvm_set_user_memory_region(s, mem);
}

289 290 291 292 293 294 295 296 297 298 299 300 301 302 303
static int kvm_dirty_pages_log_change(target_phys_addr_t phys_addr,
                                      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,
                (target_phys_addr_t)(phys_addr + size - 1));
        return -EINVAL;
    }
    return kvm_slot_dirty_pages_log_change(mem, log_dirty);
}

A
Avi Kivity 已提交
304 305
static void kvm_log_start(MemoryListener *listener,
                          MemoryRegionSection *section)
306
{
A
Avi Kivity 已提交
307 308 309 310 311 312 313
    int r;

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

A
Avi Kivity 已提交
316 317
static void kvm_log_stop(MemoryListener *listener,
                          MemoryRegionSection *section)
318
{
A
Avi Kivity 已提交
319 320 321 322 323 324 325
    int r;

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

328
static int kvm_set_migration_log(int enable)
329 330 331 332 333 334 335 336 337 338
{
    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];

339 340 341
        if (!mem->memory_size) {
            continue;
        }
342 343 344 345 346 347 348 349 350 351 352
        if (!!(mem->flags & KVM_MEM_LOG_DIRTY_PAGES) == enable) {
            continue;
        }
        err = kvm_set_user_memory_region(s, mem);
        if (err) {
            return err;
        }
    }
    return 0;
}

353
/* get kvm's dirty pages bitmap and update qemu's */
354 355
static int kvm_get_dirty_pages_log_range(MemoryRegionSection *section,
                                         unsigned long *bitmap)
A
Alexander Graf 已提交
356
{
357
    unsigned int i, j;
358 359
    unsigned long page_number, c;
    target_phys_addr_t addr, addr1;
360
    unsigned int len = ((section->size / TARGET_PAGE_SIZE) + HOST_LONG_BITS - 1) / HOST_LONG_BITS;
361
    unsigned long hpratio = getpagesize() / TARGET_PAGE_SIZE;
362 363 364 365 366 367 368 369 370 371 372

    /*
     * 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);
373
                page_number = (i * HOST_LONG_BITS + j) * hpratio;
374
                addr1 = page_number * TARGET_PAGE_SIZE;
375
                addr = section->offset_within_region + addr1;
376 377
                memory_region_set_dirty(section->mr, addr,
                                        TARGET_PAGE_SIZE * hpratio);
378 379 380 381
            } while (c != 0);
        }
    }
    return 0;
A
Alexander Graf 已提交
382 383
}

384 385
#define ALIGN(x, y)  (((x)+(y)-1) & ~((y)-1))

386 387
/**
 * kvm_physical_sync_dirty_bitmap - Grab dirty bitmap from kernel space
388 389 390
 * This function updates qemu's dirty bitmap using
 * memory_region_set_dirty().  This means all bits are set
 * to dirty.
391
 *
392
 * @start_add: start of logged region.
393 394
 * @end_addr: end of logged region.
 */
395
static int kvm_physical_sync_dirty_bitmap(MemoryRegionSection *section)
396 397
{
    KVMState *s = kvm_state;
398 399 400 401
    unsigned long size, allocated_size = 0;
    KVMDirtyLog d;
    KVMSlot *mem;
    int ret = 0;
402 403
    target_phys_addr_t start_addr = section->offset_within_address_space;
    target_phys_addr_t end_addr = start_addr + section->size;
404

405 406 407 408 409 410
    d.dirty_bitmap = NULL;
    while (start_addr < end_addr) {
        mem = kvm_lookup_overlapping_slot(s, start_addr, end_addr);
        if (mem == NULL) {
            break;
        }
411

412 413 414 415 416 417 418 419 420 421 422 423 424 425
        /* 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;
426
        if (!d.dirty_bitmap) {
427
            d.dirty_bitmap = g_malloc(size);
428
        } else if (size > allocated_size) {
429
            d.dirty_bitmap = g_realloc(d.dirty_bitmap, size);
430 431 432
        }
        allocated_size = size;
        memset(d.dirty_bitmap, 0, allocated_size);
433

434
        d.slot = mem->slot;
435

436
        if (kvm_vm_ioctl(s, KVM_GET_DIRTY_LOG, &d) == -1) {
437
            DPRINTF("ioctl failed %d\n", errno);
438 439 440
            ret = -1;
            break;
        }
441

442
        kvm_get_dirty_pages_log_range(section, d.dirty_bitmap);
443
        start_addr = mem->start_addr + mem->memory_size;
444
    }
445
    g_free(d.dirty_bitmap);
446 447

    return ret;
448 449
}

A
Anthony Liguori 已提交
450
int kvm_coalesce_mmio_region(target_phys_addr_t start, ram_addr_t size)
A
aliguori 已提交
451 452 453 454 455 456 457 458 459
{
    int ret = -ENOSYS;
    KVMState *s = kvm_state;

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

        zone.addr = start;
        zone.size = size;
460
        zone.pad = 0;
A
aliguori 已提交
461 462 463 464 465 466 467

        ret = kvm_vm_ioctl(s, KVM_REGISTER_COALESCED_MMIO, &zone);
    }

    return ret;
}

A
Anthony Liguori 已提交
468
int kvm_uncoalesce_mmio_region(target_phys_addr_t start, ram_addr_t size)
A
aliguori 已提交
469 470 471 472 473 474 475 476 477
{
    int ret = -ENOSYS;
    KVMState *s = kvm_state;

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

        zone.addr = start;
        zone.size = size;
478
        zone.pad = 0;
A
aliguori 已提交
479 480 481 482 483 484 485

        ret = kvm_vm_ioctl(s, KVM_UNREGISTER_COALESCED_MMIO, &zone);
    }

    return ret;
}

486 487 488 489 490 491 492 493 494 495 496 497
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;
}

498 499
static int kvm_check_many_ioeventfds(void)
{
500 501 502 503 504
    /* 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
505 506
     * can avoid creating too many ioeventfds.
     */
507
#if defined(CONFIG_EVENTFD)
508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 529 530 531 532 533 534
    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
}

535 536 537 538 539 540 541 542 543 544 545 546
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 已提交
547
static void kvm_set_phys_mem(MemoryRegionSection *section, bool add)
548 549 550 551
{
    KVMState *s = kvm_state;
    KVMSlot *mem, old;
    int err;
A
Avi Kivity 已提交
552 553 554 555
    MemoryRegion *mr = section->mr;
    bool log_dirty = memory_region_is_logging(mr);
    target_phys_addr_t start_addr = section->offset_within_address_space;
    ram_addr_t size = section->size;
556
    void *ram = NULL;
A
Avi Kivity 已提交
557
    unsigned delta;
558

559 560
    /* kvm works in page size chunks, but the function may be called
       with sub-page size and unaligned start address. */
A
Avi Kivity 已提交
561 562 563 564 565 566 567 568 569 570
    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;
    }
571

A
Avi Kivity 已提交
572 573
    if (!memory_region_is_ram(mr)) {
        return;
574 575
    }

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

578 579 580 581 582 583
    while (1) {
        mem = kvm_lookup_overlapping_slot(s, start_addr, start_addr + size);
        if (!mem) {
            break;
        }

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

        old = *mem;

595 596 597 598
        if (mem->flags & KVM_MEM_LOG_DIRTY_PAGES) {
            kvm_physical_sync_dirty_bitmap(section);
        }

599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616
        /* 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 已提交
617
            old.start_addr == start_addr && old.memory_size < size && add) {
618 619 620
            mem = kvm_alloc_slot(s);
            mem->memory_size = old.memory_size;
            mem->start_addr = old.start_addr;
621
            mem->ram = old.ram;
622
            mem->flags = kvm_mem_flags(s, log_dirty);
623 624 625 626 627 628 629 630 631

            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;
632
            ram += old.memory_size;
633 634 635 636 637 638 639 640 641
            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;
642
            mem->ram = old.ram;
643
            mem->flags =  kvm_mem_flags(s, log_dirty);
644 645 646 647 648

            err = kvm_set_user_memory_region(s, mem);
            if (err) {
                fprintf(stderr, "%s: error registering prefix slot: %s\n",
                        __func__, strerror(-err));
649 650 651 652 653
#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
654 655 656 657 658 659 660 661 662 663 664 665
                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;
666
            mem->ram = old.ram + size_delta;
667
            mem->flags = kvm_mem_flags(s, log_dirty);
668 669 670 671 672 673 674 675 676 677 678

            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 已提交
679
    if (!size) {
680
        return;
J
Jan Kiszka 已提交
681
    }
A
Avi Kivity 已提交
682
    if (!add) {
683
        return;
J
Jan Kiszka 已提交
684
    }
685 686 687
    mem = kvm_alloc_slot(s);
    mem->memory_size = size;
    mem->start_addr = start_addr;
688
    mem->ram = ram;
689
    mem->flags = kvm_mem_flags(s, log_dirty);
690 691 692 693 694 695 696 697 698

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

699 700 701 702 703 704 705 706
static void kvm_begin(MemoryListener *listener)
{
}

static void kvm_commit(MemoryListener *listener)
{
}

A
Avi Kivity 已提交
707 708 709 710 711 712 713 714 715 716 717 718
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);
}

719 720 721 722 723
static void kvm_region_nop(MemoryListener *listener,
                           MemoryRegionSection *section)
{
}

A
Avi Kivity 已提交
724 725
static void kvm_log_sync(MemoryListener *listener,
                         MemoryRegionSection *section)
726
{
A
Avi Kivity 已提交
727 728
    int r;

729
    r = kvm_physical_sync_dirty_bitmap(section);
A
Avi Kivity 已提交
730 731 732
    if (r < 0) {
        abort();
    }
733 734
}

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

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

A
Avi Kivity 已提交
743
static void kvm_log_global_stop(struct MemoryListener *listener)
744
{
A
Avi Kivity 已提交
745 746 747 748
    int r;

    r = kvm_set_migration_log(0);
    assert(r >= 0);
749 750
}

751 752 753 754 755
static void kvm_mem_ioeventfd_add(MemoryRegionSection *section,
                                  bool match_data, uint64_t data, int fd)
{
    int r;

756
    assert(match_data && section->size <= 8);
757

758 759
    r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
                               data, true, section->size);
760 761 762 763 764 765 766 767 768 769
    if (r < 0) {
        abort();
    }
}

static void kvm_mem_ioeventfd_del(MemoryRegionSection *section,
                                  bool match_data, uint64_t data, int fd)
{
    int r;

770 771
    r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
                               data, false, section->size);
772 773 774 775 776 777 778 779 780 781 782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825
    if (r < 0) {
        abort();
    }
}

static void kvm_io_ioeventfd_add(MemoryRegionSection *section,
                                 bool match_data, uint64_t data, int fd)
{
    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();
    }
}

static void kvm_io_ioeventfd_del(MemoryRegionSection *section,
                                 bool match_data, uint64_t data, int fd)

{
    int r;

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

static void kvm_eventfd_add(MemoryListener *listener,
                            MemoryRegionSection *section,
                            bool match_data, uint64_t data, int fd)
{
    if (section->address_space == get_system_memory()) {
        kvm_mem_ioeventfd_add(section, match_data, data, fd);
    } else {
        kvm_io_ioeventfd_add(section, match_data, data, fd);
    }
}

static void kvm_eventfd_del(MemoryListener *listener,
                            MemoryRegionSection *section,
                            bool match_data, uint64_t data, int fd)
{
    if (section->address_space == get_system_memory()) {
        kvm_mem_ioeventfd_del(section, match_data, data, fd);
    } else {
        kvm_io_ioeventfd_del(section, match_data, data, fd);
    }
}

A
Avi Kivity 已提交
826
static MemoryListener kvm_memory_listener = {
827 828
    .begin = kvm_begin,
    .commit = kvm_commit,
A
Avi Kivity 已提交
829 830
    .region_add = kvm_region_add,
    .region_del = kvm_region_del,
831
    .region_nop = kvm_region_nop,
832 833
    .log_start = kvm_log_start,
    .log_stop = kvm_log_stop,
A
Avi Kivity 已提交
834 835 836
    .log_sync = kvm_log_sync,
    .log_global_start = kvm_log_global_start,
    .log_global_stop = kvm_log_global_stop,
837 838
    .eventfd_add = kvm_eventfd_add,
    .eventfd_del = kvm_eventfd_del,
839
    .priority = 10,
840 841
};

842
static void kvm_handle_interrupt(CPUArchState *env, int mask)
843 844 845 846 847 848 849 850
{
    env->interrupt_request |= mask;

    if (!qemu_cpu_is_self(env)) {
        qemu_cpu_kick(env);
    }
}

851 852 853 854 855
int kvm_irqchip_set_irq(KVMState *s, int irq, int level)
{
    struct kvm_irq_level event;
    int ret;

856
    assert(kvm_irqchip_in_kernel());
857 858 859 860 861 862 863 864 865 866 867 868 869 870 871 872 873 874

    event.level = level;
    event.irq = irq;
    ret = kvm_vm_ioctl(s, s->irqchip_inject_ioctl, &event);
    if (ret < 0) {
        perror("kvm_set_irqchip_line");
        abort();
    }

    return (s->irqchip_inject_ioctl == KVM_IRQ_LINE) ? 1 : event.status;
}

#ifdef KVM_CAP_IRQ_ROUTING
static void set_gsi(KVMState *s, unsigned int gsi)
{
    s->used_gsi_bitmap[gsi / 32] |= 1U << (gsi % 32);
}

875 876 877 878 879
static void clear_gsi(KVMState *s, unsigned int gsi)
{
    s->used_gsi_bitmap[gsi / 32] &= ~(1U << (gsi % 32));
}

880 881
static void kvm_init_irq_routing(KVMState *s)
{
882
    int gsi_count, i;
883 884 885 886 887 888

    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 */
889
        gsi_bits = ALIGN(gsi_count, 32);
890
        s->used_gsi_bitmap = g_malloc0(gsi_bits / 8);
891
        s->gsi_count = gsi_count;
892 893 894 895 896 897 898 899 900 901

        /* 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;

902 903 904 905
    if (!s->direct_msi) {
        for (i = 0; i < KVM_MSI_HASHTAB_SIZE; i++) {
            QTAILQ_INIT(&s->msi_hashtab[i]);
        }
906 907
    }

908 909 910 911 912 913 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 939 940 941
    kvm_arch_init_irq_routing(s);
}

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);
}

void kvm_irqchip_add_route(KVMState *s, int irq, int irqchip, int pin)
{
    struct kvm_irq_routing_entry e;

942 943
    assert(pin < s->gsi_count);

944 945 946 947 948 949 950 951 952 953 954 955 956 957
    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);
}

int kvm_irqchip_commit_routes(KVMState *s)
{
    s->irq_routes->flags = 0;
    return kvm_vm_ioctl(s, KVM_SET_GSI_ROUTING, s->irq_routes);
}

958 959 960 961 962 963 964 965 966 967 968 969 970 971 972 973 974 975 976 977 978 979 980 981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010
static void kvm_irqchip_release_virq(KVMState *s, int virq)
{
    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);
}

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;
    }
1011
    if (!s->direct_msi && retry) {
1012 1013 1014 1015 1016 1017 1018 1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036
        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)
{
1037
    struct kvm_msi msi;
1038 1039
    KVMMSIRoute *route;

1040 1041 1042 1043 1044 1045 1046 1047 1048 1049
    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);
    }

1050 1051 1052 1053 1054 1055 1056 1057 1058 1059 1060 1061 1062 1063 1064 1065 1066 1067 1068 1069 1070 1071 1072 1073 1074 1075 1076 1077 1078 1079 1080 1081 1082
    route = kvm_lookup_msi_route(s, msg);
    if (!route) {
        int virq, ret;

        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);

        ret = kvm_irqchip_commit_routes(s);
        if (ret < 0) {
            return ret;
        }
    }

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

    return kvm_irqchip_set_irq(s, route->kroute.gsi, 1);
}

1083 1084 1085 1086 1087
#else /* !KVM_CAP_IRQ_ROUTING */

static void kvm_init_irq_routing(KVMState *s)
{
}
1088 1089 1090 1091 1092

int kvm_irqchip_send_msi(KVMState *s, MSIMessage msg)
{
    abort();
}
1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109 1110 1111 1112 1113 1114 1115 1116
#endif /* !KVM_CAP_IRQ_ROUTING */

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),
                           "kernel_irqchip", false) ||
        !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;
    }

    s->irqchip_inject_ioctl = KVM_IRQ_LINE;
    if (kvm_check_extension(s, KVM_CAP_IRQ_INJECT_STATUS)) {
        s->irqchip_inject_ioctl = KVM_IRQ_LINE_STATUS;
    }
1117
    kvm_kernel_irqchip = true;
1118 1119 1120 1121 1122 1123

    kvm_init_irq_routing(s);

    return 0;
}

1124
int kvm_init(void)
A
aliguori 已提交
1125
{
1126 1127 1128
    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 已提交
1129
    KVMState *s;
1130
    const KVMCapabilityInfo *missing_cap;
A
aliguori 已提交
1131 1132 1133
    int ret;
    int i;

1134
    s = g_malloc0(sizeof(KVMState));
A
aliguori 已提交
1135

1136 1137 1138 1139 1140 1141 1142 1143
    /*
     * 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());

1144
#ifdef KVM_CAP_SET_GUEST_DEBUG
B
Blue Swirl 已提交
1145
    QTAILQ_INIT(&s->kvm_sw_breakpoints);
1146
#endif
J
Jan Kiszka 已提交
1147
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
A
aliguori 已提交
1148
        s->slots[i].slot = i;
J
Jan Kiszka 已提交
1149
    }
A
aliguori 已提交
1150
    s->vmfd = -1;
K
Kevin Wolf 已提交
1151
    s->fd = qemu_open("/dev/kvm", O_RDWR);
A
aliguori 已提交
1152 1153 1154 1155 1156 1157 1158 1159
    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 已提交
1160
        if (ret > 0) {
A
aliguori 已提交
1161
            ret = -EINVAL;
J
Jan Kiszka 已提交
1162
        }
A
aliguori 已提交
1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173
        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;
    }

    s->vmfd = kvm_ioctl(s, KVM_CREATE_VM, 0);
1174 1175 1176 1177 1178
    if (s->vmfd < 0) {
#ifdef TARGET_S390X
        fprintf(stderr, "Please add the 'switch_amode' kernel parameter to "
                        "your host kernel command line\n");
#endif
1179
        ret = s->vmfd;
A
aliguori 已提交
1180
        goto err;
1181
    }
A
aliguori 已提交
1182

1183 1184 1185 1186
    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 已提交
1187
    }
1188
    if (missing_cap) {
1189
        ret = -EINVAL;
1190 1191
        fprintf(stderr, "kvm does not support %s\n%s",
                missing_cap->name, upgrade_note);
1192 1193 1194
        goto err;
    }

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

1197
    s->broken_set_mem_region = 1;
1198
    ret = kvm_check_extension(s, KVM_CAP_JOIN_MEMORY_REGIONS_WORKS);
1199 1200 1201 1202
    if (ret > 0) {
        s->broken_set_mem_region = 0;
    }

1203 1204 1205 1206
#ifdef KVM_CAP_VCPU_EVENTS
    s->vcpu_events = kvm_check_extension(s, KVM_CAP_VCPU_EVENTS);
#endif

1207 1208 1209
    s->robust_singlestep =
        kvm_check_extension(s, KVM_CAP_X86_ROBUST_SINGLESTEP);

1210 1211 1212 1213
#ifdef KVM_CAP_DEBUGREGS
    s->debugregs = kvm_check_extension(s, KVM_CAP_DEBUGREGS);
#endif

1214 1215 1216 1217 1218 1219 1220 1221
#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 已提交
1222 1223 1224 1225
#ifdef KVM_CAP_PIT_STATE2
    s->pit_state2 = kvm_check_extension(s, KVM_CAP_PIT_STATE2);
#endif

1226 1227
    s->direct_msi = (kvm_check_extension(s, KVM_CAP_SIGNAL_MSI) > 0);

1228
    ret = kvm_arch_init(s);
J
Jan Kiszka 已提交
1229
    if (ret < 0) {
A
aliguori 已提交
1230
        goto err;
J
Jan Kiszka 已提交
1231
    }
A
aliguori 已提交
1232

1233 1234 1235 1236 1237
    ret = kvm_irqchip_create(s);
    if (ret < 0) {
        goto err;
    }

A
aliguori 已提交
1238
    kvm_state = s;
1239
    memory_listener_register(&kvm_memory_listener, NULL);
A
aliguori 已提交
1240

1241 1242
    s->many_ioeventfds = kvm_check_many_ioeventfds();

1243 1244
    cpu_interrupt_handler = kvm_handle_interrupt;

A
aliguori 已提交
1245 1246 1247 1248
    return 0;

err:
    if (s) {
1249
        if (s->vmfd >= 0) {
A
aliguori 已提交
1250
            close(s->vmfd);
J
Jan Kiszka 已提交
1251 1252
        }
        if (s->fd != -1) {
A
aliguori 已提交
1253
            close(s->fd);
J
Jan Kiszka 已提交
1254
        }
A
aliguori 已提交
1255
    }
1256
    g_free(s);
A
aliguori 已提交
1257 1258 1259 1260

    return ret;
}

1261 1262
static void kvm_handle_io(uint16_t port, void *data, int direction, int size,
                          uint32_t count)
A
aliguori 已提交
1263 1264 1265 1266 1267 1268 1269 1270
{
    int i;
    uint8_t *ptr = data;

    for (i = 0; i < count; i++) {
        if (direction == KVM_EXIT_IO_IN) {
            switch (size) {
            case 1:
1271
                stb_p(ptr, cpu_inb(port));
A
aliguori 已提交
1272 1273
                break;
            case 2:
1274
                stw_p(ptr, cpu_inw(port));
A
aliguori 已提交
1275 1276
                break;
            case 4:
1277
                stl_p(ptr, cpu_inl(port));
A
aliguori 已提交
1278 1279 1280 1281 1282
                break;
            }
        } else {
            switch (size) {
            case 1:
1283
                cpu_outb(port, ldub_p(ptr));
A
aliguori 已提交
1284 1285
                break;
            case 2:
1286
                cpu_outw(port, lduw_p(ptr));
A
aliguori 已提交
1287 1288
                break;
            case 4:
1289
                cpu_outl(port, ldl_p(ptr));
A
aliguori 已提交
1290 1291 1292 1293 1294 1295 1296 1297
                break;
            }
        }

        ptr += size;
    }
}

1298
static int kvm_handle_internal_error(CPUArchState *env, struct kvm_run *run)
M
Marcelo Tosatti 已提交
1299
{
1300
    fprintf(stderr, "KVM internal error.");
M
Marcelo Tosatti 已提交
1301 1302 1303
    if (kvm_check_extension(kvm_state, KVM_CAP_INTERNAL_ERROR_DATA)) {
        int i;

1304
        fprintf(stderr, " Suberror: %d\n", run->internal.suberror);
M
Marcelo Tosatti 已提交
1305 1306 1307 1308
        for (i = 0; i < run->internal.ndata; ++i) {
            fprintf(stderr, "extra data[%d]: %"PRIx64"\n",
                    i, (uint64_t)run->internal.data[i]);
        }
1309 1310
    } else {
        fprintf(stderr, "\n");
M
Marcelo Tosatti 已提交
1311 1312 1313
    }
    if (run->internal.suberror == KVM_INTERNAL_ERROR_EMULATION) {
        fprintf(stderr, "emulation failure\n");
J
Jan Kiszka 已提交
1314
        if (!kvm_arch_stop_on_emulation_error(env)) {
1315
            cpu_dump_state(env, stderr, fprintf, CPU_DUMP_CODE);
1316
            return EXCP_INTERRUPT;
J
Jan Kiszka 已提交
1317
        }
M
Marcelo Tosatti 已提交
1318 1319 1320 1321
    }
    /* FIXME: Should trigger a qmp message to let management know
     * something went wrong.
     */
J
Jan Kiszka 已提交
1322
    return -1;
M
Marcelo Tosatti 已提交
1323 1324
}

1325
void kvm_flush_coalesced_mmio_buffer(void)
A
aliguori 已提交
1326 1327
{
    KVMState *s = kvm_state;
1328 1329 1330 1331 1332 1333 1334

    if (s->coalesced_flush_in_progress) {
        return;
    }

    s->coalesced_flush_in_progress = true;

1335 1336
    if (s->coalesced_mmio_ring) {
        struct kvm_coalesced_mmio_ring *ring = s->coalesced_mmio_ring;
A
aliguori 已提交
1337 1338 1339 1340 1341 1342
        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);
1343
            smp_wmb();
A
aliguori 已提交
1344 1345 1346
            ring->first = (ring->first + 1) % KVM_COALESCED_MMIO_MAX;
        }
    }
1347 1348

    s->coalesced_flush_in_progress = false;
A
aliguori 已提交
1349 1350
}

1351
static void do_kvm_cpu_synchronize_state(void *_env)
1352
{
1353
    CPUArchState *env = _env;
1354

J
Jan Kiszka 已提交
1355
    if (!env->kvm_vcpu_dirty) {
1356
        kvm_arch_get_registers(env);
J
Jan Kiszka 已提交
1357
        env->kvm_vcpu_dirty = 1;
1358 1359 1360
    }
}

1361
void kvm_cpu_synchronize_state(CPUArchState *env)
1362
{
J
Jan Kiszka 已提交
1363
    if (!env->kvm_vcpu_dirty) {
1364
        run_on_cpu(env, do_kvm_cpu_synchronize_state, env);
J
Jan Kiszka 已提交
1365
    }
1366 1367
}

1368
void kvm_cpu_synchronize_post_reset(CPUArchState *env)
1369 1370 1371 1372 1373
{
    kvm_arch_put_registers(env, KVM_PUT_RESET_STATE);
    env->kvm_vcpu_dirty = 0;
}

1374
void kvm_cpu_synchronize_post_init(CPUArchState *env)
1375 1376 1377 1378 1379
{
    kvm_arch_put_registers(env, KVM_PUT_FULL_STATE);
    env->kvm_vcpu_dirty = 0;
}

1380
int kvm_cpu_exec(CPUArchState *env)
A
aliguori 已提交
1381 1382
{
    struct kvm_run *run = env->kvm_run;
1383
    int ret, run_ret;
A
aliguori 已提交
1384

1385
    DPRINTF("kvm_cpu_exec()\n");
A
aliguori 已提交
1386

1387
    if (kvm_arch_process_async_events(env)) {
1388
        env->exit_request = 0;
1389
        return EXCP_HLT;
1390
    }
M
Marcelo Tosatti 已提交
1391

1392
    do {
J
Jan Kiszka 已提交
1393
        if (env->kvm_vcpu_dirty) {
1394
            kvm_arch_put_registers(env, KVM_PUT_RUNTIME_STATE);
J
Jan Kiszka 已提交
1395
            env->kvm_vcpu_dirty = 0;
1396 1397
        }

1398
        kvm_arch_pre_run(env, run);
1399 1400 1401 1402 1403 1404 1405 1406 1407
        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();
        }
1408
        qemu_mutex_unlock_iothread();
1409

1410
        run_ret = kvm_vcpu_ioctl(env, KVM_RUN, 0);
1411

1412
        qemu_mutex_lock_iothread();
A
aliguori 已提交
1413 1414
        kvm_arch_post_run(env, run);

1415 1416
        kvm_flush_coalesced_mmio_buffer();

1417
        if (run_ret < 0) {
1418 1419
            if (run_ret == -EINTR || run_ret == -EAGAIN) {
                DPRINTF("io window exit\n");
1420
                ret = EXCP_INTERRUPT;
1421 1422
                break;
            }
1423 1424
            fprintf(stderr, "error: kvm run failed %s\n",
                    strerror(-run_ret));
A
aliguori 已提交
1425 1426 1427 1428 1429
            abort();
        }

        switch (run->exit_reason) {
        case KVM_EXIT_IO:
1430
            DPRINTF("handle_io\n");
1431 1432 1433 1434 1435
            kvm_handle_io(run->io.port,
                          (uint8_t *)run + run->io.data_offset,
                          run->io.direction,
                          run->io.size,
                          run->io.count);
1436
            ret = 0;
A
aliguori 已提交
1437 1438
            break;
        case KVM_EXIT_MMIO:
1439
            DPRINTF("handle_mmio\n");
A
aliguori 已提交
1440 1441 1442 1443
            cpu_physical_memory_rw(run->mmio.phys_addr,
                                   run->mmio.data,
                                   run->mmio.len,
                                   run->mmio.is_write);
1444
            ret = 0;
A
aliguori 已提交
1445 1446
            break;
        case KVM_EXIT_IRQ_WINDOW_OPEN:
1447
            DPRINTF("irq_window_open\n");
1448
            ret = EXCP_INTERRUPT;
A
aliguori 已提交
1449 1450
            break;
        case KVM_EXIT_SHUTDOWN:
1451
            DPRINTF("shutdown\n");
A
aliguori 已提交
1452
            qemu_system_reset_request();
1453
            ret = EXCP_INTERRUPT;
A
aliguori 已提交
1454 1455
            break;
        case KVM_EXIT_UNKNOWN:
1456 1457
            fprintf(stderr, "KVM: unknown exit, hardware reason %" PRIx64 "\n",
                    (uint64_t)run->hw.hardware_exit_reason);
J
Jan Kiszka 已提交
1458
            ret = -1;
A
aliguori 已提交
1459
            break;
M
Marcelo Tosatti 已提交
1460
        case KVM_EXIT_INTERNAL_ERROR:
J
Jan Kiszka 已提交
1461
            ret = kvm_handle_internal_error(env, run);
M
Marcelo Tosatti 已提交
1462
            break;
A
aliguori 已提交
1463
        default:
1464
            DPRINTF("kvm_arch_handle_exit\n");
A
aliguori 已提交
1465 1466 1467
            ret = kvm_arch_handle_exit(env, run);
            break;
        }
1468
    } while (ret == 0);
A
aliguori 已提交
1469

J
Jan Kiszka 已提交
1470
    if (ret < 0) {
1471
        cpu_dump_state(env, stderr, fprintf, CPU_DUMP_CODE);
1472
        vm_stop(RUN_STATE_INTERNAL_ERROR);
A
aliguori 已提交
1473 1474
    }

1475
    env->exit_request = 0;
A
aliguori 已提交
1476 1477 1478
    return ret;
}

1479
int kvm_ioctl(KVMState *s, int type, ...)
A
aliguori 已提交
1480 1481
{
    int ret;
1482 1483
    void *arg;
    va_list ap;
A
aliguori 已提交
1484

1485 1486 1487 1488 1489
    va_start(ap, type);
    arg = va_arg(ap, void *);
    va_end(ap);

    ret = ioctl(s->fd, type, arg);
J
Jan Kiszka 已提交
1490
    if (ret == -1) {
A
aliguori 已提交
1491
        ret = -errno;
J
Jan Kiszka 已提交
1492
    }
A
aliguori 已提交
1493 1494 1495
    return ret;
}

1496
int kvm_vm_ioctl(KVMState *s, int type, ...)
A
aliguori 已提交
1497 1498
{
    int ret;
1499 1500 1501 1502 1503 1504
    void *arg;
    va_list ap;

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

1506
    ret = ioctl(s->vmfd, type, arg);
J
Jan Kiszka 已提交
1507
    if (ret == -1) {
A
aliguori 已提交
1508
        ret = -errno;
J
Jan Kiszka 已提交
1509
    }
A
aliguori 已提交
1510 1511 1512
    return ret;
}

1513
int kvm_vcpu_ioctl(CPUArchState *env, int type, ...)
A
aliguori 已提交
1514 1515
{
    int ret;
1516 1517 1518 1519 1520 1521
    void *arg;
    va_list ap;

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

1523
    ret = ioctl(env->kvm_fd, type, arg);
J
Jan Kiszka 已提交
1524
    if (ret == -1) {
A
aliguori 已提交
1525
        ret = -errno;
J
Jan Kiszka 已提交
1526
    }
A
aliguori 已提交
1527 1528
    return ret;
}
A
aliguori 已提交
1529 1530 1531

int kvm_has_sync_mmu(void)
{
1532
    return kvm_check_extension(kvm_state, KVM_CAP_SYNC_MMU);
A
aliguori 已提交
1533
}
1534

1535 1536 1537 1538 1539
int kvm_has_vcpu_events(void)
{
    return kvm_state->vcpu_events;
}

1540 1541 1542 1543 1544
int kvm_has_robust_singlestep(void)
{
    return kvm_state->robust_singlestep;
}

1545 1546 1547 1548 1549
int kvm_has_debugregs(void)
{
    return kvm_state->debugregs;
}

1550 1551 1552 1553 1554 1555 1556 1557 1558 1559
int kvm_has_xsave(void)
{
    return kvm_state->xsave;
}

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

J
Jan Kiszka 已提交
1560 1561 1562 1563 1564
int kvm_has_pit_state2(void)
{
    return kvm_state->pit_state2;
}

1565 1566 1567 1568 1569 1570 1571 1572
int kvm_has_many_ioeventfds(void)
{
    if (!kvm_enabled()) {
        return 0;
    }
    return kvm_state->many_ioeventfds;
}

1573 1574
int kvm_has_gsi_routing(void)
{
A
Alexander Graf 已提交
1575
#ifdef KVM_CAP_IRQ_ROUTING
1576
    return kvm_check_extension(kvm_state, KVM_CAP_IRQ_ROUTING);
A
Alexander Graf 已提交
1577 1578 1579
#else
    return false;
#endif
1580 1581
}

1582 1583
int kvm_allows_irq0_override(void)
{
1584
    return !kvm_irqchip_in_kernel() || kvm_has_gsi_routing();
1585 1586
}

1587 1588 1589
void kvm_setup_guest_memory(void *start, size_t size)
{
    if (!kvm_has_sync_mmu()) {
A
Andreas Färber 已提交
1590
        int ret = qemu_madvise(start, size, QEMU_MADV_DONTFORK);
1591 1592

        if (ret) {
A
Andreas Färber 已提交
1593 1594 1595
            perror("qemu_madvise");
            fprintf(stderr,
                    "Need MADV_DONTFORK in absence of synchronous KVM MMU\n");
1596 1597 1598 1599 1600
            exit(1);
        }
    }
}

1601
#ifdef KVM_CAP_SET_GUEST_DEBUG
1602
struct kvm_sw_breakpoint *kvm_find_sw_breakpoint(CPUArchState *env,
1603 1604 1605 1606
                                                 target_ulong pc)
{
    struct kvm_sw_breakpoint *bp;

B
Blue Swirl 已提交
1607
    QTAILQ_FOREACH(bp, &env->kvm_state->kvm_sw_breakpoints, entry) {
J
Jan Kiszka 已提交
1608
        if (bp->pc == pc) {
1609
            return bp;
J
Jan Kiszka 已提交
1610
        }
1611 1612 1613 1614
    }
    return NULL;
}

1615
int kvm_sw_breakpoints_active(CPUArchState *env)
1616
{
B
Blue Swirl 已提交
1617
    return !QTAILQ_EMPTY(&env->kvm_state->kvm_sw_breakpoints);
1618 1619
}

G
Glauber Costa 已提交
1620 1621
struct kvm_set_guest_debug_data {
    struct kvm_guest_debug dbg;
1622
    CPUArchState *env;
G
Glauber Costa 已提交
1623 1624 1625 1626 1627 1628
    int err;
};

static void kvm_invoke_set_guest_debug(void *data)
{
    struct kvm_set_guest_debug_data *dbg_data = data;
1629
    CPUArchState *env = dbg_data->env;
J
Jan Kiszka 已提交
1630 1631

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

1634
int kvm_update_guest_debug(CPUArchState *env, unsigned long reinject_trap)
1635
{
G
Glauber Costa 已提交
1636
    struct kvm_set_guest_debug_data data;
1637

1638
    data.dbg.control = reinject_trap;
1639

1640 1641 1642
    if (env->singlestep_enabled) {
        data.dbg.control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP;
    }
G
Glauber Costa 已提交
1643 1644
    kvm_arch_update_guest_debug(env, &data.dbg);
    data.env = env;
1645

1646
    run_on_cpu(env, kvm_invoke_set_guest_debug, &data);
G
Glauber Costa 已提交
1647
    return data.err;
1648 1649
}

1650
int kvm_insert_breakpoint(CPUArchState *current_env, target_ulong addr,
1651 1652 1653
                          target_ulong len, int type)
{
    struct kvm_sw_breakpoint *bp;
1654
    CPUArchState *env;
1655 1656 1657 1658 1659 1660 1661 1662 1663
    int err;

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

1664
        bp = g_malloc(sizeof(struct kvm_sw_breakpoint));
J
Jan Kiszka 已提交
1665
        if (!bp) {
1666
            return -ENOMEM;
J
Jan Kiszka 已提交
1667
        }
1668 1669 1670 1671 1672

        bp->pc = addr;
        bp->use_count = 1;
        err = kvm_arch_insert_sw_breakpoint(current_env, bp);
        if (err) {
1673
            g_free(bp);
1674 1675 1676
            return err;
        }

B
Blue Swirl 已提交
1677
        QTAILQ_INSERT_HEAD(&current_env->kvm_state->kvm_sw_breakpoints,
1678 1679 1680
                          bp, entry);
    } else {
        err = kvm_arch_insert_hw_breakpoint(addr, len, type);
J
Jan Kiszka 已提交
1681
        if (err) {
1682
            return err;
J
Jan Kiszka 已提交
1683
        }
1684 1685 1686 1687
    }

    for (env = first_cpu; env != NULL; env = env->next_cpu) {
        err = kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
1688
        if (err) {
1689
            return err;
J
Jan Kiszka 已提交
1690
        }
1691 1692 1693 1694
    }
    return 0;
}

1695
int kvm_remove_breakpoint(CPUArchState *current_env, target_ulong addr,
1696 1697 1698
                          target_ulong len, int type)
{
    struct kvm_sw_breakpoint *bp;
1699
    CPUArchState *env;
1700 1701 1702 1703
    int err;

    if (type == GDB_BREAKPOINT_SW) {
        bp = kvm_find_sw_breakpoint(current_env, addr);
J
Jan Kiszka 已提交
1704
        if (!bp) {
1705
            return -ENOENT;
J
Jan Kiszka 已提交
1706
        }
1707 1708 1709 1710 1711 1712 1713

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

        err = kvm_arch_remove_sw_breakpoint(current_env, bp);
J
Jan Kiszka 已提交
1714
        if (err) {
1715
            return err;
J
Jan Kiszka 已提交
1716
        }
1717

B
Blue Swirl 已提交
1718
        QTAILQ_REMOVE(&current_env->kvm_state->kvm_sw_breakpoints, bp, entry);
1719
        g_free(bp);
1720 1721
    } else {
        err = kvm_arch_remove_hw_breakpoint(addr, len, type);
J
Jan Kiszka 已提交
1722
        if (err) {
1723
            return err;
J
Jan Kiszka 已提交
1724
        }
1725 1726 1727 1728
    }

    for (env = first_cpu; env != NULL; env = env->next_cpu) {
        err = kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
1729
        if (err) {
1730
            return err;
J
Jan Kiszka 已提交
1731
        }
1732 1733 1734 1735
    }
    return 0;
}

1736
void kvm_remove_all_breakpoints(CPUArchState *current_env)
1737 1738 1739
{
    struct kvm_sw_breakpoint *bp, *next;
    KVMState *s = current_env->kvm_state;
1740
    CPUArchState *env;
1741

B
Blue Swirl 已提交
1742
    QTAILQ_FOREACH_SAFE(bp, &s->kvm_sw_breakpoints, entry, next) {
1743 1744 1745
        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 已提交
1746
                if (kvm_arch_remove_sw_breakpoint(env, bp) == 0) {
1747
                    break;
J
Jan Kiszka 已提交
1748
                }
1749 1750 1751 1752 1753
            }
        }
    }
    kvm_arch_remove_all_hw_breakpoints();

J
Jan Kiszka 已提交
1754
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
1755
        kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
1756
    }
1757 1758 1759 1760
}

#else /* !KVM_CAP_SET_GUEST_DEBUG */

1761
int kvm_update_guest_debug(CPUArchState *env, unsigned long reinject_trap)
1762 1763 1764 1765
{
    return -EINVAL;
}

1766
int kvm_insert_breakpoint(CPUArchState *current_env, target_ulong addr,
1767 1768 1769 1770 1771
                          target_ulong len, int type)
{
    return -EINVAL;
}

1772
int kvm_remove_breakpoint(CPUArchState *current_env, target_ulong addr,
1773 1774 1775 1776 1777
                          target_ulong len, int type)
{
    return -EINVAL;
}

1778
void kvm_remove_all_breakpoints(CPUArchState *current_env)
1779 1780 1781
{
}
#endif /* !KVM_CAP_SET_GUEST_DEBUG */
1782

1783
int kvm_set_signal_mask(CPUArchState *env, const sigset_t *sigset)
1784 1785 1786 1787
{
    struct kvm_signal_mask *sigmask;
    int r;

J
Jan Kiszka 已提交
1788
    if (!sigset) {
1789
        return kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, NULL);
J
Jan Kiszka 已提交
1790
    }
1791

1792
    sigmask = g_malloc(sizeof(*sigmask) + sizeof(*sigset));
1793 1794 1795 1796

    sigmask->len = 8;
    memcpy(sigmask->sigset, sigset, sizeof(*sigset));
    r = kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, sigmask);
1797
    g_free(sigmask);
1798 1799 1800

    return r;
}
1801

1802 1803
int kvm_set_ioeventfd_mmio(int fd, uint32_t addr, uint32_t val, bool assign,
                           uint32_t size)
1804 1805 1806 1807 1808 1809
{
    int ret;
    struct kvm_ioeventfd iofd;

    iofd.datamatch = val;
    iofd.addr = addr;
1810
    iofd.len = size;
1811 1812 1813 1814 1815 1816 1817 1818 1819 1820 1821 1822 1823 1824 1825 1826 1827 1828 1829 1830
    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;
}

1831 1832 1833 1834 1835 1836 1837 1838 1839 1840
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 已提交
1841
    if (!kvm_enabled()) {
1842
        return -ENOSYS;
J
Jan Kiszka 已提交
1843 1844
    }
    if (!assign) {
1845
        kick.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
J
Jan Kiszka 已提交
1846
    }
1847
    r = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &kick);
J
Jan Kiszka 已提交
1848
    if (r < 0) {
1849
        return r;
J
Jan Kiszka 已提交
1850
    }
1851
    return 0;
1852
}
1853

1854
int kvm_on_sigbus_vcpu(CPUArchState *env, int code, void *addr)
1855 1856 1857 1858 1859 1860 1861 1862
{
    return kvm_arch_on_sigbus_vcpu(env, code, addr);
}

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