1ae1fae34SPekka Enberg #include "kvm/kvm.h" 2ae1fae34SPekka Enberg 3eda03319SPekka Enberg #include "kvm/interrupt.h" 4f3150089SPekka Enberg #include "kvm/util.h" 5eda03319SPekka Enberg 66c7d8514SPekka Enberg #include <linux/kvm.h> 7f5ab5f67SPekka Enberg 8f5ab5f67SPekka Enberg #include <asm/bootparam.h> 9f5ab5f67SPekka Enberg 10ae1fae34SPekka Enberg #include <sys/ioctl.h> 111f9cff23SPekka Enberg #include <inttypes.h> 121f9cff23SPekka Enberg #include <sys/mman.h> 132da26a59SPekka Enberg #include <stdbool.h> 146e5e8b8dSPekka Enberg #include <assert.h> 1506e41eeaSPekka Enberg #include <limits.h> 16f5ab5f67SPekka Enberg #include <stdarg.h> 17b8f6afcdSPekka Enberg #include <stdlib.h> 18f5ab5f67SPekka Enberg #include <string.h> 190d1f17ecSPekka Enberg #include <unistd.h> 201f9cff23SPekka Enberg #include <stdio.h> 21b8f6afcdSPekka Enberg #include <fcntl.h> 22b8f6afcdSPekka Enberg 231f9cff23SPekka Enberg /* 241f9cff23SPekka Enberg * Compatibility code. Remove this when we move to tools/kvm. 251f9cff23SPekka Enberg */ 261f9cff23SPekka Enberg #ifndef KVM_EXIT_INTERNAL_ERROR 271f9cff23SPekka Enberg # define KVM_EXIT_INTERNAL_ERROR 17 281f9cff23SPekka Enberg #endif 291f9cff23SPekka Enberg 30ae1fae34SPekka Enberg #define DEFINE_KVM_EXIT_REASON(reason) [reason] = #reason 310d1f17ecSPekka Enberg 32ae1fae34SPekka Enberg const char *kvm_exit_reasons[] = { 33ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_UNKNOWN), 34ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_EXCEPTION), 35ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_IO), 36ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_HYPERCALL), 37ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_DEBUG), 38ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_HLT), 39ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_MMIO), 40ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_IRQ_WINDOW_OPEN), 41ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_SHUTDOWN), 42ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_FAIL_ENTRY), 43ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_INTR), 44ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_SET_TPR), 45ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_TPR_ACCESS), 46ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_S390_SIEIC), 47ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_S390_RESET), 48ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_DCR), 49ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_NMI), 50ae1fae34SPekka Enberg DEFINE_KVM_EXIT_REASON(KVM_EXIT_INTERNAL_ERROR), 519b1fb1c3SPekka Enberg }; 529b1fb1c3SPekka Enberg 5348cf3877SPekka Enberg static inline bool host_ptr_in_ram(struct kvm *self, void *p) 5448cf3877SPekka Enberg { 5548cf3877SPekka Enberg return self->ram_start <= p && p < (self->ram_start + self->ram_size); 5648cf3877SPekka Enberg } 5748cf3877SPekka Enberg 586753ed2fSPekka Enberg static inline uint32_t segment_to_flat(uint16_t selector, uint16_t offset) 596753ed2fSPekka Enberg { 606753ed2fSPekka Enberg return ((uint32_t)selector << 4) + (uint32_t) offset; 616753ed2fSPekka Enberg } 626753ed2fSPekka Enberg 636753ed2fSPekka Enberg static inline void *guest_flat_to_host(struct kvm *self, unsigned long offset) 64ae1fae34SPekka Enberg { 65ae1fae34SPekka Enberg return self->ram_start + offset; 66ae1fae34SPekka Enberg } 67ae1fae34SPekka Enberg 686753ed2fSPekka Enberg static inline void *guest_real_to_host(struct kvm *self, uint16_t selector, uint16_t offset) 696753ed2fSPekka Enberg { 706753ed2fSPekka Enberg unsigned long flat = segment_to_flat(selector, offset); 716753ed2fSPekka Enberg 726753ed2fSPekka Enberg return guest_flat_to_host(self, flat); 736753ed2fSPekka Enberg } 746753ed2fSPekka Enberg 75ae1fae34SPekka Enberg static bool kvm__supports_extension(struct kvm *self, unsigned int extension) 76b8f6afcdSPekka Enberg { 7728fa19c0SPekka Enberg int ret; 78b8f6afcdSPekka Enberg 7973ac60e6SPekka Enberg ret = ioctl(self->sys_fd, KVM_CHECK_EXTENSION, extension); 804076b041SPekka Enberg if (ret < 0) 814076b041SPekka Enberg return false; 824076b041SPekka Enberg 834076b041SPekka Enberg return ret; 844076b041SPekka Enberg } 854076b041SPekka Enberg 864076b041SPekka Enberg static struct kvm *kvm__new(void) 874076b041SPekka Enberg { 884076b041SPekka Enberg struct kvm *self = calloc(1, sizeof *self); 894076b041SPekka Enberg 904076b041SPekka Enberg if (!self) 914076b041SPekka Enberg die("out of memory"); 924076b041SPekka Enberg 934076b041SPekka Enberg return self; 944076b041SPekka Enberg } 954076b041SPekka Enberg 969ef4c68eSPekka Enberg void kvm__delete(struct kvm *self) 979ef4c68eSPekka Enberg { 989ef4c68eSPekka Enberg free(self->ram_start); 999ef4c68eSPekka Enberg free(self); 1009ef4c68eSPekka Enberg } 1019ef4c68eSPekka Enberg 102ae1fae34SPekka Enberg struct kvm *kvm__init(void) 1034076b041SPekka Enberg { 1042b0e3342SPekka Enberg struct kvm_userspace_memory_region mem; 1054076b041SPekka Enberg struct kvm *self; 1060d1f17ecSPekka Enberg long page_size; 1071f9cff23SPekka Enberg int mmap_size; 1084076b041SPekka Enberg int ret; 1094076b041SPekka Enberg 1104076b041SPekka Enberg self = kvm__new(); 1114076b041SPekka Enberg 11273ac60e6SPekka Enberg self->sys_fd = open("/dev/kvm", O_RDWR); 11373ac60e6SPekka Enberg if (self->sys_fd < 0) 114f5ab5f67SPekka Enberg die_perror("open"); 115b8f6afcdSPekka Enberg 11673ac60e6SPekka Enberg ret = ioctl(self->sys_fd, KVM_GET_API_VERSION, 0); 1176c7d8514SPekka Enberg if (ret != KVM_API_VERSION) 118f5ab5f67SPekka Enberg die_perror("KVM_API_VERSION ioctl"); 1196c7d8514SPekka Enberg 12073ac60e6SPekka Enberg self->vm_fd = ioctl(self->sys_fd, KVM_CREATE_VM, 0); 12173ac60e6SPekka Enberg if (self->vm_fd < 0) 122f5ab5f67SPekka Enberg die_perror("KVM_CREATE_VM ioctl"); 12328fa19c0SPekka Enberg 1244076b041SPekka Enberg if (!kvm__supports_extension(self, KVM_CAP_USER_MEMORY)) 125f5ab5f67SPekka Enberg die("KVM_CAP_USER_MEMORY is not supported"); 1262da26a59SPekka Enberg 1270d1f17ecSPekka Enberg self->ram_size = 64UL * 1024UL * 1024UL; 1280d1f17ecSPekka Enberg 1290d1f17ecSPekka Enberg page_size = sysconf(_SC_PAGESIZE); 1300d1f17ecSPekka Enberg if (posix_memalign(&self->ram_start, page_size, self->ram_size) != 0) 1310d1f17ecSPekka Enberg die("out of memory"); 1320d1f17ecSPekka Enberg 1332b0e3342SPekka Enberg mem = (struct kvm_userspace_memory_region) { 1342b0e3342SPekka Enberg .slot = 0, 1352b0e3342SPekka Enberg .guest_phys_addr = 0x0UL, 1360d1f17ecSPekka Enberg .memory_size = self->ram_size, 1370d1f17ecSPekka Enberg .userspace_addr = (unsigned long) self->ram_start, 1382b0e3342SPekka Enberg }; 1392b0e3342SPekka Enberg 14073ac60e6SPekka Enberg ret = ioctl(self->vm_fd, KVM_SET_USER_MEMORY_REGION, &mem, 1); 1412b0e3342SPekka Enberg if (ret < 0) 142f5ab5f67SPekka Enberg die_perror("KVM_SET_USER_MEMORY_REGION ioctl"); 1432b0e3342SPekka Enberg 144895c2fefSPekka Enberg if (!kvm__supports_extension(self, KVM_CAP_SET_TSS_ADDR)) 145f5ab5f67SPekka Enberg die("KVM_CAP_SET_TSS_ADDR is not supported"); 146895c2fefSPekka Enberg 14773ac60e6SPekka Enberg ret = ioctl(self->vm_fd, KVM_SET_TSS_ADDR, 0xfffbd000); 148895c2fefSPekka Enberg if (ret < 0) 149f5ab5f67SPekka Enberg die_perror("KVM_SET_TSS_ADDR ioctl"); 150895c2fefSPekka Enberg 15173ac60e6SPekka Enberg self->vcpu_fd = ioctl(self->vm_fd, KVM_CREATE_VCPU, 0); 1522b0e3342SPekka Enberg if (self->vcpu_fd < 0) 153f5ab5f67SPekka Enberg die_perror("KVM_CREATE_VCPU ioctl"); 1542b0e3342SPekka Enberg 1551f9cff23SPekka Enberg mmap_size = ioctl(self->sys_fd, KVM_GET_VCPU_MMAP_SIZE, 0); 1561f9cff23SPekka Enberg if (mmap_size < 0) 157f5ab5f67SPekka Enberg die_perror("KVM_GET_VCPU_MMAP_SIZE ioctl"); 1581f9cff23SPekka Enberg 1591f9cff23SPekka Enberg self->kvm_run = mmap(NULL, mmap_size, PROT_READ|PROT_WRITE, MAP_SHARED, self->vcpu_fd, 0); 1601f9cff23SPekka Enberg if (self->kvm_run == MAP_FAILED) 1611f9cff23SPekka Enberg die("unable to mmap vcpu fd"); 1621f9cff23SPekka Enberg 1634076b041SPekka Enberg return self; 1644076b041SPekka Enberg } 1654076b041SPekka Enberg 166ae1fae34SPekka Enberg void kvm__enable_singlestep(struct kvm *self) 167aee6632eSPekka Enberg { 168aee6632eSPekka Enberg struct kvm_guest_debug debug = { 169aee6632eSPekka Enberg .control = KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP, 170aee6632eSPekka Enberg }; 171aee6632eSPekka Enberg 172aee6632eSPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_GUEST_DEBUG, &debug) < 0) 173b625d4b6SCyrill Gorcunov warning("KVM_SET_GUEST_DEBUG failed"); 174aee6632eSPekka Enberg } 175aee6632eSPekka Enberg 1765f6772b8SCyrill Gorcunov #define BOOT_LOADER_SELECTOR 0x1000 177b08e9ec4SPekka Enberg #define BOOT_LOADER_IP 0x0000 178dbdb74c2SPekka Enberg #define BOOT_LOADER_SP 0x8000 1792dd4a4edSCyrill Gorcunov #define BOOT_CMDLINE_OFFSET 0x20000 1802dd4a4edSCyrill Gorcunov 1812dd4a4edSCyrill Gorcunov #define BOOT_PROTOCOL_REQUIRED 0x202 182a43f6460SCyrill Gorcunov #define LOAD_HIGH 0x01 183009b0758SPekka Enberg 184edc8a14dSPekka Enberg static int load_flat_binary(struct kvm *self, int fd) 185009b0758SPekka Enberg { 186009b0758SPekka Enberg void *p; 187009b0758SPekka Enberg int nr; 188009b0758SPekka Enberg 189009b0758SPekka Enberg if (lseek(fd, 0, SEEK_SET) < 0) 190009b0758SPekka Enberg die_perror("lseek"); 191009b0758SPekka Enberg 1926753ed2fSPekka Enberg p = guest_real_to_host(self, BOOT_LOADER_SELECTOR, BOOT_LOADER_IP); 193009b0758SPekka Enberg 194009b0758SPekka Enberg while ((nr = read(fd, p, 65536)) > 0) 195009b0758SPekka Enberg p += nr; 196009b0758SPekka Enberg 197dbdb74c2SPekka Enberg self->boot_selector = BOOT_LOADER_SELECTOR; 198edc8a14dSPekka Enberg self->boot_ip = BOOT_LOADER_IP; 199dbdb74c2SPekka Enberg self->boot_sp = BOOT_LOADER_SP; 200edc8a14dSPekka Enberg 2017fb218bdSPekka Enberg return true; 202009b0758SPekka Enberg } 203009b0758SPekka Enberg 2047fb218bdSPekka Enberg /* 2057fb218bdSPekka Enberg * The protected mode kernel part of a modern bzImage is loaded at 1 MB by 2067fb218bdSPekka Enberg * default. 2077fb218bdSPekka Enberg */ 2087fb218bdSPekka Enberg #define BZ_KERNEL_START 0x100000UL 209ae1fae34SPekka Enberg 210ae1fae34SPekka Enberg static const char *BZIMAGE_MAGIC = "HdrS"; 211ae1fae34SPekka Enberg 21210943d14SPekka Enberg #define BZ_DEFAULT_SETUP_SECTS 4 21310943d14SPekka Enberg 2146d1f350dSCyrill Gorcunov static bool load_bzimage(struct kvm *self, int fd, const char *kernel_cmdline) 215ae1fae34SPekka Enberg { 216bc75b0aeSCyrill Gorcunov struct real_intr_desc intr; 21722489bb0SCyrill Gorcunov struct boot_params boot; 2184b62331fSPekka Enberg unsigned long setup_sects; 219305d9054SCyrill Gorcunov unsigned int intr_addr; 2202dd4a4edSCyrill Gorcunov size_t cmdline_size; 2217fb218bdSPekka Enberg ssize_t setup_size; 22222489bb0SCyrill Gorcunov void *p; 223ae1fae34SPekka Enberg int nr; 224ae1fae34SPekka Enberg 2255d67eaf6SPekka Enberg /* 2265d67eaf6SPekka Enberg * See Documentation/x86/boot.txt for details no bzImage on-disk and 2275d67eaf6SPekka Enberg * memory layout. 2285d67eaf6SPekka Enberg */ 2295d67eaf6SPekka Enberg 230009b0758SPekka Enberg if (lseek(fd, 0, SEEK_SET) < 0) 231009b0758SPekka Enberg die_perror("lseek"); 232009b0758SPekka Enberg 233ae1fae34SPekka Enberg read(fd, &boot, sizeof(boot)); 234ae1fae34SPekka Enberg 235ae1fae34SPekka Enberg if (memcmp(&boot.hdr.header, BZIMAGE_MAGIC, strlen(BZIMAGE_MAGIC)) != 0) 2367fb218bdSPekka Enberg return false; 237ae1fae34SPekka Enberg 2382dd4a4edSCyrill Gorcunov if (boot.hdr.version < BOOT_PROTOCOL_REQUIRED) { 239ad681038SCyrill Gorcunov warning("Too old kernel"); 240ad681038SCyrill Gorcunov return false; 241ad681038SCyrill Gorcunov } 242ad681038SCyrill Gorcunov 243e93ab78aSPekka Enberg if (lseek(fd, 0, SEEK_SET) < 0) 244e93ab78aSPekka Enberg die_perror("lseek"); 245e93ab78aSPekka Enberg 2464cf542bbSCyrill Gorcunov if (!boot.hdr.setup_sects) 2474cf542bbSCyrill Gorcunov boot.hdr.setup_sects = BZ_DEFAULT_SETUP_SECTS; 24810943d14SPekka Enberg setup_sects = boot.hdr.setup_sects + 1; 24910943d14SPekka Enberg 25054d4a626SPekka Enberg setup_size = setup_sects << 9; 2516753ed2fSPekka Enberg p = guest_real_to_host(self, BOOT_LOADER_SELECTOR, BOOT_LOADER_IP); 252ae1fae34SPekka Enberg 2537fb218bdSPekka Enberg if (read(fd, p, setup_size) != setup_size) 2547fb218bdSPekka Enberg die_perror("read"); 2557fb218bdSPekka Enberg 2566753ed2fSPekka Enberg p = guest_flat_to_host(self, BZ_KERNEL_START); 257ae1fae34SPekka Enberg 258ae1fae34SPekka Enberg while ((nr = read(fd, p, 65536)) > 0) 259ae1fae34SPekka Enberg p += nr; 260ae1fae34SPekka Enberg 261a43f6460SCyrill Gorcunov p = guest_flat_to_host(self, BOOT_CMDLINE_OFFSET); 262debcfac0SCyrill Gorcunov if (kernel_cmdline) { 263debcfac0SCyrill Gorcunov cmdline_size = strlen(kernel_cmdline) + 1; 264debcfac0SCyrill Gorcunov if (cmdline_size > boot.hdr.cmdline_size) 265debcfac0SCyrill Gorcunov cmdline_size = boot.hdr.cmdline_size; 266ad681038SCyrill Gorcunov 2672dd4a4edSCyrill Gorcunov memset(p, 0, boot.hdr.cmdline_size); 2682dd4a4edSCyrill Gorcunov memcpy(p, kernel_cmdline, cmdline_size - 1); 269debcfac0SCyrill Gorcunov } 270debcfac0SCyrill Gorcunov 271a43f6460SCyrill Gorcunov #define hdr_offset(member) \ 272a43f6460SCyrill Gorcunov offsetof(struct boot_params, hdr) + \ 273a43f6460SCyrill Gorcunov offsetof(struct setup_header, member) 274a43f6460SCyrill Gorcunov #define guest_hdr(kvm, member) \ 275a43f6460SCyrill Gorcunov guest_real_to_host(kvm, \ 276a43f6460SCyrill Gorcunov BOOT_LOADER_SELECTOR, \ 277a43f6460SCyrill Gorcunov hdr_offset(member)) 278a43f6460SCyrill Gorcunov 279a43f6460SCyrill Gorcunov /* some fields in guest header have to be updated */ 280a43f6460SCyrill Gorcunov p = guest_hdr(self, cmd_line_ptr); 281a43f6460SCyrill Gorcunov *(uint32_t *)p = BOOT_CMDLINE_OFFSET; 282a43f6460SCyrill Gorcunov 283a43f6460SCyrill Gorcunov p = guest_hdr(self, type_of_loader); 284a43f6460SCyrill Gorcunov *(uint8_t *)p = 0xff; 285a43f6460SCyrill Gorcunov 286a43f6460SCyrill Gorcunov p = guest_hdr(self, heap_end_ptr); 287a43f6460SCyrill Gorcunov *(uint16_t *)p = 0xfe00; 288a43f6460SCyrill Gorcunov 289a43f6460SCyrill Gorcunov p = guest_hdr(self, loadflags); 290a43f6460SCyrill Gorcunov *(uint8_t *)p |= CAN_USE_HEAP; 291a43f6460SCyrill Gorcunov 292dbdb74c2SPekka Enberg self->boot_selector = BOOT_LOADER_SELECTOR; 293edc8a14dSPekka Enberg /* 294edc8a14dSPekka Enberg * The real-mode setup code starts at offset 0x200 of a bzImage. See 295edc8a14dSPekka Enberg * Documentation/x86/boot.txt for details. 296edc8a14dSPekka Enberg */ 297edc8a14dSPekka Enberg self->boot_ip = BOOT_LOADER_IP + 0x200; 298dbdb74c2SPekka Enberg self->boot_sp = BOOT_LOADER_SP; 299edc8a14dSPekka Enberg 300ea684828SCyrill Gorcunov /* 30122489bb0SCyrill Gorcunov * Setup a *fake* real mode vector table, it has only 30222489bb0SCyrill Gorcunov * one real hadler which does just iret 30322489bb0SCyrill Gorcunov * 304305d9054SCyrill Gorcunov * This is where the BIOS lives -- BDA area 305ea684828SCyrill Gorcunov */ 306305d9054SCyrill Gorcunov intr_addr = BIOS_INTR_NEXT(BDA_START + 0, 16); 307305d9054SCyrill Gorcunov p = guest_flat_to_host(self, intr_addr); 3088b8fb6c7SCyrill Gorcunov memcpy(p, intfake, intfake_end - intfake); 309bc75b0aeSCyrill Gorcunov intr = (struct real_intr_desc) { 310305d9054SCyrill Gorcunov .segment = REAL_SEGMENT(intr_addr), 31122489bb0SCyrill Gorcunov .offset = 0, 312ea684828SCyrill Gorcunov }; 313bc75b0aeSCyrill Gorcunov interrupt_table__setup(&self->interrupt_table, &intr); 314305d9054SCyrill Gorcunov 3158b8fb6c7SCyrill Gorcunov intr_addr = BIOS_INTR_NEXT(BDA_START + (intfake_end - intfake), 16); 316305d9054SCyrill Gorcunov p = guest_flat_to_host(self, intr_addr); 3178b8fb6c7SCyrill Gorcunov memcpy(p, int10, int10_end - int10); 318305d9054SCyrill Gorcunov intr = (struct real_intr_desc) { 319305d9054SCyrill Gorcunov .segment = REAL_SEGMENT(intr_addr), 320305d9054SCyrill Gorcunov .offset = 0, 321305d9054SCyrill Gorcunov }; 322305d9054SCyrill Gorcunov interrupt_table__set(&self->interrupt_table, &intr, 0x10); 323305d9054SCyrill Gorcunov 324305d9054SCyrill Gorcunov p = guest_flat_to_host(self, 0); 325bc75b0aeSCyrill Gorcunov interrupt_table__copy(&self->interrupt_table, p, REAL_INTR_SIZE); 326ea684828SCyrill Gorcunov 3277fb218bdSPekka Enberg return true; 328ae1fae34SPekka Enberg } 329ae1fae34SPekka Enberg 3306d1f350dSCyrill Gorcunov bool kvm__load_kernel(struct kvm *kvm, const char *kernel_filename, 3316d1f350dSCyrill Gorcunov const char *kernel_cmdline) 332ae1fae34SPekka Enberg { 3337fb218bdSPekka Enberg bool ret; 334ae1fae34SPekka Enberg int fd; 335ae1fae34SPekka Enberg 336ae1fae34SPekka Enberg fd = open(kernel_filename, O_RDONLY); 337ae1fae34SPekka Enberg if (fd < 0) 338ae1fae34SPekka Enberg die("unable to open kernel"); 339ae1fae34SPekka Enberg 3406d1f350dSCyrill Gorcunov ret = load_bzimage(kvm, fd, kernel_cmdline); 341009b0758SPekka Enberg if (ret) 342009b0758SPekka Enberg goto found_kernel; 343ae1fae34SPekka Enberg 344009b0758SPekka Enberg ret = load_flat_binary(kvm, fd); 345009b0758SPekka Enberg if (ret) 346009b0758SPekka Enberg goto found_kernel; 347009b0758SPekka Enberg 348009b0758SPekka Enberg die("%s is not a valid bzImage or flat binary", kernel_filename); 349009b0758SPekka Enberg 350009b0758SPekka Enberg found_kernel: 351ae1fae34SPekka Enberg return ret; 352ae1fae34SPekka Enberg } 353ae1fae34SPekka Enberg 35406e41eeaSPekka Enberg static inline uint64_t ip_flat_to_real(struct kvm *self, uint64_t ip) 35506e41eeaSPekka Enberg { 35606e41eeaSPekka Enberg uint64_t cs = self->sregs.cs.selector; 35706e41eeaSPekka Enberg 35806e41eeaSPekka Enberg return ip - (cs << 4); 35906e41eeaSPekka Enberg } 36006e41eeaSPekka Enberg 361f01944c8SPekka Enberg static inline bool is_in_protected_mode(struct kvm *self) 362f01944c8SPekka Enberg { 363f01944c8SPekka Enberg return self->sregs.cr0 & 0x01; 364f01944c8SPekka Enberg } 365f01944c8SPekka Enberg 366f326512aSPekka Enberg static inline uint64_t ip_to_flat(struct kvm *self, uint64_t ip) 36706e41eeaSPekka Enberg { 368f326512aSPekka Enberg uint64_t cs; 369f326512aSPekka Enberg 370f326512aSPekka Enberg /* 371f326512aSPekka Enberg * NOTE! We should take code segment base address into account here. 372f326512aSPekka Enberg * Luckily it's usually zero because Linux uses flat memory model. 373f326512aSPekka Enberg */ 374f01944c8SPekka Enberg if (is_in_protected_mode(self)) 375f326512aSPekka Enberg return ip; 376f326512aSPekka Enberg 377f326512aSPekka Enberg cs = self->sregs.cs.selector; 37806e41eeaSPekka Enberg 37906e41eeaSPekka Enberg return ip + (cs << 4); 38006e41eeaSPekka Enberg } 38106e41eeaSPekka Enberg 382dbdb74c2SPekka Enberg static inline uint32_t selector_to_base(uint16_t selector) 383dbdb74c2SPekka Enberg { 384dbdb74c2SPekka Enberg /* 385dbdb74c2SPekka Enberg * KVM on Intel requires 'base' to be 'selector * 16' in real mode. 386dbdb74c2SPekka Enberg */ 387dbdb74c2SPekka Enberg return (uint32_t)selector * 16; 388dbdb74c2SPekka Enberg } 389dbdb74c2SPekka Enberg 39053d48714SPekka Enberg static struct kvm_msrs *kvm_msrs__new(size_t nmsrs) 39153d48714SPekka Enberg { 39253d48714SPekka Enberg struct kvm_msrs *self = calloc(1, sizeof(*self) + (sizeof(struct kvm_msr_entry) * nmsrs)); 39353d48714SPekka Enberg 39453d48714SPekka Enberg if (!self) 39553d48714SPekka Enberg die("out of memory"); 39653d48714SPekka Enberg 39753d48714SPekka Enberg return self; 39853d48714SPekka Enberg } 39953d48714SPekka Enberg 40053d48714SPekka Enberg #define MSR_IA32_TIME_STAMP_COUNTER 0x10 40153d48714SPekka Enberg 40253d48714SPekka Enberg #define MSR_IA32_SYSENTER_CS 0x174 40353d48714SPekka Enberg #define MSR_IA32_SYSENTER_ESP 0x175 40453d48714SPekka Enberg #define MSR_IA32_SYSENTER_EIP 0x176 40553d48714SPekka Enberg 40653d48714SPekka Enberg #define MSR_IA32_STAR 0xc0000081 40753d48714SPekka Enberg #define MSR_IA32_LSTAR 0xc0000082 40853d48714SPekka Enberg #define MSR_IA32_CSTAR 0xc0000083 40953d48714SPekka Enberg #define MSR_IA32_FMASK 0xc0000084 41053d48714SPekka Enberg #define MSR_IA32_KERNEL_GS_BASE 0xc0000102 41153d48714SPekka Enberg 41253d48714SPekka Enberg #define KVM_MSR_ENTRY(_index, _data) \ 41353d48714SPekka Enberg (struct kvm_msr_entry) { .index = _index, .data = _data } 41453d48714SPekka Enberg 41553d48714SPekka Enberg static void kvm__setup_msrs(struct kvm *self) 41653d48714SPekka Enberg { 41753d48714SPekka Enberg unsigned long ndx = 0; 41853d48714SPekka Enberg 41953d48714SPekka Enberg self->msrs = kvm_msrs__new(100); 42053d48714SPekka Enberg 42153d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_SYSENTER_CS, 0x0); 42253d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_SYSENTER_ESP, 0x0); 42353d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_SYSENTER_EIP, 0x0); 4248b334abcSCyrill Gorcunov #ifdef CONFIG_X86_64 42553d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_STAR, 0x0); 42653d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_CSTAR, 0x0); 42753d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_KERNEL_GS_BASE, 0x0); 42853d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_FMASK, 0x0); 42953d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_LSTAR, 0x0); 43044069a9dSCyrill Gorcunov #endif 43153d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_TIME_STAMP_COUNTER, 0x0); 43253d48714SPekka Enberg 43353d48714SPekka Enberg self->msrs->nmsrs = ndx; 43453d48714SPekka Enberg 43553d48714SPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_MSRS, self->msrs) < 0) 43653d48714SPekka Enberg die_perror("KVM_SET_MSRS failed"); 43753d48714SPekka Enberg } 43853d48714SPekka Enberg 4393d78d3a5SPekka Enberg static void kvm__setup_fpu(struct kvm *self) 4403d78d3a5SPekka Enberg { 4413d78d3a5SPekka Enberg self->fpu = (struct kvm_fpu) { 4423d78d3a5SPekka Enberg .fcw = 0x37f, 4433d78d3a5SPekka Enberg .mxcsr = 0x1f80, 4443d78d3a5SPekka Enberg }; 4453d78d3a5SPekka Enberg 4463d78d3a5SPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_FPU, &self->fpu) < 0) 4473d78d3a5SPekka Enberg die_perror("KVM_SET_FPU failed"); 4483d78d3a5SPekka Enberg } 4493d78d3a5SPekka Enberg 4503d78d3a5SPekka Enberg static void kvm__setup_regs(struct kvm *self) 4513d78d3a5SPekka Enberg { 4523d78d3a5SPekka Enberg self->regs = (struct kvm_regs) { 4533d78d3a5SPekka Enberg /* We start the guest in 16-bit real mode */ 4543d78d3a5SPekka Enberg .rflags = 0x0000000000000002ULL, 4553d78d3a5SPekka Enberg 4563d78d3a5SPekka Enberg .rip = self->boot_ip, 4573d78d3a5SPekka Enberg .rsp = self->boot_sp, 4583d78d3a5SPekka Enberg .rbp = self->boot_sp, 4593d78d3a5SPekka Enberg }; 4603d78d3a5SPekka Enberg 4613d78d3a5SPekka Enberg if (self->regs.rip > USHRT_MAX) 4623d78d3a5SPekka Enberg die("ip 0x%" PRIx64 " is too high for real mode", (uint64_t) self->regs.rip); 4633d78d3a5SPekka Enberg 4643d78d3a5SPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_REGS, &self->regs) < 0) 4653d78d3a5SPekka Enberg die_perror("KVM_SET_REGS failed"); 4663d78d3a5SPekka Enberg } 4673d78d3a5SPekka Enberg 4683d78d3a5SPekka Enberg static void kvm__setup_sregs(struct kvm *self) 469ae1fae34SPekka Enberg { 47053602077SPekka Enberg self->sregs = (struct kvm_sregs) { 47153602077SPekka Enberg .cr0 = 0x60000010ULL, 47253602077SPekka Enberg .cs = (struct kvm_segment) { 473dbdb74c2SPekka Enberg .selector = self->boot_selector, 474dbdb74c2SPekka Enberg .base = selector_to_base(self->boot_selector), 47553602077SPekka Enberg .limit = 0xffffU, 47653602077SPekka Enberg .type = 0x0bU, 47753602077SPekka Enberg .present = 1, 47853602077SPekka Enberg .dpl = 0x03, 47953602077SPekka Enberg .s = 1, 48053602077SPekka Enberg }, 48153602077SPekka Enberg .ss = (struct kvm_segment) { 482dbdb74c2SPekka Enberg .selector = self->boot_selector, 483dbdb74c2SPekka Enberg .base = selector_to_base(self->boot_selector), 48453602077SPekka Enberg .limit = 0xffffU, 48553602077SPekka Enberg .type = 0x03U, 48653602077SPekka Enberg .present = 1, 48753602077SPekka Enberg .dpl = 0x03, 48853602077SPekka Enberg .s = 1, 48953602077SPekka Enberg }, 49053602077SPekka Enberg .ds = (struct kvm_segment) { 491dbdb74c2SPekka Enberg .selector = self->boot_selector, 492dbdb74c2SPekka Enberg .base = selector_to_base(self->boot_selector), 49353602077SPekka Enberg .limit = 0xffffU, 49453602077SPekka Enberg .type = 0x03U, 49553602077SPekka Enberg .present = 1, 49653602077SPekka Enberg .dpl = 0x03, 49753602077SPekka Enberg .s = 1, 49853602077SPekka Enberg }, 49953602077SPekka Enberg .es = (struct kvm_segment) { 500dbdb74c2SPekka Enberg .selector = self->boot_selector, 501dbdb74c2SPekka Enberg .base = selector_to_base(self->boot_selector), 50253602077SPekka Enberg .limit = 0xffffU, 50353602077SPekka Enberg .type = 0x03U, 50453602077SPekka Enberg .present = 1, 50553602077SPekka Enberg .dpl = 0x03, 50653602077SPekka Enberg .s = 1, 50753602077SPekka Enberg }, 50853602077SPekka Enberg .fs = (struct kvm_segment) { 509dbdb74c2SPekka Enberg .selector = self->boot_selector, 510dbdb74c2SPekka Enberg .base = selector_to_base(self->boot_selector), 51153602077SPekka Enberg .limit = 0xffffU, 51253602077SPekka Enberg .type = 0x03U, 51353602077SPekka Enberg .present = 1, 51453602077SPekka Enberg .dpl = 0x03, 51553602077SPekka Enberg .s = 1, 51653602077SPekka Enberg }, 51753602077SPekka Enberg .gs = (struct kvm_segment) { 518dbdb74c2SPekka Enberg .selector = self->boot_selector, 519dbdb74c2SPekka Enberg .base = selector_to_base(self->boot_selector), 52053602077SPekka Enberg .limit = 0xffffU, 52153602077SPekka Enberg .type = 0x03U, 52253602077SPekka Enberg .present = 1, 52353602077SPekka Enberg .dpl = 0x03, 52453602077SPekka Enberg .s = 1, 52553602077SPekka Enberg }, 52653602077SPekka Enberg .tr = (struct kvm_segment) { 52753602077SPekka Enberg .limit = 0xffffU, 52853602077SPekka Enberg .present = 1, 52953602077SPekka Enberg .type = 0x03U, 53053602077SPekka Enberg }, 53153602077SPekka Enberg .ldt = (struct kvm_segment) { 53253602077SPekka Enberg .limit = 0xffffU, 53353602077SPekka Enberg .present = 1, 5347085d935SPekka Enberg .type = 0x02U, 53553602077SPekka Enberg }, 53653602077SPekka Enberg .gdt = (struct kvm_dtable) { 53753602077SPekka Enberg .limit = 0xffffU, 53853602077SPekka Enberg }, 53953602077SPekka Enberg .idt = (struct kvm_dtable) { 54053602077SPekka Enberg .limit = 0xffffU, 54153602077SPekka Enberg }, 54253602077SPekka Enberg }; 54353602077SPekka Enberg 54453602077SPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_SREGS, &self->sregs) < 0) 54553602077SPekka Enberg die_perror("KVM_SET_SREGS failed"); 5463d78d3a5SPekka Enberg } 54706e41eeaSPekka Enberg 5483d78d3a5SPekka Enberg void kvm__reset_vcpu(struct kvm *self) 5493d78d3a5SPekka Enberg { 5503d78d3a5SPekka Enberg kvm__setup_sregs(self); 551dbdb74c2SPekka Enberg 5523d78d3a5SPekka Enberg kvm__setup_regs(self); 55306e41eeaSPekka Enberg 5543d78d3a5SPekka Enberg kvm__setup_fpu(self); 55553d48714SPekka Enberg 55653d48714SPekka Enberg kvm__setup_msrs(self); 557ae1fae34SPekka Enberg } 558ae1fae34SPekka Enberg 559ae1fae34SPekka Enberg void kvm__run(struct kvm *self) 560ae1fae34SPekka Enberg { 561ae1fae34SPekka Enberg if (ioctl(self->vcpu_fd, KVM_RUN, 0) < 0) 562ae1fae34SPekka Enberg die_perror("KVM_RUN failed"); 563ae1fae34SPekka Enberg } 564ae1fae34SPekka Enberg 5658351aaddSPekka Enberg static void print_dtable(const char *name, struct kvm_dtable *dtable) 5668351aaddSPekka Enberg { 5678351aaddSPekka Enberg printf(" %s %016" PRIx64 " %08" PRIx16 "\n", 5688351aaddSPekka Enberg name, (uint64_t) dtable->base, (uint16_t) dtable->limit); 5698351aaddSPekka Enberg } 5708351aaddSPekka Enberg 57153602077SPekka Enberg static void print_segment(const char *name, struct kvm_segment *seg) 57253602077SPekka Enberg { 573ce556636SPekka Enberg printf(" %s %04" PRIx16 " %016" PRIx64 " %08" PRIx32 " %02" PRIx8 " %x %x %x %x %x %x %x\n", 57453602077SPekka Enberg name, (uint16_t) seg->selector, (uint64_t) seg->base, (uint32_t) seg->limit, 575ce556636SPekka Enberg (uint8_t) seg->type, seg->present, seg->dpl, seg->db, seg->s, seg->l, seg->g, seg->avl); 57653602077SPekka Enberg } 57753602077SPekka Enberg 578ae1fae34SPekka Enberg void kvm__show_registers(struct kvm *self) 5797118d2caSPekka Enberg { 58053602077SPekka Enberg unsigned long cr0, cr2, cr3; 58153602077SPekka Enberg unsigned long cr4, cr8; 5827118d2caSPekka Enberg unsigned long rax, rbx, rcx; 5837118d2caSPekka Enberg unsigned long rdx, rsi, rdi; 5847118d2caSPekka Enberg unsigned long rbp, r8, r9; 5857118d2caSPekka Enberg unsigned long r10, r11, r12; 5867118d2caSPekka Enberg unsigned long r13, r14, r15; 5877118d2caSPekka Enberg unsigned long rip, rsp; 58853602077SPekka Enberg struct kvm_sregs sregs; 589a2fe6199SPekka Enberg unsigned long rflags; 5907118d2caSPekka Enberg struct kvm_regs regs; 591ce5e0ecbSPekka Enberg int i; 5927118d2caSPekka Enberg 5937118d2caSPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_REGS, ®s) < 0) 5947118d2caSPekka Enberg die("KVM_GET_REGS failed"); 5957118d2caSPekka Enberg 596a2fe6199SPekka Enberg rflags = regs.rflags; 597a2fe6199SPekka Enberg 5987118d2caSPekka Enberg rip = regs.rip; rsp = regs.rsp; 5997118d2caSPekka Enberg rax = regs.rax; rbx = regs.rbx; rcx = regs.rcx; 6007118d2caSPekka Enberg rdx = regs.rdx; rsi = regs.rsi; rdi = regs.rdi; 6017118d2caSPekka Enberg rbp = regs.rbp; r8 = regs.r8; r9 = regs.r9; 6027118d2caSPekka Enberg r10 = regs.r10; r11 = regs.r11; r12 = regs.r12; 6037118d2caSPekka Enberg r13 = regs.r13; r14 = regs.r14; r15 = regs.r15; 6047118d2caSPekka Enberg 6057118d2caSPekka Enberg printf("Registers:\n"); 6062177ec43SPekka Enberg printf(" rip: %016lx rsp: %016lx flags: %016lx\n", rip, rsp, rflags); 607ea2e4ea0SCyrill Gorcunov printf(" rax: %016lx rbx: %016lx rcx: %016lx\n", rax, rbx, rcx); 6087118d2caSPekka Enberg printf(" rdx: %016lx rsi: %016lx rdi: %016lx\n", rdx, rsi, rdi); 6097118d2caSPekka Enberg printf(" rbp: %016lx r8: %016lx r9: %016lx\n", rbp, r8, r9); 6107118d2caSPekka Enberg printf(" r10: %016lx r11: %016lx r12: %016lx\n", r10, r11, r12); 6117118d2caSPekka Enberg printf(" r13: %016lx r14: %016lx r15: %016lx\n", r13, r14, r15); 61253602077SPekka Enberg 61353602077SPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_SREGS, &sregs) < 0) 61453602077SPekka Enberg die("KVM_GET_REGS failed"); 61553602077SPekka Enberg 61653602077SPekka Enberg cr0 = sregs.cr0; cr2 = sregs.cr2; cr3 = sregs.cr3; 61753602077SPekka Enberg cr4 = sregs.cr4; cr8 = sregs.cr8; 61853602077SPekka Enberg 61953602077SPekka Enberg printf(" cr0: %016lx cr2: %016lx cr3: %016lx\n", cr0, cr2, cr3); 62053602077SPekka Enberg printf(" cr4: %016lx cr8: %016lx\n", cr4, cr8); 621ce5e0ecbSPekka Enberg printf("Segment registers:\n"); 622ce556636SPekka Enberg printf(" register selector base limit type p dpl db s l g avl\n"); 62353602077SPekka Enberg print_segment("cs ", &sregs.cs); 62453602077SPekka Enberg print_segment("ss ", &sregs.ss); 62553602077SPekka Enberg print_segment("ds ", &sregs.ds); 62653602077SPekka Enberg print_segment("es ", &sregs.es); 62753602077SPekka Enberg print_segment("fs ", &sregs.fs); 62853602077SPekka Enberg print_segment("gs ", &sregs.gs); 629ce5e0ecbSPekka Enberg print_segment("tr ", &sregs.tr); 630ce5e0ecbSPekka Enberg print_segment("ldt", &sregs.ldt); 6318351aaddSPekka Enberg print_dtable("gdt", &sregs.gdt); 6328351aaddSPekka Enberg print_dtable("idt", &sregs.idt); 633*0f9983b2SCyrill Gorcunov printf(" [ efer: %016" PRIx64 " apic base: %016" PRIx64 " nmi: %s ]\n", 634*0f9983b2SCyrill Gorcunov (uint64_t) sregs.efer, (uint64_t) sregs.apic_base, 6352049569dSPekka Enberg (self->nmi_disabled ? "disabled" : "enabled")); 636ce5e0ecbSPekka Enberg printf("Interrupt bitmap:\n"); 637ce5e0ecbSPekka Enberg printf(" "); 638ce5e0ecbSPekka Enberg for (i = 0; i < (KVM_NR_INTERRUPTS + 63) / 64; i++) 639*0f9983b2SCyrill Gorcunov printf("%016" PRIx64 " ", (uint64_t) sregs.interrupt_bitmap[i]); 640ce5e0ecbSPekka Enberg printf("\n"); 6417118d2caSPekka Enberg } 6427118d2caSPekka Enberg 643ae1fae34SPekka Enberg void kvm__show_code(struct kvm *self) 6446f10be05SPekka Enberg { 6456f10be05SPekka Enberg unsigned int code_bytes = 64; 6466f10be05SPekka Enberg unsigned int code_prologue = code_bytes * 43 / 64; 6476f10be05SPekka Enberg unsigned int code_len = code_bytes; 6486f10be05SPekka Enberg unsigned char c; 649ae1fae34SPekka Enberg unsigned int i; 6506f10be05SPekka Enberg uint8_t *ip; 6516f10be05SPekka Enberg 6522a601aafSPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_REGS, &self->regs) < 0) 6532a601aafSPekka Enberg die("KVM_GET_REGS failed"); 6542a601aafSPekka Enberg 6552a601aafSPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_SREGS, &self->sregs) < 0) 6562a601aafSPekka Enberg die("KVM_GET_SREGS failed"); 6572a601aafSPekka Enberg 658f326512aSPekka Enberg ip = guest_flat_to_host(self, ip_to_flat(self, self->regs.rip) - code_prologue); 6596f10be05SPekka Enberg 6606f10be05SPekka Enberg printf("Code: "); 6616f10be05SPekka Enberg 6626f10be05SPekka Enberg for (i = 0; i < code_len; i++, ip++) { 66348cf3877SPekka Enberg if (!host_ptr_in_ram(self, ip)) 66448cf3877SPekka Enberg break; 66548cf3877SPekka Enberg 6666e8abc38SPekka Enberg c = *ip; 6676e8abc38SPekka Enberg 668f326512aSPekka Enberg if (ip == guest_flat_to_host(self, ip_to_flat(self, self->regs.rip))) 6696f10be05SPekka Enberg printf("<%02x> ", c); 6706f10be05SPekka Enberg else 6716f10be05SPekka Enberg printf("%02x ", c); 6726f10be05SPekka Enberg } 6736f10be05SPekka Enberg 6746f10be05SPekka Enberg printf("\n"); 6752a7d39a4SPekka Enberg 6762a7d39a4SPekka Enberg printf("Stack:\n"); 6772a7d39a4SPekka Enberg kvm__dump_mem(self, self->regs.rsp, 32); 6786f10be05SPekka Enberg } 679090f898eSCyrill Gorcunov 680f01944c8SPekka Enberg void kvm__show_page_tables(struct kvm *self) 681f01944c8SPekka Enberg { 682f01944c8SPekka Enberg uint64_t *pte1; 683f01944c8SPekka Enberg uint64_t *pte2; 684f01944c8SPekka Enberg uint64_t *pte3; 685f01944c8SPekka Enberg uint64_t *pte4; 686f01944c8SPekka Enberg 687f01944c8SPekka Enberg if (!is_in_protected_mode(self)) 688f01944c8SPekka Enberg return; 689f01944c8SPekka Enberg 690f01944c8SPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_SREGS, &self->sregs) < 0) 691f01944c8SPekka Enberg die("KVM_GET_SREGS failed"); 692f01944c8SPekka Enberg 693f01944c8SPekka Enberg pte4 = guest_flat_to_host(self, self->sregs.cr3); 69448cf3877SPekka Enberg if (!host_ptr_in_ram(self, pte4)) 69548cf3877SPekka Enberg return; 69648cf3877SPekka Enberg 697f01944c8SPekka Enberg pte3 = guest_flat_to_host(self, (*pte4 & ~0xfff)); 69848cf3877SPekka Enberg if (!host_ptr_in_ram(self, pte3)) 69948cf3877SPekka Enberg return; 70048cf3877SPekka Enberg 701f01944c8SPekka Enberg pte2 = guest_flat_to_host(self, (*pte3 & ~0xfff)); 70248cf3877SPekka Enberg if (!host_ptr_in_ram(self, pte2)) 70348cf3877SPekka Enberg return; 70448cf3877SPekka Enberg 705f01944c8SPekka Enberg pte1 = guest_flat_to_host(self, (*pte2 & ~0xfff)); 70648cf3877SPekka Enberg if (!host_ptr_in_ram(self, pte1)) 70748cf3877SPekka Enberg return; 708f01944c8SPekka Enberg 709f01944c8SPekka Enberg printf("Page Tables:\n"); 710f01944c8SPekka Enberg if (*pte2 & (1 << 7)) 711*0f9983b2SCyrill Gorcunov printf(" pte4: %016" PRIx64 " pte3: %016" PRIx64 712*0f9983b2SCyrill Gorcunov " pte2: %016" PRIx64 "\n", 713*0f9983b2SCyrill Gorcunov *pte4, *pte3, *pte2); 714f01944c8SPekka Enberg else 715*0f9983b2SCyrill Gorcunov printf(" pte4: %016" PRIx64 " pte3: %016" PRIx64 " pte2: %016" 716*0f9983b2SCyrill Gorcunov PRIx64 " pte1: %016" PRIx64 "\n", 717*0f9983b2SCyrill Gorcunov *pte4, *pte3, *pte2, *pte1); 718f01944c8SPekka Enberg } 719f01944c8SPekka Enberg 720090f898eSCyrill Gorcunov void kvm__dump_mem(struct kvm *self, unsigned long addr, unsigned long size) 721090f898eSCyrill Gorcunov { 722090f898eSCyrill Gorcunov unsigned char *p; 723090f898eSCyrill Gorcunov unsigned long n; 724090f898eSCyrill Gorcunov 725090f898eSCyrill Gorcunov size &= ~7; /* mod 8 */ 726090f898eSCyrill Gorcunov if (!size) 727090f898eSCyrill Gorcunov return; 728090f898eSCyrill Gorcunov 7292a7d39a4SPekka Enberg p = guest_flat_to_host(self, addr); 730090f898eSCyrill Gorcunov 73148cf3877SPekka Enberg for (n = 0; n < size; n+=8) { 73248cf3877SPekka Enberg if (!host_ptr_in_ram(self, p + n)) 73348cf3877SPekka Enberg break; 73448cf3877SPekka Enberg 735090f898eSCyrill Gorcunov printf(" 0x%08lx: %02x %02x %02x %02x %02x %02x %02x %02x\n", 736090f898eSCyrill Gorcunov addr + n, p[n + 0], p[n + 1], p[n + 2], p[n + 3], 737090f898eSCyrill Gorcunov p[n + 4], p[n + 5], p[n + 6], p[n + 7]); 738090f898eSCyrill Gorcunov } 73948cf3877SPekka Enberg } 740