accel/kvm/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   <[email protected]>
   9  *  Glauber Costa     <[email protected]>
  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 "qemu/osdep.h"
  17 #include <sys/ioctl.h>
  18
  19 #include <linux/kvm.h>
  20
  21 #include "qemu/atomic.h"
  22 #include "qemu/option.h"
  23 #include "qemu/config-file.h"
  24 #include "qemu/error-report.h"
  25 #include "qapi/error.h"
  26 #include "hw/pci/msi.h"
  27 #include "hw/pci/msix.h"
  28 #include "hw/s390x/adapter.h"
  29 #include "exec/gdbstub.h"
  30 #include "sysemu/kvm_int.h"
  31 #include "sysemu/runstate.h"
  32 #include "sysemu/cpus.h"
  33 #include "sysemu/sysemu.h"
  34 #include "qemu/bswap.h"
  35 #include "exec/memory.h"
  36 #include "exec/ram_addr.h"
  37 #include "exec/address-spaces.h"
  38 #include "qemu/event_notifier.h"
  39 #include "qemu/main-loop.h"
  40 #include "trace.h"
  41 #include "hw/irq.h"
  42 #include "sysemu/sev.h"
  43 #include "qapi/visitor.h"
  44 #include "qapi/qapi-types-common.h"
  45 #include "qapi/qapi-visit-common.h"
  46 #include "sysemu/reset.h"
  47
  48 #include "hw/boards.h"
  49
  50 /* This check must be after config-host.h is included */
  51 #ifdef CONFIG_EVENTFD
  52 #include <sys/eventfd.h>
  53 #endif
  54
  55 /* KVM uses PAGE_SIZE in its definition of KVM_COALESCED_MMIO_MAX. We
  56  * need to use the real host PAGE_SIZE, as that's what KVM will use.
  57  */
  58 #define PAGE_SIZE qemu_real_host_page_size
  59
  60 //#define DEBUG_KVM
  61
  62 #ifdef DEBUG_KVM
  63 #define DPRINTF(fmt, ...) \
  64     do { fprintf(stderr, fmt, ## __VA_ARGS__); } while (0)
  65 #else
  66 #define DPRINTF(fmt, ...) \
  67     do { } while (0)
  68 #endif
  69
  70 #define KVM_MSI_HASHTAB_SIZE    256
  71
  72 struct KVMParkedVcpu {
  73     unsigned long vcpu_id;
  74     int kvm_fd;
  75     QLIST_ENTRY(KVMParkedVcpu) node;
  76 };
  77
  78 struct KVMState
  79 {
  80     AccelState parent_obj;
  81
  82     int nr_slots;
  83     int fd;
  84     int vmfd;
  85     int coalesced_mmio;
  86     int coalesced_pio;
  87     struct kvm_coalesced_mmio_ring *coalesced_mmio_ring;
  88     bool coalesced_flush_in_progress;
  89     int vcpu_events;
  90     int robust_singlestep;
  91     int debugregs;
  92 #ifdef KVM_CAP_SET_GUEST_DEBUG
  93     QTAILQ_HEAD(, kvm_sw_breakpoint) kvm_sw_breakpoints;
  94 #endif
  95     int max_nested_state_len;
  96     int many_ioeventfds;
  97     int intx_set_mask;
  98     int kvm_shadow_mem;
  99     bool kernel_irqchip_allowed;
 100     bool kernel_irqchip_required;
 101     OnOffAuto kernel_irqchip_split;
 102     bool sync_mmu;
 103     uint64_t manual_dirty_log_protect;
 104     /* The man page (and posix) say ioctl numbers are signed int, but
 105      * they're not.  Linux, glibc and *BSD all treat ioctl numbers as
 106      * unsigned, and treating them as signed here can break things */
 107     unsigned irq_set_ioctl;
 108     unsigned int sigmask_len;
 109     GHashTable *gsimap;
 110 #ifdef KVM_CAP_IRQ_ROUTING
 111     struct kvm_irq_routing *irq_routes;
 112     int nr_allocated_irq_routes;
 113     unsigned long *used_gsi_bitmap;
 114     unsigned int gsi_count;
 115     QTAILQ_HEAD(, KVMMSIRoute) msi_hashtab[KVM_MSI_HASHTAB_SIZE];
 116 #endif
 117     KVMMemoryListener memory_listener;
 118     QLIST_HEAD(, KVMParkedVcpu) kvm_parked_vcpus;
 119
 120     /* memory encryption */
 121     void *memcrypt_handle;
 122     int (*memcrypt_encrypt_data)(void *handle, uint8_t *ptr, uint64_t len);
 123
 124     /* For "info mtree -f" to tell if an MR is registered in KVM */
 125     int nr_as;
 126     struct KVMAs {
 127         KVMMemoryListener *ml;
 128         AddressSpace *as;
 129     } *as;
 130 };
 131
 132 KVMState *kvm_state;
 133 bool kvm_kernel_irqchip;
 134 bool kvm_split_irqchip;
 135 bool kvm_async_interrupts_allowed;
 136 bool kvm_halt_in_kernel_allowed;
 137 bool kvm_eventfds_allowed;
 138 bool kvm_irqfds_allowed;
 139 bool kvm_resamplefds_allowed;
 140 bool kvm_msi_via_irqfd_allowed;
 141 bool kvm_gsi_routing_allowed;
 142 bool kvm_gsi_direct_mapping;
 143 bool kvm_allowed;
 144 bool kvm_readonly_mem_allowed;
 145 bool kvm_vm_attributes_allowed;
 146 bool kvm_direct_msi_allowed;
 147 bool kvm_ioeventfd_any_length_allowed;
 148 bool kvm_msi_use_devid;
 149 static bool kvm_immediate_exit;
 150 static hwaddr kvm_max_slot_size = ~0;
 151
 152 static const KVMCapabilityInfo kvm_required_capabilites[] = {
 153     KVM_CAP_INFO(USER_MEMORY),
 154     KVM_CAP_INFO(DESTROY_MEMORY_REGION_WORKS),
 155     KVM_CAP_INFO(JOIN_MEMORY_REGIONS_WORKS),
 156     KVM_CAP_LAST_INFO
 157 };
 158
 159 static NotifierList kvm_irqchip_change_notifiers =
 160     NOTIFIER_LIST_INITIALIZER(kvm_irqchip_change_notifiers);
 161
 162 struct KVMResampleFd {
 163     int gsi;
 164     EventNotifier *resample_event;
 165     QLIST_ENTRY(KVMResampleFd) node;
 166 };
 167 typedef struct KVMResampleFd KVMResampleFd;
 168
 169 /*
 170  * Only used with split irqchip where we need to do the resample fd
 171  * kick for the kernel from userspace.
 172  */
 173 static QLIST_HEAD(, KVMResampleFd) kvm_resample_fd_list =
 174     QLIST_HEAD_INITIALIZER(kvm_resample_fd_list);
 175
 176 #define kvm_slots_lock(kml)      qemu_mutex_lock(&(kml)->slots_lock)
 177 #define kvm_slots_unlock(kml)    qemu_mutex_unlock(&(kml)->slots_lock)
 178
 179 static inline void kvm_resample_fd_remove(int gsi)
 180 {
 181     KVMResampleFd *rfd;
 182
 183     QLIST_FOREACH(rfd, &kvm_resample_fd_list, node) {
 184         if (rfd->gsi == gsi) {
 185             QLIST_REMOVE(rfd, node);
 186             g_free(rfd);
 187             break;
 188         }
 189     }
 190 }
 191
 192 static inline void kvm_resample_fd_insert(int gsi, EventNotifier *event)
 193 {
 194     KVMResampleFd *rfd = g_new0(KVMResampleFd, 1);
 195
 196     rfd->gsi = gsi;
 197     rfd->resample_event = event;
 198
 199     QLIST_INSERT_HEAD(&kvm_resample_fd_list, rfd, node);
 200 }
 201
 202 void kvm_resample_fd_notify(int gsi)
 203 {
 204     KVMResampleFd *rfd;
 205
 206     QLIST_FOREACH(rfd, &kvm_resample_fd_list, node) {
 207         if (rfd->gsi == gsi) {
 208             event_notifier_set(rfd->resample_event);
 209             trace_kvm_resample_fd_notify(gsi);
 210             return;
 211         }
 212     }
 213 }
 214
 215 int kvm_get_max_memslots(void)
 216 {
 217     KVMState *s = KVM_STATE(current_accel());
 218
 219     return s->nr_slots;
 220 }
 221
 222 bool kvm_memcrypt_enabled(void)
 223 {
 224     if (kvm_state && kvm_state->memcrypt_handle) {
 225         return true;
 226     }
 227
 228     return false;
 229 }
 230
 231 int kvm_memcrypt_encrypt_data(uint8_t *ptr, uint64_t len)
 232 {
 233     if (kvm_state->memcrypt_handle &&
 234         kvm_state->memcrypt_encrypt_data) {
 235         return kvm_state->memcrypt_encrypt_data(kvm_state->memcrypt_handle,
 236                                               ptr, len);
 237     }
 238
 239     return 1;
 240 }
 241
 242 /* Called with KVMMemoryListener.slots_lock held */
 243 static KVMSlot *kvm_get_free_slot(KVMMemoryListener *kml)
 244 {
 245     KVMState *s = kvm_state;
 246     int i;
 247
 248     for (i = 0; i < s->nr_slots; i++) {
 249         if (kml->slots[i].memory_size == 0) {
 250             return &kml->slots[i];
 251         }
 252     }
 253
 254     return NULL;
 255 }
 256
 257 bool kvm_has_free_slot(MachineState *ms)
 258 {
 259     KVMState *s = KVM_STATE(ms->accelerator);
 260     bool result;
 261     KVMMemoryListener *kml = &s->memory_listener;
 262
 263     kvm_slots_lock(kml);
 264     result = !!kvm_get_free_slot(kml);
 265     kvm_slots_unlock(kml);
 266
 267     return result;
 268 }
 269
 270 /* Called with KVMMemoryListener.slots_lock held */
 271 static KVMSlot *kvm_alloc_slot(KVMMemoryListener *kml)
 272 {
 273     KVMSlot *slot = kvm_get_free_slot(kml);
 274
 275     if (slot) {
 276         return slot;
 277     }
 278
 279     fprintf(stderr, "%s: no free slot available\n", __func__);
 280     abort();
 281 }
 282
 283 static KVMSlot *kvm_lookup_matching_slot(KVMMemoryListener *kml,
 284                                          hwaddr start_addr,
 285                                          hwaddr size)
 286 {
 287     KVMState *s = kvm_state;
 288     int i;
 289
 290     for (i = 0; i < s->nr_slots; i++) {
 291         KVMSlot *mem = &kml->slots[i];
 292
 293         if (start_addr == mem->start_addr && size == mem->memory_size) {
 294             return mem;
 295         }
 296     }
 297
 298     return NULL;
 299 }
 300
 301 /*
 302  * Calculate and align the start address and the size of the section.
 303  * Return the size. If the size is 0, the aligned section is empty.
 304  */
 305 static hwaddr kvm_align_section(MemoryRegionSection *section,
 306                                 hwaddr *start)
 307 {
 308     hwaddr size = int128_get64(section->size);
 309     hwaddr delta, aligned;
 310
 311     /* kvm works in page size chunks, but the function may be called
 312        with sub-page size and unaligned start address. Pad the start
 313        address to next and truncate size to previous page boundary. */
 314     aligned = ROUND_UP(section->offset_within_address_space,
 315                        qemu_real_host_page_size);
 316     delta = aligned - section->offset_within_address_space;
 317     *start = aligned;
 318     if (delta > size) {
 319         return 0;
 320     }
 321
 322     return (size - delta) & qemu_real_host_page_mask;
 323 }
 324
 325 int kvm_physical_memory_addr_from_host(KVMState *s, void *ram,
 326                                        hwaddr *phys_addr)
 327 {
 328     KVMMemoryListener *kml = &s->memory_listener;
 329     int i, ret = 0;
 330
 331     kvm_slots_lock(kml);
 332     for (i = 0; i < s->nr_slots; i++) {
 333         KVMSlot *mem = &kml->slots[i];
 334
 335         if (ram >= mem->ram && ram < mem->ram + mem->memory_size) {
 336             *phys_addr = mem->start_addr + (ram - mem->ram);
 337             ret = 1;
 338             break;
 339         }
 340     }
 341     kvm_slots_unlock(kml);
 342
 343     return ret;
 344 }
 345
 346 static int kvm_set_user_memory_region(KVMMemoryListener *kml, KVMSlot *slot, bool new)
 347 {
 348     KVMState *s = kvm_state;
 349     struct kvm_userspace_memory_region mem;
 350     int ret;
 351
 352     mem.slot = slot->slot | (kml->as_id << 16);
 353     mem.guest_phys_addr = slot->start_addr;
 354     mem.userspace_addr = (unsigned long)slot->ram;
 355     mem.flags = slot->flags;
 356
 357     if (slot->memory_size && !new && (mem.flags ^ slot->old_flags) & KVM_MEM_READONLY) {
 358         /* Set the slot size to 0 before setting the slot to the desired
 359          * value. This is needed based on KVM commit 75d61fbc. */
 360         mem.memory_size = 0;
 361         ret = kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
 362         if (ret < 0) {
 363             goto err;
 364         }
 365     }
 366     mem.memory_size = slot->memory_size;
 367     ret = kvm_vm_ioctl(s, KVM_SET_USER_MEMORY_REGION, &mem);
 368     slot->old_flags = mem.flags;
 369 err:
 370     trace_kvm_set_user_memory(mem.slot, mem.flags, mem.guest_phys_addr,
 371                               mem.memory_size, mem.userspace_addr, ret);
 372     if (ret < 0) {
 373         error_report("%s: KVM_SET_USER_MEMORY_REGION failed, slot=%d,"
 374                      " start=0x%" PRIx64 ", size=0x%" PRIx64 ": %s",
 375                      __func__, mem.slot, slot->start_addr,
 376                      (uint64_t)mem.memory_size, strerror(errno));
 377     }
 378     return ret;
 379 }
 380
 381 int kvm_destroy_vcpu(CPUState *cpu)
 382 {
 383     KVMState *s = kvm_state;
 384     long mmap_size;
 385     struct KVMParkedVcpu *vcpu = NULL;
 386     int ret = 0;
 387
 388     DPRINTF("kvm_destroy_vcpu\n");
 389
 390     ret = kvm_arch_destroy_vcpu(cpu);
 391     if (ret < 0) {
 392         goto err;
 393     }
 394
 395     mmap_size = kvm_ioctl(s, KVM_GET_VCPU_MMAP_SIZE, 0);
 396     if (mmap_size < 0) {
 397         ret = mmap_size;
 398         DPRINTF("KVM_GET_VCPU_MMAP_SIZE failed\n");
 399         goto err;
 400     }
 401
 402     ret = munmap(cpu->kvm_run, mmap_size);
 403     if (ret < 0) {
 404         goto err;
 405     }
 406
 407     vcpu = g_malloc0(sizeof(*vcpu));
 408     vcpu->vcpu_id = kvm_arch_vcpu_id(cpu);
 409     vcpu->kvm_fd = cpu->kvm_fd;
 410     QLIST_INSERT_HEAD(&kvm_state->kvm_parked_vcpus, vcpu, node);
 411 err:
 412     return ret;
 413 }
 414
 415 static int kvm_get_vcpu(KVMState *s, unsigned long vcpu_id)
 416 {
 417     struct KVMParkedVcpu *cpu;
 418
 419     QLIST_FOREACH(cpu, &s->kvm_parked_vcpus, node) {
 420         if (cpu->vcpu_id == vcpu_id) {
 421             int kvm_fd;
 422
 423             QLIST_REMOVE(cpu, node);
 424             kvm_fd = cpu->kvm_fd;
 425             g_free(cpu);
 426             return kvm_fd;
 427         }
 428     }
 429
 430     return kvm_vm_ioctl(s, KVM_CREATE_VCPU, (void *)vcpu_id);
 431 }
 432
 433 int kvm_init_vcpu(CPUState *cpu)
 434 {
 435     KVMState *s = kvm_state;
 436     long mmap_size;
 437     int ret;
 438
 439     DPRINTF("kvm_init_vcpu\n");
 440
 441     ret = kvm_get_vcpu(s, kvm_arch_vcpu_id(cpu));
 442     if (ret < 0) {
 443         DPRINTF("kvm_create_vcpu failed\n");
 444         goto err;
 445     }
 446
 447     cpu->kvm_fd = ret;
 448     cpu->kvm_state = s;
 449     cpu->vcpu_dirty = true;
 450
 451     mmap_size = kvm_ioctl(s, KVM_GET_VCPU_MMAP_SIZE, 0);
 452     if (mmap_size < 0) {
 453         ret = mmap_size;
 454         DPRINTF("KVM_GET_VCPU_MMAP_SIZE failed\n");
 455         goto err;
 456     }
 457
 458     cpu->kvm_run = mmap(NULL, mmap_size, PROT_READ | PROT_WRITE, MAP_SHARED,
 459                         cpu->kvm_fd, 0);
 460     if (cpu->kvm_run == MAP_FAILED) {
 461         ret = -errno;
 462         DPRINTF("mmap'ing vcpu state failed\n");
 463         goto err;
 464     }
 465
 466     if (s->coalesced_mmio && !s->coalesced_mmio_ring) {
 467         s->coalesced_mmio_ring =
 468             (void *)cpu->kvm_run + s->coalesced_mmio * PAGE_SIZE;
 469     }
 470
 471     ret = kvm_arch_init_vcpu(cpu);
 472 err:
 473     return ret;
 474 }
 475
 476 /*
 477  * dirty pages logging control
 478  */
 479
 480 static int kvm_mem_flags(MemoryRegion *mr)
 481 {
 482     bool readonly = mr->readonly || memory_region_is_romd(mr);
 483     int flags = 0;
 484
 485     if (memory_region_get_dirty_log_mask(mr) != 0) {
 486         flags |= KVM_MEM_LOG_DIRTY_PAGES;
 487     }
 488     if (readonly && kvm_readonly_mem_allowed) {
 489         flags |= KVM_MEM_READONLY;
 490     }
 491     return flags;
 492 }
 493
 494 /* Called with KVMMemoryListener.slots_lock held */
 495 static int kvm_slot_update_flags(KVMMemoryListener *kml, KVMSlot *mem,
 496                                  MemoryRegion *mr)
 497 {
 498     mem->flags = kvm_mem_flags(mr);
 499
 500     /* If nothing changed effectively, no need to issue ioctl */
 501     if (mem->flags == mem->old_flags) {
 502         return 0;
 503     }
 504
 505     return kvm_set_user_memory_region(kml, mem, false);
 506 }
 507
 508 static int kvm_section_update_flags(KVMMemoryListener *kml,
 509                                     MemoryRegionSection *section)
 510 {
 511     hwaddr start_addr, size, slot_size;
 512     KVMSlot *mem;
 513     int ret = 0;
 514
 515     size = kvm_align_section(section, &start_addr);
 516     if (!size) {
 517         return 0;
 518     }
 519
 520     kvm_slots_lock(kml);
 521
 522     while (size && !ret) {
 523         slot_size = MIN(kvm_max_slot_size, size);
 524         mem = kvm_lookup_matching_slot(kml, start_addr, slot_size);
 525         if (!mem) {
 526             /* We don't have a slot if we want to trap every access. */
 527             goto out;
 528         }
 529
 530         ret = kvm_slot_update_flags(kml, mem, section->mr);
 531         start_addr += slot_size;
 532         size -= slot_size;
 533     }
 534
 535 out:
 536     kvm_slots_unlock(kml);
 537     return ret;
 538 }
 539
 540 static void kvm_log_start(MemoryListener *listener,
 541                           MemoryRegionSection *section,
 542                           int old, int new)
 543 {
 544     KVMMemoryListener *kml = container_of(listener, KVMMemoryListener, listener);
 545     int r;
 546
 547     if (old != 0) {
 548         return;
 549     }
 550
 551     r = kvm_section_update_flags(kml, section);
 552     if (r < 0) {
 553         abort();
 554     }
 555 }
 556
 557 static void kvm_log_stop(MemoryListener *listener,
 558                           MemoryRegionSection *section,
 559                           int old, int new)
 560 {
 561     KVMMemoryListener *kml = container_of(listener, KVMMemoryListener, listener);
 562     int r;
 563
 564     if (new != 0) {
 565         return;
 566     }
 567
 568     r = kvm_section_update_flags(kml, section);
 569     if (r < 0) {
 570         abort();
 571     }
 572 }
 573
 574 /* get kvm's dirty pages bitmap and update qemu's */
 575 static int kvm_get_dirty_pages_log_range(MemoryRegionSection *section,
 576                                          unsigned long *bitmap)
 577 {
 578     ram_addr_t start = section->offset_within_region +
 579                        memory_region_get_ram_addr(section->mr);
 580     ram_addr_t pages = int128_get64(section->size) / qemu_real_host_page_size;
 581
 582     cpu_physical_memory_set_dirty_lebitmap(bitmap, start, pages);
 583     return 0;
 584 }
 585
 586 #define ALIGN(x, y)  (((x)+(y)-1) & ~((y)-1))
 587
 588 /* Allocate the dirty bitmap for a slot  */
 589 static void kvm_memslot_init_dirty_bitmap(KVMSlot *mem)
 590 {
 591     /*
 592      * XXX bad kernel interface alert
 593      * For dirty bitmap, kernel allocates array of size aligned to
 594      * bits-per-long.  But for case when the kernel is 64bits and
 595      * the userspace is 32bits, userspace can't align to the same
 596      * bits-per-long, since sizeof(long) is different between kernel
 597      * and user space.  This way, userspace will provide buffer which
 598      * may be 4 bytes less than the kernel will use, resulting in
 599      * userspace memory corruption (which is not detectable by valgrind
 600      * too, in most cases).
 601      * So for now, let's align to 64 instead of HOST_LONG_BITS here, in
 602      * a hope that sizeof(long) won't become >8 any time soon.
 603      */
 604     hwaddr bitmap_size = ALIGN(((mem->memory_size) >> TARGET_PAGE_BITS),
 605                                         /*HOST_LONG_BITS*/ 64) / 8;
 606     mem->dirty_bmap = g_malloc0(bitmap_size);
 607 }
 608
 609 /**
 610  * kvm_physical_sync_dirty_bitmap - Sync dirty bitmap from kernel space
 611  *
 612  * This function will first try to fetch dirty bitmap from the kernel,
 613  * and then updates qemu's dirty bitmap.
 614  *
 615  * NOTE: caller must be with kml->slots_lock held.
 616  *
 617  * @kml: the KVM memory listener object
 618  * @section: the memory section to sync the dirty bitmap with
 619  */
 620 static int kvm_physical_sync_dirty_bitmap(KVMMemoryListener *kml,
 621                                           MemoryRegionSection *section)
 622 {
 623     KVMState *s = kvm_state;
 624     struct kvm_dirty_log d = {};
 625     KVMSlot *mem;
 626     hwaddr start_addr, size;
 627     hwaddr slot_size, slot_offset = 0;
 628     int ret = 0;
 629
 630     size = kvm_align_section(section, &start_addr);
 631     while (size) {
 632         MemoryRegionSection subsection = *section;
 633
 634         slot_size = MIN(kvm_max_slot_size, size);
 635         mem = kvm_lookup_matching_slot(kml, start_addr, slot_size);
 636         if (!mem) {
 637             /* We don't have a slot if we want to trap every access. */
 638             goto out;
 639         }
 640
 641         if (!mem->dirty_bmap) {
 642             /* Allocate on the first log_sync, once and for all */
 643             kvm_memslot_init_dirty_bitmap(mem);
 644         }
 645
 646         d.dirty_bitmap = mem->dirty_bmap;
 647         d.slot = mem->slot | (kml->as_id << 16);
 648         if (kvm_vm_ioctl(s, KVM_GET_DIRTY_LOG, &d) == -1) {
 649             DPRINTF("ioctl failed %d\n", errno);
 650             ret = -1;
 651             goto out;
 652         }
 653
 654         subsection.offset_within_region += slot_offset;
 655         subsection.size = int128_make64(slot_size);
 656         kvm_get_dirty_pages_log_range(&subsection, d.dirty_bitmap);
 657
 658         slot_offset += slot_size;
 659         start_addr += slot_size;
 660         size -= slot_size;
 661     }
 662 out:
 663     return ret;
 664 }
 665
 666 /* Alignment requirement for KVM_CLEAR_DIRTY_LOG - 64 pages */
 667 #define KVM_CLEAR_LOG_SHIFT  6
 668 #define KVM_CLEAR_LOG_ALIGN  (qemu_real_host_page_size << KVM_CLEAR_LOG_SHIFT)
 669 #define KVM_CLEAR_LOG_MASK   (-KVM_CLEAR_LOG_ALIGN)
 670
 671 static int kvm_log_clear_one_slot(KVMSlot *mem, int as_id, uint64_t start,
 672                                   uint64_t size)
 673 {
 674     KVMState *s = kvm_state;
 675     uint64_t end, bmap_start, start_delta, bmap_npages;
 676     struct kvm_clear_dirty_log d;
 677     unsigned long *bmap_clear = NULL, psize = qemu_real_host_page_size;
 678     int ret;
 679
 680     /*
 681      * We need to extend either the start or the size or both to
 682      * satisfy the KVM interface requirement.  Firstly, do the start
 683      * page alignment on 64 host pages
 684      */
 685     bmap_start = start & KVM_CLEAR_LOG_MASK;
 686     start_delta = start - bmap_start;
 687     bmap_start /= psize;
 688
 689     /*
 690      * The kernel interface has restriction on the size too, that either:
 691      *
 692      * (1) the size is 64 host pages aligned (just like the start), or
 693      * (2) the size fills up until the end of the KVM memslot.
 694      */
 695     bmap_npages = DIV_ROUND_UP(size + start_delta, KVM_CLEAR_LOG_ALIGN)
 696         << KVM_CLEAR_LOG_SHIFT;
 697     end = mem->memory_size / psize;
 698     if (bmap_npages > end - bmap_start) {
 699         bmap_npages = end - bmap_start;
 700     }
 701     start_delta /= psize;
 702
 703     /*
 704      * Prepare the bitmap to clear dirty bits.  Here we must guarantee
 705      * that we won't clear any unknown dirty bits otherwise we might
 706      * accidentally clear some set bits which are not yet synced from
 707      * the kernel into QEMU's bitmap, then we'll lose track of the
 708      * guest modifications upon those pages (which can directly lead
 709      * to guest data loss or panic after migration).
 710      *
 711      * Layout of the KVMSlot.dirty_bmap:
 712      *
 713      *                   |<-------- bmap_npages -----------..>|
 714      *                                                     [1]
 715      *                     start_delta         size
 716      *  |----------------|-------------|------------------|------------|
 717      *  ^                ^             ^                               ^
 718      *  |                |             |                               |
 719      * start          bmap_start     (start)                         end
 720      * of memslot                                             of memslot
 721      *
 722      * [1] bmap_npages can be aligned to either 64 pages or the end of slot
 723      */
 724
 725     assert(bmap_start % BITS_PER_LONG == 0);
 726     /* We should never do log_clear before log_sync */
 727     assert(mem->dirty_bmap);
 728     if (start_delta) {
 729         /* Slow path - we need to manipulate a temp bitmap */
 730         bmap_clear = bitmap_new(bmap_npages);
 731         bitmap_copy_with_src_offset(bmap_clear, mem->dirty_bmap,
 732                                     bmap_start, start_delta + size / psize);
 733         /*
 734          * We need to fill the holes at start because that was not
 735          * specified by the caller and we extended the bitmap only for
 736          * 64 pages alignment
 737          */
 738         bitmap_clear(bmap_clear, 0, start_delta);
 739         d.dirty_bitmap = bmap_clear;
 740     } else {
 741         /* Fast path - start address aligns well with BITS_PER_LONG */
 742         d.dirty_bitmap = mem->dirty_bmap + BIT_WORD(bmap_start);
 743     }
 744
 745     d.first_page = bmap_start;
 746     /* It should never overflow.  If it happens, say something */
 747     assert(bmap_npages <= UINT32_MAX);
 748     d.num_pages = bmap_npages;
 749     d.slot = mem->slot | (as_id << 16);
 750
 751     if (kvm_vm_ioctl(s, KVM_CLEAR_DIRTY_LOG, &d) == -1) {
 752         ret = -errno;
 753         error_report("%s: KVM_CLEAR_DIRTY_LOG failed, slot=%d, "
 754                      "start=0x%"PRIx64", size=0x%"PRIx32", errno=%d",
 755                      __func__, d.slot, (uint64_t)d.first_page,
 756                      (uint32_t)d.num_pages, ret);
 757     } else {
 758         ret = 0;
 759         trace_kvm_clear_dirty_log(d.slot, d.first_page, d.num_pages);
 760     }
 761
 762     /*
 763      * After we have updated the remote dirty bitmap, we update the
 764      * cached bitmap as well for the memslot, then if another user
 765      * clears the same region we know we shouldn't clear it again on
 766      * the remote otherwise it's data loss as well.
 767      */
 768     bitmap_clear(mem->dirty_bmap, bmap_start + start_delta,
 769                  size / psize);
 770     /* This handles the NULL case well */
 771     g_free(bmap_clear);
 772     return ret;
 773 }
 774
 775
 776 /**
 777  * kvm_physical_log_clear - Clear the kernel's dirty bitmap for range
 778  *
 779  * NOTE: this will be a no-op if we haven't enabled manual dirty log
 780  * protection in the host kernel because in that case this operation
 781  * will be done within log_sync().
 782  *
 783  * @kml:     the kvm memory listener
 784  * @section: the memory range to clear dirty bitmap
 785  */
 786 static int kvm_physical_log_clear(KVMMemoryListener *kml,
 787                                   MemoryRegionSection *section)
 788 {
 789     KVMState *s = kvm_state;
 790     uint64_t start, size, offset, count;
 791     KVMSlot *mem;
 792     int ret = 0, i;
 793
 794     if (!s->manual_dirty_log_protect) {
 795         /* No need to do explicit clear */
 796         return ret;
 797     }
 798
 799     start = section->offset_within_address_space;
 800     size = int128_get64(section->size);
 801
 802     if (!size) {
 803         /* Nothing more we can do... */
 804         return ret;
 805     }
 806
 807     kvm_slots_lock(kml);
 808
 809     for (i = 0; i < s->nr_slots; i++) {
 810         mem = &kml->slots[i];
 811         /* Discard slots that are empty or do not overlap the section */
 812         if (!mem->memory_size ||
 813             mem->start_addr > start + size - 1 ||
 814             start > mem->start_addr + mem->memory_size - 1) {
 815             continue;
 816         }
 817
 818         if (start >= mem->start_addr) {
 819             /* The slot starts before section or is aligned to it.  */
 820             offset = start - mem->start_addr;
 821             count = MIN(mem->memory_size - offset, size);
 822         } else {
 823             /* The slot starts after section.  */
 824             offset = 0;
 825             count = MIN(mem->memory_size, size - (mem->start_addr - start));
 826         }
 827         ret = kvm_log_clear_one_slot(mem, kml->as_id, offset, count);
 828         if (ret < 0) {
 829             break;
 830         }
 831     }
 832
 833     kvm_slots_unlock(kml);
 834
 835     return ret;
 836 }
 837
 838 static void kvm_coalesce_mmio_region(MemoryListener *listener,
 839                                      MemoryRegionSection *secion,
 840                                      hwaddr start, hwaddr size)
 841 {
 842     KVMState *s = kvm_state;
 843
 844     if (s->coalesced_mmio) {
 845         struct kvm_coalesced_mmio_zone zone;
 846
 847         zone.addr = start;
 848         zone.size = size;
 849         zone.pad = 0;
 850
 851         (void)kvm_vm_ioctl(s, KVM_REGISTER_COALESCED_MMIO, &zone);
 852     }
 853 }
 854
 855 static void kvm_uncoalesce_mmio_region(MemoryListener *listener,
 856                                        MemoryRegionSection *secion,
 857                                        hwaddr start, hwaddr size)
 858 {
 859     KVMState *s = kvm_state;
 860
 861     if (s->coalesced_mmio) {
 862         struct kvm_coalesced_mmio_zone zone;
 863
 864         zone.addr = start;
 865         zone.size = size;
 866         zone.pad = 0;
 867
 868         (void)kvm_vm_ioctl(s, KVM_UNREGISTER_COALESCED_MMIO, &zone);
 869     }
 870 }
 871
 872 static void kvm_coalesce_pio_add(MemoryListener *listener,
 873                                 MemoryRegionSection *section,
 874                                 hwaddr start, hwaddr size)
 875 {
 876     KVMState *s = kvm_state;
 877
 878     if (s->coalesced_pio) {
 879         struct kvm_coalesced_mmio_zone zone;
 880
 881         zone.addr = start;
 882         zone.size = size;
 883         zone.pio = 1;
 884
 885         (void)kvm_vm_ioctl(s, KVM_REGISTER_COALESCED_MMIO, &zone);
 886     }
 887 }
 888
 889 static void kvm_coalesce_pio_del(MemoryListener *listener,
 890                                 MemoryRegionSection *section,
 891                                 hwaddr start, hwaddr size)
 892 {
 893     KVMState *s = kvm_state;
 894
 895     if (s->coalesced_pio) {
 896         struct kvm_coalesced_mmio_zone zone;
 897
 898         zone.addr = start;
 899         zone.size = size;
 900         zone.pio = 1;
 901
 902         (void)kvm_vm_ioctl(s, KVM_UNREGISTER_COALESCED_MMIO, &zone);
 903      }
 904 }
 905
 906 static MemoryListener kvm_coalesced_pio_listener = {
 907     .coalesced_io_add = kvm_coalesce_pio_add,
 908     .coalesced_io_del = kvm_coalesce_pio_del,
 909 };
 910
 911 int kvm_check_extension(KVMState *s, unsigned int extension)
 912 {
 913     int ret;
 914
 915     ret = kvm_ioctl(s, KVM_CHECK_EXTENSION, extension);
 916     if (ret < 0) {
 917         ret = 0;
 918     }
 919
 920     return ret;
 921 }
 922
 923 int kvm_vm_check_extension(KVMState *s, unsigned int extension)
 924 {
 925     int ret;
 926
 927     ret = kvm_vm_ioctl(s, KVM_CHECK_EXTENSION, extension);
 928     if (ret < 0) {
 929         /* VM wide version not implemented, use global one instead */
 930         ret = kvm_check_extension(s, extension);
 931     }
 932
 933     return ret;
 934 }
 935
 936 typedef struct HWPoisonPage {
 937     ram_addr_t ram_addr;
 938     QLIST_ENTRY(HWPoisonPage) list;
 939 } HWPoisonPage;
 940
 941 static QLIST_HEAD(, HWPoisonPage) hwpoison_page_list =
 942     QLIST_HEAD_INITIALIZER(hwpoison_page_list);
 943
 944 static void kvm_unpoison_all(void *param)
 945 {
 946     HWPoisonPage *page, *next_page;
 947
 948     QLIST_FOREACH_SAFE(page, &hwpoison_page_list, list, next_page) {
 949         QLIST_REMOVE(page, list);
 950         qemu_ram_remap(page->ram_addr, TARGET_PAGE_SIZE);
 951         g_free(page);
 952     }
 953 }
 954
 955 void kvm_hwpoison_page_add(ram_addr_t ram_addr)
 956 {
 957     HWPoisonPage *page;
 958
 959     QLIST_FOREACH(page, &hwpoison_page_list, list) {
 960         if (page->ram_addr == ram_addr) {
 961             return;
 962         }
 963     }
 964     page = g_new(HWPoisonPage, 1);
 965     page->ram_addr = ram_addr;
 966     QLIST_INSERT_HEAD(&hwpoison_page_list, page, list);
 967 }
 968
 969 static uint32_t adjust_ioeventfd_endianness(uint32_t val, uint32_t size)
 970 {
 971 #if defined(HOST_WORDS_BIGENDIAN) != defined(TARGET_WORDS_BIGENDIAN)
 972     /* The kernel expects ioeventfd values in HOST_WORDS_BIGENDIAN
 973      * endianness, but the memory core hands them in target endianness.
 974      * For example, PPC is always treated as big-endian even if running
 975      * on KVM and on PPC64LE.  Correct here.
 976      */
 977     switch (size) {
 978     case 2:
 979         val = bswap16(val);
 980         break;
 981     case 4:
 982         val = bswap32(val);
 983         break;
 984     }
 985 #endif
 986     return val;
 987 }
 988
 989 static int kvm_set_ioeventfd_mmio(int fd, hwaddr addr, uint32_t val,
 990                                   bool assign, uint32_t size, bool datamatch)
 991 {
 992     int ret;
 993     struct kvm_ioeventfd iofd = {
 994         .datamatch = datamatch ? adjust_ioeventfd_endianness(val, size) : 0,
 995         .addr = addr,
 996         .len = size,
 997         .flags = 0,
 998         .fd = fd,
 999     };
1000
1001     trace_kvm_set_ioeventfd_mmio(fd, (uint64_t)addr, val, assign, size,
1002                                  datamatch);
1003     if (!kvm_enabled()) {
1004         return -ENOSYS;
1005     }
1006
1007     if (datamatch) {
1008         iofd.flags |= KVM_IOEVENTFD_FLAG_DATAMATCH;
1009     }
1010     if (!assign) {
1011         iofd.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
1012     }
1013
1014     ret = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &iofd);
1015
1016     if (ret < 0) {
1017         return -errno;
1018     }
1019
1020     return 0;
1021 }
1022
1023 static int kvm_set_ioeventfd_pio(int fd, uint16_t addr, uint16_t val,
1024                                  bool assign, uint32_t size, bool datamatch)
1025 {
1026     struct kvm_ioeventfd kick = {
1027         .datamatch = datamatch ? adjust_ioeventfd_endianness(val, size) : 0,
1028         .addr = addr,
1029         .flags = KVM_IOEVENTFD_FLAG_PIO,
1030         .len = size,
1031         .fd = fd,
1032     };
1033     int r;
1034     trace_kvm_set_ioeventfd_pio(fd, addr, val, assign, size, datamatch);
1035     if (!kvm_enabled()) {
1036         return -ENOSYS;
1037     }
1038     if (datamatch) {
1039         kick.flags |= KVM_IOEVENTFD_FLAG_DATAMATCH;
1040     }
1041     if (!assign) {
1042         kick.flags |= KVM_IOEVENTFD_FLAG_DEASSIGN;
1043     }
1044     r = kvm_vm_ioctl(kvm_state, KVM_IOEVENTFD, &kick);
1045     if (r < 0) {
1046         return r;
1047     }
1048     return 0;
1049 }
1050
1051
1052 static int kvm_check_many_ioeventfds(void)
1053 {
1054     /* Userspace can use ioeventfd for io notification.  This requires a host
1055      * that supports eventfd(2) and an I/O thread; since eventfd does not
1056      * support SIGIO it cannot interrupt the vcpu.
1057      *
1058      * Older kernels have a 6 device limit on the KVM io bus.  Find out so we
1059      * can avoid creating too many ioeventfds.
1060      */
1061 #if defined(CONFIG_EVENTFD)
1062     int ioeventfds[7];
1063     int i, ret = 0;
1064     for (i = 0; i < ARRAY_SIZE(ioeventfds); i++) {
1065         ioeventfds[i] = eventfd(0, EFD_CLOEXEC);
1066         if (ioeventfds[i] < 0) {
1067             break;
1068         }
1069         ret = kvm_set_ioeventfd_pio(ioeventfds[i], 0, i, true, 2, true);
1070         if (ret < 0) {
1071             close(ioeventfds[i]);
1072             break;
1073         }
1074     }
1075
1076     /* Decide whether many devices are supported or not */
1077     ret = i == ARRAY_SIZE(ioeventfds);
1078
1079     while (i-- > 0) {
1080         kvm_set_ioeventfd_pio(ioeventfds[i], 0, i, false, 2, true);
1081         close(ioeventfds[i]);
1082     }
1083     return ret;
1084 #else
1085     return 0;
1086 #endif
1087 }
1088
1089 static const KVMCapabilityInfo *
1090 kvm_check_extension_list(KVMState *s, const KVMCapabilityInfo *list)
1091 {
1092     while (list->name) {
1093         if (!kvm_check_extension(s, list->value)) {
1094             return list;
1095         }
1096         list++;
1097     }
1098     return NULL;
1099 }
1100
1101 void kvm_set_max_memslot_size(hwaddr max_slot_size)
1102 {
1103     g_assert(
1104         ROUND_UP(max_slot_size, qemu_real_host_page_size) == max_slot_size
1105     );
1106     kvm_max_slot_size = max_slot_size;
1107 }
1108
1109 static void kvm_set_phys_mem(KVMMemoryListener *kml,
1110                              MemoryRegionSection *section, bool add)
1111 {
1112     KVMSlot *mem;
1113     int err;
1114     MemoryRegion *mr = section->mr;
1115     bool writeable = !mr->readonly && !mr->rom_device;
1116     hwaddr start_addr, size, slot_size;
1117     void *ram;
1118
1119     if (!memory_region_is_ram(mr)) {
1120         if (writeable || !kvm_readonly_mem_allowed) {
1121             return;
1122         } else if (!mr->romd_mode) {
1123             /* If the memory device is not in romd_mode, then we actually want
1124              * to remove the kvm memory slot so all accesses will trap. */
1125             add = false;
1126         }
1127     }
1128
1129     size = kvm_align_section(section, &start_addr);
1130     if (!size) {
1131         return;
1132     }
1133
1134     /* use aligned delta to align the ram address */
1135     ram = memory_region_get_ram_ptr(mr) + section->offset_within_region +
1136           (start_addr - section->offset_within_address_space);
1137
1138     kvm_slots_lock(kml);
1139
1140     if (!add) {
1141         do {
1142             slot_size = MIN(kvm_max_slot_size, size);
1143             mem = kvm_lookup_matching_slot(kml, start_addr, slot_size);
1144             if (!mem) {
1145                 goto out;
1146             }
1147             if (mem->flags & KVM_MEM_LOG_DIRTY_PAGES) {
1148                 kvm_physical_sync_dirty_bitmap(kml, section);
1149             }
1150
1151             /* unregister the slot */
1152             g_free(mem->dirty_bmap);
1153             mem->dirty_bmap = NULL;
1154             mem->memory_size = 0;
1155             mem->flags = 0;
1156             err = kvm_set_user_memory_region(kml, mem, false);
1157             if (err) {
1158                 fprintf(stderr, "%s: error unregistering slot: %s\n",
1159                         __func__, strerror(-err));
1160                 abort();
1161             }
1162             start_addr += slot_size;
1163             size -= slot_size;
1164         } while (size);
1165         goto out;
1166     }
1167
1168     /* register the new slot */
1169     do {
1170         slot_size = MIN(kvm_max_slot_size, size);
1171         mem = kvm_alloc_slot(kml);
1172         mem->memory_size = slot_size;
1173         mem->start_addr = start_addr;
1174         mem->ram = ram;
1175         mem->flags = kvm_mem_flags(mr);
1176
1177         if (mem->flags & KVM_MEM_LOG_DIRTY_PAGES) {
1178             /*
1179              * Reallocate the bmap; it means it doesn't disappear in
1180              * middle of a migrate.
1181              */
1182             kvm_memslot_init_dirty_bitmap(mem);
1183         }
1184         err = kvm_set_user_memory_region(kml, mem, true);
1185         if (err) {
1186             fprintf(stderr, "%s: error registering slot: %s\n", __func__,
1187                     strerror(-err));
1188             abort();
1189         }
1190         start_addr += slot_size;
1191         ram += slot_size;
1192         size -= slot_size;
1193     } while (size);
1194
1195 out:
1196     kvm_slots_unlock(kml);
1197 }
1198
1199 static void kvm_region_add(MemoryListener *listener,
1200                            MemoryRegionSection *section)
1201 {
1202     KVMMemoryListener *kml = container_of(listener, KVMMemoryListener, listener);
1203
1204     memory_region_ref(section->mr);
1205     kvm_set_phys_mem(kml, section, true);
1206 }
1207
1208 static void kvm_region_del(MemoryListener *listener,
1209                            MemoryRegionSection *section)
1210 {
1211     KVMMemoryListener *kml = container_of(listener, KVMMemoryListener, listener);
1212
1213     kvm_set_phys_mem(kml, section, false);
1214     memory_region_unref(section->mr);
1215 }
1216
1217 static void kvm_log_sync(MemoryListener *listener,
1218                          MemoryRegionSection *section)
1219 {
1220     KVMMemoryListener *kml = container_of(listener, KVMMemoryListener, listener);
1221     int r;
1222
1223     kvm_slots_lock(kml);
1224     r = kvm_physical_sync_dirty_bitmap(kml, section);
1225     kvm_slots_unlock(kml);
1226     if (r < 0) {
1227         abort();
1228     }
1229 }
1230
1231 static void kvm_log_clear(MemoryListener *listener,
1232                           MemoryRegionSection *section)
1233 {
1234     KVMMemoryListener *kml = container_of(listener, KVMMemoryListener, listener);
1235     int r;
1236
1237     r = kvm_physical_log_clear(kml, section);
1238     if (r < 0) {
1239         error_report_once("%s: kvm log clear failed: mr=%s "
1240                           "offset=%"HWADDR_PRIx" size=%"PRIx64, __func__,
1241                           section->mr->name, section->offset_within_region,
1242                           int128_get64(section->size));
1243         abort();
1244     }
1245 }
1246
1247 static void kvm_mem_ioeventfd_add(MemoryListener *listener,
1248                                   MemoryRegionSection *section,
1249                                   bool match_data, uint64_t data,
1250                                   EventNotifier *e)
1251 {
1252     int fd = event_notifier_get_fd(e);
1253     int r;
1254
1255     r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
1256                                data, true, int128_get64(section->size),
1257                                match_data);
1258     if (r < 0) {
1259         fprintf(stderr, "%s: error adding ioeventfd: %s (%d)\n",
1260                 __func__, strerror(-r), -r);
1261         abort();
1262     }
1263 }
1264
1265 static void kvm_mem_ioeventfd_del(MemoryListener *listener,
1266                                   MemoryRegionSection *section,
1267                                   bool match_data, uint64_t data,
1268                                   EventNotifier *e)
1269 {
1270     int fd = event_notifier_get_fd(e);
1271     int r;
1272
1273     r = kvm_set_ioeventfd_mmio(fd, section->offset_within_address_space,
1274                                data, false, int128_get64(section->size),
1275                                match_data);
1276     if (r < 0) {
1277         fprintf(stderr, "%s: error deleting ioeventfd: %s (%d)\n",
1278                 __func__, strerror(-r), -r);
1279         abort();
1280     }
1281 }
1282
1283 static void kvm_io_ioeventfd_add(MemoryListener *listener,
1284                                  MemoryRegionSection *section,
1285                                  bool match_data, uint64_t data,
1286                                  EventNotifier *e)
1287 {
1288     int fd = event_notifier_get_fd(e);
1289     int r;
1290
1291     r = kvm_set_ioeventfd_pio(fd, section->offset_within_address_space,
1292                               data, true, int128_get64(section->size),
1293                               match_data);
1294     if (r < 0) {
1295         fprintf(stderr, "%s: error adding ioeventfd: %s (%d)\n",
1296                 __func__, strerror(-r), -r);
1297         abort();
1298     }
1299 }
1300
1301 static void kvm_io_ioeventfd_del(MemoryListener *listener,
1302                                  MemoryRegionSection *section,
1303                                  bool match_data, uint64_t data,
1304                                  EventNotifier *e)
1305
1306 {
1307     int fd = event_notifier_get_fd(e);
1308     int r;
1309
1310     r = kvm_set_ioeventfd_pio(fd, section->offset_within_address_space,
1311                               data, false, int128_get64(section->size),
1312                               match_data);
1313     if (r < 0) {
1314         fprintf(stderr, "%s: error deleting ioeventfd: %s (%d)\n",
1315                 __func__, strerror(-r), -r);
1316         abort();
1317     }
1318 }
1319
1320 void kvm_memory_listener_register(KVMState *s, KVMMemoryListener *kml,
1321                                   AddressSpace *as, int as_id)
1322 {
1323     int i;
1324
1325     qemu_mutex_init(&kml->slots_lock);
1326     kml->slots = g_malloc0(s->nr_slots * sizeof(KVMSlot));
1327     kml->as_id = as_id;
1328
1329     for (i = 0; i < s->nr_slots; i++) {
1330         kml->slots[i].slot = i;
1331     }
1332
1333     kml->listener.region_add = kvm_region_add;
1334     kml->listener.region_del = kvm_region_del;
1335     kml->listener.log_start = kvm_log_start;
1336     kml->listener.log_stop = kvm_log_stop;
1337     kml->listener.log_sync = kvm_log_sync;
1338     kml->listener.log_clear = kvm_log_clear;
1339     kml->listener.priority = 10;
1340
1341     memory_listener_register(&kml->listener, as);
1342
1343     for (i = 0; i < s->nr_as; ++i) {
1344         if (!s->as[i].as) {
1345             s->as[i].as = as;
1346             s->as[i].ml = kml;
1347             break;
1348         }
1349     }
1350 }
1351
1352 static MemoryListener kvm_io_listener = {
1353     .eventfd_add = kvm_io_ioeventfd_add,
1354     .eventfd_del = kvm_io_ioeventfd_del,
1355     .priority = 10,
1356 };
1357
1358 int kvm_set_irq(KVMState *s, int irq, int level)
1359 {
1360     struct kvm_irq_level event;
1361     int ret;
1362
1363     assert(kvm_async_interrupts_enabled());
1364
1365     event.level = level;
1366     event.irq = irq;
1367     ret = kvm_vm_ioctl(s, s->irq_set_ioctl, &event);
1368     if (ret < 0) {
1369         perror("kvm_set_irq");
1370         abort();
1371     }
1372
1373     return (s->irq_set_ioctl == KVM_IRQ_LINE) ? 1 : event.status;
1374 }
1375
1376 #ifdef KVM_CAP_IRQ_ROUTING
1377 typedef struct KVMMSIRoute {
1378     struct kvm_irq_routing_entry kroute;
1379     QTAILQ_ENTRY(KVMMSIRoute) entry;
1380 } KVMMSIRoute;
1381
1382 static void set_gsi(KVMState *s, unsigned int gsi)
1383 {
1384     set_bit(gsi, s->used_gsi_bitmap);
1385 }
1386
1387 static void clear_gsi(KVMState *s, unsigned int gsi)
1388 {
1389     clear_bit(gsi, s->used_gsi_bitmap);
1390 }
1391
1392 void kvm_init_irq_routing(KVMState *s)
1393 {
1394     int gsi_count, i;
1395
1396     gsi_count = kvm_check_extension(s, KVM_CAP_IRQ_ROUTING) - 1;
1397     if (gsi_count > 0) {
1398         /* Round up so we can search ints using ffs */
1399         s->used_gsi_bitmap = bitmap_new(gsi_count);
1400         s->gsi_count = gsi_count;
1401     }
1402
1403     s->irq_routes = g_malloc0(sizeof(*s->irq_routes));
1404     s->nr_allocated_irq_routes = 0;
1405
1406     if (!kvm_direct_msi_allowed) {
1407         for (i = 0; i < KVM_MSI_HASHTAB_SIZE; i++) {
1408             QTAILQ_INIT(&s->msi_hashtab[i]);
1409         }
1410     }
1411
1412     kvm_arch_init_irq_routing(s);
1413 }
1414
1415 void kvm_irqchip_commit_routes(KVMState *s)
1416 {
1417     int ret;
1418
1419     if (kvm_gsi_direct_mapping()) {
1420         return;
1421     }
1422
1423     if (!kvm_gsi_routing_enabled()) {
1424         return;
1425     }
1426
1427     s->irq_routes->flags = 0;
1428     trace_kvm_irqchip_commit_routes();
1429     ret = kvm_vm_ioctl(s, KVM_SET_GSI_ROUTING, s->irq_routes);
1430     assert(ret == 0);
1431 }
1432
1433 static void kvm_add_routing_entry(KVMState *s,
1434                                   struct kvm_irq_routing_entry *entry)
1435 {
1436     struct kvm_irq_routing_entry *new;
1437     int n, size;
1438
1439     if (s->irq_routes->nr == s->nr_allocated_irq_routes) {
1440         n = s->nr_allocated_irq_routes * 2;
1441         if (n < 64) {
1442             n = 64;
1443         }
1444         size = sizeof(struct kvm_irq_routing);
1445         size += n * sizeof(*new);
1446         s->irq_routes = g_realloc(s->irq_routes, size);
1447         s->nr_allocated_irq_routes = n;
1448     }
1449     n = s->irq_routes->nr++;
1450     new = &s->irq_routes->entries[n];
1451
1452     *new = *entry;
1453
1454     set_gsi(s, entry->gsi);
1455 }
1456
1457 static int kvm_update_routing_entry(KVMState *s,
1458                                     struct kvm_irq_routing_entry *new_entry)
1459 {
1460     struct kvm_irq_routing_entry *entry;
1461     int n;
1462
1463     for (n = 0; n < s->irq_routes->nr; n++) {
1464         entry = &s->irq_routes->entries[n];
1465         if (entry->gsi != new_entry->gsi) {
1466             continue;
1467         }
1468
1469         if(!memcmp(entry, new_entry, sizeof *entry)) {
1470             return 0;
1471         }
1472
1473         *entry = *new_entry;
1474
1475         return 0;
1476     }
1477
1478     return -ESRCH;
1479 }
1480
1481 void kvm_irqchip_add_irq_route(KVMState *s, int irq, int irqchip, int pin)
1482 {
1483     struct kvm_irq_routing_entry e = {};
1484
1485     assert(pin < s->gsi_count);
1486
1487     e.gsi = irq;
1488     e.type = KVM_IRQ_ROUTING_IRQCHIP;
1489     e.flags = 0;
1490     e.u.irqchip.irqchip = irqchip;
1491     e.u.irqchip.pin = pin;
1492     kvm_add_routing_entry(s, &e);
1493 }
1494
1495 void kvm_irqchip_release_virq(KVMState *s, int virq)
1496 {
1497     struct kvm_irq_routing_entry *e;
1498     int i;
1499
1500     if (kvm_gsi_direct_mapping()) {
1501         return;
1502     }
1503
1504     for (i = 0; i < s->irq_routes->nr; i++) {
1505         e = &s->irq_routes->entries[i];
1506         if (e->gsi == virq) {
1507             s->irq_routes->nr--;
1508             *e = s->irq_routes->entries[s->irq_routes->nr];
1509         }
1510     }
1511     clear_gsi(s, virq);
1512     kvm_arch_release_virq_post(virq);
1513     trace_kvm_irqchip_release_virq(virq);
1514 }
1515
1516 void kvm_irqchip_add_change_notifier(Notifier *n)
1517 {
1518     notifier_list_add(&kvm_irqchip_change_notifiers, n);
1519 }
1520
1521 void kvm_irqchip_remove_change_notifier(Notifier *n)
1522 {
1523     notifier_remove(n);
1524 }
1525
1526 void kvm_irqchip_change_notify(void)
1527 {
1528     notifier_list_notify(&kvm_irqchip_change_notifiers, NULL);
1529 }
1530
1531 static unsigned int kvm_hash_msi(uint32_t data)
1532 {
1533     /* This is optimized for IA32 MSI layout. However, no other arch shall
1534      * repeat the mistake of not providing a direct MSI injection API. */
1535     return data & 0xff;
1536 }
1537
1538 static void kvm_flush_dynamic_msi_routes(KVMState *s)
1539 {
1540     KVMMSIRoute *route, *next;
1541     unsigned int hash;
1542
1543     for (hash = 0; hash < KVM_MSI_HASHTAB_SIZE; hash++) {
1544         QTAILQ_FOREACH_SAFE(route, &s->msi_hashtab[hash], entry, next) {
1545             kvm_irqchip_release_virq(s, route->kroute.gsi);
1546             QTAILQ_REMOVE(&s->msi_hashtab[hash], route, entry);
1547             g_free(route);
1548         }
1549     }
1550 }
1551
1552 static int kvm_irqchip_get_virq(KVMState *s)
1553 {
1554     int next_virq;
1555
1556     /*
1557      * PIC and IOAPIC share the first 16 GSI numbers, thus the available
1558      * GSI numbers are more than the number of IRQ route. Allocating a GSI
1559      * number can succeed even though a new route entry cannot be added.
1560      * When this happens, flush dynamic MSI entries to free IRQ route entries.
1561      */
1562     if (!kvm_direct_msi_allowed && s->irq_routes->nr == s->gsi_count) {
1563         kvm_flush_dynamic_msi_routes(s);
1564     }
1565
1566     /* Return the lowest unused GSI in the bitmap */
1567     next_virq = find_first_zero_bit(s->used_gsi_bitmap, s->gsi_count);
1568     if (next_virq >= s->gsi_count) {
1569         return -ENOSPC;
1570     } else {
1571         return next_virq;
1572     }
1573 }
1574
1575 static KVMMSIRoute *kvm_lookup_msi_route(KVMState *s, MSIMessage msg)
1576 {
1577     unsigned int hash = kvm_hash_msi(msg.data);
1578     KVMMSIRoute *route;
1579
1580     QTAILQ_FOREACH(route, &s->msi_hashtab[hash], entry) {
1581         if (route->kroute.u.msi.address_lo == (uint32_t)msg.address &&
1582             route->kroute.u.msi.address_hi == (msg.address >> 32) &&
1583             route->kroute.u.msi.data == le32_to_cpu(msg.data)) {
1584             return route;
1585         }
1586     }
1587     return NULL;
1588 }
1589
1590 int kvm_irqchip_send_msi(KVMState *s, MSIMessage msg)
1591 {
1592     struct kvm_msi msi;
1593     KVMMSIRoute *route;
1594
1595     if (kvm_direct_msi_allowed) {
1596         msi.address_lo = (uint32_t)msg.address;
1597         msi.address_hi = msg.address >> 32;
1598         msi.data = le32_to_cpu(msg.data);
1599         msi.flags = 0;
1600         memset(msi.pad, 0, sizeof(msi.pad));
1601
1602         return kvm_vm_ioctl(s, KVM_SIGNAL_MSI, &msi);
1603     }
1604
1605     route = kvm_lookup_msi_route(s, msg);
1606     if (!route) {
1607         int virq;
1608
1609         virq = kvm_irqchip_get_virq(s);
1610         if (virq < 0) {
1611             return virq;
1612         }
1613
1614         route = g_malloc0(sizeof(KVMMSIRoute));
1615         route->kroute.gsi = virq;
1616         route->kroute.type = KVM_IRQ_ROUTING_MSI;
1617         route->kroute.flags = 0;
1618         route->kroute.u.msi.address_lo = (uint32_t)msg.address;
1619         route->kroute.u.msi.address_hi = msg.address >> 32;
1620         route->kroute.u.msi.data = le32_to_cpu(msg.data);
1621
1622         kvm_add_routing_entry(s, &route->kroute);
1623         kvm_irqchip_commit_routes(s);
1624
1625         QTAILQ_INSERT_TAIL(&s->msi_hashtab[kvm_hash_msi(msg.data)], route,
1626                            entry);
1627     }
1628
1629     assert(route->kroute.type == KVM_IRQ_ROUTING_MSI);
1630
1631     return kvm_set_irq(s, route->kroute.gsi, 1);
1632 }
1633
1634 int kvm_irqchip_add_msi_route(KVMState *s, int vector, PCIDevice *dev)
1635 {
1636     struct kvm_irq_routing_entry kroute = {};
1637     int virq;
1638     MSIMessage msg = {0, 0};
1639
1640     if (pci_available && dev) {
1641         msg = pci_get_msi_message(dev, vector);
1642     }
1643
1644     if (kvm_gsi_direct_mapping()) {
1645         return kvm_arch_msi_data_to_gsi(msg.data);
1646     }
1647
1648     if (!kvm_gsi_routing_enabled()) {
1649         return -ENOSYS;
1650     }
1651
1652     virq = kvm_irqchip_get_virq(s);
1653     if (virq < 0) {
1654         return virq;
1655     }
1656
1657     kroute.gsi = virq;
1658     kroute.type = KVM_IRQ_ROUTING_MSI;
1659     kroute.flags = 0;
1660     kroute.u.msi.address_lo = (uint32_t)msg.address;
1661     kroute.u.msi.address_hi = msg.address >> 32;
1662     kroute.u.msi.data = le32_to_cpu(msg.data);
1663     if (pci_available && kvm_msi_devid_required()) {
1664         kroute.flags = KVM_MSI_VALID_DEVID;
1665         kroute.u.msi.devid = pci_requester_id(dev);
1666     }
1667     if (kvm_arch_fixup_msi_route(&kroute, msg.address, msg.data, dev)) {
1668         kvm_irqchip_release_virq(s, virq);
1669         return -EINVAL;
1670     }
1671
1672     trace_kvm_irqchip_add_msi_route(dev ? dev->name : (char *)"N/A",
1673                                     vector, virq);
1674
1675     kvm_add_routing_entry(s, &kroute);
1676     kvm_arch_add_msi_route_post(&kroute, vector, dev);
1677     kvm_irqchip_commit_routes(s);
1678
1679     return virq;
1680 }
1681
1682 int kvm_irqchip_update_msi_route(KVMState *s, int virq, MSIMessage msg,
1683                                  PCIDevice *dev)
1684 {
1685     struct kvm_irq_routing_entry kroute = {};
1686
1687     if (kvm_gsi_direct_mapping()) {
1688         return 0;
1689     }
1690
1691     if (!kvm_irqchip_in_kernel()) {
1692         return -ENOSYS;
1693     }
1694
1695     kroute.gsi = virq;
1696     kroute.type = KVM_IRQ_ROUTING_MSI;
1697     kroute.flags = 0;
1698     kroute.u.msi.address_lo = (uint32_t)msg.address;
1699     kroute.u.msi.address_hi = msg.address >> 32;
1700     kroute.u.msi.data = le32_to_cpu(msg.data);
1701     if (pci_available && kvm_msi_devid_required()) {
1702         kroute.flags = KVM_MSI_VALID_DEVID;
1703         kroute.u.msi.devid = pci_requester_id(dev);
1704     }
1705     if (kvm_arch_fixup_msi_route(&kroute, msg.address, msg.data, dev)) {
1706         return -EINVAL;
1707     }
1708
1709     trace_kvm_irqchip_update_msi_route(virq);
1710
1711     return kvm_update_routing_entry(s, &kroute);
1712 }
1713
1714 static int kvm_irqchip_assign_irqfd(KVMState *s, EventNotifier *event,
1715                                     EventNotifier *resample, int virq,
1716                                     bool assign)
1717 {
1718     int fd = event_notifier_get_fd(event);
1719     int rfd = resample ? event_notifier_get_fd(resample) : -1;
1720
1721     struct kvm_irqfd irqfd = {
1722         .fd = fd,
1723         .gsi = virq,
1724         .flags = assign ? 0 : KVM_IRQFD_FLAG_DEASSIGN,
1725     };
1726
1727     if (rfd != -1) {
1728         assert(assign);
1729         if (kvm_irqchip_is_split()) {
1730             /*
1731              * When the slow irqchip (e.g. IOAPIC) is in the
1732              * userspace, KVM kernel resamplefd will not work because
1733              * the EOI of the interrupt will be delivered to userspace
1734              * instead, so the KVM kernel resamplefd kick will be
1735              * skipped.  The userspace here mimics what the kernel
1736              * provides with resamplefd, remember the resamplefd and
1737              * kick it when we receive EOI of this IRQ.
1738              *
1739              * This is hackery because IOAPIC is mostly bypassed
1740              * (except EOI broadcasts) when irqfd is used.  However
1741              * this can bring much performance back for split irqchip
1742              * with INTx IRQs (for VFIO, this gives 93% perf of the
1743              * full fast path, which is 46% perf boost comparing to
1744              * the INTx slow path).
1745              */
1746             kvm_resample_fd_insert(virq, resample);
1747         } else {
1748             irqfd.flags |= KVM_IRQFD_FLAG_RESAMPLE;
1749             irqfd.resamplefd = rfd;
1750         }
1751     } else if (!assign) {
1752         if (kvm_irqchip_is_split()) {
1753             kvm_resample_fd_remove(virq);
1754         }
1755     }
1756
1757     if (!kvm_irqfds_enabled()) {
1758         return -ENOSYS;
1759     }
1760
1761     return kvm_vm_ioctl(s, KVM_IRQFD, &irqfd);
1762 }
1763
1764 int kvm_irqchip_add_adapter_route(KVMState *s, AdapterInfo *adapter)
1765 {
1766     struct kvm_irq_routing_entry kroute = {};
1767     int virq;
1768
1769     if (!kvm_gsi_routing_enabled()) {
1770         return -ENOSYS;
1771     }
1772
1773     virq = kvm_irqchip_get_virq(s);
1774     if (virq < 0) {
1775         return virq;
1776     }
1777
1778     kroute.gsi = virq;
1779     kroute.type = KVM_IRQ_ROUTING_S390_ADAPTER;
1780     kroute.flags = 0;
1781     kroute.u.adapter.summary_addr = adapter->summary_addr;
1782     kroute.u.adapter.ind_addr = adapter->ind_addr;
1783     kroute.u.adapter.summary_offset = adapter->summary_offset;
1784     kroute.u.adapter.ind_offset = adapter->ind_offset;
1785     kroute.u.adapter.adapter_id = adapter->adapter_id;
1786
1787     kvm_add_routing_entry(s, &kroute);
1788
1789     return virq;
1790 }
1791
1792 int kvm_irqchip_add_hv_sint_route(KVMState *s, uint32_t vcpu, uint32_t sint)
1793 {
1794     struct kvm_irq_routing_entry kroute = {};
1795     int virq;
1796
1797     if (!kvm_gsi_routing_enabled()) {
1798         return -ENOSYS;
1799     }
1800     if (!kvm_check_extension(s, KVM_CAP_HYPERV_SYNIC)) {
1801         return -ENOSYS;
1802     }
1803     virq = kvm_irqchip_get_virq(s);
1804     if (virq < 0) {
1805         return virq;
1806     }
1807
1808     kroute.gsi = virq;
1809     kroute.type = KVM_IRQ_ROUTING_HV_SINT;
1810     kroute.flags = 0;
1811     kroute.u.hv_sint.vcpu = vcpu;
1812     kroute.u.hv_sint.sint = sint;
1813
1814     kvm_add_routing_entry(s, &kroute);
1815     kvm_irqchip_commit_routes(s);
1816
1817     return virq;
1818 }
1819
1820 #else /* !KVM_CAP_IRQ_ROUTING */
1821
1822 void kvm_init_irq_routing(KVMState *s)
1823 {
1824 }
1825
1826 void kvm_irqchip_release_virq(KVMState *s, int virq)
1827 {
1828 }
1829
1830 int kvm_irqchip_send_msi(KVMState *s, MSIMessage msg)
1831 {
1832     abort();
1833 }
1834
1835 int kvm_irqchip_add_msi_route(KVMState *s, int vector, PCIDevice *dev)
1836 {
1837     return -ENOSYS;
1838 }
1839
1840 int kvm_irqchip_add_adapter_route(KVMState *s, AdapterInfo *adapter)
1841 {
1842     return -ENOSYS;
1843 }
1844
1845 int kvm_irqchip_add_hv_sint_route(KVMState *s, uint32_t vcpu, uint32_t sint)
1846 {
1847     return -ENOSYS;
1848 }
1849
1850 static int kvm_irqchip_assign_irqfd(KVMState *s, EventNotifier *event,
1851                                     EventNotifier *resample, int virq,
1852                                     bool assign)
1853 {
1854     abort();
1855 }
1856
1857 int kvm_irqchip_update_msi_route(KVMState *s, int virq, MSIMessage msg)
1858 {
1859     return -ENOSYS;
1860 }
1861 #endif /* !KVM_CAP_IRQ_ROUTING */
1862
1863 int kvm_irqchip_add_irqfd_notifier_gsi(KVMState *s, EventNotifier *n,
1864                                        EventNotifier *rn, int virq)
1865 {
1866     return kvm_irqchip_assign_irqfd(s, n, rn, virq, true);
1867 }
1868
1869 int kvm_irqchip_remove_irqfd_notifier_gsi(KVMState *s, EventNotifier *n,
1870                                           int virq)
1871 {
1872     return kvm_irqchip_assign_irqfd(s, n, NULL, virq, false);
1873 }
1874
1875 int kvm_irqchip_add_irqfd_notifier(KVMState *s, EventNotifier *n,
1876                                    EventNotifier *rn, qemu_irq irq)
1877 {
1878     gpointer key, gsi;
1879     gboolean found = g_hash_table_lookup_extended(s->gsimap, irq, &key, &gsi);
1880
1881     if (!found) {
1882         return -ENXIO;
1883     }
1884     return kvm_irqchip_add_irqfd_notifier_gsi(s, n, rn, GPOINTER_TO_INT(gsi));
1885 }
1886
1887 int kvm_irqchip_remove_irqfd_notifier(KVMState *s, EventNotifier *n,
1888                                       qemu_irq irq)
1889 {
1890     gpointer key, gsi;
1891     gboolean found = g_hash_table_lookup_extended(s->gsimap, irq, &key, &gsi);
1892
1893     if (!found) {
1894         return -ENXIO;
1895     }
1896     return kvm_irqchip_remove_irqfd_notifier_gsi(s, n, GPOINTER_TO_INT(gsi));
1897 }
1898
1899 void kvm_irqchip_set_qemuirq_gsi(KVMState *s, qemu_irq irq, int gsi)
1900 {
1901     g_hash_table_insert(s->gsimap, irq, GINT_TO_POINTER(gsi));
1902 }
1903
1904 static void kvm_irqchip_create(KVMState *s)
1905 {
1906     int ret;
1907
1908     assert(s->kernel_irqchip_split != ON_OFF_AUTO_AUTO);
1909     if (kvm_check_extension(s, KVM_CAP_IRQCHIP)) {
1910         ;
1911     } else if (kvm_check_extension(s, KVM_CAP_S390_IRQCHIP)) {
1912         ret = kvm_vm_enable_cap(s, KVM_CAP_S390_IRQCHIP, 0);
1913         if (ret < 0) {
1914             fprintf(stderr, "Enable kernel irqchip failed: %s\n", strerror(-ret));
1915             exit(1);
1916         }
1917     } else {
1918         return;
1919     }
1920
1921     /* First probe and see if there's a arch-specific hook to create the
1922      * in-kernel irqchip for us */
1923     ret = kvm_arch_irqchip_create(s);
1924     if (ret == 0) {
1925         if (s->kernel_irqchip_split == ON_OFF_AUTO_ON) {
1926             perror("Split IRQ chip mode not supported.");
1927             exit(1);
1928         } else {
1929             ret = kvm_vm_ioctl(s, KVM_CREATE_IRQCHIP);
1930         }
1931     }
1932     if (ret < 0) {
1933         fprintf(stderr, "Create kernel irqchip failed: %s\n", strerror(-ret));
1934         exit(1);
1935     }
1936
1937     kvm_kernel_irqchip = true;
1938     /* If we have an in-kernel IRQ chip then we must have asynchronous
1939      * interrupt delivery (though the reverse is not necessarily true)
1940      */
1941     kvm_async_interrupts_allowed = true;
1942     kvm_halt_in_kernel_allowed = true;
1943
1944     kvm_init_irq_routing(s);
1945
1946     s->gsimap = g_hash_table_new(g_direct_hash, g_direct_equal);
1947 }
1948
1949 /* Find number of supported CPUs using the recommended
1950  * procedure from the kernel API documentation to cope with
1951  * older kernels that may be missing capabilities.
1952  */
1953 static int kvm_recommended_vcpus(KVMState *s)
1954 {
1955     int ret = kvm_vm_check_extension(s, KVM_CAP_NR_VCPUS);
1956     return (ret) ? ret : 4;
1957 }
1958
1959 static int kvm_max_vcpus(KVMState *s)
1960 {
1961     int ret = kvm_check_extension(s, KVM_CAP_MAX_VCPUS);
1962     return (ret) ? ret : kvm_recommended_vcpus(s);
1963 }
1964
1965 static int kvm_max_vcpu_id(KVMState *s)
1966 {
1967     int ret = kvm_check_extension(s, KVM_CAP_MAX_VCPU_ID);
1968     return (ret) ? ret : kvm_max_vcpus(s);
1969 }
1970
1971 bool kvm_vcpu_id_is_valid(int vcpu_id)
1972 {
1973     KVMState *s = KVM_STATE(current_accel());
1974     return vcpu_id >= 0 && vcpu_id < kvm_max_vcpu_id(s);
1975 }
1976
1977 static int kvm_init(MachineState *ms)
1978 {
1979     MachineClass *mc = MACHINE_GET_CLASS(ms);
1980     static const char upgrade_note[] =
1981         "Please upgrade to at least kernel 2.6.29 or recent kvm-kmod\n"
1982         "(see http://sourceforge.net/projects/kvm).\n";
1983     struct {
1984         const char *name;
1985         int num;
1986     } num_cpus[] = {
1987         { "SMP",          ms->smp.cpus },
1988         { "hotpluggable", ms->smp.max_cpus },
1989         { NULL, }
1990     }, *nc = num_cpus;
1991     int soft_vcpus_limit, hard_vcpus_limit;
1992     KVMState *s;
1993     const KVMCapabilityInfo *missing_cap;
1994     int ret;
1995     int type = 0;
1996     const char *kvm_type;
1997     uint64_t dirty_log_manual_caps;
1998
1999     s = KVM_STATE(ms->accelerator);
2000
2001     /*
2002      * On systems where the kernel can support different base page
2003      * sizes, host page size may be different from TARGET_PAGE_SIZE,
2004      * even with KVM.  TARGET_PAGE_SIZE is assumed to be the minimum
2005      * page size for the system though.
2006      */
2007     assert(TARGET_PAGE_SIZE <= qemu_real_host_page_size);
2008
2009     s->sigmask_len = 8;
2010
2011 #ifdef KVM_CAP_SET_GUEST_DEBUG
2012     QTAILQ_INIT(&s->kvm_sw_breakpoints);
2013 #endif
2014     QLIST_INIT(&s->kvm_parked_vcpus);
2015     s->vmfd = -1;
2016     s->fd = qemu_open("/dev/kvm", O_RDWR);
2017     if (s->fd == -1) {
2018         fprintf(stderr, "Could not access KVM kernel module: %m\n");
2019         ret = -errno;
2020         goto err;
2021     }
2022
2023     ret = kvm_ioctl(s, KVM_GET_API_VERSION, 0);
2024     if (ret < KVM_API_VERSION) {
2025         if (ret >= 0) {
2026             ret = -EINVAL;
2027         }
2028         fprintf(stderr, "kvm version too old\n");
2029         goto err;
2030     }
2031
2032     if (ret > KVM_API_VERSION) {
2033         ret = -EINVAL;
2034         fprintf(stderr, "kvm version not supported\n");
2035         goto err;
2036     }
2037
2038     kvm_immediate_exit = kvm_check_extension(s, KVM_CAP_IMMEDIATE_EXIT);
2039     s->nr_slots = kvm_check_extension(s, KVM_CAP_NR_MEMSLOTS);
2040
2041     /* If unspecified, use the default value */
2042     if (!s->nr_slots) {
2043         s->nr_slots = 32;
2044     }
2045
2046     s->nr_as = kvm_check_extension(s, KVM_CAP_MULTI_ADDRESS_SPACE);
2047     if (s->nr_as <= 1) {
2048         s->nr_as = 1;
2049     }
2050     s->as = g_new0(struct KVMAs, s->nr_as);
2051
2052     kvm_type = qemu_opt_get(qemu_get_machine_opts(), "kvm-type");
2053     if (mc->kvm_type) {
2054         type = mc->kvm_type(ms, kvm_type);
2055     } else if (kvm_type) {
2056         ret = -EINVAL;
2057         fprintf(stderr, "Invalid argument kvm-type=%s\n", kvm_type);
2058         goto err;
2059     }
2060
2061     do {
2062         ret = kvm_ioctl(s, KVM_CREATE_VM, type);
2063     } while (ret == -EINTR);
2064
2065     if (ret < 0) {
2066         fprintf(stderr, "ioctl(KVM_CREATE_VM) failed: %d %s\n", -ret,
2067                 strerror(-ret));
2068
2069 #ifdef TARGET_S390X
2070         if (ret == -EINVAL) {
2071             fprintf(stderr,
2072                     "Host kernel setup problem detected. Please verify:\n");
2073             fprintf(stderr, "- for kernels supporting the switch_amode or"
2074                     " user_mode parameters, whether\n");
2075             fprintf(stderr,
2076                     "  user space is running in primary address space\n");
2077             fprintf(stderr,
2078                     "- for kernels supporting the vm.allocate_pgste sysctl, "
2079                     "whether it is enabled\n");
2080         }
2081 #endif
2082         goto err;
2083     }
2084
2085     s->vmfd = ret;
2086
2087     /* check the vcpu limits */
2088     soft_vcpus_limit = kvm_recommended_vcpus(s);
2089     hard_vcpus_limit = kvm_max_vcpus(s);
2090
2091     while (nc->name) {
2092         if (nc->num > soft_vcpus_limit) {
2093             warn_report("Number of %s cpus requested (%d) exceeds "
2094                         "the recommended cpus supported by KVM (%d)",
2095                         nc->name, nc->num, soft_vcpus_limit);
2096
2097             if (nc->num > hard_vcpus_limit) {
2098                 fprintf(stderr, "Number of %s cpus requested (%d) exceeds "
2099                         "the maximum cpus supported by KVM (%d)\n",
2100                         nc->name, nc->num, hard_vcpus_limit);
2101                 exit(1);
2102             }
2103         }
2104         nc++;
2105     }
2106
2107     missing_cap = kvm_check_extension_list(s, kvm_required_capabilites);
2108     if (!missing_cap) {
2109         missing_cap =
2110             kvm_check_extension_list(s, kvm_arch_required_capabilities);
2111     }
2112     if (missing_cap) {
2113         ret = -EINVAL;
2114         fprintf(stderr, "kvm does not support %s\n%s",
2115                 missing_cap->name, upgrade_note);
2116         goto err;
2117     }
2118
2119     s->coalesced_mmio = kvm_check_extension(s, KVM_CAP_COALESCED_MMIO);
2120     s->coalesced_pio = s->coalesced_mmio &&
2121                        kvm_check_extension(s, KVM_CAP_COALESCED_PIO);
2122
2123     dirty_log_manual_caps =
2124         kvm_check_extension(s, KVM_CAP_MANUAL_DIRTY_LOG_PROTECT2);
2125     dirty_log_manual_caps &= (KVM_DIRTY_LOG_MANUAL_PROTECT_ENABLE |
2126                               KVM_DIRTY_LOG_INITIALLY_SET);
2127     s->manual_dirty_log_protect = dirty_log_manual_caps;
2128     if (dirty_log_manual_caps) {
2129         ret = kvm_vm_enable_cap(s, KVM_CAP_MANUAL_DIRTY_LOG_PROTECT2, 0,
2130                                    dirty_log_manual_caps);
2131         if (ret) {
2132             warn_report("Trying to enable capability %"PRIu64" of "
2133                         "KVM_CAP_MANUAL_DIRTY_LOG_PROTECT2 but failed. "
2134                         "Falling back to the legacy mode. ",
2135                         dirty_log_manual_caps);
2136             s->manual_dirty_log_protect = 0;
2137         }
2138     }
2139
2140 #ifdef KVM_CAP_VCPU_EVENTS
2141     s->vcpu_events = kvm_check_extension(s, KVM_CAP_VCPU_EVENTS);
2142 #endif
2143
2144     s->robust_singlestep =
2145         kvm_check_extension(s, KVM_CAP_X86_ROBUST_SINGLESTEP);
2146
2147 #ifdef KVM_CAP_DEBUGREGS
2148     s->debugregs = kvm_check_extension(s, KVM_CAP_DEBUGREGS);
2149 #endif
2150
2151     s->max_nested_state_len = kvm_check_extension(s, KVM_CAP_NESTED_STATE);
2152
2153 #ifdef KVM_CAP_IRQ_ROUTING
2154     kvm_direct_msi_allowed = (kvm_check_extension(s, KVM_CAP_SIGNAL_MSI) > 0);
2155 #endif
2156
2157     s->intx_set_mask = kvm_check_extension(s, KVM_CAP_PCI_2_3);
2158
2159     s->irq_set_ioctl = KVM_IRQ_LINE;
2160     if (kvm_check_extension(s, KVM_CAP_IRQ_INJECT_STATUS)) {
2161         s->irq_set_ioctl = KVM_IRQ_LINE_STATUS;
2162     }
2163
2164     kvm_readonly_mem_allowed =
2165         (kvm_check_extension(s, KVM_CAP_READONLY_MEM) > 0);
2166
2167     kvm_eventfds_allowed =
2168         (kvm_check_extension(s, KVM_CAP_IOEVENTFD) > 0);
2169
2170     kvm_irqfds_allowed =
2171         (kvm_check_extension(s, KVM_CAP_IRQFD) > 0);
2172
2173     kvm_resamplefds_allowed =
2174         (kvm_check_extension(s, KVM_CAP_IRQFD_RESAMPLE) > 0);
2175
2176     kvm_vm_attributes_allowed =
2177         (kvm_check_extension(s, KVM_CAP_VM_ATTRIBUTES) > 0);
2178
2179     kvm_ioeventfd_any_length_allowed =
2180         (kvm_check_extension(s, KVM_CAP_IOEVENTFD_ANY_LENGTH) > 0);
2181
2182     kvm_state = s;
2183
2184     /*
2185      * if memory encryption object is specified then initialize the memory
2186      * encryption context.
2187      */
2188     if (ms->memory_encryption) {
2189         kvm_state->memcrypt_handle = sev_guest_init(ms->memory_encryption);
2190         if (!kvm_state->memcrypt_handle) {
2191             ret = -1;
2192             goto err;
2193         }
2194
2195         kvm_state->memcrypt_encrypt_data = sev_encrypt_data;
2196     }
2197
2198     ret = kvm_arch_init(ms, s);
2199     if (ret < 0) {
2200         goto err;
2201     }
2202
2203     if (s->kernel_irqchip_split == ON_OFF_AUTO_AUTO) {
2204         s->kernel_irqchip_split = mc->default_kernel_irqchip_split ? ON_OFF_AUTO_ON : ON_OFF_AUTO_OFF;
2205     }
2206
2207     qemu_register_reset(kvm_unpoison_all, NULL);
2208
2209     if (s->kernel_irqchip_allowed) {
2210         kvm_irqchip_create(s);
2211     }
2212
2213     if (kvm_eventfds_allowed) {
2214         s->memory_listener.listener.eventfd_add = kvm_mem_ioeventfd_add;
2215         s->memory_listener.listener.eventfd_del = kvm_mem_ioeventfd_del;
2216     }
2217     s->memory_listener.listener.coalesced_io_add = kvm_coalesce_mmio_region;
2218     s->memory_listener.listener.coalesced_io_del = kvm_uncoalesce_mmio_region;
2219
2220     kvm_memory_listener_register(s, &s->memory_listener,
2221                                  &address_space_memory, 0);
2222     memory_listener_register(&kvm_io_listener,
2223                              &address_space_io);
2224     memory_listener_register(&kvm_coalesced_pio_listener,
2225                              &address_space_io);
2226
2227     s->many_ioeventfds = kvm_check_many_ioeventfds();
2228
2229     s->sync_mmu = !!kvm_vm_check_extension(kvm_state, KVM_CAP_SYNC_MMU);
2230     if (!s->sync_mmu) {
2231         ret = ram_block_discard_disable(true);
2232         assert(!ret);
2233     }
2234
2235     return 0;
2236
2237 err:
2238     assert(ret < 0);
2239     if (s->vmfd >= 0) {
2240         close(s->vmfd);
2241     }
2242     if (s->fd != -1) {
2243         close(s->fd);
2244     }
2245     g_free(s->memory_listener.slots);
2246
2247     return ret;
2248 }
2249
2250 void kvm_set_sigmask_len(KVMState *s, unsigned int sigmask_len)
2251 {
2252     s->sigmask_len = sigmask_len;
2253 }
2254
2255 static void kvm_handle_io(uint16_t port, MemTxAttrs attrs, void *data, int direction,
2256                           int size, uint32_t count)
2257 {
2258     int i;
2259     uint8_t *ptr = data;
2260
2261     for (i = 0; i < count; i++) {
2262         address_space_rw(&address_space_io, port, attrs,
2263                          ptr, size,
2264                          direction == KVM_EXIT_IO_OUT);
2265         ptr += size;
2266     }
2267 }
2268
2269 static int kvm_handle_internal_error(CPUState *cpu, struct kvm_run *run)
2270 {
2271     fprintf(stderr, "KVM internal error. Suberror: %d\n",
2272             run->internal.suberror);
2273
2274     if (kvm_check_extension(kvm_state, KVM_CAP_INTERNAL_ERROR_DATA)) {
2275         int i;
2276
2277         for (i = 0; i < run->internal.ndata; ++i) {
2278             fprintf(stderr, "extra data[%d]: %"PRIx64"\n",
2279                     i, (uint64_t)run->internal.data[i]);
2280         }
2281     }
2282     if (run->internal.suberror == KVM_INTERNAL_ERROR_EMULATION) {
2283         fprintf(stderr, "emulation failure\n");
2284         if (!kvm_arch_stop_on_emulation_error(cpu)) {
2285             cpu_dump_state(cpu, stderr, CPU_DUMP_CODE);
2286             return EXCP_INTERRUPT;
2287         }
2288     }
2289     /* FIXME: Should trigger a qmp message to let management know
2290      * something went wrong.
2291      */
2292     return -1;
2293 }
2294
2295 void kvm_flush_coalesced_mmio_buffer(void)
2296 {
2297     KVMState *s = kvm_state;
2298
2299     if (s->coalesced_flush_in_progress) {
2300         return;
2301     }
2302
2303     s->coalesced_flush_in_progress = true;
2304
2305     if (s->coalesced_mmio_ring) {
2306         struct kvm_coalesced_mmio_ring *ring = s->coalesced_mmio_ring;
2307         while (ring->first != ring->last) {
2308             struct kvm_coalesced_mmio *ent;
2309
2310             ent = &ring->coalesced_mmio[ring->first];
2311
2312             if (ent->pio == 1) {
2313                 address_space_write(&address_space_io, ent->phys_addr,
2314                                     MEMTXATTRS_UNSPECIFIED, ent->data,
2315                                     ent->len);
2316             } else {
2317                 cpu_physical_memory_write(ent->phys_addr, ent->data, ent->len);
2318             }
2319             smp_wmb();
2320             ring->first = (ring->first + 1) % KVM_COALESCED_MMIO_MAX;
2321         }
2322     }
2323
2324     s->coalesced_flush_in_progress = false;
2325 }
2326
2327 static void do_kvm_cpu_synchronize_state(CPUState *cpu, run_on_cpu_data arg)
2328 {
2329     if (!cpu->vcpu_dirty) {
2330         kvm_arch_get_registers(cpu);
2331         cpu->vcpu_dirty = true;
2332     }
2333 }
2334
2335 void kvm_cpu_synchronize_state(CPUState *cpu)
2336 {
2337     if (!cpu->vcpu_dirty) {
2338         run_on_cpu(cpu, do_kvm_cpu_synchronize_state, RUN_ON_CPU_NULL);
2339     }
2340 }
2341
2342 static void do_kvm_cpu_synchronize_post_reset(CPUState *cpu, run_on_cpu_data arg)
2343 {
2344     kvm_arch_put_registers(cpu, KVM_PUT_RESET_STATE);
2345     cpu->vcpu_dirty = false;
2346 }
2347
2348 void kvm_cpu_synchronize_post_reset(CPUState *cpu)
2349 {
2350     run_on_cpu(cpu, do_kvm_cpu_synchronize_post_reset, RUN_ON_CPU_NULL);
2351 }
2352
2353 static void do_kvm_cpu_synchronize_post_init(CPUState *cpu, run_on_cpu_data arg)
2354 {
2355     kvm_arch_put_registers(cpu, KVM_PUT_FULL_STATE);
2356     cpu->vcpu_dirty = false;
2357 }
2358
2359 void kvm_cpu_synchronize_post_init(CPUState *cpu)
2360 {
2361     run_on_cpu(cpu, do_kvm_cpu_synchronize_post_init, RUN_ON_CPU_NULL);
2362 }
2363
2364 static void do_kvm_cpu_synchronize_pre_loadvm(CPUState *cpu, run_on_cpu_data arg)
2365 {
2366     cpu->vcpu_dirty = true;
2367 }
2368
2369 void kvm_cpu_synchronize_pre_loadvm(CPUState *cpu)
2370 {
2371     run_on_cpu(cpu, do_kvm_cpu_synchronize_pre_loadvm, RUN_ON_CPU_NULL);
2372 }
2373
2374 #ifdef KVM_HAVE_MCE_INJECTION
2375 static __thread void *pending_sigbus_addr;
2376 static __thread int pending_sigbus_code;
2377 static __thread bool have_sigbus_pending;
2378 #endif
2379
2380 static void kvm_cpu_kick(CPUState *cpu)
2381 {
2382     atomic_set(&cpu->kvm_run->immediate_exit, 1);
2383 }
2384
2385 static void kvm_cpu_kick_self(void)
2386 {
2387     if (kvm_immediate_exit) {
2388         kvm_cpu_kick(current_cpu);
2389     } else {
2390         qemu_cpu_kick_self();
2391     }
2392 }
2393
2394 static void kvm_eat_signals(CPUState *cpu)
2395 {
2396     struct timespec ts = { 0, 0 };
2397     siginfo_t siginfo;
2398     sigset_t waitset;
2399     sigset_t chkset;
2400     int r;
2401
2402     if (kvm_immediate_exit) {
2403         atomic_set(&cpu->kvm_run->immediate_exit, 0);
2404         /* Write kvm_run->immediate_exit before the cpu->exit_request
2405          * write in kvm_cpu_exec.
2406          */
2407         smp_wmb();
2408         return;
2409     }
2410
2411     sigemptyset(&waitset);
2412     sigaddset(&waitset, SIG_IPI);
2413
2414     do {
2415         r = sigtimedwait(&waitset, &siginfo, &ts);
2416         if (r == -1 && !(errno == EAGAIN || errno == EINTR)) {
2417             perror("sigtimedwait");
2418             exit(1);
2419         }
2420
2421         r = sigpending(&chkset);
2422         if (r == -1) {
2423             perror("sigpending");
2424             exit(1);
2425         }
2426     } while (sigismember(&chkset, SIG_IPI));
2427 }
2428
2429 int kvm_cpu_exec(CPUState *cpu)
2430 {
2431     struct kvm_run *run = cpu->kvm_run;
2432     int ret, run_ret;
2433
2434     DPRINTF("kvm_cpu_exec()\n");
2435
2436     if (kvm_arch_process_async_events(cpu)) {
2437         atomic_set(&cpu->exit_request, 0);
2438         return EXCP_HLT;
2439     }
2440
2441     qemu_mutex_unlock_iothread();
2442     cpu_exec_start(cpu);
2443
2444     do {
2445         MemTxAttrs attrs;
2446
2447         if (cpu->vcpu_dirty) {
2448             kvm_arch_put_registers(cpu, KVM_PUT_RUNTIME_STATE);
2449             cpu->vcpu_dirty = false;
2450         }
2451
2452         kvm_arch_pre_run(cpu, run);
2453         if (atomic_read(&cpu->exit_request)) {
2454             DPRINTF("interrupt exit requested\n");
2455             /*
2456              * KVM requires us to reenter the kernel after IO exits to complete
2457              * instruction emulation. This self-signal will ensure that we
2458              * leave ASAP again.
2459              */
2460             kvm_cpu_kick_self();
2461         }
2462
2463         /* Read cpu->exit_request before KVM_RUN reads run->immediate_exit.
2464          * Matching barrier in kvm_eat_signals.
2465          */
2466         smp_rmb();
2467
2468         run_ret = kvm_vcpu_ioctl(cpu, KVM_RUN, 0);
2469
2470         attrs = kvm_arch_post_run(cpu, run);
2471
2472 #ifdef KVM_HAVE_MCE_INJECTION
2473         if (unlikely(have_sigbus_pending)) {
2474             qemu_mutex_lock_iothread();
2475             kvm_arch_on_sigbus_vcpu(cpu, pending_sigbus_code,
2476                                     pending_sigbus_addr);
2477             have_sigbus_pending = false;
2478             qemu_mutex_unlock_iothread();
2479         }
2480 #endif
2481
2482         if (run_ret < 0) {
2483             if (run_ret == -EINTR || run_ret == -EAGAIN) {
2484                 DPRINTF("io window exit\n");
2485                 kvm_eat_signals(cpu);
2486                 ret = EXCP_INTERRUPT;
2487                 break;
2488             }
2489             fprintf(stderr, "error: kvm run failed %s\n",
2490                     strerror(-run_ret));
2491 #ifdef TARGET_PPC
2492             if (run_ret == -EBUSY) {
2493                 fprintf(stderr,
2494                         "This is probably because your SMT is enabled.\n"
2495                         "VCPU can only run on primary threads with all "
2496                         "secondary threads offline.\n");
2497             }
2498 #endif
2499             ret = -1;
2500             break;
2501         }
2502
2503         trace_kvm_run_exit(cpu->cpu_index, run->exit_reason);
2504         switch (run->exit_reason) {
2505         case KVM_EXIT_IO:
2506             DPRINTF("handle_io\n");
2507             /* Called outside BQL */
2508             kvm_handle_io(run->io.port, attrs,
2509                           (uint8_t *)run + run->io.data_offset,
2510                           run->io.direction,
2511                           run->io.size,
2512                           run->io.count);
2513             ret = 0;
2514             break;
2515         case KVM_EXIT_MMIO:
2516             DPRINTF("handle_mmio\n");
2517             /* Called outside BQL */
2518             address_space_rw(&address_space_memory,
2519                              run->mmio.phys_addr, attrs,
2520                              run->mmio.data,
2521                              run->mmio.len,
2522                              run->mmio.is_write);
2523             ret = 0;
2524             break;
2525         case KVM_EXIT_IRQ_WINDOW_OPEN:
2526             DPRINTF("irq_window_open\n");
2527             ret = EXCP_INTERRUPT;
2528             break;
2529         case KVM_EXIT_SHUTDOWN:
2530             DPRINTF("shutdown\n");
2531             qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
2532             ret = EXCP_INTERRUPT;
2533             break;
2534         case KVM_EXIT_UNKNOWN:
2535             fprintf(stderr, "KVM: unknown exit, hardware reason %" PRIx64 "\n",
2536                     (uint64_t)run->hw.hardware_exit_reason);
2537             ret = -1;
2538             break;
2539         case KVM_EXIT_INTERNAL_ERROR:
2540             ret = kvm_handle_internal_error(cpu, run);
2541             break;
2542         case KVM_EXIT_SYSTEM_EVENT:
2543             switch (run->system_event.type) {
2544             case KVM_SYSTEM_EVENT_SHUTDOWN:
2545                 qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
2546                 ret = EXCP_INTERRUPT;
2547                 break;
2548             case KVM_SYSTEM_EVENT_RESET:
2549                 qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
2550                 ret = EXCP_INTERRUPT;
2551                 break;
2552             case KVM_SYSTEM_EVENT_CRASH:
2553                 kvm_cpu_synchronize_state(cpu);
2554                 qemu_mutex_lock_iothread();
2555                 qemu_system_guest_panicked(cpu_get_crash_info(cpu));
2556                 qemu_mutex_unlock_iothread();
2557                 ret = 0;
2558                 break;
2559             default:
2560                 DPRINTF("kvm_arch_handle_exit\n");
2561                 ret = kvm_arch_handle_exit(cpu, run);
2562                 break;
2563             }
2564             break;
2565         default:
2566             DPRINTF("kvm_arch_handle_exit\n");
2567             ret = kvm_arch_handle_exit(cpu, run);
2568             break;
2569         }
2570     } while (ret == 0);
2571
2572     cpu_exec_end(cpu);
2573     qemu_mutex_lock_iothread();
2574
2575     if (ret < 0) {
2576         cpu_dump_state(cpu, stderr, CPU_DUMP_CODE);
2577         vm_stop(RUN_STATE_INTERNAL_ERROR);
2578     }
2579
2580     atomic_set(&cpu->exit_request, 0);
2581     return ret;
2582 }
2583
2584 int kvm_ioctl(KVMState *s, int type, ...)
2585 {
2586     int ret;
2587     void *arg;
2588     va_list ap;
2589
2590     va_start(ap, type);
2591     arg = va_arg(ap, void *);
2592     va_end(ap);
2593
2594     trace_kvm_ioctl(type, arg);
2595     ret = ioctl(s->fd, type, arg);
2596     if (ret == -1) {
2597         ret = -errno;
2598     }
2599     return ret;
2600 }
2601
2602 int kvm_vm_ioctl(KVMState *s, int type, ...)
2603 {
2604     int ret;
2605     void *arg;
2606     va_list ap;
2607
2608     va_start(ap, type);
2609     arg = va_arg(ap, void *);
2610     va_end(ap);
2611
2612     trace_kvm_vm_ioctl(type, arg);
2613     ret = ioctl(s->vmfd, type, arg);
2614     if (ret == -1) {
2615         ret = -errno;
2616     }
2617     return ret;
2618 }
2619
2620 int kvm_vcpu_ioctl(CPUState *cpu, int type, ...)
2621 {
2622     int ret;
2623     void *arg;
2624     va_list ap;
2625
2626     va_start(ap, type);
2627     arg = va_arg(ap, void *);
2628     va_end(ap);
2629
2630     trace_kvm_vcpu_ioctl(cpu->cpu_index, type, arg);
2631     ret = ioctl(cpu->kvm_fd, type, arg);
2632     if (ret == -1) {
2633         ret = -errno;
2634     }
2635     return ret;
2636 }
2637
2638 int kvm_device_ioctl(int fd, int type, ...)
2639 {
2640     int ret;
2641     void *arg;
2642     va_list ap;
2643
2644     va_start(ap, type);
2645     arg = va_arg(ap, void *);
2646     va_end(ap);
2647
2648     trace_kvm_device_ioctl(fd, type, arg);
2649     ret = ioctl(fd, type, arg);
2650     if (ret == -1) {
2651         ret = -errno;
2652     }
2653     return ret;
2654 }
2655
2656 int kvm_vm_check_attr(KVMState *s, uint32_t group, uint64_t attr)
2657 {
2658     int ret;
2659     struct kvm_device_attr attribute = {
2660         .group = group,
2661         .attr = attr,
2662     };
2663
2664     if (!kvm_vm_attributes_allowed) {
2665         return 0;
2666     }
2667
2668     ret = kvm_vm_ioctl(s, KVM_HAS_DEVICE_ATTR, &attribute);
2669     /* kvm returns 0 on success for HAS_DEVICE_ATTR */
2670     return ret ? 0 : 1;
2671 }
2672
2673 int kvm_device_check_attr(int dev_fd, uint32_t group, uint64_t attr)
2674 {
2675     struct kvm_device_attr attribute = {
2676         .group = group,
2677         .attr = attr,
2678         .flags = 0,
2679     };
2680
2681     return kvm_device_ioctl(dev_fd, KVM_HAS_DEVICE_ATTR, &attribute) ? 0 : 1;
2682 }
2683
2684 int kvm_device_access(int fd, int group, uint64_t attr,
2685                       void *val, bool write, Error **errp)
2686 {
2687     struct kvm_device_attr kvmattr;
2688     int err;
2689
2690     kvmattr.flags = 0;
2691     kvmattr.group = group;
2692     kvmattr.attr = attr;
2693     kvmattr.addr = (uintptr_t)val;
2694
2695     err = kvm_device_ioctl(fd,
2696                            write ? KVM_SET_DEVICE_ATTR : KVM_GET_DEVICE_ATTR,
2697                            &kvmattr);
2698     if (err < 0) {
2699         error_setg_errno(errp, -err,
2700                          "KVM_%s_DEVICE_ATTR failed: Group %d "
2701                          "attr 0x%016" PRIx64,
2702                          write ? "SET" : "GET", group, attr);
2703     }
2704     return err;
2705 }
2706
2707 bool kvm_has_sync_mmu(void)
2708 {
2709     return kvm_state->sync_mmu;
2710 }
2711
2712 int kvm_has_vcpu_events(void)
2713 {
2714     return kvm_state->vcpu_events;
2715 }
2716
2717 int kvm_has_robust_singlestep(void)
2718 {
2719     return kvm_state->robust_singlestep;
2720 }
2721
2722 int kvm_has_debugregs(void)
2723 {
2724     return kvm_state->debugregs;
2725 }
2726
2727 int kvm_max_nested_state_length(void)
2728 {
2729     return kvm_state->max_nested_state_len;
2730 }
2731
2732 int kvm_has_many_ioeventfds(void)
2733 {
2734     if (!kvm_enabled()) {
2735         return 0;
2736     }
2737     return kvm_state->many_ioeventfds;
2738 }
2739
2740 int kvm_has_gsi_routing(void)
2741 {
2742 #ifdef KVM_CAP_IRQ_ROUTING
2743     return kvm_check_extension(kvm_state, KVM_CAP_IRQ_ROUTING);
2744 #else
2745     return false;
2746 #endif
2747 }
2748
2749 int kvm_has_intx_set_mask(void)
2750 {
2751     return kvm_state->intx_set_mask;
2752 }
2753
2754 bool kvm_arm_supports_user_irq(void)
2755 {
2756     return kvm_check_extension(kvm_state, KVM_CAP_ARM_USER_IRQ);
2757 }
2758
2759 #ifdef KVM_CAP_SET_GUEST_DEBUG
2760 struct kvm_sw_breakpoint *kvm_find_sw_breakpoint(CPUState *cpu,
2761                                                  target_ulong pc)
2762 {
2763     struct kvm_sw_breakpoint *bp;
2764
2765     QTAILQ_FOREACH(bp, &cpu->kvm_state->kvm_sw_breakpoints, entry) {
2766         if (bp->pc == pc) {
2767             return bp;
2768         }
2769     }
2770     return NULL;
2771 }
2772
2773 int kvm_sw_breakpoints_active(CPUState *cpu)
2774 {
2775     return !QTAILQ_EMPTY(&cpu->kvm_state->kvm_sw_breakpoints);
2776 }
2777
2778 struct kvm_set_guest_debug_data {
2779     struct kvm_guest_debug dbg;
2780     int err;
2781 };
2782
2783 static void kvm_invoke_set_guest_debug(CPUState *cpu, run_on_cpu_data data)
2784 {
2785     struct kvm_set_guest_debug_data *dbg_data =
2786         (struct kvm_set_guest_debug_data *) data.host_ptr;
2787
2788     dbg_data->err = kvm_vcpu_ioctl(cpu, KVM_SET_GUEST_DEBUG,
2789                                    &dbg_data->dbg);
2790 }
2791
2792 int kvm_update_guest_debug(CPUState *cpu, unsigned long reinject_trap)
2793 {
2794     struct kvm_set_guest_debug_data data;
2795
2796     data.dbg.control = reinject_trap;
2797
2798     if (cpu->singlestep_enabled) {
2799         data.dbg.control |= KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP;
2800     }
2801     kvm_arch_update_guest_debug(cpu, &data.dbg);
2802
2803     run_on_cpu(cpu, kvm_invoke_set_guest_debug,
2804                RUN_ON_CPU_HOST_PTR(&data));
2805     return data.err;
2806 }
2807
2808 int kvm_insert_breakpoint(CPUState *cpu, target_ulong addr,
2809                           target_ulong len, int type)
2810 {
2811     struct kvm_sw_breakpoint *bp;
2812     int err;
2813
2814     if (type == GDB_BREAKPOINT_SW) {
2815         bp = kvm_find_sw_breakpoint(cpu, addr);
2816         if (bp) {
2817             bp->use_count++;
2818             return 0;
2819         }
2820
2821         bp = g_malloc(sizeof(struct kvm_sw_breakpoint));
2822         bp->pc = addr;
2823         bp->use_count = 1;
2824         err = kvm_arch_insert_sw_breakpoint(cpu, bp);
2825         if (err) {
2826             g_free(bp);
2827             return err;
2828         }
2829
2830         QTAILQ_INSERT_HEAD(&cpu->kvm_state->kvm_sw_breakpoints, bp, entry);
2831     } else {
2832         err = kvm_arch_insert_hw_breakpoint(addr, len, type);
2833         if (err) {
2834             return err;
2835         }
2836     }
2837
2838     CPU_FOREACH(cpu) {
2839         err = kvm_update_guest_debug(cpu, 0);
2840         if (err) {
2841             return err;
2842         }
2843     }
2844     return 0;
2845 }
2846
2847 int kvm_remove_breakpoint(CPUState *cpu, target_ulong addr,
2848                           target_ulong len, int type)
2849 {
2850     struct kvm_sw_breakpoint *bp;
2851     int err;
2852
2853     if (type == GDB_BREAKPOINT_SW) {
2854         bp = kvm_find_sw_breakpoint(cpu, addr);
2855         if (!bp) {
2856             return -ENOENT;
2857         }
2858
2859         if (bp->use_count > 1) {
2860             bp->use_count--;
2861             return 0;
2862         }
2863
2864         err = kvm_arch_remove_sw_breakpoint(cpu, bp);
2865         if (err) {
2866             return err;
2867         }
2868
2869         QTAILQ_REMOVE(&cpu->kvm_state->kvm_sw_breakpoints, bp, entry);
2870         g_free(bp);
2871     } else {
2872         err = kvm_arch_remove_hw_breakpoint(addr, len, type);
2873         if (err) {
2874             return err;
2875         }
2876     }
2877
2878     CPU_FOREACH(cpu) {
2879         err = kvm_update_guest_debug(cpu, 0);
2880         if (err) {
2881             return err;
2882         }
2883     }
2884     return 0;
2885 }
2886
2887 void kvm_remove_all_breakpoints(CPUState *cpu)
2888 {
2889     struct kvm_sw_breakpoint *bp, *next;
2890     KVMState *s = cpu->kvm_state;
2891     CPUState *tmpcpu;
2892
2893     QTAILQ_FOREACH_SAFE(bp, &s->kvm_sw_breakpoints, entry, next) {
2894         if (kvm_arch_remove_sw_breakpoint(cpu, bp) != 0) {
2895             /* Try harder to find a CPU that currently sees the breakpoint. */
2896             CPU_FOREACH(tmpcpu) {
2897                 if (kvm_arch_remove_sw_breakpoint(tmpcpu, bp) == 0) {
2898                     break;
2899                 }
2900             }
2901         }
2902         QTAILQ_REMOVE(&s->kvm_sw_breakpoints, bp, entry);
2903         g_free(bp);
2904     }
2905     kvm_arch_remove_all_hw_breakpoints();
2906
2907     CPU_FOREACH(cpu) {
2908         kvm_update_guest_debug(cpu, 0);
2909     }
2910 }
2911
2912 #else /* !KVM_CAP_SET_GUEST_DEBUG */
2913
2914 int kvm_update_guest_debug(CPUState *cpu, unsigned long reinject_trap)
2915 {
2916     return -EINVAL;
2917 }
2918
2919 int kvm_insert_breakpoint(CPUState *cpu, target_ulong addr,
2920                           target_ulong len, int type)
2921 {
2922     return -EINVAL;
2923 }
2924
2925 int kvm_remove_breakpoint(CPUState *cpu, target_ulong addr,
2926                           target_ulong len, int type)
2927 {
2928     return -EINVAL;
2929 }
2930
2931 void kvm_remove_all_breakpoints(CPUState *cpu)
2932 {
2933 }
2934 #endif /* !KVM_CAP_SET_GUEST_DEBUG */
2935
2936 static int kvm_set_signal_mask(CPUState *cpu, const sigset_t *sigset)
2937 {
2938     KVMState *s = kvm_state;
2939     struct kvm_signal_mask *sigmask;
2940     int r;
2941
2942     sigmask = g_malloc(sizeof(*sigmask) + sizeof(*sigset));
2943
2944     sigmask->len = s->sigmask_len;
2945     memcpy(sigmask->sigset, sigset, sizeof(*sigset));
2946     r = kvm_vcpu_ioctl(cpu, KVM_SET_SIGNAL_MASK, sigmask);
2947     g_free(sigmask);
2948
2949     return r;
2950 }
2951
2952 static void kvm_ipi_signal(int sig)
2953 {
2954     if (current_cpu) {
2955         assert(kvm_immediate_exit);
2956         kvm_cpu_kick(current_cpu);
2957     }
2958 }
2959
2960 void kvm_init_cpu_signals(CPUState *cpu)
2961 {
2962     int r;
2963     sigset_t set;
2964     struct sigaction sigact;
2965
2966     memset(&sigact, 0, sizeof(sigact));
2967     sigact.sa_handler = kvm_ipi_signal;
2968     sigaction(SIG_IPI, &sigact, NULL);
2969
2970     pthread_sigmask(SIG_BLOCK, NULL, &set);
2971 #if defined KVM_HAVE_MCE_INJECTION
2972     sigdelset(&set, SIGBUS);
2973     pthread_sigmask(SIG_SETMASK, &set, NULL);
2974 #endif
2975     sigdelset(&set, SIG_IPI);
2976     if (kvm_immediate_exit) {
2977         r = pthread_sigmask(SIG_SETMASK, &set, NULL);
2978     } else {
2979         r = kvm_set_signal_mask(cpu, &set);
2980     }
2981     if (r) {
2982         fprintf(stderr, "kvm_set_signal_mask: %s\n", strerror(-r));
2983         exit(1);
2984     }
2985 }
2986
2987 /* Called asynchronously in VCPU thread.  */
2988 int kvm_on_sigbus_vcpu(CPUState *cpu, int code, void *addr)
2989 {
2990 #ifdef KVM_HAVE_MCE_INJECTION
2991     if (have_sigbus_pending) {
2992         return 1;
2993     }
2994     have_sigbus_pending = true;
2995     pending_sigbus_addr = addr;
2996     pending_sigbus_code = code;
2997     atomic_set(&cpu->exit_request, 1);
2998     return 0;
2999 #else
3000     return 1;
3001 #endif
3002 }
3003
3004 /* Called synchronously (via signalfd) in main thread.  */
3005 int kvm_on_sigbus(int code, void *addr)
3006 {
3007 #ifdef KVM_HAVE_MCE_INJECTION
3008     /* Action required MCE kills the process if SIGBUS is blocked.  Because
3009      * that's what happens in the I/O thread, where we handle MCE via signalfd,
3010      * we can only get action optional here.
3011      */
3012     assert(code != BUS_MCEERR_AR);
3013     kvm_arch_on_sigbus_vcpu(first_cpu, code, addr);
3014     return 0;
3015 #else
3016     return 1;
3017 #endif
3018 }
3019
3020 int kvm_create_device(KVMState *s, uint64_t type, bool test)
3021 {
3022     int ret;
3023     struct kvm_create_device create_dev;
3024
3025     create_dev.type = type;
3026     create_dev.fd = -1;
3027     create_dev.flags = test ? KVM_CREATE_DEVICE_TEST : 0;
3028
3029     if (!kvm_check_extension(s, KVM_CAP_DEVICE_CTRL)) {
3030         return -ENOTSUP;
3031     }
3032
3033     ret = kvm_vm_ioctl(s, KVM_CREATE_DEVICE, &create_dev);
3034     if (ret) {
3035         return ret;
3036     }
3037
3038     return test ? 0 : create_dev.fd;
3039 }
3040
3041 bool kvm_device_supported(int vmfd, uint64_t type)
3042 {
3043     struct kvm_create_device create_dev = {
3044         .type = type,
3045         .fd = -1,
3046         .flags = KVM_CREATE_DEVICE_TEST,
3047     };
3048
3049     if (ioctl(vmfd, KVM_CHECK_EXTENSION, KVM_CAP_DEVICE_CTRL) <= 0) {
3050         return false;
3051     }
3052
3053     return (ioctl(vmfd, KVM_CREATE_DEVICE, &create_dev) >= 0);
3054 }
3055
3056 int kvm_set_one_reg(CPUState *cs, uint64_t id, void *source)
3057 {
3058     struct kvm_one_reg reg;
3059     int r;
3060
3061     reg.id = id;
3062     reg.addr = (uintptr_t) source;
3063     r = kvm_vcpu_ioctl(cs, KVM_SET_ONE_REG, &reg);
3064     if (r) {
3065         trace_kvm_failed_reg_set(id, strerror(-r));
3066     }
3067     return r;
3068 }
3069
3070 int kvm_get_one_reg(CPUState *cs, uint64_t id, void *target)
3071 {
3072     struct kvm_one_reg reg;
3073     int r;
3074
3075     reg.id = id;
3076     reg.addr = (uintptr_t) target;
3077     r = kvm_vcpu_ioctl(cs, KVM_GET_ONE_REG, &reg);
3078     if (r) {
3079         trace_kvm_failed_reg_get(id, strerror(-r));
3080     }
3081     return r;
3082 }
3083
3084 static bool kvm_accel_has_memory(MachineState *ms, AddressSpace *as,
3085                                  hwaddr start_addr, hwaddr size)
3086 {
3087     KVMState *kvm = KVM_STATE(ms->accelerator);
3088     int i;
3089
3090     for (i = 0; i < kvm->nr_as; ++i) {
3091         if (kvm->as[i].as == as && kvm->as[i].ml) {
3092             size = MIN(kvm_max_slot_size, size);
3093             return NULL != kvm_lookup_matching_slot(kvm->as[i].ml,
3094                                                     start_addr, size);
3095         }
3096     }
3097
3098     return false;
3099 }
3100
3101 static void kvm_get_kvm_shadow_mem(Object *obj, Visitor *v,
3102                                    const char *name, void *opaque,
3103                                    Error **errp)
3104 {
3105     KVMState *s = KVM_STATE(obj);
3106     int64_t value = s->kvm_shadow_mem;
3107
3108     visit_type_int(v, name, &value, errp);
3109 }
3110
3111 static void kvm_set_kvm_shadow_mem(Object *obj, Visitor *v,
3112                                    const char *name, void *opaque,
3113                                    Error **errp)
3114 {
3115     KVMState *s = KVM_STATE(obj);
3116     int64_t value;
3117
3118     if (!visit_type_int(v, name, &value, errp)) {
3119         return;
3120     }
3121
3122     s->kvm_shadow_mem = value;
3123 }
3124
3125 static void kvm_set_kernel_irqchip(Object *obj, Visitor *v,
3126                                    const char *name, void *opaque,
3127                                    Error **errp)
3128 {
3129     KVMState *s = KVM_STATE(obj);
3130     OnOffSplit mode;
3131
3132     if (!visit_type_OnOffSplit(v, name, &mode, errp)) {
3133         return;
3134     }
3135     switch (mode) {
3136     case ON_OFF_SPLIT_ON:
3137         s->kernel_irqchip_allowed = true;
3138         s->kernel_irqchip_required = true;
3139         s->kernel_irqchip_split = ON_OFF_AUTO_OFF;
3140         break;
3141     case ON_OFF_SPLIT_OFF:
3142         s->kernel_irqchip_allowed = false;
3143         s->kernel_irqchip_required = false;
3144         s->kernel_irqchip_split = ON_OFF_AUTO_OFF;
3145         break;
3146     case ON_OFF_SPLIT_SPLIT:
3147         s->kernel_irqchip_allowed = true;
3148         s->kernel_irqchip_required = true;
3149         s->kernel_irqchip_split = ON_OFF_AUTO_ON;
3150         break;
3151     default:
3152         /* The value was checked in visit_type_OnOffSplit() above. If
3153          * we get here, then something is wrong in QEMU.
3154          */
3155         abort();
3156     }
3157 }
3158
3159 bool kvm_kernel_irqchip_allowed(void)
3160 {
3161     return kvm_state->kernel_irqchip_allowed;
3162 }
3163
3164 bool kvm_kernel_irqchip_required(void)
3165 {
3166     return kvm_state->kernel_irqchip_required;
3167 }
3168
3169 bool kvm_kernel_irqchip_split(void)
3170 {
3171     return kvm_state->kernel_irqchip_split == ON_OFF_AUTO_ON;
3172 }
3173
3174 static void kvm_accel_instance_init(Object *obj)
3175 {
3176     KVMState *s = KVM_STATE(obj);
3177
3178     s->kvm_shadow_mem = -1;
3179     s->kernel_irqchip_allowed = true;
3180     s->kernel_irqchip_split = ON_OFF_AUTO_AUTO;
3181 }
3182
3183 static void kvm_accel_class_init(ObjectClass *oc, void *data)
3184 {
3185     AccelClass *ac = ACCEL_CLASS(oc);
3186     ac->name = "KVM";
3187     ac->init_machine = kvm_init;
3188     ac->has_memory = kvm_accel_has_memory;
3189     ac->allowed = &kvm_allowed;
3190
3191     object_class_property_add(oc, "kernel-irqchip", "on|off|split",
3192         NULL, kvm_set_kernel_irqchip,
3193         NULL, NULL);
3194     object_class_property_set_description(oc, "kernel-irqchip",
3195         "Configure KVM in-kernel irqchip");
3196
3197     object_class_property_add(oc, "kvm-shadow-mem", "int",
3198         kvm_get_kvm_shadow_mem, kvm_set_kvm_shadow_mem,
3199         NULL, NULL);
3200     object_class_property_set_description(oc, "kvm-shadow-mem",
3201         "KVM shadow MMU size");
3202 }
3203
3204 static const TypeInfo kvm_accel_type = {
3205     .name = TYPE_KVM_ACCEL,
3206     .parent = TYPE_ACCEL,
3207     .instance_init = kvm_accel_instance_init,
3208     .class_init = kvm_accel_class_init,
3209     .instance_size = sizeof(KVMState),
3210 };
3211
3212 static void kvm_type_init(void)
3213 {
3214     type_register_static(&kvm_accel_type);
3215 }
3216
3217 type_init(kvm_type_init);