kvm-all.c

   1 /*
   2  * QEMU KVM support
   3  *
   4  * Copyright IBM, Corp. 2008
   5  *           Red Hat, Inc. 2008
   6  *
   7  * Authors:
   8  *  Anthony Liguori   <aliguori@us.ibm.com>
   9  *  Glauber Costa     <gcosta@redhat.com>
  10  *
  11  * This work is licensed under the terms of the GNU GPL, version 2 or later.
  12  * See the COPYING file in the top-level directory.
  13  *
  14  */
  15
  16 #include <sys/types.h>
  17 #include <sys/ioctl.h>
  18 #include <sys/mman.h>
  19 #include <stdarg.h>
  20
  21 #include <linux/kvm.h>
  22
  23 #include "qemu-common.h"
  24 #include "qemu-barrier.h"
  25 #include "sysemu.h"
  26 #include "hw/hw.h"
  27 #include "gdbstub.h"
  28 #include "kvm.h"
  29 #include "bswap.h"
  30
  31 /* This check must be after config-host.h is included */
  32 #ifdef CONFIG_EVENTFD
  33 #include <sys/eventfd.h>
  34 #endif
  35
  36 /* KVM uses PAGE_SIZE in it's definition of COALESCED_MMIO_MAX */
  37 #define PAGE_SIZE TARGET_PAGE_SIZE
  38
  39 //#define DEBUG_KVM
  40
  41 #ifdef DEBUG_KVM
  42 #define DPRINTF(fmt, ...) \
  43     do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
  44 #else
  45 #define DPRINTF(fmt, ...) \
  46     do { } while (0)
  47 #endif
  48
  49 typedef struct KVMSlot
  50 {
  51     target_phys_addr_t start_addr;
  52     ram_addr_t memory_size;
  53     ram_addr_t phys_offset;
  54     int slot;
  55     int flags;
  56 } KVMSlot;
  57
  58 typedef struct kvm_dirty_log KVMDirtyLog;
  59
  60 struct KVMState
  61 {
  62     KVMSlot slots[32];
  63     int fd;
  64     int vmfd;
  65     int coalesced_mmio;
  66 #ifdef KVM_CAP_COALESCED_MMIO
  67     struct kvm_coalesced_mmio_ring *coalesced_mmio_ring;
  68 #endif
  69     int broken_set_mem_region;
  70     int migration_log;
  71     int vcpu_events;
  72     int robust_singlestep;
  73     int debugregs;
  74 #ifdef KVM_CAP_SET_GUEST_DEBUG
  75     struct kvm_sw_breakpoint_head kvm_sw_breakpoints;
  76 #endif
  77     int irqchip_in_kernel;
  78     int pit_in_kernel;
  79     int xsave, xcrs;
  80     int many_ioeventfds;
  81 };
  82
  83 static KVMState *kvm_state;
  84
  85 static KVMSlot *kvm_alloc_slot(KVMState *s)
  86 {
  87     int i;
  88
  89     for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
  90         /* KVM private memory slots */
  91         if (i >= 8 && i < 12)
  92             continue;
  93         if (s->slots[i].memory_size == 0)
  94             return &s->slots[i];
  95     }
  96
  97     fprintf(stderr, "%s: no free slot available\n", __func__);
  98     abort();
  99 }
 100
 101 static KVMSlot *kvm_lookup_matching_slot(KVMState *s,
 102                                          target_phys_addr_t start_addr,
 103                                          target_phys_addr_t end_addr)
 104 {
 105     int i;
 106
 107     for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
 108         KVMSlot *mem = &s->slots[i];
 109
 110         if (start_addr == mem->start_addr &&
 111             end_addr == mem->start_addr + mem->memory_size) {
 112             return mem;
 113         }
 114     }
 115
 116     return NULL;
 117 }
 118
 119 /*
 120  * Find overlapping slot with lowest start address
 121  */
 122 static KVMSlot *kvm_lookup_overlapping_slot(KVMState *s,
 123                                             target_phys_addr_t start_addr,
 124                                             target_phys_addr_t end_addr)
 125 {
 126     KVMSlot *found = NULL;
 127     int i;
 128
 129     for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
 130         KVMSlot *mem = &s->slots[i];
 131
 132         if (mem->memory_size == 0 ||
 133             (found && found->start_addr < mem->start_addr)) {
 134             continue;
 135         }
 136
 137         if (end_addr > mem->start_addr &&
 138             start_addr < mem->start_addr + mem->memory_size) {
 139             found = mem;
 140         }
 141     }
 142
 143     return found;
 144 }
 145
 146 int kvm_physical_memory_addr_from_ram(KVMState *s, ram_addr_t ram_addr,
 147                                       target_phys_addr_t *phys_addr)
 148 {
 149     int i;
 150
 151     for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
 152         KVMSlot *mem = &s->slots[i];
 153
 154         if (ram_addr >= mem->phys_offset &&
 155             ram_addr < mem->phys_offset + mem->memory_size) {
 156             *phys_addr = mem->start_addr + (ram_addr - mem->phys_offset);
 157             return 1;
 158         }
 159     }
 160
 161     return 0;
 162 }
 163
 164 static int kvm_set_user_memory_region(KVMState *s, KVMSlot *slot)
 165 {
 166     struct kvm_userspace_memory_region mem;
 167
 168     mem.slot = slot->slot;
 169     mem.guest_phys_addr = slot->start_addr;
 170     mem.memory_size = slot->memory_size;
 171     mem.userspace_addr = (unsigned long)qemu_get_ram_ptr(slot->phys_offset);
 172     mem.flags = slot->flags;
 173     if (s->migration_log) {
 174         mem.flags |= KVM_MEM_LOG_DIRTY_PAGES;
 175     }
 176     return kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
 177 }
 178
 179 static void kvm_reset_vcpu(void *opaque)
 180 {
 181     CPUState *env = opaque;
 182
 183     kvm_arch_reset_vcpu(env);
 184 }
 185
 186 int kvm_irqchip_in_kernel(void)
 187 {
 188     return kvm_state->irqchip_in_kernel;
 189 }
 190
 191 int kvm_pit_in_kernel(void)
 192 {
 193     return kvm_state->pit_in_kernel;
 194 }
 195
 196
 197 int kvm_init_vcpu(CPUState *env)
 198 {
 199     KVMState *s = kvm_state;
 200     long mmap_size;
 201     int ret;
 202
 203     DPRINTF("kvm_init_vcpu\n");
 204
 205     ret = kvm_vm_ioctl(s, KVM_CREATE_VCPU, env->cpu_index);
 206     if (ret < 0) {
 207         DPRINTF("kvm_create_vcpu failed\n");
 208         goto err;
 209     }
 210
 211     env->kvm_fd = ret;
 212     env->kvm_state = s;
 213
 214     mmap_size = kvm_ioctl(s, KVM_GET_VCPU_MMAP_SIZE, 0);
 215     if (mmap_size < 0) {
 216         DPRINTF("KVM_GET_VCPU_MMAP_SIZE failed\n");
 217         goto err;
 218     }
 219
 220     env->kvm_run = mmap(NULL, mmap_size, PROT_READ | PROT_WRITE, MAP_SHARED,
 221                         env->kvm_fd, 0);
 222     if (env->kvm_run == MAP_FAILED) {
 223         ret = -errno;
 224         DPRINTF("mmap'ing vcpu state failed\n");
 225         goto err;
 226     }
 227
 228 #ifdef KVM_CAP_COALESCED_MMIO
 229     if (s->coalesced_mmio && !s->coalesced_mmio_ring)
 230         s->coalesced_mmio_ring = (void *) env->kvm_run +
 231                 s->coalesced_mmio * PAGE_SIZE;
 232 #endif
 233
 234     ret = kvm_arch_init_vcpu(env);
 235     if (ret == 0) {
 236         qemu_register_reset(kvm_reset_vcpu, env);
 237         kvm_arch_reset_vcpu(env);
 238     }
 239 err:
 240     return ret;
 241 }
 242
 243 /*
 244  * dirty pages logging control
 245  */
 246 static int kvm_dirty_pages_log_change(target_phys_addr_t phys_addr,
 247                                       ram_addr_t size, int flags, int mask)
 248 {
 249     KVMState *s = kvm_state;
 250     KVMSlot *mem = kvm_lookup_matching_slot(s, phys_addr, phys_addr + size);
 251     int old_flags;
 252
 253     if (mem == NULL)  {
 254             fprintf(stderr, "BUG: %s: invalid parameters " TARGET_FMT_plx "-"
 255                     TARGET_FMT_plx "\n", __func__, phys_addr,
 256                     (target_phys_addr_t)(phys_addr + size - 1));
 257             return -EINVAL;
 258     }
 259
 260     old_flags = mem->flags;
 261
 262     flags = (mem->flags & ~mask) | flags;
 263     mem->flags = flags;
 264
 265     /* If nothing changed effectively, no need to issue ioctl */
 266     if (s->migration_log) {
 267         flags |= KVM_MEM_LOG_DIRTY_PAGES;
 268     }
 269     if (flags == old_flags) {
 270             return 0;
 271     }
 272
 273     return kvm_set_user_memory_region(s, mem);
 274 }
 275
 276 int kvm_log_start(target_phys_addr_t phys_addr, ram_addr_t size)
 277 {
 278         return kvm_dirty_pages_log_change(phys_addr, size,
 279                                           KVM_MEM_LOG_DIRTY_PAGES,
 280                                           KVM_MEM_LOG_DIRTY_PAGES);
 281 }
 282
 283 int kvm_log_stop(target_phys_addr_t phys_addr, ram_addr_t size)
 284 {
 285         return kvm_dirty_pages_log_change(phys_addr, size,
 286                                           0,
 287                                           KVM_MEM_LOG_DIRTY_PAGES);
 288 }
 289
 290 static int kvm_set_migration_log(int enable)
 291 {
 292     KVMState *s = kvm_state;
 293     KVMSlot *mem;
 294     int i, err;
 295
 296     s->migration_log = enable;
 297
 298     for (i = 0; i < ARRAY_SIZE(s->slots); i++) {
 299         mem = &s->slots[i];
 300
 301         if (!mem->memory_size) {
 302             continue;
 303         }
 304         if (!!(mem->flags & KVM_MEM_LOG_DIRTY_PAGES) == enable) {
 305             continue;
 306         }
 307         err = kvm_set_user_memory_region(s, mem);
 308         if (err) {
 309             return err;
 310         }
 311     }
 312     return 0;
 313 }
 314
 315 /* get kvm's dirty pages bitmap and update qemu's */
 316 static int kvm_get_dirty_pages_log_range(unsigned long start_addr,
 317                                          unsigned long *bitmap,
 318                                          unsigned long offset,
 319                                          unsigned long mem_size)
 320 {
 321     unsigned int i, j;
 322     unsigned long page_number, addr, addr1, c;
 323     ram_addr_t ram_addr;
 324     unsigned int len = ((mem_size / TARGET_PAGE_SIZE) + HOST_LONG_BITS - 1) /
 325         HOST_LONG_BITS;
 326
 327     /*
 328      * bitmap-traveling is faster than memory-traveling (for addr...)
 329      * especially when most of the memory is not dirty.
 330      */
 331     for (i = 0; i < len; i++) {
 332         if (bitmap[i] != 0) {
 333             c = leul_to_cpu(bitmap[i]);
 334             do {
 335                 j = ffsl(c) - 1;
 336                 c &= ~(1ul << j);
 337                 page_number = i * HOST_LONG_BITS + j;
 338                 addr1 = page_number * TARGET_PAGE_SIZE;
 339                 addr = offset + addr1;
 340                 ram_addr = cpu_get_physical_page_desc(addr);
 341                 cpu_physical_memory_set_dirty(ram_addr);
 342             } while (c != 0);
 343         }
 344     }
 345     return 0;
 346 }
 347
 348 #define ALIGN(x, y)  (((x)+(y)-1) & ~((y)-1))
 349
 350 /**
 351  * kvm_physical_sync_dirty_bitmap - Grab dirty bitmap from kernel space
 352  * This function updates qemu's dirty bitmap using cpu_physical_memory_set_dirty().
 353  * This means all bits are set to dirty.
 354  *
 355  * @start_add: start of logged region.
 356  * @end_addr: end of logged region.
 357  */
 358 static int kvm_physical_sync_dirty_bitmap(target_phys_addr_t start_addr,
 359                                           target_phys_addr_t end_addr)
 360 {
 361     KVMState *s = kvm_state;
 362     unsigned long size, allocated_size = 0;
 363     KVMDirtyLog d;
 364     KVMSlot *mem;
 365     int ret = 0;
 366
 367     d.dirty_bitmap = NULL;
 368     while (start_addr < end_addr) {
 369         mem = kvm_lookup_overlapping_slot(s, start_addr, end_addr);
 370         if (mem == NULL) {
 371             break;
 372         }
 373
 374         size = ALIGN(((mem->memory_size) >> TARGET_PAGE_BITS), HOST_LONG_BITS) / 8;
 375         if (!d.dirty_bitmap) {
 376             d.dirty_bitmap = qemu_malloc(size);
 377         } else if (size > allocated_size) {
 378             d.dirty_bitmap = qemu_realloc(d.dirty_bitmap, size);
 379         }
 380         allocated_size = size;
 381         memset(d.dirty_bitmap, 0, allocated_size);
 382
 383         d.slot = mem->slot;
 384
 385         if (kvm_vm_ioctl(s, KVM_GET_DIRTY_LOG, &d) == -1) {
 386             DPRINTF("ioctl failed %d\n", errno);
 387             ret = -1;
 388             break;
 389         }
 390
 391         kvm_get_dirty_pages_log_range(mem->start_addr, d.dirty_bitmap,
 392                                       mem->start_addr, mem->memory_size);
 393         start_addr = mem->start_addr + mem->memory_size;
 394     }
 395     qemu_free(d.dirty_bitmap);
 396
 397     return ret;
 398 }
 399
 400 int kvm_coalesce_mmio_region(target_phys_addr_t start, ram_addr_t size)
 401 {
 402     int ret = -ENOSYS;
 403 #ifdef KVM_CAP_COALESCED_MMIO
 404     KVMState *s = kvm_state;
 405
 406     if (s->coalesced_mmio) {
 407         struct kvm_coalesced_mmio_zone zone;
 408
 409         zone.addr = start;
 410         zone.size = size;
 411
 412         ret = kvm_vm_ioctl(s, KVM_REGISTER_COALESCED_MMIO, &zone);
 413     }
 414 #endif
 415
 416     return ret;
 417 }
 418
 419 int kvm_uncoalesce_mmio_region(target_phys_addr_t start, ram_addr_t size)
 420 {
 421     int ret = -ENOSYS;
 422 #ifdef KVM_CAP_COALESCED_MMIO
 423     KVMState *s = kvm_state;
 424
 425     if (s->coalesced_mmio) {
 426         struct kvm_coalesced_mmio_zone zone;
 427
 428         zone.addr = start;
 429         zone.size = size;
 430
 431         ret = kvm_vm_ioctl(s, KVM_UNREGISTER_COALESCED_MMIO, &zone);
 432     }
 433 #endif
 434
 435     return ret;
 436 }
 437
 438 int kvm_check_extension(KVMState *s, unsigned int extension)
 439 {
 440     int ret;
 441
 442     ret = kvm_ioctl(s, KVM_CHECK_EXTENSION, extension);
 443     if (ret < 0) {
 444         ret = 0;
 445     }
 446
 447     return ret;
 448 }
 449
 450 static int kvm_check_many_ioeventfds(void)
 451 {
 452     /* Older kernels have a 6 device limit on the KVM io bus.  Find out so we
 453      * can avoid creating too many ioeventfds.
 454      */
 455 #ifdef CONFIG_EVENTFD
 456     int ioeventfds[7];
 457     int i, ret = 0;
 458     for (i = 0; i < ARRAY_SIZE(ioeventfds); i++) {
 459         ioeventfds[i] = eventfd(0, EFD_CLOEXEC);
 460         if (ioeventfds[i] < 0) {
 461             break;
 462         }
 463         ret = kvm_set_ioeventfd_pio_word(ioeventfds[i], 0, i, true);
 464         if (ret < 0) {
 465             close(ioeventfds[i]);
 466             break;
 467         }
 468     }
 469
 470     /* Decide whether many devices are supported or not */
 471     ret = i == ARRAY_SIZE(ioeventfds);
 472
 473     while (i-- > 0) {
 474         kvm_set_ioeventfd_pio_word(ioeventfds[i], 0, i, false);
 475         close(ioeventfds[i]);
 476     }
 477     return ret;
 478 #else
 479     return 0;
 480 #endif
 481 }
 482
 483 static void kvm_set_phys_mem(target_phys_addr_t start_addr,
 484                              ram_addr_t size,
 485                              ram_addr_t phys_offset)
 486 {
 487     KVMState *s = kvm_state;
 488     ram_addr_t flags = phys_offset & ~TARGET_PAGE_MASK;
 489     KVMSlot *mem, old;
 490     int err;
 491
 492     /* kvm works in page size chunks, but the function may be called
 493        with sub-page size and unaligned start address. */
 494     size = TARGET_PAGE_ALIGN(size);
 495     start_addr = TARGET_PAGE_ALIGN(start_addr);
 496
 497     /* KVM does not support read-only slots */
 498     phys_offset &= ~IO_MEM_ROM;
 499
 500     while (1) {
 501         mem = kvm_lookup_overlapping_slot(s, start_addr, start_addr + size);
 502         if (!mem) {
 503             break;
 504         }
 505
 506         if (flags < IO_MEM_UNASSIGNED && start_addr >= mem->start_addr &&
 507             (start_addr + size <= mem->start_addr + mem->memory_size) &&
 508             (phys_offset - start_addr == mem->phys_offset - mem->start_addr)) {
 509             /* The new slot fits into the existing one and comes with
 510              * identical parameters - nothing to be done. */
 511             return;
 512         }
 513
 514         old = *mem;
 515
 516         /* unregister the overlapping slot */
 517         mem->memory_size = 0;
 518         err = kvm_set_user_memory_region(s, mem);
 519         if (err) {
 520             fprintf(stderr, "%s: error unregistering overlapping slot: %s\n",
 521                     __func__, strerror(-err));
 522             abort();
 523         }
 524
 525         /* Workaround for older KVM versions: we can't join slots, even not by
 526          * unregistering the previous ones and then registering the larger
 527          * slot. We have to maintain the existing fragmentation. Sigh.
 528          *
 529          * This workaround assumes that the new slot starts at the same
 530          * address as the first existing one. If not or if some overlapping
 531          * slot comes around later, we will fail (not seen in practice so far)
 532          * - and actually require a recent KVM version. */
 533         if (s->broken_set_mem_region &&
 534             old.start_addr == start_addr && old.memory_size < size &&
 535             flags < IO_MEM_UNASSIGNED) {
 536             mem = kvm_alloc_slot(s);
 537             mem->memory_size = old.memory_size;
 538             mem->start_addr = old.start_addr;
 539             mem->phys_offset = old.phys_offset;
 540             mem->flags = 0;
 541
 542             err = kvm_set_user_memory_region(s, mem);
 543             if (err) {
 544                 fprintf(stderr, "%s: error updating slot: %s\n", __func__,
 545                         strerror(-err));
 546                 abort();
 547             }
 548
 549             start_addr += old.memory_size;
 550             phys_offset += old.memory_size;
 551             size -= old.memory_size;
 552             continue;
 553         }
 554
 555         /* register prefix slot */
 556         if (old.start_addr < start_addr) {
 557             mem = kvm_alloc_slot(s);
 558             mem->memory_size = start_addr - old.start_addr;
 559             mem->start_addr = old.start_addr;
 560             mem->phys_offset = old.phys_offset;
 561             mem->flags = 0;
 562
 563             err = kvm_set_user_memory_region(s, mem);
 564             if (err) {
 565                 fprintf(stderr, "%s: error registering prefix slot: %s\n",
 566                         __func__, strerror(-err));
 567                 abort();
 568             }
 569         }
 570
 571         /* register suffix slot */
 572         if (old.start_addr + old.memory_size > start_addr + size) {
 573             ram_addr_t size_delta;
 574
 575             mem = kvm_alloc_slot(s);
 576             mem->start_addr = start_addr + size;
 577             size_delta = mem->start_addr - old.start_addr;
 578             mem->memory_size = old.memory_size - size_delta;
 579             mem->phys_offset = old.phys_offset + size_delta;
 580             mem->flags = 0;
 581
 582             err = kvm_set_user_memory_region(s, mem);
 583             if (err) {
 584                 fprintf(stderr, "%s: error registering suffix slot: %s\n",
 585                         __func__, strerror(-err));
 586                 abort();
 587             }
 588         }
 589     }
 590
 591     /* in case the KVM bug workaround already "consumed" the new slot */
 592     if (!size)
 593         return;
 594
 595     /* KVM does not need to know about this memory */
 596     if (flags >= IO_MEM_UNASSIGNED)
 597         return;
 598
 599     mem = kvm_alloc_slot(s);
 600     mem->memory_size = size;
 601     mem->start_addr = start_addr;
 602     mem->phys_offset = phys_offset;
 603     mem->flags = 0;
 604
 605     err = kvm_set_user_memory_region(s, mem);
 606     if (err) {
 607         fprintf(stderr, "%s: error registering slot: %s\n", __func__,
 608                 strerror(-err));
 609         abort();
 610     }
 611 }
 612
 613 static void kvm_client_set_memory(struct CPUPhysMemoryClient *client,
 614                                   target_phys_addr_t start_addr,
 615                                   ram_addr_t size,
 616                                   ram_addr_t phys_offset)
 617 {
 618         kvm_set_phys_mem(start_addr, size, phys_offset);
 619 }
 620
 621 static int kvm_client_sync_dirty_bitmap(struct CPUPhysMemoryClient *client,
 622                                         target_phys_addr_t start_addr,
 623                                         target_phys_addr_t end_addr)
 624 {
 625         return kvm_physical_sync_dirty_bitmap(start_addr, end_addr);
 626 }
 627
 628 static int kvm_client_migration_log(struct CPUPhysMemoryClient *client,
 629                                     int enable)
 630 {
 631         return kvm_set_migration_log(enable);
 632 }
 633
 634 static CPUPhysMemoryClient kvm_cpu_phys_memory_client = {
 635         .set_memory = kvm_client_set_memory,
 636         .sync_dirty_bitmap = kvm_client_sync_dirty_bitmap,
 637         .migration_log = kvm_client_migration_log,
 638 };
 639
 640 int kvm_init(int smp_cpus)
 641 {
 642     static const char upgrade_note[] =
 643         "Please upgrade to at least kernel 2.6.29 or recent kvm-kmod\n"
 644         "(see http://sourceforge.net/projects/kvm).\n";
 645     KVMState *s;
 646     int ret;
 647     int i;
 648
 649     s = qemu_mallocz(sizeof(KVMState));
 650
 651 #ifdef KVM_CAP_SET_GUEST_DEBUG
 652     QTAILQ_INIT(&s->kvm_sw_breakpoints);
 653 #endif
 654     for (i = 0; i < ARRAY_SIZE(s->slots); i++)
 655         s->slots[i].slot = i;
 656
 657     s->vmfd = -1;
 658     s->fd = qemu_open("/dev/kvm", O_RDWR);
 659     if (s->fd == -1) {
 660         fprintf(stderr, "Could not access KVM kernel module: %m\n");
 661         ret = -errno;
 662         goto err;
 663     }
 664
 665     ret = kvm_ioctl(s, KVM_GET_API_VERSION, 0);
 666     if (ret < KVM_API_VERSION) {
 667         if (ret > 0)
 668             ret = -EINVAL;
 669         fprintf(stderr, "kvm version too old\n");
 670         goto err;
 671     }
 672
 673     if (ret > KVM_API_VERSION) {
 674         ret = -EINVAL;
 675         fprintf(stderr, "kvm version not supported\n");
 676         goto err;
 677     }
 678
 679     s->vmfd = kvm_ioctl(s, KVM_CREATE_VM, 0);
 680     if (s->vmfd < 0) {
 681 #ifdef TARGET_S390X
 682         fprintf(stderr, "Please add the 'switch_amode' kernel parameter to "
 683                         "your host kernel command line\n");
 684 #endif
 685         goto err;
 686     }
 687
 688     /* initially, KVM allocated its own memory and we had to jump through
 689      * hooks to make phys_ram_base point to this.  Modern versions of KVM
 690      * just use a user allocated buffer so we can use regular pages
 691      * unmodified.  Make sure we have a sufficiently modern version of KVM.
 692      */
 693     if (!kvm_check_extension(s, KVM_CAP_USER_MEMORY)) {
 694         ret = -EINVAL;
 695         fprintf(stderr, "kvm does not support KVM_CAP_USER_MEMORY\n%s",
 696                 upgrade_note);
 697         goto err;
 698     }
 699
 700     /* There was a nasty bug in < kvm-80 that prevents memory slots from being
 701      * destroyed properly.  Since we rely on this capability, refuse to work
 702      * with any kernel without this capability. */
 703     if (!kvm_check_extension(s, KVM_CAP_DESTROY_MEMORY_REGION_WORKS)) {
 704         ret = -EINVAL;
 705
 706         fprintf(stderr,
 707                 "KVM kernel module broken (DESTROY_MEMORY_REGION).\n%s",
 708                 upgrade_note);
 709         goto err;
 710     }
 711
 712     s->coalesced_mmio = 0;
 713 #ifdef KVM_CAP_COALESCED_MMIO
 714     s->coalesced_mmio = kvm_check_extension(s, KVM_CAP_COALESCED_MMIO);
 715     s->coalesced_mmio_ring = NULL;
 716 #endif
 717
 718     s->broken_set_mem_region = 1;
 719 #ifdef KVM_CAP_JOIN_MEMORY_REGIONS_WORKS
 720     ret = kvm_ioctl(s, KVM_CHECK_EXTENSION, KVM_CAP_JOIN_MEMORY_REGIONS_WORKS);
 721     if (ret > 0) {
 722         s->broken_set_mem_region = 0;
 723     }
 724 #endif
 725
 726     s->vcpu_events = 0;
 727 #ifdef KVM_CAP_VCPU_EVENTS
 728     s->vcpu_events = kvm_check_extension(s, KVM_CAP_VCPU_EVENTS);
 729 #endif
 730
 731     s->robust_singlestep = 0;
 732 #ifdef KVM_CAP_X86_ROBUST_SINGLESTEP
 733     s->robust_singlestep =
 734         kvm_check_extension(s, KVM_CAP_X86_ROBUST_SINGLESTEP);
 735 #endif
 736
 737     s->debugregs = 0;
 738 #ifdef KVM_CAP_DEBUGREGS
 739     s->debugregs = kvm_check_extension(s, KVM_CAP_DEBUGREGS);
 740 #endif
 741
 742     s->xsave = 0;
 743 #ifdef KVM_CAP_XSAVE
 744     s->xsave = kvm_check_extension(s, KVM_CAP_XSAVE);
 745 #endif
 746
 747     s->xcrs = 0;
 748 #ifdef KVM_CAP_XCRS
 749     s->xcrs = kvm_check_extension(s, KVM_CAP_XCRS);
 750 #endif
 751
 752     ret = kvm_arch_init(s, smp_cpus);
 753     if (ret < 0)
 754         goto err;
 755
 756     kvm_state = s;
 757     cpu_register_phys_memory_client(&kvm_cpu_phys_memory_client);
 758
 759     s->many_ioeventfds = kvm_check_many_ioeventfds();
 760
 761     return 0;
 762
 763 err:
 764     if (s) {
 765         if (s->vmfd != -1)
 766             close(s->vmfd);
 767         if (s->fd != -1)
 768             close(s->fd);
 769     }
 770     qemu_free(s);
 771
 772     return ret;
 773 }
 774
 775 static int kvm_handle_io(uint16_t port, void *data, int direction, int size,
 776                          uint32_t count)
 777 {
 778     int i;
 779     uint8_t *ptr = data;
 780
 781     for (i = 0; i < count; i++) {
 782         if (direction == KVM_EXIT_IO_IN) {
 783             switch (size) {
 784             case 1:
 785                 stb_p(ptr, cpu_inb(port));
 786                 break;
 787             case 2:
 788                 stw_p(ptr, cpu_inw(port));
 789                 break;
 790             case 4:
 791                 stl_p(ptr, cpu_inl(port));
 792                 break;
 793             }
 794         } else {
 795             switch (size) {
 796             case 1:
 797                 cpu_outb(port, ldub_p(ptr));
 798                 break;
 799             case 2:
 800                 cpu_outw(port, lduw_p(ptr));
 801                 break;
 802             case 4:
 803                 cpu_outl(port, ldl_p(ptr));
 804                 break;
 805             }
 806         }
 807
 808         ptr += size;
 809     }
 810
 811     return 1;
 812 }
 813
 814 #ifdef KVM_CAP_INTERNAL_ERROR_DATA
 815 static void kvm_handle_internal_error(CPUState *env, struct kvm_run *run)
 816 {
 817
 818     if (kvm_check_extension(kvm_state, KVM_CAP_INTERNAL_ERROR_DATA)) {
 819         int i;
 820
 821         fprintf(stderr, "KVM internal error. Suberror: %d\n",
 822                 run->internal.suberror);
 823
 824         for (i = 0; i < run->internal.ndata; ++i) {
 825             fprintf(stderr, "extra data[%d]: %"PRIx64"\n",
 826                     i, (uint64_t)run->internal.data[i]);
 827         }
 828     }
 829     cpu_dump_state(env, stderr, fprintf, 0);
 830     if (run->internal.suberror == KVM_INTERNAL_ERROR_EMULATION) {
 831         fprintf(stderr, "emulation failure\n");
 832         if (!kvm_arch_stop_on_emulation_error(env))
 833                 return;
 834     }
 835     /* FIXME: Should trigger a qmp message to let management know
 836      * something went wrong.
 837      */
 838     vm_stop(0);
 839 }
 840 #endif
 841
 842 void kvm_flush_coalesced_mmio_buffer(void)
 843 {
 844 #ifdef KVM_CAP_COALESCED_MMIO
 845     KVMState *s = kvm_state;
 846     if (s->coalesced_mmio_ring) {
 847         struct kvm_coalesced_mmio_ring *ring = s->coalesced_mmio_ring;
 848         while (ring->first != ring->last) {
 849             struct kvm_coalesced_mmio *ent;
 850
 851             ent = &ring->coalesced_mmio[ring->first];
 852
 853             cpu_physical_memory_write(ent->phys_addr, ent->data, ent->len);
 854             smp_wmb();
 855             ring->first = (ring->first + 1) % KVM_COALESCED_MMIO_MAX;
 856         }
 857     }
 858 #endif
 859 }
 860
 861 static void do_kvm_cpu_synchronize_state(void *_env)
 862 {
 863     CPUState *env = _env;
 864
 865     if (!env->kvm_vcpu_dirty) {
 866         kvm_arch_get_registers(env);
 867         env->kvm_vcpu_dirty = 1;
 868     }
 869 }
 870
 871 void kvm_cpu_synchronize_state(CPUState *env)
 872 {
 873     if (!env->kvm_vcpu_dirty)
 874         run_on_cpu(env, do_kvm_cpu_synchronize_state, env);
 875 }
 876
 877 void kvm_cpu_synchronize_post_reset(CPUState *env)
 878 {
 879     kvm_arch_put_registers(env, KVM_PUT_RESET_STATE);
 880     env->kvm_vcpu_dirty = 0;
 881 }
 882
 883 void kvm_cpu_synchronize_post_init(CPUState *env)
 884 {
 885     kvm_arch_put_registers(env, KVM_PUT_FULL_STATE);
 886     env->kvm_vcpu_dirty = 0;
 887 }
 888
 889 int kvm_cpu_exec(CPUState *env)
 890 {
 891     struct kvm_run *run = env->kvm_run;
 892     int ret;
 893
 894     DPRINTF("kvm_cpu_exec()\n");
 895
 896     do {
 897 #ifndef CONFIG_IOTHREAD
 898         if (env->exit_request) {
 899             DPRINTF("interrupt exit requested\n");
 900             ret = 0;
 901             break;
 902         }
 903 #endif
 904
 905         if (kvm_arch_process_irqchip_events(env)) {
 906             ret = 0;
 907             break;
 908         }
 909
 910         if (env->kvm_vcpu_dirty) {
 911             kvm_arch_put_registers(env, KVM_PUT_RUNTIME_STATE);
 912             env->kvm_vcpu_dirty = 0;
 913         }
 914
 915         kvm_arch_pre_run(env, run);
 916         cpu_single_env = NULL;
 917         qemu_mutex_unlock_iothread();
 918         ret = kvm_vcpu_ioctl(env, KVM_RUN, 0);
 919         qemu_mutex_lock_iothread();
 920         cpu_single_env = env;
 921         kvm_arch_post_run(env, run);
 922
 923         if (ret == -EINTR || ret == -EAGAIN) {
 924             cpu_exit(env);
 925             DPRINTF("io window exit\n");
 926             ret = 0;
 927             break;
 928         }
 929
 930         if (ret < 0) {
 931             DPRINTF("kvm run failed %s\n", strerror(-ret));
 932             abort();
 933         }
 934
 935         kvm_flush_coalesced_mmio_buffer();
 936
 937         ret = 0; /* exit loop */
 938         switch (run->exit_reason) {
 939         case KVM_EXIT_IO:
 940             DPRINTF("handle_io\n");
 941             ret = kvm_handle_io(run->io.port,
 942                                 (uint8_t *)run + run->io.data_offset,
 943                                 run->io.direction,
 944                                 run->io.size,
 945                                 run->io.count);
 946             break;
 947         case KVM_EXIT_MMIO:
 948             DPRINTF("handle_mmio\n");
 949             cpu_physical_memory_rw(run->mmio.phys_addr,
 950                                    run->mmio.data,
 951                                    run->mmio.len,
 952                                    run->mmio.is_write);
 953             ret = 1;
 954             break;
 955         case KVM_EXIT_IRQ_WINDOW_OPEN:
 956             DPRINTF("irq_window_open\n");
 957             break;
 958         case KVM_EXIT_SHUTDOWN:
 959             DPRINTF("shutdown\n");
 960             qemu_system_reset_request();
 961             ret = 1;
 962             break;
 963         case KVM_EXIT_UNKNOWN:
 964             DPRINTF("kvm_exit_unknown\n");
 965             break;
 966         case KVM_EXIT_FAIL_ENTRY:
 967             DPRINTF("kvm_exit_fail_entry\n");
 968             break;
 969         case KVM_EXIT_EXCEPTION:
 970             DPRINTF("kvm_exit_exception\n");
 971             break;
 972 #ifdef KVM_CAP_INTERNAL_ERROR_DATA
 973         case KVM_EXIT_INTERNAL_ERROR:
 974             kvm_handle_internal_error(env, run);
 975             break;
 976 #endif
 977         case KVM_EXIT_DEBUG:
 978             DPRINTF("kvm_exit_debug\n");
 979 #ifdef KVM_CAP_SET_GUEST_DEBUG
 980             if (kvm_arch_debug(&run->debug.arch)) {
 981                 env->exception_index = EXCP_DEBUG;
 982                 return 0;
 983             }
 984             /* re-enter, this exception was guest-internal */
 985             ret = 1;
 986 #endif /* KVM_CAP_SET_GUEST_DEBUG */
 987             break;
 988         default:
 989             DPRINTF("kvm_arch_handle_exit\n");
 990             ret = kvm_arch_handle_exit(env, run);
 991             break;
 992         }
 993     } while (ret > 0);
 994
 995     if (env->exit_request) {
 996         env->exit_request = 0;
 997         env->exception_index = EXCP_INTERRUPT;
 998     }
 999
1000     return ret;
1001 }
1002
1003 int kvm_ioctl(KVMState *s, int type, ...)
1004 {
1005     int ret;
1006     void *arg;
1007     va_list ap;
1008
1009     va_start(ap, type);
1010     arg = va_arg(ap, void *);
1011     va_end(ap);
1012
1013     ret = ioctl(s->fd, type, arg);
1014     if (ret == -1)
1015         ret = -errno;
1016
1017     return ret;
1018 }
1019
1020 int kvm_vm_ioctl(KVMState *s, int type, ...)
1021 {
1022     int ret;
1023     void *arg;
1024     va_list ap;
1025
1026     va_start(ap, type);
1027     arg = va_arg(ap, void *);
1028     va_end(ap);
1029
1030     ret = ioctl(s->vmfd, type, arg);
1031     if (ret == -1)
1032         ret = -errno;
1033
1034     return ret;
1035 }
1036
1037 int kvm_vcpu_ioctl(CPUState *env, int type, ...)
1038 {
1039     int ret;
1040     void *arg;
1041     va_list ap;
1042
1043     va_start(ap, type);
1044     arg = va_arg(ap, void *);
1045     va_end(ap);
1046
1047     ret = ioctl(env->kvm_fd, type, arg);
1048     if (ret == -1)
1049         ret = -errno;
1050
1051     return ret;
1052 }
1053
1054 int kvm_has_sync_mmu(void)
1055 {
1056 #ifdef KVM_CAP_SYNC_MMU
1057     KVMState *s = kvm_state;
1058
1059     return kvm_check_extension(s, KVM_CAP_SYNC_MMU);
1060 #else
1061     return 0;
1062 #endif
1063 }
1064
1065 int kvm_has_vcpu_events(void)
1066 {
1067     return kvm_state->vcpu_events;
1068 }
1069
1070 int kvm_has_robust_singlestep(void)
1071 {
1072     return kvm_state->robust_singlestep;
1073 }
1074
1075 int kvm_has_debugregs(void)
1076 {
1077     return kvm_state->debugregs;
1078 }
1079
1080 int kvm_has_xsave(void)
1081 {
1082     return kvm_state->xsave;
1083 }
1084
1085 int kvm_has_xcrs(void)
1086 {
1087     return kvm_state->xcrs;
1088 }
1089
1090 int kvm_has_many_ioeventfds(void)
1091 {
1092     return kvm_state->many_ioeventfds;
1093 }
1094
1095 void kvm_setup_guest_memory(void *start, size_t size)
1096 {
1097     if (!kvm_has_sync_mmu()) {
1098         int ret = qemu_madvise(start, size, QEMU_MADV_DONTFORK);
1099
1100         if (ret) {
1101             perror("qemu_madvise");
1102             fprintf(stderr,
1103                     "Need MADV_DONTFORK in absence of synchronous KVM MMU\n");
1104             exit(1);
1105         }
1106     }
1107 }
1108
1109 #ifdef KVM_CAP_SET_GUEST_DEBUG
1110 struct kvm_sw_breakpoint *kvm_find_sw_breakpoint(CPUState *env,
1111                                                  target_ulong pc)
1112 {
1113     struct kvm_sw_breakpoint *bp;
1114
1115     QTAILQ_FOREACH(bp, &env->kvm_state->kvm_sw_breakpoints, entry) {
1116         if (bp->pc == pc)
1117             return bp;
1118     }
1119     return NULL;
1120 }
1121
1122 int kvm_sw_breakpoints_active(CPUState *env)
1123 {
1124     return !QTAILQ_EMPTY(&env->kvm_state->kvm_sw_breakpoints);
1125 }
1126
1127 struct kvm_set_guest_debug_data {
1128     struct kvm_guest_debug dbg;
1129     CPUState *env;
1130     int err;
1131 };
1132
1133 static void kvm_invoke_set_guest_debug(void *data)
1134 {
1135     struct kvm_set_guest_debug_data *dbg_data = data;
1136     CPUState *env = dbg_data->env;
1137
1138     dbg_data->err = kvm_vcpu_ioctl(env, KVM_SET_GUEST_DEBUG, &dbg_data->dbg);
1139 }
1140
1141 int kvm_update_guest_debug(CPUState *env, unsigned long reinject_trap)
1142 {
1143     struct kvm_set_guest_debug_data data;
1144
1145     data.dbg.control = reinject_trap;
1146
1147     if (env->singlestep_enabled) {
1148         data.dbg.control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP;
1149     }
1150     kvm_arch_update_guest_debug(env, &data.dbg);
1151     data.env = env;
1152
1153     run_on_cpu(env, kvm_invoke_set_guest_debug, &data);
1154     return data.err;
1155 }
1156
1157 int kvm_insert_breakpoint(CPUState *current_env, target_ulong addr,
1158                           target_ulong len, int type)
1159 {
1160     struct kvm_sw_breakpoint *bp;
1161     CPUState *env;
1162     int err;
1163
1164     if (type == GDB_BREAKPOINT_SW) {
1165         bp = kvm_find_sw_breakpoint(current_env, addr);
1166         if (bp) {
1167             bp->use_count++;
1168             return 0;
1169         }
1170
1171         bp = qemu_malloc(sizeof(struct kvm_sw_breakpoint));
1172         if (!bp)
1173             return -ENOMEM;
1174
1175         bp->pc = addr;
1176         bp->use_count = 1;
1177         err = kvm_arch_insert_sw_breakpoint(current_env, bp);
1178         if (err) {
1179             free(bp);
1180             return err;
1181         }
1182
1183         QTAILQ_INSERT_HEAD(&current_env->kvm_state->kvm_sw_breakpoints,
1184                           bp, entry);
1185     } else {
1186         err = kvm_arch_insert_hw_breakpoint(addr, len, type);
1187         if (err)
1188             return err;
1189     }
1190
1191     for (env = first_cpu; env != NULL; env = env->next_cpu) {
1192         err = kvm_update_guest_debug(env, 0);
1193         if (err)
1194             return err;
1195     }
1196     return 0;
1197 }
1198
1199 int kvm_remove_breakpoint(CPUState *current_env, target_ulong addr,
1200                           target_ulong len, int type)
1201 {
1202     struct kvm_sw_breakpoint *bp;
1203     CPUState *env;
1204     int err;
1205
1206     if (type == GDB_BREAKPOINT_SW) {
1207         bp = kvm_find_sw_breakpoint(current_env, addr);
1208         if (!bp)
1209             return -ENOENT;
1210
1211         if (bp->use_count > 1) {
1212             bp->use_count--;
1213             return 0;
1214         }
1215
1216         err = kvm_arch_remove_sw_breakpoint(current_env, bp);
1217         if (err)
1218             return err;
1219
1220         QTAILQ_REMOVE(&current_env->kvm_state->kvm_sw_breakpoints, bp, entry);
1221         qemu_free(bp);
1222     } else {
1223         err = kvm_arch_remove_hw_breakpoint(addr, len, type);
1224         if (err)
1225             return err;
1226     }
1227
1228     for (env = first_cpu; env != NULL; env = env->next_cpu) {
1229         err = kvm_update_guest_debug(env, 0);
1230         if (err)
1231             return err;
1232     }
1233     return 0;
1234 }
1235
1236 void kvm_remove_all_breakpoints(CPUState *current_env)
1237 {
1238     struct kvm_sw_breakpoint *bp, *next;
1239     KVMState *s = current_env->kvm_state;
1240     CPUState *env;
1241
1242     QTAILQ_FOREACH_SAFE(bp, &s->kvm_sw_breakpoints, entry, next) {
1243         if (kvm_arch_remove_sw_breakpoint(current_env, bp) != 0) {
1244             /* Try harder to find a CPU that currently sees the breakpoint. */
1245             for (env = first_cpu; env != NULL; env = env->next_cpu) {
1246                 if (kvm_arch_remove_sw_breakpoint(env, bp) == 0)
1247                     break;
1248             }
1249         }
1250     }
1251     kvm_arch_remove_all_hw_breakpoints();
1252
1253     for (env = first_cpu; env != NULL; env = env->next_cpu)
1254         kvm_update_guest_debug(env, 0);
1255 }
1256
1257 #else /* !KVM_CAP_SET_GUEST_DEBUG */
1258
1259 int kvm_update_guest_debug(CPUState *env, unsigned long reinject_trap)
1260 {
1261     return -EINVAL;
1262 }
1263
1264 int kvm_insert_breakpoint(CPUState *current_env, target_ulong addr,
1265                           target_ulong len, int type)
1266 {
1267     return -EINVAL;
1268 }
1269
1270 int kvm_remove_breakpoint(CPUState *current_env, target_ulong addr,
1271                           target_ulong len, int type)
1272 {
1273     return -EINVAL;
1274 }
1275
1276 void kvm_remove_all_breakpoints(CPUState *current_env)
1277 {
1278 }
1279 #endif /* !KVM_CAP_SET_GUEST_DEBUG */
1280
1281 int kvm_set_signal_mask(CPUState *env, const sigset_t *sigset)
1282 {
1283     struct kvm_signal_mask *sigmask;
1284     int r;
1285
1286     if (!sigset)
1287         return kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, NULL);
1288
1289     sigmask = qemu_malloc(sizeof(*sigmask) + sizeof(*sigset));
1290
1291     sigmask->len = 8;
1292     memcpy(sigmask->sigset, sigset, sizeof(*sigset));
1293     r = kvm_vcpu_ioctl(env, KVM_SET_SIGNAL_MASK, sigmask);
1294     free(sigmask);
1295
1296     return r;
1297 }
1298
1299 int kvm_set_ioeventfd_mmio_long(int fd, uint32_t addr, uint32_t val, bool assign)
1300 {
1301 #ifdef KVM_IOEVENTFD
1302     int ret;
1303     struct kvm_ioeventfd iofd;
1304
1305     iofd.datamatch = val;
1306     iofd.addr = addr;
1307     iofd.len = 4;
1308     iofd.flags = KVM_IOEVENTFD_FLAG_DATAMATCH;
1309     iofd.fd = fd;
1310
1311     if (!kvm_enabled()) {
1312         return -ENOSYS;
1313     }
1314
1315     if (!assign) {
1316         iofd.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
1317     }
1318
1319     ret = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &iofd);
1320
1321     if (ret < 0) {
1322         return -errno;
1323     }
1324
1325     return 0;
1326 #else
1327     return -ENOSYS;
1328 #endif
1329 }
1330
1331 int kvm_set_ioeventfd_pio_word(int fd, uint16_t addr, uint16_t val, bool assign)
1332 {
1333 #ifdef KVM_IOEVENTFD
1334     struct kvm_ioeventfd kick = {
1335         .datamatch = val,
1336         .addr = addr,
1337         .len = 2,
1338         .flags = KVM_IOEVENTFD_FLAG_DATAMATCH | KVM_IOEVENTFD_FLAG_PIO,
1339         .fd = fd,
1340     };
1341     int r;
1342     if (!kvm_enabled())
1343         return -ENOSYS;
1344     if (!assign)
1345         kick.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
1346     r = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &kick);
1347     if (r < 0)
1348         return r;
1349     return 0;
1350 #else
1351     return -ENOSYS;
1352 #endif
1353 }