kvm-all.c 52.4 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 25 26
#include "qemu/atomic.h"
#include "qemu/option.h"
#include "qemu/config-file.h"
27
#include "sysemu/sysemu.h"
J
Jan Kiszka 已提交
28
#include "hw/hw.h"
29
#include "hw/pci/msi.h"
30
#include "exec/gdbstub.h"
31
#include "sysemu/kvm.h"
32
#include "qemu/bswap.h"
33 34
#include "exec/memory.h"
#include "exec/address-spaces.h"
35
#include "qemu/event_notifier.h"
36
#include "trace.h"
A
aliguori 已提交
37

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

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

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

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

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

60 61
#define KVM_MSI_HASHTAB_SIZE    256

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

71 72
typedef struct kvm_dirty_log KVMDirtyLog;

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

107
KVMState *kvm_state;
108
bool kvm_kernel_irqchip;
109
bool kvm_async_interrupts_allowed;
110
bool kvm_irqfds_allowed;
111
bool kvm_msi_via_irqfd_allowed;
112
bool kvm_gsi_routing_allowed;
113
bool kvm_allowed;
114
bool kvm_readonly_mem_allowed;
A
aliguori 已提交
115

116 117 118 119 120 121
static const KVMCapabilityInfo kvm_required_capabilites[] = {
    KVM_CAP_INFO(USER_MEMORY),
    KVM_CAP_INFO(DESTROY_MEMORY_REGION_WORKS),
    KVM_CAP_LAST_INFO
};

A
aliguori 已提交
122 123 124 125 126
static KVMSlot *kvm_alloc_slot(KVMState *s)
{
    int i;

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

132 133 134 135 136
    fprintf(stderr, "%s: no free slot available\n", __func__);
    abort();
}

static KVMSlot *kvm_lookup_matching_slot(KVMState *s,
A
Avi Kivity 已提交
137 138
                                         hwaddr start_addr,
                                         hwaddr end_addr)
139 140 141 142 143 144 145 146 147 148 149 150
{
    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 已提交
151 152 153
    return NULL;
}

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

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

167 168 169 170 171 172 173 174 175
        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 已提交
176 177
    }

178
    return found;
A
aliguori 已提交
179 180
}

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

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

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

    return 0;
}

198 199 200 201 202 203
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;
204
    mem.userspace_addr = (unsigned long)slot->ram;
205
    mem.flags = slot->flags;
206 207 208
    if (s->migration_log) {
        mem.flags |= KVM_MEM_LOG_DIRTY_PAGES;
    }
209 210 211 212 213 214 215
    if (mem.flags & KVM_MEM_READONLY) {
        /* Set the slot size to 0 before setting the slot to the desired
         * value. This is needed based on KVM commit 75d61fbc. */
        mem.memory_size = 0;
        kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
    }
    mem.memory_size = slot->memory_size;
216 217 218
    return kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
}

J
Jan Kiszka 已提交
219 220
static void kvm_reset_vcpu(void *opaque)
{
A
Andreas Färber 已提交
221
    CPUState *cpu = opaque;
J
Jan Kiszka 已提交
222

A
Andreas Färber 已提交
223
    kvm_arch_reset_vcpu(cpu);
J
Jan Kiszka 已提交
224
}
225

226
int kvm_init_vcpu(CPUState *cpu)
A
aliguori 已提交
227 228 229 230 231
{
    KVMState *s = kvm_state;
    long mmap_size;
    int ret;

232
    DPRINTF("kvm_init_vcpu\n");
A
aliguori 已提交
233

234
    ret = kvm_vm_ioctl(s, KVM_CREATE_VCPU, (void *)kvm_arch_vcpu_id(cpu));
A
aliguori 已提交
235
    if (ret < 0) {
236
        DPRINTF("kvm_create_vcpu failed\n");
A
aliguori 已提交
237 238 239
        goto err;
    }

A
Andreas Färber 已提交
240
    cpu->kvm_fd = ret;
241
    cpu->kvm_state = s;
A
Andreas Färber 已提交
242
    cpu->kvm_vcpu_dirty = true;
A
aliguori 已提交
243 244 245

    mmap_size = kvm_ioctl(s, KVM_GET_VCPU_MMAP_SIZE, 0);
    if (mmap_size < 0) {
246
        ret = mmap_size;
247
        DPRINTF("KVM_GET_VCPU_MMAP_SIZE failed\n");
A
aliguori 已提交
248 249 250
        goto err;
    }

A
Andreas Färber 已提交
251
    cpu->kvm_run = mmap(NULL, mmap_size, PROT_READ | PROT_WRITE, MAP_SHARED,
A
Andreas Färber 已提交
252
                        cpu->kvm_fd, 0);
A
Andreas Färber 已提交
253
    if (cpu->kvm_run == MAP_FAILED) {
A
aliguori 已提交
254
        ret = -errno;
255
        DPRINTF("mmap'ing vcpu state failed\n");
A
aliguori 已提交
256 257 258
        goto err;
    }

J
Jan Kiszka 已提交
259 260
    if (s->coalesced_mmio && !s->coalesced_mmio_ring) {
        s->coalesced_mmio_ring =
A
Andreas Färber 已提交
261
            (void *)cpu->kvm_run + s->coalesced_mmio * PAGE_SIZE;
J
Jan Kiszka 已提交
262
    }
263

A
Andreas Färber 已提交
264
    ret = kvm_arch_init_vcpu(cpu);
J
Jan Kiszka 已提交
265
    if (ret == 0) {
A
Andreas Färber 已提交
266 267
        qemu_register_reset(kvm_reset_vcpu, cpu);
        kvm_arch_reset_vcpu(cpu);
J
Jan Kiszka 已提交
268
    }
A
aliguori 已提交
269 270 271 272
err:
    return ret;
}

273 274 275
/*
 * dirty pages logging control
 */
276

277
static int kvm_mem_flags(KVMState *s, bool log_dirty, bool readonly)
278
{
279 280 281 282 283 284
    int flags = 0;
    flags = log_dirty ? KVM_MEM_LOG_DIRTY_PAGES : 0;
    if (readonly && kvm_readonly_mem_allowed) {
        flags |= KVM_MEM_READONLY;
    }
    return flags;
285 286 287
}

static int kvm_slot_dirty_pages_log_change(KVMSlot *mem, bool log_dirty)
288 289
{
    KVMState *s = kvm_state;
290
    int flags, mask = KVM_MEM_LOG_DIRTY_PAGES;
291 292 293
    int old_flags;

    old_flags = mem->flags;
294

295
    flags = (mem->flags & ~mask) | kvm_mem_flags(s, log_dirty, false);
296 297
    mem->flags = flags;

298 299 300 301
    /* If nothing changed effectively, no need to issue ioctl */
    if (s->migration_log) {
        flags |= KVM_MEM_LOG_DIRTY_PAGES;
    }
302

303
    if (flags == old_flags) {
304
        return 0;
305 306
    }

307 308 309
    return kvm_set_user_memory_region(s, mem);
}

A
Avi Kivity 已提交
310
static int kvm_dirty_pages_log_change(hwaddr phys_addr,
311 312 313 314 315 316 317 318
                                      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 已提交
319
                (hwaddr)(phys_addr + size - 1));
320 321 322 323 324
        return -EINVAL;
    }
    return kvm_slot_dirty_pages_log_change(mem, log_dirty);
}

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

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

A
Avi Kivity 已提交
337 338
static void kvm_log_stop(MemoryListener *listener,
                          MemoryRegionSection *section)
339
{
A
Avi Kivity 已提交
340 341 342 343 344 345 346
    int r;

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

349
static int kvm_set_migration_log(int enable)
350 351 352 353 354 355 356 357 358 359
{
    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];

360 361 362
        if (!mem->memory_size) {
            continue;
        }
363 364 365 366 367 368 369 370 371 372 373
        if (!!(mem->flags & KVM_MEM_LOG_DIRTY_PAGES) == enable) {
            continue;
        }
        err = kvm_set_user_memory_region(s, mem);
        if (err) {
            return err;
        }
    }
    return 0;
}

374
/* get kvm's dirty pages bitmap and update qemu's */
375 376
static int kvm_get_dirty_pages_log_range(MemoryRegionSection *section,
                                         unsigned long *bitmap)
A
Alexander Graf 已提交
377
{
378
    unsigned int i, j;
379
    unsigned long page_number, c;
A
Avi Kivity 已提交
380
    hwaddr addr, addr1;
381
    unsigned int len = ((section->size / getpagesize()) + HOST_LONG_BITS - 1) / HOST_LONG_BITS;
382
    unsigned long hpratio = getpagesize() / TARGET_PAGE_SIZE;
383 384 385 386 387 388 389 390 391 392 393

    /*
     * 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);
394
                page_number = (i * HOST_LONG_BITS + j) * hpratio;
395
                addr1 = page_number * TARGET_PAGE_SIZE;
396
                addr = section->offset_within_region + addr1;
397 398
                memory_region_set_dirty(section->mr, addr,
                                        TARGET_PAGE_SIZE * hpratio);
399 400 401 402
            } while (c != 0);
        }
    }
    return 0;
A
Alexander Graf 已提交
403 404
}

405 406
#define ALIGN(x, y)  (((x)+(y)-1) & ~((y)-1))

407 408
/**
 * kvm_physical_sync_dirty_bitmap - Grab dirty bitmap from kernel space
409 410 411
 * This function updates qemu's dirty bitmap using
 * memory_region_set_dirty().  This means all bits are set
 * to dirty.
412
 *
413
 * @start_add: start of logged region.
414 415
 * @end_addr: end of logged region.
 */
416
static int kvm_physical_sync_dirty_bitmap(MemoryRegionSection *section)
417 418
{
    KVMState *s = kvm_state;
419 420 421 422
    unsigned long size, allocated_size = 0;
    KVMDirtyLog d;
    KVMSlot *mem;
    int ret = 0;
A
Avi Kivity 已提交
423 424
    hwaddr start_addr = section->offset_within_address_space;
    hwaddr end_addr = start_addr + section->size;
425

426 427 428 429 430 431
    d.dirty_bitmap = NULL;
    while (start_addr < end_addr) {
        mem = kvm_lookup_overlapping_slot(s, start_addr, end_addr);
        if (mem == NULL) {
            break;
        }
432

433 434 435 436 437 438 439 440 441 442 443 444 445 446
        /* 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;
447
        if (!d.dirty_bitmap) {
448
            d.dirty_bitmap = g_malloc(size);
449
        } else if (size > allocated_size) {
450
            d.dirty_bitmap = g_realloc(d.dirty_bitmap, size);
451 452 453
        }
        allocated_size = size;
        memset(d.dirty_bitmap, 0, allocated_size);
454

455
        d.slot = mem->slot;
456

457
        if (kvm_vm_ioctl(s, KVM_GET_DIRTY_LOG, &d) == -1) {
458
            DPRINTF("ioctl failed %d\n", errno);
459 460 461
            ret = -1;
            break;
        }
462

463
        kvm_get_dirty_pages_log_range(section, d.dirty_bitmap);
464
        start_addr = mem->start_addr + mem->memory_size;
465
    }
466
    g_free(d.dirty_bitmap);
467 468

    return ret;
469 470
}

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

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

        zone.addr = start;
        zone.size = size;
482
        zone.pad = 0;
A
aliguori 已提交
483

484
        (void)kvm_vm_ioctl(s, KVM_REGISTER_COALESCED_MMIO, &zone);
A
aliguori 已提交
485 486 487
    }
}

488 489
static void kvm_uncoalesce_mmio_region(MemoryListener *listener,
                                       MemoryRegionSection *secion,
A
Avi Kivity 已提交
490
                                       hwaddr start, hwaddr size)
A
aliguori 已提交
491 492 493 494 495 496 497 498
{
    KVMState *s = kvm_state;

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

        zone.addr = start;
        zone.size = size;
499
        zone.pad = 0;
A
aliguori 已提交
500

501
        (void)kvm_vm_ioctl(s, KVM_UNREGISTER_COALESCED_MMIO, &zone);
A
aliguori 已提交
502 503 504
    }
}

505 506 507 508 509 510 511 512 513 514 515 516
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;
}

517
static int kvm_set_ioeventfd_mmio(int fd, uint32_t addr, uint32_t val,
518
                                  bool assign, uint32_t size, bool datamatch)
M
Michael S. Tsirkin 已提交
519 520 521 522
{
    int ret;
    struct kvm_ioeventfd iofd;

523
    iofd.datamatch = datamatch ? val : 0;
M
Michael S. Tsirkin 已提交
524 525
    iofd.addr = addr;
    iofd.len = size;
526
    iofd.flags = 0;
M
Michael S. Tsirkin 已提交
527 528 529 530 531 532
    iofd.fd = fd;

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

533 534 535
    if (datamatch) {
        iofd.flags |= KVM_IOEVENTFD_FLAG_DATAMATCH;
    }
M
Michael S. Tsirkin 已提交
536 537 538 539 540 541 542 543 544 545 546 547 548
    if (!assign) {
        iofd.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
    }

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

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

    return 0;
}

549
static int kvm_set_ioeventfd_pio(int fd, uint16_t addr, uint16_t val,
550
                                 bool assign, uint32_t size, bool datamatch)
M
Michael S. Tsirkin 已提交
551 552
{
    struct kvm_ioeventfd kick = {
553
        .datamatch = datamatch ? val : 0,
M
Michael S. Tsirkin 已提交
554
        .addr = addr,
555
        .flags = KVM_IOEVENTFD_FLAG_PIO,
556
        .len = size,
M
Michael S. Tsirkin 已提交
557 558 559 560 561 562
        .fd = fd,
    };
    int r;
    if (!kvm_enabled()) {
        return -ENOSYS;
    }
563 564 565
    if (datamatch) {
        kick.flags |= KVM_IOEVENTFD_FLAG_DATAMATCH;
    }
M
Michael S. Tsirkin 已提交
566 567 568 569 570 571 572 573 574 575 576
    if (!assign) {
        kick.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
    }
    r = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &kick);
    if (r < 0) {
        return r;
    }
    return 0;
}


577 578
static int kvm_check_many_ioeventfds(void)
{
579 580 581 582 583
    /* 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
584 585
     * can avoid creating too many ioeventfds.
     */
586
#if defined(CONFIG_EVENTFD)
587 588 589 590 591 592 593
    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;
        }
594
        ret = kvm_set_ioeventfd_pio(ioeventfds[i], 0, i, true, 2, true);
595 596 597 598 599 600 601 602 603 604
        if (ret < 0) {
            close(ioeventfds[i]);
            break;
        }
    }

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

    while (i-- > 0) {
605
        kvm_set_ioeventfd_pio(ioeventfds[i], 0, i, false, 2, true);
606 607 608 609 610 611 612 613
        close(ioeventfds[i]);
    }
    return ret;
#else
    return 0;
#endif
}

614 615 616 617 618 619 620 621 622 623 624 625
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 已提交
626
static void kvm_set_phys_mem(MemoryRegionSection *section, bool add)
627 628 629 630
{
    KVMState *s = kvm_state;
    KVMSlot *mem, old;
    int err;
A
Avi Kivity 已提交
631 632
    MemoryRegion *mr = section->mr;
    bool log_dirty = memory_region_is_logging(mr);
633 634
    bool writeable = !mr->readonly && !mr->rom_device;
    bool readonly_flag = mr->readonly || memory_region_is_romd(mr);
A
Avi Kivity 已提交
635
    hwaddr start_addr = section->offset_within_address_space;
A
Avi Kivity 已提交
636
    ram_addr_t size = section->size;
637
    void *ram = NULL;
A
Avi Kivity 已提交
638
    unsigned delta;
639

640 641
    /* kvm works in page size chunks, but the function may be called
       with sub-page size and unaligned start address. */
A
Avi Kivity 已提交
642 643 644 645 646 647 648 649 650 651
    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;
    }
652

A
Avi Kivity 已提交
653
    if (!memory_region_is_ram(mr)) {
654 655 656 657 658 659 660
        if (writeable || !kvm_readonly_mem_allowed) {
            return;
        } else if (!mr->romd_mode) {
            /* If the memory device is not in romd_mode, then we actually want
             * to remove the kvm memory slot so all accesses will trap. */
            add = false;
        }
661 662
    }

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

665 666 667 668 669 670
    while (1) {
        mem = kvm_lookup_overlapping_slot(s, start_addr, start_addr + size);
        if (!mem) {
            break;
        }

A
Avi Kivity 已提交
671
        if (add && start_addr >= mem->start_addr &&
672
            (start_addr + size <= mem->start_addr + mem->memory_size) &&
673
            (ram - start_addr == mem->ram - mem->start_addr)) {
674
            /* The new slot fits into the existing one and comes with
675 676
             * identical parameters - update flags and done. */
            kvm_slot_dirty_pages_log_change(mem, log_dirty);
677 678 679 680 681
            return;
        }

        old = *mem;

682 683 684 685
        if (mem->flags & KVM_MEM_LOG_DIRTY_PAGES) {
            kvm_physical_sync_dirty_bitmap(section);
        }

686 687 688 689 690 691 692 693 694 695 696 697 698 699 700 701 702 703
        /* 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 已提交
704
            old.start_addr == start_addr && old.memory_size < size && add) {
705 706 707
            mem = kvm_alloc_slot(s);
            mem->memory_size = old.memory_size;
            mem->start_addr = old.start_addr;
708
            mem->ram = old.ram;
709
            mem->flags = kvm_mem_flags(s, log_dirty, readonly_flag);
710 711 712 713 714 715 716 717 718

            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;
719
            ram += old.memory_size;
720 721 722 723 724 725 726 727 728
            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;
729
            mem->ram = old.ram;
730
            mem->flags =  kvm_mem_flags(s, log_dirty, readonly_flag);
731 732 733 734 735

            err = kvm_set_user_memory_region(s, mem);
            if (err) {
                fprintf(stderr, "%s: error registering prefix slot: %s\n",
                        __func__, strerror(-err));
736 737 738 739 740
#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
741 742 743 744 745 746 747 748 749 750 751 752
                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;
753
            mem->ram = old.ram + size_delta;
754
            mem->flags = kvm_mem_flags(s, log_dirty, readonly_flag);
755 756 757 758 759 760 761 762 763 764 765

            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 已提交
766
    if (!size) {
767
        return;
J
Jan Kiszka 已提交
768
    }
A
Avi Kivity 已提交
769
    if (!add) {
770
        return;
J
Jan Kiszka 已提交
771
    }
772 773 774
    mem = kvm_alloc_slot(s);
    mem->memory_size = size;
    mem->start_addr = start_addr;
775
    mem->ram = ram;
776
    mem->flags = kvm_mem_flags(s, log_dirty, readonly_flag);
777 778 779 780 781 782 783 784 785

    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 已提交
786 787 788 789 790 791 792 793 794 795 796 797 798 799
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)
800
{
A
Avi Kivity 已提交
801 802
    int r;

803
    r = kvm_physical_sync_dirty_bitmap(section);
A
Avi Kivity 已提交
804 805 806
    if (r < 0) {
        abort();
    }
807 808
}

A
Avi Kivity 已提交
809
static void kvm_log_global_start(struct MemoryListener *listener)
810
{
A
Avi Kivity 已提交
811 812 813 814
    int r;

    r = kvm_set_migration_log(1);
    assert(r >= 0);
815 816
}

A
Avi Kivity 已提交
817
static void kvm_log_global_stop(struct MemoryListener *listener)
818
{
A
Avi Kivity 已提交
819 820 821 822
    int r;

    r = kvm_set_migration_log(0);
    assert(r >= 0);
823 824
}

825 826 827 828 829 830
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);
831 832
    int r;

833
    r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
834
                               data, true, section->size, match_data);
835 836 837 838 839
    if (r < 0) {
        abort();
    }
}

840 841 842 843
static void kvm_mem_ioeventfd_del(MemoryListener *listener,
                                  MemoryRegionSection *section,
                                  bool match_data, uint64_t data,
                                  EventNotifier *e)
844
{
845
    int fd = event_notifier_get_fd(e);
846 847
    int r;

848
    r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
849
                               data, false, section->size, match_data);
850 851 852 853 854
    if (r < 0) {
        abort();
    }
}

855 856 857 858
static void kvm_io_ioeventfd_add(MemoryListener *listener,
                                 MemoryRegionSection *section,
                                 bool match_data, uint64_t data,
                                 EventNotifier *e)
859
{
860
    int fd = event_notifier_get_fd(e);
861 862
    int r;

863
    r = kvm_set_ioeventfd_pio(fd, section->offset_within_address_space,
864
                              data, true, section->size, match_data);
865 866 867 868 869
    if (r < 0) {
        abort();
    }
}

870 871 872 873
static void kvm_io_ioeventfd_del(MemoryListener *listener,
                                 MemoryRegionSection *section,
                                 bool match_data, uint64_t data,
                                 EventNotifier *e)
874 875

{
876
    int fd = event_notifier_get_fd(e);
877 878
    int r;

879
    r = kvm_set_ioeventfd_pio(fd, section->offset_within_address_space,
880
                              data, false, section->size, match_data);
881 882 883 884 885
    if (r < 0) {
        abort();
    }
}

A
Avi Kivity 已提交
886 887 888
static MemoryListener kvm_memory_listener = {
    .region_add = kvm_region_add,
    .region_del = kvm_region_del,
889 890
    .log_start = kvm_log_start,
    .log_stop = kvm_log_stop,
A
Avi Kivity 已提交
891 892 893
    .log_sync = kvm_log_sync,
    .log_global_start = kvm_log_global_start,
    .log_global_stop = kvm_log_global_stop,
894 895
    .eventfd_add = kvm_mem_ioeventfd_add,
    .eventfd_del = kvm_mem_ioeventfd_del,
896 897
    .coalesced_mmio_add = kvm_coalesce_mmio_region,
    .coalesced_mmio_del = kvm_uncoalesce_mmio_region,
898 899 900 901 902 903
    .priority = 10,
};

static MemoryListener kvm_io_listener = {
    .eventfd_add = kvm_io_ioeventfd_add,
    .eventfd_del = kvm_io_ioeventfd_del,
904
    .priority = 10,
905 906
};

907
static void kvm_handle_interrupt(CPUState *cpu, int mask)
908
{
909
    cpu->interrupt_request |= mask;
910

911
    if (!qemu_cpu_is_self(cpu)) {
912
        qemu_cpu_kick(cpu);
913 914 915
    }
}

916
int kvm_set_irq(KVMState *s, int irq, int level)
917 918 919 920
{
    struct kvm_irq_level event;
    int ret;

921
    assert(kvm_async_interrupts_enabled());
922 923 924

    event.level = level;
    event.irq = irq;
925
    ret = kvm_vm_ioctl(s, s->irq_set_ioctl, &event);
926
    if (ret < 0) {
927
        perror("kvm_set_irq");
928 929 930
        abort();
    }

931
    return (s->irq_set_ioctl == KVM_IRQ_LINE) ? 1 : event.status;
932 933 934
}

#ifdef KVM_CAP_IRQ_ROUTING
935 936 937 938 939
typedef struct KVMMSIRoute {
    struct kvm_irq_routing_entry kroute;
    QTAILQ_ENTRY(KVMMSIRoute) entry;
} KVMMSIRoute;

940 941 942 943 944
static void set_gsi(KVMState *s, unsigned int gsi)
{
    s->used_gsi_bitmap[gsi / 32] |= 1U << (gsi % 32);
}

945 946 947 948 949
static void clear_gsi(KVMState *s, unsigned int gsi)
{
    s->used_gsi_bitmap[gsi / 32] &= ~(1U << (gsi % 32));
}

950 951
static void kvm_init_irq_routing(KVMState *s)
{
952
    int gsi_count, i;
953 954 955 956 957 958

    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 */
959
        gsi_bits = ALIGN(gsi_count, 32);
960
        s->used_gsi_bitmap = g_malloc0(gsi_bits / 8);
961
        s->gsi_count = gsi_count;
962 963 964 965 966 967 968 969 970 971

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

972 973 974 975
    if (!s->direct_msi) {
        for (i = 0; i < KVM_MSI_HASHTAB_SIZE; i++) {
            QTAILQ_INIT(&s->msi_hashtab[i]);
        }
976 977
    }

978 979 980
    kvm_arch_init_irq_routing(s);
}

981 982 983 984 985 986 987 988 989
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);
}

990 991 992 993 994 995 996 997 998 999 1000 1001 1002 1003 1004 1005 1006 1007 1008 1009 1010 1011 1012 1013 1014
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);
1015 1016

    kvm_irqchip_commit_routes(s);
1017 1018
}

1019 1020 1021 1022 1023 1024 1025 1026 1027 1028 1029 1030 1031 1032 1033 1034 1035 1036 1037 1038 1039 1040 1041 1042
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;
}

1043
void kvm_irqchip_add_irq_route(KVMState *s, int irq, int irqchip, int pin)
1044 1045 1046
{
    struct kvm_irq_routing_entry e;

1047 1048
    assert(pin < s->gsi_count);

1049 1050 1051 1052 1053 1054 1055 1056
    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);
}

1057
void kvm_irqchip_release_virq(KVMState *s, int virq)
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 1083 1084 1085 1086 1087 1088 1089 1090 1091 1092 1093 1094 1095 1096 1097 1098 1099 1100 1101 1102 1103 1104 1105 1106 1107 1108 1109
{
    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;
    }
1110
    if (!s->direct_msi && retry) {
1111 1112 1113 1114 1115 1116 1117 1118 1119 1120 1121 1122 1123 1124 1125 1126 1127 1128 1129 1130 1131 1132 1133 1134 1135
        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)
{
1136
    struct kvm_msi msi;
1137 1138
    KVMMSIRoute *route;

1139 1140 1141 1142 1143 1144 1145 1146 1147 1148
    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);
    }

1149 1150
    route = kvm_lookup_msi_route(s, msg);
    if (!route) {
1151
        int virq;
1152 1153 1154 1155 1156 1157 1158 1159 1160 1161 1162 1163 1164 1165 1166 1167 1168 1169 1170 1171 1172 1173

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

1174
    return kvm_set_irq(s, route->kroute.gsi, 1);
1175 1176
}

1177 1178 1179 1180 1181
int kvm_irqchip_add_msi_route(KVMState *s, MSIMessage msg)
{
    struct kvm_irq_routing_entry kroute;
    int virq;

1182
    if (!kvm_gsi_routing_enabled()) {
1183 1184 1185 1186 1187 1188 1189 1190 1191 1192 1193 1194 1195 1196 1197 1198 1199 1200 1201 1202
        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;
}

1203 1204 1205 1206 1207 1208 1209 1210 1211 1212 1213 1214 1215 1216 1217 1218 1219 1220
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);
}

1221 1222 1223 1224 1225 1226 1227 1228
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,
    };

1229
    if (!kvm_irqfds_enabled()) {
1230 1231 1232 1233 1234 1235
        return -ENOSYS;
    }

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

1236 1237 1238 1239 1240
#else /* !KVM_CAP_IRQ_ROUTING */

static void kvm_init_irq_routing(KVMState *s)
{
}
1241

1242 1243 1244 1245
void kvm_irqchip_release_virq(KVMState *s, int virq)
{
}

1246 1247 1248 1249
int kvm_irqchip_send_msi(KVMState *s, MSIMessage msg)
{
    abort();
}
1250 1251 1252

int kvm_irqchip_add_msi_route(KVMState *s, MSIMessage msg)
{
1253
    return -ENOSYS;
1254
}
1255 1256 1257 1258 1259

static int kvm_irqchip_assign_irqfd(KVMState *s, int fd, int virq, bool assign)
{
    abort();
}
1260 1261 1262 1263 1264

int kvm_irqchip_update_msi_route(KVMState *s, int virq, MSIMessage msg)
{
    return -ENOSYS;
}
1265 1266
#endif /* !KVM_CAP_IRQ_ROUTING */

J
Jan Kiszka 已提交
1267
int kvm_irqchip_add_irqfd_notifier(KVMState *s, EventNotifier *n, int virq)
1268
{
J
Jan Kiszka 已提交
1269
    return kvm_irqchip_assign_irqfd(s, event_notifier_get_fd(n), virq, true);
1270 1271
}

J
Jan Kiszka 已提交
1272
int kvm_irqchip_remove_irqfd_notifier(KVMState *s, EventNotifier *n, int virq)
1273
{
J
Jan Kiszka 已提交
1274
    return kvm_irqchip_assign_irqfd(s, event_notifier_get_fd(n), virq, false);
1275 1276
}

1277 1278 1279 1280 1281 1282 1283
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),
1284
                           "kernel_irqchip", true) ||
1285 1286 1287 1288 1289 1290 1291 1292 1293 1294
        !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;
    }

1295
    kvm_kernel_irqchip = true;
1296 1297 1298 1299
    /* 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;
1300 1301 1302 1303 1304 1305

    kvm_init_irq_routing(s);

    return 0;
}

1306 1307 1308 1309 1310 1311 1312 1313 1314 1315 1316 1317 1318 1319 1320 1321 1322 1323 1324 1325
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;
}

1326
int kvm_init(void)
A
aliguori 已提交
1327
{
1328 1329 1330
    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 已提交
1331
    KVMState *s;
1332
    const KVMCapabilityInfo *missing_cap;
A
aliguori 已提交
1333 1334
    int ret;
    int i;
1335
    int max_vcpus;
A
aliguori 已提交
1336

1337
    s = g_malloc0(sizeof(KVMState));
A
aliguori 已提交
1338

1339 1340 1341 1342 1343 1344 1345 1346
    /*
     * 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());

1347
#ifdef KVM_CAP_SET_GUEST_DEBUG
B
Blue Swirl 已提交
1348
    QTAILQ_INIT(&s->kvm_sw_breakpoints);
1349
#endif
J
Jan Kiszka 已提交
1350
    for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
A
aliguori 已提交
1351
        s->slots[i].slot = i;
J
Jan Kiszka 已提交
1352
    }
A
aliguori 已提交
1353
    s->vmfd = -1;
K
Kevin Wolf 已提交
1354
    s->fd = qemu_open("/dev/kvm", O_RDWR);
A
aliguori 已提交
1355 1356 1357 1358 1359 1360 1361 1362
    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 已提交
1363
        if (ret > 0) {
A
aliguori 已提交
1364
            ret = -EINVAL;
J
Jan Kiszka 已提交
1365
        }
A
aliguori 已提交
1366 1367 1368 1369 1370 1371 1372 1373 1374 1375
        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;
    }

1376 1377 1378 1379 1380 1381 1382 1383
    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 已提交
1384
    s->vmfd = kvm_ioctl(s, KVM_CREATE_VM, 0);
1385 1386 1387 1388 1389
    if (s->vmfd < 0) {
#ifdef TARGET_S390X
        fprintf(stderr, "Please add the 'switch_amode' kernel parameter to "
                        "your host kernel command line\n");
#endif
1390
        ret = s->vmfd;
A
aliguori 已提交
1391
        goto err;
1392
    }
A
aliguori 已提交
1393

1394 1395 1396 1397
    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 已提交
1398
    }
1399
    if (missing_cap) {
1400
        ret = -EINVAL;
1401 1402
        fprintf(stderr, "kvm does not support %s\n%s",
                missing_cap->name, upgrade_note);
1403 1404 1405
        goto err;
    }

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

1408
    s->broken_set_mem_region = 1;
1409
    ret = kvm_check_extension(s, KVM_CAP_JOIN_MEMORY_REGIONS_WORKS);
1410 1411 1412 1413
    if (ret > 0) {
        s->broken_set_mem_region = 0;
    }

1414 1415 1416 1417
#ifdef KVM_CAP_VCPU_EVENTS
    s->vcpu_events = kvm_check_extension(s, KVM_CAP_VCPU_EVENTS);
#endif

1418 1419 1420
    s->robust_singlestep =
        kvm_check_extension(s, KVM_CAP_X86_ROBUST_SINGLESTEP);

1421 1422 1423 1424
#ifdef KVM_CAP_DEBUGREGS
    s->debugregs = kvm_check_extension(s, KVM_CAP_DEBUGREGS);
#endif

1425 1426 1427 1428 1429 1430 1431 1432
#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 已提交
1433 1434 1435 1436
#ifdef KVM_CAP_PIT_STATE2
    s->pit_state2 = kvm_check_extension(s, KVM_CAP_PIT_STATE2);
#endif

1437
#ifdef KVM_CAP_IRQ_ROUTING
1438
    s->direct_msi = (kvm_check_extension(s, KVM_CAP_SIGNAL_MSI) > 0);
1439
#endif
1440

1441 1442
    s->intx_set_mask = kvm_check_extension(s, KVM_CAP_PCI_2_3);

1443
    s->irq_set_ioctl = KVM_IRQ_LINE;
1444
    if (kvm_check_extension(s, KVM_CAP_IRQ_INJECT_STATUS)) {
1445
        s->irq_set_ioctl = KVM_IRQ_LINE_STATUS;
1446 1447
    }

1448 1449 1450 1451 1452
#ifdef KVM_CAP_READONLY_MEM
    kvm_readonly_mem_allowed =
        (kvm_check_extension(s, KVM_CAP_READONLY_MEM) > 0);
#endif

1453
    ret = kvm_arch_init(s);
J
Jan Kiszka 已提交
1454
    if (ret < 0) {
A
aliguori 已提交
1455
        goto err;
J
Jan Kiszka 已提交
1456
    }
A
aliguori 已提交
1457

1458 1459 1460 1461 1462
    ret = kvm_irqchip_create(s);
    if (ret < 0) {
        goto err;
    }

A
aliguori 已提交
1463
    kvm_state = s;
1464 1465
    memory_listener_register(&kvm_memory_listener, &address_space_memory);
    memory_listener_register(&kvm_io_listener, &address_space_io);
A
aliguori 已提交
1466

1467 1468
    s->many_ioeventfds = kvm_check_many_ioeventfds();

1469 1470
    cpu_interrupt_handler = kvm_handle_interrupt;

A
aliguori 已提交
1471 1472 1473
    return 0;

err:
1474 1475 1476 1477 1478
    if (s->vmfd >= 0) {
        close(s->vmfd);
    }
    if (s->fd != -1) {
        close(s->fd);
A
aliguori 已提交
1479
    }
1480
    g_free(s);
A
aliguori 已提交
1481 1482 1483 1484

    return ret;
}

1485 1486
static void kvm_handle_io(uint16_t port, void *data, int direction, int size,
                          uint32_t count)
A
aliguori 已提交
1487 1488 1489 1490 1491 1492 1493 1494
{
    int i;
    uint8_t *ptr = data;

    for (i = 0; i < count; i++) {
        if (direction == KVM_EXIT_IO_IN) {
            switch (size) {
            case 1:
1495
                stb_p(ptr, cpu_inb(port));
A
aliguori 已提交
1496 1497
                break;
            case 2:
1498
                stw_p(ptr, cpu_inw(port));
A
aliguori 已提交
1499 1500
                break;
            case 4:
1501
                stl_p(ptr, cpu_inl(port));
A
aliguori 已提交
1502 1503 1504 1505 1506
                break;
            }
        } else {
            switch (size) {
            case 1:
1507
                cpu_outb(port, ldub_p(ptr));
A
aliguori 已提交
1508 1509
                break;
            case 2:
1510
                cpu_outw(port, lduw_p(ptr));
A
aliguori 已提交
1511 1512
                break;
            case 4:
1513
                cpu_outl(port, ldl_p(ptr));
A
aliguori 已提交
1514 1515 1516 1517 1518 1519 1520 1521
                break;
            }
        }

        ptr += size;
    }
}

1522
static int kvm_handle_internal_error(CPUArchState *env, struct kvm_run *run)
M
Marcelo Tosatti 已提交
1523
{
A
Andreas Färber 已提交
1524 1525
    CPUState *cpu = ENV_GET_CPU(env);

1526
    fprintf(stderr, "KVM internal error.");
M
Marcelo Tosatti 已提交
1527 1528 1529
    if (kvm_check_extension(kvm_state, KVM_CAP_INTERNAL_ERROR_DATA)) {
        int i;

1530
        fprintf(stderr, " Suberror: %d\n", run->internal.suberror);
M
Marcelo Tosatti 已提交
1531 1532 1533 1534
        for (i = 0; i < run->internal.ndata; ++i) {
            fprintf(stderr, "extra data[%d]: %"PRIx64"\n",
                    i, (uint64_t)run->internal.data[i]);
        }
1535 1536
    } else {
        fprintf(stderr, "\n");
M
Marcelo Tosatti 已提交
1537 1538 1539
    }
    if (run->internal.suberror == KVM_INTERNAL_ERROR_EMULATION) {
        fprintf(stderr, "emulation failure\n");
A
Andreas Färber 已提交
1540
        if (!kvm_arch_stop_on_emulation_error(cpu)) {
1541
            cpu_dump_state(env, stderr, fprintf, CPU_DUMP_CODE);
1542
            return EXCP_INTERRUPT;
J
Jan Kiszka 已提交
1543
        }
M
Marcelo Tosatti 已提交
1544 1545 1546 1547
    }
    /* FIXME: Should trigger a qmp message to let management know
     * something went wrong.
     */
J
Jan Kiszka 已提交
1548
    return -1;
M
Marcelo Tosatti 已提交
1549 1550
}

1551
void kvm_flush_coalesced_mmio_buffer(void)
A
aliguori 已提交
1552 1553
{
    KVMState *s = kvm_state;
1554 1555 1556 1557 1558 1559 1560

    if (s->coalesced_flush_in_progress) {
        return;
    }

    s->coalesced_flush_in_progress = true;

1561 1562
    if (s->coalesced_mmio_ring) {
        struct kvm_coalesced_mmio_ring *ring = s->coalesced_mmio_ring;
A
aliguori 已提交
1563 1564 1565 1566 1567 1568
        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);
1569
            smp_wmb();
A
aliguori 已提交
1570 1571 1572
            ring->first = (ring->first + 1) % KVM_COALESCED_MMIO_MAX;
        }
    }
1573 1574

    s->coalesced_flush_in_progress = false;
A
aliguori 已提交
1575 1576
}

A
Andreas Färber 已提交
1577
static void do_kvm_cpu_synchronize_state(void *arg)
1578
{
A
Andreas Färber 已提交
1579
    CPUState *cpu = arg;
1580

A
Andreas Färber 已提交
1581 1582 1583
    if (!cpu->kvm_vcpu_dirty) {
        kvm_arch_get_registers(cpu);
        cpu->kvm_vcpu_dirty = true;
1584 1585 1586
    }
}

1587
void kvm_cpu_synchronize_state(CPUArchState *env)
1588
{
1589 1590
    CPUState *cpu = ENV_GET_CPU(env);

A
Andreas Färber 已提交
1591 1592
    if (!cpu->kvm_vcpu_dirty) {
        run_on_cpu(cpu, do_kvm_cpu_synchronize_state, cpu);
J
Jan Kiszka 已提交
1593
    }
1594 1595
}

1596
void kvm_cpu_synchronize_post_reset(CPUState *cpu)
1597
{
A
Andreas Färber 已提交
1598 1599
    kvm_arch_put_registers(cpu, KVM_PUT_RESET_STATE);
    cpu->kvm_vcpu_dirty = false;
1600 1601
}

1602
void kvm_cpu_synchronize_post_init(CPUState *cpu)
1603
{
A
Andreas Färber 已提交
1604 1605
    kvm_arch_put_registers(cpu, KVM_PUT_FULL_STATE);
    cpu->kvm_vcpu_dirty = false;
1606 1607
}

1608
int kvm_cpu_exec(CPUArchState *env)
A
aliguori 已提交
1609
{
A
Andreas Färber 已提交
1610
    CPUState *cpu = ENV_GET_CPU(env);
A
Andreas Färber 已提交
1611
    struct kvm_run *run = cpu->kvm_run;
1612
    int ret, run_ret;
A
aliguori 已提交
1613

1614
    DPRINTF("kvm_cpu_exec()\n");
A
aliguori 已提交
1615

A
Andreas Färber 已提交
1616
    if (kvm_arch_process_async_events(cpu)) {
1617
        cpu->exit_request = 0;
1618
        return EXCP_HLT;
1619
    }
M
Marcelo Tosatti 已提交
1620

1621
    do {
A
Andreas Färber 已提交
1622 1623 1624
        if (cpu->kvm_vcpu_dirty) {
            kvm_arch_put_registers(cpu, KVM_PUT_RUNTIME_STATE);
            cpu->kvm_vcpu_dirty = false;
1625 1626
        }

A
Andreas Färber 已提交
1627
        kvm_arch_pre_run(cpu, run);
1628
        if (cpu->exit_request) {
1629 1630 1631 1632 1633 1634 1635 1636
            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();
        }
1637
        qemu_mutex_unlock_iothread();
1638

1639
        run_ret = kvm_vcpu_ioctl(cpu, KVM_RUN, 0);
1640

1641
        qemu_mutex_lock_iothread();
A
Andreas Färber 已提交
1642
        kvm_arch_post_run(cpu, run);
A
aliguori 已提交
1643

1644
        if (run_ret < 0) {
1645 1646
            if (run_ret == -EINTR || run_ret == -EAGAIN) {
                DPRINTF("io window exit\n");
1647
                ret = EXCP_INTERRUPT;
1648 1649
                break;
            }
1650 1651
            fprintf(stderr, "error: kvm run failed %s\n",
                    strerror(-run_ret));
A
aliguori 已提交
1652 1653 1654
            abort();
        }

1655
        trace_kvm_run_exit(cpu->cpu_index, run->exit_reason);
A
aliguori 已提交
1656 1657
        switch (run->exit_reason) {
        case KVM_EXIT_IO:
1658
            DPRINTF("handle_io\n");
1659 1660 1661 1662 1663
            kvm_handle_io(run->io.port,
                          (uint8_t *)run + run->io.data_offset,
                          run->io.direction,
                          run->io.size,
                          run->io.count);
1664
            ret = 0;
A
aliguori 已提交
1665 1666
            break;
        case KVM_EXIT_MMIO:
1667
            DPRINTF("handle_mmio\n");
A
aliguori 已提交
1668 1669 1670 1671
            cpu_physical_memory_rw(run->mmio.phys_addr,
                                   run->mmio.data,
                                   run->mmio.len,
                                   run->mmio.is_write);
1672
            ret = 0;
A
aliguori 已提交
1673 1674
            break;
        case KVM_EXIT_IRQ_WINDOW_OPEN:
1675
            DPRINTF("irq_window_open\n");
1676
            ret = EXCP_INTERRUPT;
A
aliguori 已提交
1677 1678
            break;
        case KVM_EXIT_SHUTDOWN:
1679
            DPRINTF("shutdown\n");
A
aliguori 已提交
1680
            qemu_system_reset_request();
1681
            ret = EXCP_INTERRUPT;
A
aliguori 已提交
1682 1683
            break;
        case KVM_EXIT_UNKNOWN:
1684 1685
            fprintf(stderr, "KVM: unknown exit, hardware reason %" PRIx64 "\n",
                    (uint64_t)run->hw.hardware_exit_reason);
J
Jan Kiszka 已提交
1686
            ret = -1;
A
aliguori 已提交
1687
            break;
M
Marcelo Tosatti 已提交
1688
        case KVM_EXIT_INTERNAL_ERROR:
J
Jan Kiszka 已提交
1689
            ret = kvm_handle_internal_error(env, run);
M
Marcelo Tosatti 已提交
1690
            break;
A
aliguori 已提交
1691
        default:
1692
            DPRINTF("kvm_arch_handle_exit\n");
A
Andreas Färber 已提交
1693
            ret = kvm_arch_handle_exit(cpu, run);
A
aliguori 已提交
1694 1695
            break;
        }
1696
    } while (ret == 0);
A
aliguori 已提交
1697

J
Jan Kiszka 已提交
1698
    if (ret < 0) {
1699
        cpu_dump_state(env, stderr, fprintf, CPU_DUMP_CODE);
1700
        vm_stop(RUN_STATE_INTERNAL_ERROR);
A
aliguori 已提交
1701 1702
    }

1703
    cpu->exit_request = 0;
A
aliguori 已提交
1704 1705 1706
    return ret;
}

1707
int kvm_ioctl(KVMState *s, int type, ...)
A
aliguori 已提交
1708 1709
{
    int ret;
1710 1711
    void *arg;
    va_list ap;
A
aliguori 已提交
1712

1713 1714 1715 1716
    va_start(ap, type);
    arg = va_arg(ap, void *);
    va_end(ap);

1717
    trace_kvm_ioctl(type, arg);
1718
    ret = ioctl(s->fd, type, arg);
J
Jan Kiszka 已提交
1719
    if (ret == -1) {
A
aliguori 已提交
1720
        ret = -errno;
J
Jan Kiszka 已提交
1721
    }
A
aliguori 已提交
1722 1723 1724
    return ret;
}

1725
int kvm_vm_ioctl(KVMState *s, int type, ...)
A
aliguori 已提交
1726 1727
{
    int ret;
1728 1729 1730 1731 1732 1733
    void *arg;
    va_list ap;

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

1735
    trace_kvm_vm_ioctl(type, arg);
1736
    ret = ioctl(s->vmfd, type, arg);
J
Jan Kiszka 已提交
1737
    if (ret == -1) {
A
aliguori 已提交
1738
        ret = -errno;
J
Jan Kiszka 已提交
1739
    }
A
aliguori 已提交
1740 1741 1742
    return ret;
}

1743
int kvm_vcpu_ioctl(CPUState *cpu, int type, ...)
A
aliguori 已提交
1744 1745
{
    int ret;
1746 1747 1748 1749 1750 1751
    void *arg;
    va_list ap;

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

1753
    trace_kvm_vcpu_ioctl(cpu->cpu_index, type, arg);
A
Andreas Färber 已提交
1754
    ret = ioctl(cpu->kvm_fd, type, arg);
J
Jan Kiszka 已提交
1755
    if (ret == -1) {
A
aliguori 已提交
1756
        ret = -errno;
J
Jan Kiszka 已提交
1757
    }
A
aliguori 已提交
1758 1759
    return ret;
}
A
aliguori 已提交
1760 1761 1762

int kvm_has_sync_mmu(void)
{
1763
    return kvm_check_extension(kvm_state, KVM_CAP_SYNC_MMU);
A
aliguori 已提交
1764
}
1765

1766 1767 1768 1769 1770
int kvm_has_vcpu_events(void)
{
    return kvm_state->vcpu_events;
}

1771 1772 1773 1774 1775
int kvm_has_robust_singlestep(void)
{
    return kvm_state->robust_singlestep;
}

1776 1777 1778 1779 1780
int kvm_has_debugregs(void)
{
    return kvm_state->debugregs;
}

1781 1782 1783 1784 1785 1786 1787 1788 1789 1790
int kvm_has_xsave(void)
{
    return kvm_state->xsave;
}

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

J
Jan Kiszka 已提交
1791 1792 1793 1794 1795
int kvm_has_pit_state2(void)
{
    return kvm_state->pit_state2;
}

1796 1797 1798 1799 1800 1801 1802 1803
int kvm_has_many_ioeventfds(void)
{
    if (!kvm_enabled()) {
        return 0;
    }
    return kvm_state->many_ioeventfds;
}

1804 1805
int kvm_has_gsi_routing(void)
{
A
Alexander Graf 已提交
1806
#ifdef KVM_CAP_IRQ_ROUTING
1807
    return kvm_check_extension(kvm_state, KVM_CAP_IRQ_ROUTING);
A
Alexander Graf 已提交
1808 1809 1810
#else
    return false;
#endif
1811 1812
}

1813 1814 1815 1816 1817
int kvm_has_intx_set_mask(void)
{
    return kvm_state->intx_set_mask;
}

1818
void *kvm_ram_alloc(ram_addr_t size)
1819 1820 1821 1822
{
#ifdef TARGET_S390X
    void *mem;

1823
    mem = kvm_arch_ram_alloc(size);
1824 1825 1826 1827
    if (mem) {
        return mem;
    }
#endif
1828
    return qemu_anon_ram_alloc(size);
1829 1830
}

1831 1832
void kvm_setup_guest_memory(void *start, size_t size)
{
1833 1834 1835
#ifdef CONFIG_VALGRIND_H
    VALGRIND_MAKE_MEM_DEFINED(start, size);
#endif
1836
    if (!kvm_has_sync_mmu()) {
A
Andreas Färber 已提交
1837
        int ret = qemu_madvise(start, size, QEMU_MADV_DONTFORK);
1838 1839

        if (ret) {
A
Andreas Färber 已提交
1840 1841 1842
            perror("qemu_madvise");
            fprintf(stderr,
                    "Need MADV_DONTFORK in absence of synchronous KVM MMU\n");
1843 1844 1845 1846 1847
            exit(1);
        }
    }
}

1848
#ifdef KVM_CAP_SET_GUEST_DEBUG
1849
struct kvm_sw_breakpoint *kvm_find_sw_breakpoint(CPUState *cpu,
1850 1851 1852 1853
                                                 target_ulong pc)
{
    struct kvm_sw_breakpoint *bp;

1854
    QTAILQ_FOREACH(bp, &cpu->kvm_state->kvm_sw_breakpoints, entry) {
J
Jan Kiszka 已提交
1855
        if (bp->pc == pc) {
1856
            return bp;
J
Jan Kiszka 已提交
1857
        }
1858 1859 1860 1861
    }
    return NULL;
}

1862
int kvm_sw_breakpoints_active(CPUState *cpu)
1863
{
1864
    return !QTAILQ_EMPTY(&cpu->kvm_state->kvm_sw_breakpoints);
1865 1866
}

G
Glauber Costa 已提交
1867 1868
struct kvm_set_guest_debug_data {
    struct kvm_guest_debug dbg;
1869
    CPUState *cpu;
G
Glauber Costa 已提交
1870 1871 1872 1873 1874 1875
    int err;
};

static void kvm_invoke_set_guest_debug(void *data)
{
    struct kvm_set_guest_debug_data *dbg_data = data;
J
Jan Kiszka 已提交
1876

1877 1878
    dbg_data->err = kvm_vcpu_ioctl(dbg_data->cpu, KVM_SET_GUEST_DEBUG,
                                   &dbg_data->dbg);
G
Glauber Costa 已提交
1879 1880
}

1881
int kvm_update_guest_debug(CPUArchState *env, unsigned long reinject_trap)
1882
{
1883
    CPUState *cpu = ENV_GET_CPU(env);
G
Glauber Costa 已提交
1884
    struct kvm_set_guest_debug_data data;
1885

1886
    data.dbg.control = reinject_trap;
1887

1888 1889 1890
    if (env->singlestep_enabled) {
        data.dbg.control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP;
    }
A
Andreas Färber 已提交
1891
    kvm_arch_update_guest_debug(cpu, &data.dbg);
1892
    data.cpu = cpu;
1893

1894
    run_on_cpu(cpu, kvm_invoke_set_guest_debug, &data);
G
Glauber Costa 已提交
1895
    return data.err;
1896 1897
}

1898
int kvm_insert_breakpoint(CPUArchState *current_env, target_ulong addr,
1899 1900
                          target_ulong len, int type)
{
A
Andreas Färber 已提交
1901
    CPUState *current_cpu = ENV_GET_CPU(current_env);
1902
    struct kvm_sw_breakpoint *bp;
1903
    CPUArchState *env;
1904 1905 1906
    int err;

    if (type == GDB_BREAKPOINT_SW) {
1907
        bp = kvm_find_sw_breakpoint(current_cpu, addr);
1908 1909 1910 1911 1912
        if (bp) {
            bp->use_count++;
            return 0;
        }

1913
        bp = g_malloc(sizeof(struct kvm_sw_breakpoint));
J
Jan Kiszka 已提交
1914
        if (!bp) {
1915
            return -ENOMEM;
J
Jan Kiszka 已提交
1916
        }
1917 1918 1919

        bp->pc = addr;
        bp->use_count = 1;
A
Andreas Färber 已提交
1920
        err = kvm_arch_insert_sw_breakpoint(current_cpu, bp);
1921
        if (err) {
1922
            g_free(bp);
1923 1924 1925
            return err;
        }

1926
        QTAILQ_INSERT_HEAD(&current_cpu->kvm_state->kvm_sw_breakpoints,
1927 1928 1929
                          bp, entry);
    } else {
        err = kvm_arch_insert_hw_breakpoint(addr, len, type);
J
Jan Kiszka 已提交
1930
        if (err) {
1931
            return err;
J
Jan Kiszka 已提交
1932
        }
1933 1934 1935 1936
    }

    for (env = first_cpu; env != NULL; env = env->next_cpu) {
        err = kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
1937
        if (err) {
1938
            return err;
J
Jan Kiszka 已提交
1939
        }
1940 1941 1942 1943
    }
    return 0;
}

1944
int kvm_remove_breakpoint(CPUArchState *current_env, target_ulong addr,
1945 1946
                          target_ulong len, int type)
{
A
Andreas Färber 已提交
1947
    CPUState *current_cpu = ENV_GET_CPU(current_env);
1948
    struct kvm_sw_breakpoint *bp;
1949
    CPUArchState *env;
1950 1951 1952
    int err;

    if (type == GDB_BREAKPOINT_SW) {
1953
        bp = kvm_find_sw_breakpoint(current_cpu, addr);
J
Jan Kiszka 已提交
1954
        if (!bp) {
1955
            return -ENOENT;
J
Jan Kiszka 已提交
1956
        }
1957 1958 1959 1960 1961 1962

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

A
Andreas Färber 已提交
1963
        err = kvm_arch_remove_sw_breakpoint(current_cpu, bp);
J
Jan Kiszka 已提交
1964
        if (err) {
1965
            return err;
J
Jan Kiszka 已提交
1966
        }
1967

1968
        QTAILQ_REMOVE(&current_cpu->kvm_state->kvm_sw_breakpoints, bp, entry);
1969
        g_free(bp);
1970 1971
    } else {
        err = kvm_arch_remove_hw_breakpoint(addr, len, type);
J
Jan Kiszka 已提交
1972
        if (err) {
1973
            return err;
J
Jan Kiszka 已提交
1974
        }
1975 1976 1977 1978
    }

    for (env = first_cpu; env != NULL; env = env->next_cpu) {
        err = kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
1979
        if (err) {
1980
            return err;
J
Jan Kiszka 已提交
1981
        }
1982 1983 1984 1985
    }
    return 0;
}

1986
void kvm_remove_all_breakpoints(CPUArchState *current_env)
1987
{
A
Andreas Färber 已提交
1988
    CPUState *current_cpu = ENV_GET_CPU(current_env);
1989
    struct kvm_sw_breakpoint *bp, *next;
1990
    KVMState *s = current_cpu->kvm_state;
1991
    CPUArchState *env;
A
Andreas Färber 已提交
1992
    CPUState *cpu;
1993

B
Blue Swirl 已提交
1994
    QTAILQ_FOREACH_SAFE(bp, &s->kvm_sw_breakpoints, entry, next) {
A
Andreas Färber 已提交
1995
        if (kvm_arch_remove_sw_breakpoint(current_cpu, bp) != 0) {
1996 1997
            /* Try harder to find a CPU that currently sees the breakpoint. */
            for (env = first_cpu; env != NULL; env = env->next_cpu) {
A
Andreas Färber 已提交
1998 1999
                cpu = ENV_GET_CPU(env);
                if (kvm_arch_remove_sw_breakpoint(cpu, bp) == 0) {
2000
                    break;
J
Jan Kiszka 已提交
2001
                }
2002 2003
            }
        }
2004 2005
        QTAILQ_REMOVE(&s->kvm_sw_breakpoints, bp, entry);
        g_free(bp);
2006 2007 2008
    }
    kvm_arch_remove_all_hw_breakpoints();

J
Jan Kiszka 已提交
2009
    for (env = first_cpu; env != NULL; env = env->next_cpu) {
2010
        kvm_update_guest_debug(env, 0);
J
Jan Kiszka 已提交
2011
    }
2012 2013 2014 2015
}

#else /* !KVM_CAP_SET_GUEST_DEBUG */

2016
int kvm_update_guest_debug(CPUArchState *env, unsigned long reinject_trap)
2017 2018 2019 2020
{
    return -EINVAL;
}

2021
int kvm_insert_breakpoint(CPUArchState *current_env, target_ulong addr,
2022 2023 2024 2025 2026
                          target_ulong len, int type)
{
    return -EINVAL;
}

2027
int kvm_remove_breakpoint(CPUArchState *current_env, target_ulong addr,
2028 2029 2030 2031 2032
                          target_ulong len, int type)
{
    return -EINVAL;
}

2033
void kvm_remove_all_breakpoints(CPUArchState *current_env)
2034 2035 2036
{
}
#endif /* !KVM_CAP_SET_GUEST_DEBUG */
2037

2038
int kvm_set_signal_mask(CPUArchState *env, const sigset_t *sigset)
2039
{
2040
    CPUState *cpu = ENV_GET_CPU(env);
2041 2042 2043
    struct kvm_signal_mask *sigmask;
    int r;

J
Jan Kiszka 已提交
2044
    if (!sigset) {
2045
        return kvm_vcpu_ioctl(cpu, KVM_SET_SIGNAL_MASK, NULL);
J
Jan Kiszka 已提交
2046
    }
2047

2048
    sigmask = g_malloc(sizeof(*sigmask) + sizeof(*sigset));
2049 2050 2051

    sigmask->len = 8;
    memcpy(sigmask->sigset, sigset, sizeof(*sigset));
2052
    r = kvm_vcpu_ioctl(cpu, KVM_SET_SIGNAL_MASK, sigmask);
2053
    g_free(sigmask);
2054 2055 2056

    return r;
}
2057
int kvm_on_sigbus_vcpu(CPUState *cpu, int code, void *addr)
2058
{
A
Andreas Färber 已提交
2059
    return kvm_arch_on_sigbus_vcpu(cpu, code, addr);
2060 2061 2062 2063 2064 2065
}

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