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 5355e19624SCyrill Gorcunov #define DEFINE_KVM_EXT(ext) \ 5455e19624SCyrill Gorcunov .name = #ext, \ 5555e19624SCyrill Gorcunov .code = ext 5655e19624SCyrill Gorcunov 5755e19624SCyrill Gorcunov struct { 5855e19624SCyrill Gorcunov const char *name; 5955e19624SCyrill Gorcunov int code; 6055e19624SCyrill Gorcunov } kvm_req_ext[] = { 6155e19624SCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_COALESCED_MMIO) }, 6255e19624SCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_SET_TSS_ADDR) }, 6355e19624SCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_PIT2) }, 6455e19624SCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_USER_MEMORY) }, 6555e19624SCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_IRQ_ROUTING) }, 6655e19624SCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_IRQCHIP) }, 677c0ec28fSCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_HLT) }, 6855e19624SCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_IRQ_INJECT_STATUS) }, 69d38ad31aSCyrill Gorcunov { DEFINE_KVM_EXT(KVM_CAP_EXT_CPUID) }, 7055e19624SCyrill Gorcunov }; 7155e19624SCyrill Gorcunov 7248cf3877SPekka Enberg static inline bool host_ptr_in_ram(struct kvm *self, void *p) 7348cf3877SPekka Enberg { 7448cf3877SPekka Enberg return self->ram_start <= p && p < (self->ram_start + self->ram_size); 7548cf3877SPekka Enberg } 7648cf3877SPekka Enberg 776753ed2fSPekka Enberg static inline uint32_t segment_to_flat(uint16_t selector, uint16_t offset) 786753ed2fSPekka Enberg { 796753ed2fSPekka Enberg return ((uint32_t)selector << 4) + (uint32_t) offset; 806753ed2fSPekka Enberg } 816753ed2fSPekka Enberg 826753ed2fSPekka Enberg static inline void *guest_flat_to_host(struct kvm *self, unsigned long offset) 83ae1fae34SPekka Enberg { 84ae1fae34SPekka Enberg return self->ram_start + offset; 85ae1fae34SPekka Enberg } 86ae1fae34SPekka Enberg 876753ed2fSPekka Enberg static inline void *guest_real_to_host(struct kvm *self, uint16_t selector, uint16_t offset) 886753ed2fSPekka Enberg { 896753ed2fSPekka Enberg unsigned long flat = segment_to_flat(selector, offset); 906753ed2fSPekka Enberg 916753ed2fSPekka Enberg return guest_flat_to_host(self, flat); 926753ed2fSPekka Enberg } 936753ed2fSPekka Enberg 94ae1fae34SPekka Enberg static bool kvm__supports_extension(struct kvm *self, unsigned int extension) 95b8f6afcdSPekka Enberg { 9628fa19c0SPekka Enberg int ret; 97b8f6afcdSPekka Enberg 9873ac60e6SPekka Enberg ret = ioctl(self->sys_fd, KVM_CHECK_EXTENSION, extension); 994076b041SPekka Enberg if (ret < 0) 1004076b041SPekka Enberg return false; 1014076b041SPekka Enberg 1024076b041SPekka Enberg return ret; 1034076b041SPekka Enberg } 1044076b041SPekka Enberg 10555e19624SCyrill Gorcunov static int kvm__check_extensions(struct kvm *self) 10655e19624SCyrill Gorcunov { 10755e19624SCyrill Gorcunov unsigned int i; 10855e19624SCyrill Gorcunov 10955e19624SCyrill Gorcunov for (i = 0; i < ARRAY_SIZE(kvm_req_ext); i++) { 11055e19624SCyrill Gorcunov if (!kvm__supports_extension(self, kvm_req_ext[i].code)) { 11155e19624SCyrill Gorcunov error("Unsuppored KVM extension detected: %s", 11255e19624SCyrill Gorcunov kvm_req_ext[i].name); 11355e19624SCyrill Gorcunov return (int)-i; 11455e19624SCyrill Gorcunov } 11555e19624SCyrill Gorcunov } 11655e19624SCyrill Gorcunov 11755e19624SCyrill Gorcunov return 0; 11855e19624SCyrill Gorcunov } 11955e19624SCyrill Gorcunov 1204076b041SPekka Enberg static struct kvm *kvm__new(void) 1214076b041SPekka Enberg { 1224076b041SPekka Enberg struct kvm *self = calloc(1, sizeof *self); 1234076b041SPekka Enberg 1244076b041SPekka Enberg if (!self) 1254076b041SPekka Enberg die("out of memory"); 1264076b041SPekka Enberg 1274076b041SPekka Enberg return self; 1284076b041SPekka Enberg } 1294076b041SPekka Enberg 1309ef4c68eSPekka Enberg void kvm__delete(struct kvm *self) 1319ef4c68eSPekka Enberg { 1329ef4c68eSPekka Enberg free(self->ram_start); 1339ef4c68eSPekka Enberg free(self); 1349ef4c68eSPekka Enberg } 1359ef4c68eSPekka Enberg 136*6d7c36ceSPekka Enberg struct kvm *kvm__init(const char *kvm_dev) 1374076b041SPekka Enberg { 1382b0e3342SPekka Enberg struct kvm_userspace_memory_region mem; 1399687927dSAsias He struct kvm_pit_config pit_config = { .flags = 0, }; 1404076b041SPekka Enberg struct kvm *self; 1410d1f17ecSPekka Enberg long page_size; 1421f9cff23SPekka Enberg int mmap_size; 1434076b041SPekka Enberg int ret; 1444076b041SPekka Enberg 1454076b041SPekka Enberg self = kvm__new(); 1464076b041SPekka Enberg 147*6d7c36ceSPekka Enberg self->sys_fd = open(kvm_dev, O_RDWR); 148*6d7c36ceSPekka Enberg if (self->sys_fd < 0) { 149*6d7c36ceSPekka Enberg if (errno == ENOENT) 150*6d7c36ceSPekka Enberg die("'%s' not found. Please make sure you have CONFIG_KVM enabled.", kvm_dev); 151*6d7c36ceSPekka Enberg 152f5ab5f67SPekka Enberg die_perror("open"); 153*6d7c36ceSPekka Enberg } 154b8f6afcdSPekka Enberg 15573ac60e6SPekka Enberg ret = ioctl(self->sys_fd, KVM_GET_API_VERSION, 0); 1566c7d8514SPekka Enberg if (ret != KVM_API_VERSION) 157f5ab5f67SPekka Enberg die_perror("KVM_API_VERSION ioctl"); 1586c7d8514SPekka Enberg 15973ac60e6SPekka Enberg self->vm_fd = ioctl(self->sys_fd, KVM_CREATE_VM, 0); 16073ac60e6SPekka Enberg if (self->vm_fd < 0) 161f5ab5f67SPekka Enberg die_perror("KVM_CREATE_VM ioctl"); 16228fa19c0SPekka Enberg 16355e19624SCyrill Gorcunov if (kvm__check_extensions(self)) 16455e19624SCyrill Gorcunov die("A required KVM extention is not supported by OS"); 1659687927dSAsias He 1669687927dSAsias He ret = ioctl(self->vm_fd, KVM_SET_TSS_ADDR, 0xfffbd000); 1679687927dSAsias He if (ret < 0) 1689687927dSAsias He die_perror("KVM_SET_TSS_ADDR ioctl"); 1699687927dSAsias He 1709687927dSAsias He ret = ioctl(self->vm_fd, KVM_CREATE_PIT2, &pit_config); 1719687927dSAsias He if (ret < 0) 1729687927dSAsias He die_perror("KVM_CREATE_PIT2 ioctl"); 1739687927dSAsias He 1740d1f17ecSPekka Enberg self->ram_size = 64UL * 1024UL * 1024UL; 1750d1f17ecSPekka Enberg 1760d1f17ecSPekka Enberg page_size = sysconf(_SC_PAGESIZE); 1770d1f17ecSPekka Enberg if (posix_memalign(&self->ram_start, page_size, self->ram_size) != 0) 1780d1f17ecSPekka Enberg die("out of memory"); 1790d1f17ecSPekka Enberg 1802b0e3342SPekka Enberg mem = (struct kvm_userspace_memory_region) { 1812b0e3342SPekka Enberg .slot = 0, 1822b0e3342SPekka Enberg .guest_phys_addr = 0x0UL, 1830d1f17ecSPekka Enberg .memory_size = self->ram_size, 1840d1f17ecSPekka Enberg .userspace_addr = (unsigned long) self->ram_start, 1852b0e3342SPekka Enberg }; 1862b0e3342SPekka Enberg 187b6e68186SAsias He ret = ioctl(self->vm_fd, KVM_SET_USER_MEMORY_REGION, &mem); 1882b0e3342SPekka Enberg if (ret < 0) 189f5ab5f67SPekka Enberg die_perror("KVM_SET_USER_MEMORY_REGION ioctl"); 1902b0e3342SPekka Enberg 1919687927dSAsias He ret = ioctl(self->vm_fd, KVM_CREATE_IRQCHIP); 192895c2fefSPekka Enberg if (ret < 0) 1939687927dSAsias He die_perror("KVM_CREATE_IRQCHIP ioctl"); 1949687927dSAsias He 19573ac60e6SPekka Enberg self->vcpu_fd = ioctl(self->vm_fd, KVM_CREATE_VCPU, 0); 1962b0e3342SPekka Enberg if (self->vcpu_fd < 0) 197f5ab5f67SPekka Enberg die_perror("KVM_CREATE_VCPU ioctl"); 1982b0e3342SPekka Enberg 1991f9cff23SPekka Enberg mmap_size = ioctl(self->sys_fd, KVM_GET_VCPU_MMAP_SIZE, 0); 2001f9cff23SPekka Enberg if (mmap_size < 0) 201f5ab5f67SPekka Enberg die_perror("KVM_GET_VCPU_MMAP_SIZE ioctl"); 2021f9cff23SPekka Enberg 2031f9cff23SPekka Enberg self->kvm_run = mmap(NULL, mmap_size, PROT_READ|PROT_WRITE, MAP_SHARED, self->vcpu_fd, 0); 2041f9cff23SPekka Enberg if (self->kvm_run == MAP_FAILED) 2051f9cff23SPekka Enberg die("unable to mmap vcpu fd"); 2061f9cff23SPekka Enberg 2074076b041SPekka Enberg return self; 2084076b041SPekka Enberg } 2094076b041SPekka Enberg 210ae1fae34SPekka Enberg void kvm__enable_singlestep(struct kvm *self) 211aee6632eSPekka Enberg { 212aee6632eSPekka Enberg struct kvm_guest_debug debug = { 213aee6632eSPekka Enberg .control = KVM_GUESTDBG_ENABLE | KVM_GUESTDBG_SINGLESTEP, 214aee6632eSPekka Enberg }; 215aee6632eSPekka Enberg 216aee6632eSPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_GUEST_DEBUG, &debug) < 0) 217b625d4b6SCyrill Gorcunov warning("KVM_SET_GUEST_DEBUG failed"); 218aee6632eSPekka Enberg } 219aee6632eSPekka Enberg 2205f6772b8SCyrill Gorcunov #define BOOT_LOADER_SELECTOR 0x1000 221b08e9ec4SPekka Enberg #define BOOT_LOADER_IP 0x0000 222dbdb74c2SPekka Enberg #define BOOT_LOADER_SP 0x8000 2232dd4a4edSCyrill Gorcunov #define BOOT_CMDLINE_OFFSET 0x20000 2242dd4a4edSCyrill Gorcunov 2252dd4a4edSCyrill Gorcunov #define BOOT_PROTOCOL_REQUIRED 0x202 226a43f6460SCyrill Gorcunov #define LOAD_HIGH 0x01 227009b0758SPekka Enberg 228edc8a14dSPekka Enberg static int load_flat_binary(struct kvm *self, int fd) 229009b0758SPekka Enberg { 230009b0758SPekka Enberg void *p; 231009b0758SPekka Enberg int nr; 232009b0758SPekka Enberg 233009b0758SPekka Enberg if (lseek(fd, 0, SEEK_SET) < 0) 234009b0758SPekka Enberg die_perror("lseek"); 235009b0758SPekka Enberg 2366753ed2fSPekka Enberg p = guest_real_to_host(self, BOOT_LOADER_SELECTOR, BOOT_LOADER_IP); 237009b0758SPekka Enberg 238009b0758SPekka Enberg while ((nr = read(fd, p, 65536)) > 0) 239009b0758SPekka Enberg p += nr; 240009b0758SPekka Enberg 241dbdb74c2SPekka Enberg self->boot_selector = BOOT_LOADER_SELECTOR; 242edc8a14dSPekka Enberg self->boot_ip = BOOT_LOADER_IP; 243dbdb74c2SPekka Enberg self->boot_sp = BOOT_LOADER_SP; 244edc8a14dSPekka Enberg 2457fb218bdSPekka Enberg return true; 246009b0758SPekka Enberg } 247009b0758SPekka Enberg 2487fb218bdSPekka Enberg /* 2497fb218bdSPekka Enberg * The protected mode kernel part of a modern bzImage is loaded at 1 MB by 2507fb218bdSPekka Enberg * default. 2517fb218bdSPekka Enberg */ 2527fb218bdSPekka Enberg #define BZ_KERNEL_START 0x100000UL 253ae1fae34SPekka Enberg 254ae1fae34SPekka Enberg static const char *BZIMAGE_MAGIC = "HdrS"; 255ae1fae34SPekka Enberg 25610943d14SPekka Enberg #define BZ_DEFAULT_SETUP_SECTS 4 25710943d14SPekka Enberg 2586d1f350dSCyrill Gorcunov static bool load_bzimage(struct kvm *self, int fd, const char *kernel_cmdline) 259ae1fae34SPekka Enberg { 260bc75b0aeSCyrill Gorcunov struct real_intr_desc intr; 26122489bb0SCyrill Gorcunov struct boot_params boot; 2624b62331fSPekka Enberg unsigned long setup_sects; 263305d9054SCyrill Gorcunov unsigned int intr_addr; 2642dd4a4edSCyrill Gorcunov size_t cmdline_size; 2657fb218bdSPekka Enberg ssize_t setup_size; 26622489bb0SCyrill Gorcunov void *p; 267ae1fae34SPekka Enberg int nr; 268ae1fae34SPekka Enberg 2695d67eaf6SPekka Enberg /* 2705d67eaf6SPekka Enberg * See Documentation/x86/boot.txt for details no bzImage on-disk and 2715d67eaf6SPekka Enberg * memory layout. 2725d67eaf6SPekka Enberg */ 2735d67eaf6SPekka Enberg 274009b0758SPekka Enberg if (lseek(fd, 0, SEEK_SET) < 0) 275009b0758SPekka Enberg die_perror("lseek"); 276009b0758SPekka Enberg 277ae1fae34SPekka Enberg read(fd, &boot, sizeof(boot)); 278ae1fae34SPekka Enberg 279ae1fae34SPekka Enberg if (memcmp(&boot.hdr.header, BZIMAGE_MAGIC, strlen(BZIMAGE_MAGIC)) != 0) 2807fb218bdSPekka Enberg return false; 281ae1fae34SPekka Enberg 2822dd4a4edSCyrill Gorcunov if (boot.hdr.version < BOOT_PROTOCOL_REQUIRED) { 283ad681038SCyrill Gorcunov warning("Too old kernel"); 284ad681038SCyrill Gorcunov return false; 285ad681038SCyrill Gorcunov } 286ad681038SCyrill Gorcunov 287e93ab78aSPekka Enberg if (lseek(fd, 0, SEEK_SET) < 0) 288e93ab78aSPekka Enberg die_perror("lseek"); 289e93ab78aSPekka Enberg 2904cf542bbSCyrill Gorcunov if (!boot.hdr.setup_sects) 2914cf542bbSCyrill Gorcunov boot.hdr.setup_sects = BZ_DEFAULT_SETUP_SECTS; 29210943d14SPekka Enberg setup_sects = boot.hdr.setup_sects + 1; 29310943d14SPekka Enberg 29454d4a626SPekka Enberg setup_size = setup_sects << 9; 2956753ed2fSPekka Enberg p = guest_real_to_host(self, BOOT_LOADER_SELECTOR, BOOT_LOADER_IP); 296ae1fae34SPekka Enberg 2977fb218bdSPekka Enberg if (read(fd, p, setup_size) != setup_size) 2987fb218bdSPekka Enberg die_perror("read"); 2997fb218bdSPekka Enberg 3006753ed2fSPekka Enberg p = guest_flat_to_host(self, BZ_KERNEL_START); 301ae1fae34SPekka Enberg 302ae1fae34SPekka Enberg while ((nr = read(fd, p, 65536)) > 0) 303ae1fae34SPekka Enberg p += nr; 304ae1fae34SPekka Enberg 305a43f6460SCyrill Gorcunov p = guest_flat_to_host(self, BOOT_CMDLINE_OFFSET); 306debcfac0SCyrill Gorcunov if (kernel_cmdline) { 307debcfac0SCyrill Gorcunov cmdline_size = strlen(kernel_cmdline) + 1; 308debcfac0SCyrill Gorcunov if (cmdline_size > boot.hdr.cmdline_size) 309debcfac0SCyrill Gorcunov cmdline_size = boot.hdr.cmdline_size; 310ad681038SCyrill Gorcunov 3112dd4a4edSCyrill Gorcunov memset(p, 0, boot.hdr.cmdline_size); 3122dd4a4edSCyrill Gorcunov memcpy(p, kernel_cmdline, cmdline_size - 1); 313debcfac0SCyrill Gorcunov } 314debcfac0SCyrill Gorcunov 315a43f6460SCyrill Gorcunov #define hdr_offset(member) \ 316a43f6460SCyrill Gorcunov offsetof(struct boot_params, hdr) + \ 317a43f6460SCyrill Gorcunov offsetof(struct setup_header, member) 318a43f6460SCyrill Gorcunov #define guest_hdr(kvm, member) \ 319a43f6460SCyrill Gorcunov guest_real_to_host(kvm, \ 320a43f6460SCyrill Gorcunov BOOT_LOADER_SELECTOR, \ 321a43f6460SCyrill Gorcunov hdr_offset(member)) 322a43f6460SCyrill Gorcunov 323a43f6460SCyrill Gorcunov /* some fields in guest header have to be updated */ 324a43f6460SCyrill Gorcunov p = guest_hdr(self, cmd_line_ptr); 325a43f6460SCyrill Gorcunov *(uint32_t *)p = BOOT_CMDLINE_OFFSET; 326a43f6460SCyrill Gorcunov 327a43f6460SCyrill Gorcunov p = guest_hdr(self, type_of_loader); 328a43f6460SCyrill Gorcunov *(uint8_t *)p = 0xff; 329a43f6460SCyrill Gorcunov 330a43f6460SCyrill Gorcunov p = guest_hdr(self, heap_end_ptr); 331a43f6460SCyrill Gorcunov *(uint16_t *)p = 0xfe00; 332a43f6460SCyrill Gorcunov 333a43f6460SCyrill Gorcunov p = guest_hdr(self, loadflags); 334a43f6460SCyrill Gorcunov *(uint8_t *)p |= CAN_USE_HEAP; 335a43f6460SCyrill Gorcunov 336dbdb74c2SPekka Enberg self->boot_selector = BOOT_LOADER_SELECTOR; 337edc8a14dSPekka Enberg /* 338edc8a14dSPekka Enberg * The real-mode setup code starts at offset 0x200 of a bzImage. See 339edc8a14dSPekka Enberg * Documentation/x86/boot.txt for details. 340edc8a14dSPekka Enberg */ 341edc8a14dSPekka Enberg self->boot_ip = BOOT_LOADER_IP + 0x200; 342dbdb74c2SPekka Enberg self->boot_sp = BOOT_LOADER_SP; 343edc8a14dSPekka Enberg 344ea684828SCyrill Gorcunov /* 34522489bb0SCyrill Gorcunov * Setup a *fake* real mode vector table, it has only 34622489bb0SCyrill Gorcunov * one real hadler which does just iret 34722489bb0SCyrill Gorcunov * 348305d9054SCyrill Gorcunov * This is where the BIOS lives -- BDA area 349ea684828SCyrill Gorcunov */ 350305d9054SCyrill Gorcunov intr_addr = BIOS_INTR_NEXT(BDA_START + 0, 16); 351305d9054SCyrill Gorcunov p = guest_flat_to_host(self, intr_addr); 3528b8fb6c7SCyrill Gorcunov memcpy(p, intfake, intfake_end - intfake); 353bc75b0aeSCyrill Gorcunov intr = (struct real_intr_desc) { 354305d9054SCyrill Gorcunov .segment = REAL_SEGMENT(intr_addr), 35522489bb0SCyrill Gorcunov .offset = 0, 356ea684828SCyrill Gorcunov }; 357bc75b0aeSCyrill Gorcunov interrupt_table__setup(&self->interrupt_table, &intr); 358305d9054SCyrill Gorcunov 3598b8fb6c7SCyrill Gorcunov intr_addr = BIOS_INTR_NEXT(BDA_START + (intfake_end - intfake), 16); 360305d9054SCyrill Gorcunov p = guest_flat_to_host(self, intr_addr); 3618b8fb6c7SCyrill Gorcunov memcpy(p, int10, int10_end - int10); 362305d9054SCyrill Gorcunov intr = (struct real_intr_desc) { 363305d9054SCyrill Gorcunov .segment = REAL_SEGMENT(intr_addr), 364305d9054SCyrill Gorcunov .offset = 0, 365305d9054SCyrill Gorcunov }; 366305d9054SCyrill Gorcunov interrupt_table__set(&self->interrupt_table, &intr, 0x10); 367305d9054SCyrill Gorcunov 368305d9054SCyrill Gorcunov p = guest_flat_to_host(self, 0); 369bc75b0aeSCyrill Gorcunov interrupt_table__copy(&self->interrupt_table, p, REAL_INTR_SIZE); 370ea684828SCyrill Gorcunov 3717fb218bdSPekka Enberg return true; 372ae1fae34SPekka Enberg } 373ae1fae34SPekka Enberg 3746d1f350dSCyrill Gorcunov bool kvm__load_kernel(struct kvm *kvm, const char *kernel_filename, 3756d1f350dSCyrill Gorcunov const char *kernel_cmdline) 376ae1fae34SPekka Enberg { 3777fb218bdSPekka Enberg bool ret; 378ae1fae34SPekka Enberg int fd; 379ae1fae34SPekka Enberg 380ae1fae34SPekka Enberg fd = open(kernel_filename, O_RDONLY); 381ae1fae34SPekka Enberg if (fd < 0) 382ae1fae34SPekka Enberg die("unable to open kernel"); 383ae1fae34SPekka Enberg 3846d1f350dSCyrill Gorcunov ret = load_bzimage(kvm, fd, kernel_cmdline); 385009b0758SPekka Enberg if (ret) 386009b0758SPekka Enberg goto found_kernel; 387ae1fae34SPekka Enberg 388009b0758SPekka Enberg ret = load_flat_binary(kvm, fd); 389009b0758SPekka Enberg if (ret) 390009b0758SPekka Enberg goto found_kernel; 391009b0758SPekka Enberg 392009b0758SPekka Enberg die("%s is not a valid bzImage or flat binary", kernel_filename); 393009b0758SPekka Enberg 394009b0758SPekka Enberg found_kernel: 395ae1fae34SPekka Enberg return ret; 396ae1fae34SPekka Enberg } 397ae1fae34SPekka Enberg 39806e41eeaSPekka Enberg static inline uint64_t ip_flat_to_real(struct kvm *self, uint64_t ip) 39906e41eeaSPekka Enberg { 40006e41eeaSPekka Enberg uint64_t cs = self->sregs.cs.selector; 40106e41eeaSPekka Enberg 40206e41eeaSPekka Enberg return ip - (cs << 4); 40306e41eeaSPekka Enberg } 40406e41eeaSPekka Enberg 405f01944c8SPekka Enberg static inline bool is_in_protected_mode(struct kvm *self) 406f01944c8SPekka Enberg { 407f01944c8SPekka Enberg return self->sregs.cr0 & 0x01; 408f01944c8SPekka Enberg } 409f01944c8SPekka Enberg 410f326512aSPekka Enberg static inline uint64_t ip_to_flat(struct kvm *self, uint64_t ip) 41106e41eeaSPekka Enberg { 412f326512aSPekka Enberg uint64_t cs; 413f326512aSPekka Enberg 414f326512aSPekka Enberg /* 415f326512aSPekka Enberg * NOTE! We should take code segment base address into account here. 416f326512aSPekka Enberg * Luckily it's usually zero because Linux uses flat memory model. 417f326512aSPekka Enberg */ 418f01944c8SPekka Enberg if (is_in_protected_mode(self)) 419f326512aSPekka Enberg return ip; 420f326512aSPekka Enberg 421f326512aSPekka Enberg cs = self->sregs.cs.selector; 42206e41eeaSPekka Enberg 42306e41eeaSPekka Enberg return ip + (cs << 4); 42406e41eeaSPekka Enberg } 42506e41eeaSPekka Enberg 426dbdb74c2SPekka Enberg static inline uint32_t selector_to_base(uint16_t selector) 427dbdb74c2SPekka Enberg { 428dbdb74c2SPekka Enberg /* 429dbdb74c2SPekka Enberg * KVM on Intel requires 'base' to be 'selector * 16' in real mode. 430dbdb74c2SPekka Enberg */ 431dbdb74c2SPekka Enberg return (uint32_t)selector * 16; 432dbdb74c2SPekka Enberg } 433dbdb74c2SPekka Enberg 43453d48714SPekka Enberg static struct kvm_msrs *kvm_msrs__new(size_t nmsrs) 43553d48714SPekka Enberg { 43653d48714SPekka Enberg struct kvm_msrs *self = calloc(1, sizeof(*self) + (sizeof(struct kvm_msr_entry) * nmsrs)); 43753d48714SPekka Enberg 43853d48714SPekka Enberg if (!self) 43953d48714SPekka Enberg die("out of memory"); 44053d48714SPekka Enberg 44153d48714SPekka Enberg return self; 44253d48714SPekka Enberg } 44353d48714SPekka Enberg 44453d48714SPekka Enberg #define MSR_IA32_TIME_STAMP_COUNTER 0x10 44553d48714SPekka Enberg 44653d48714SPekka Enberg #define MSR_IA32_SYSENTER_CS 0x174 44753d48714SPekka Enberg #define MSR_IA32_SYSENTER_ESP 0x175 44853d48714SPekka Enberg #define MSR_IA32_SYSENTER_EIP 0x176 44953d48714SPekka Enberg 45053d48714SPekka Enberg #define MSR_IA32_STAR 0xc0000081 45153d48714SPekka Enberg #define MSR_IA32_LSTAR 0xc0000082 45253d48714SPekka Enberg #define MSR_IA32_CSTAR 0xc0000083 45353d48714SPekka Enberg #define MSR_IA32_FMASK 0xc0000084 45453d48714SPekka Enberg #define MSR_IA32_KERNEL_GS_BASE 0xc0000102 45553d48714SPekka Enberg 45653d48714SPekka Enberg #define KVM_MSR_ENTRY(_index, _data) \ 45753d48714SPekka Enberg (struct kvm_msr_entry) { .index = _index, .data = _data } 45853d48714SPekka Enberg 45953d48714SPekka Enberg static void kvm__setup_msrs(struct kvm *self) 46053d48714SPekka Enberg { 46153d48714SPekka Enberg unsigned long ndx = 0; 46253d48714SPekka Enberg 46353d48714SPekka Enberg self->msrs = kvm_msrs__new(100); 46453d48714SPekka Enberg 46553d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_SYSENTER_CS, 0x0); 46653d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_SYSENTER_ESP, 0x0); 46753d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_SYSENTER_EIP, 0x0); 4688b334abcSCyrill Gorcunov #ifdef CONFIG_X86_64 46953d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_STAR, 0x0); 47053d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_CSTAR, 0x0); 47153d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_KERNEL_GS_BASE, 0x0); 47253d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_FMASK, 0x0); 47353d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_LSTAR, 0x0); 47444069a9dSCyrill Gorcunov #endif 47553d48714SPekka Enberg self->msrs->entries[ndx++] = KVM_MSR_ENTRY(MSR_IA32_TIME_STAMP_COUNTER, 0x0); 47653d48714SPekka Enberg 47753d48714SPekka Enberg self->msrs->nmsrs = ndx; 47853d48714SPekka Enberg 47953d48714SPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_MSRS, self->msrs) < 0) 48053d48714SPekka Enberg die_perror("KVM_SET_MSRS failed"); 48153d48714SPekka Enberg } 48253d48714SPekka Enberg 4833d78d3a5SPekka Enberg static void kvm__setup_fpu(struct kvm *self) 4843d78d3a5SPekka Enberg { 4853d78d3a5SPekka Enberg self->fpu = (struct kvm_fpu) { 4863d78d3a5SPekka Enberg .fcw = 0x37f, 4873d78d3a5SPekka Enberg .mxcsr = 0x1f80, 4883d78d3a5SPekka Enberg }; 4893d78d3a5SPekka Enberg 4903d78d3a5SPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_FPU, &self->fpu) < 0) 4913d78d3a5SPekka Enberg die_perror("KVM_SET_FPU failed"); 4923d78d3a5SPekka Enberg } 4933d78d3a5SPekka Enberg 4943d78d3a5SPekka Enberg static void kvm__setup_regs(struct kvm *self) 4953d78d3a5SPekka Enberg { 4963d78d3a5SPekka Enberg self->regs = (struct kvm_regs) { 4973d78d3a5SPekka Enberg /* We start the guest in 16-bit real mode */ 4983d78d3a5SPekka Enberg .rflags = 0x0000000000000002ULL, 4993d78d3a5SPekka Enberg 5003d78d3a5SPekka Enberg .rip = self->boot_ip, 5013d78d3a5SPekka Enberg .rsp = self->boot_sp, 5023d78d3a5SPekka Enberg .rbp = self->boot_sp, 5033d78d3a5SPekka Enberg }; 5043d78d3a5SPekka Enberg 5053d78d3a5SPekka Enberg if (self->regs.rip > USHRT_MAX) 5063d78d3a5SPekka Enberg die("ip 0x%" PRIx64 " is too high for real mode", (uint64_t) self->regs.rip); 5073d78d3a5SPekka Enberg 5083d78d3a5SPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_REGS, &self->regs) < 0) 5093d78d3a5SPekka Enberg die_perror("KVM_SET_REGS failed"); 5103d78d3a5SPekka Enberg } 5113d78d3a5SPekka Enberg 5123d78d3a5SPekka Enberg static void kvm__setup_sregs(struct kvm *self) 513ae1fae34SPekka Enberg { 51453602077SPekka Enberg 5150ed849e6SAsias He if (ioctl(self->vcpu_fd, KVM_GET_SREGS, &self->sregs) < 0) 5160ed849e6SAsias He die_perror("KVM_GET_SREGS failed"); 5174a7c140aSAsias He 5180ed849e6SAsias He self->sregs.cs.selector = self->boot_selector; 5190ed849e6SAsias He self->sregs.cs.base = selector_to_base(self->boot_selector); 5204e42cf94SAsias He self->sregs.ss.selector = self->boot_selector; 5214e42cf94SAsias He self->sregs.ss.base = selector_to_base(self->boot_selector); 5224e42cf94SAsias He self->sregs.ds.selector = self->boot_selector; 5234e42cf94SAsias He self->sregs.ds.base = selector_to_base(self->boot_selector); 5244e42cf94SAsias He self->sregs.es.selector = self->boot_selector; 5254e42cf94SAsias He self->sregs.es.base = selector_to_base(self->boot_selector); 5264e42cf94SAsias He self->sregs.fs.selector = self->boot_selector; 5274e42cf94SAsias He self->sregs.fs.base = selector_to_base(self->boot_selector); 5284e42cf94SAsias He self->sregs.gs.selector = self->boot_selector; 5294e42cf94SAsias He self->sregs.gs.base = selector_to_base(self->boot_selector); 5304a7c140aSAsias He 53153602077SPekka Enberg if (ioctl(self->vcpu_fd, KVM_SET_SREGS, &self->sregs) < 0) 53253602077SPekka Enberg die_perror("KVM_SET_SREGS failed"); 5333d78d3a5SPekka Enberg } 53406e41eeaSPekka Enberg 5353d78d3a5SPekka Enberg void kvm__reset_vcpu(struct kvm *self) 5363d78d3a5SPekka Enberg { 5373d78d3a5SPekka Enberg kvm__setup_sregs(self); 538dbdb74c2SPekka Enberg 5393d78d3a5SPekka Enberg kvm__setup_regs(self); 54006e41eeaSPekka Enberg 5413d78d3a5SPekka Enberg kvm__setup_fpu(self); 54253d48714SPekka Enberg 54353d48714SPekka Enberg kvm__setup_msrs(self); 544ae1fae34SPekka Enberg } 545ae1fae34SPekka Enberg 546ae1fae34SPekka Enberg void kvm__run(struct kvm *self) 547ae1fae34SPekka Enberg { 548ae1fae34SPekka Enberg if (ioctl(self->vcpu_fd, KVM_RUN, 0) < 0) 549ae1fae34SPekka Enberg die_perror("KVM_RUN failed"); 550ae1fae34SPekka Enberg } 551ae1fae34SPekka Enberg 5528351aaddSPekka Enberg static void print_dtable(const char *name, struct kvm_dtable *dtable) 5538351aaddSPekka Enberg { 5548351aaddSPekka Enberg printf(" %s %016" PRIx64 " %08" PRIx16 "\n", 5558351aaddSPekka Enberg name, (uint64_t) dtable->base, (uint16_t) dtable->limit); 5568351aaddSPekka Enberg } 5578351aaddSPekka Enberg 55853602077SPekka Enberg static void print_segment(const char *name, struct kvm_segment *seg) 55953602077SPekka Enberg { 560ce556636SPekka Enberg printf(" %s %04" PRIx16 " %016" PRIx64 " %08" PRIx32 " %02" PRIx8 " %x %x %x %x %x %x %x\n", 56153602077SPekka Enberg name, (uint16_t) seg->selector, (uint64_t) seg->base, (uint32_t) seg->limit, 562ce556636SPekka Enberg (uint8_t) seg->type, seg->present, seg->dpl, seg->db, seg->s, seg->l, seg->g, seg->avl); 56353602077SPekka Enberg } 56453602077SPekka Enberg 565ae1fae34SPekka Enberg void kvm__show_registers(struct kvm *self) 5667118d2caSPekka Enberg { 56753602077SPekka Enberg unsigned long cr0, cr2, cr3; 56853602077SPekka Enberg unsigned long cr4, cr8; 5697118d2caSPekka Enberg unsigned long rax, rbx, rcx; 5707118d2caSPekka Enberg unsigned long rdx, rsi, rdi; 5717118d2caSPekka Enberg unsigned long rbp, r8, r9; 5727118d2caSPekka Enberg unsigned long r10, r11, r12; 5737118d2caSPekka Enberg unsigned long r13, r14, r15; 5747118d2caSPekka Enberg unsigned long rip, rsp; 57553602077SPekka Enberg struct kvm_sregs sregs; 576a2fe6199SPekka Enberg unsigned long rflags; 5777118d2caSPekka Enberg struct kvm_regs regs; 578ce5e0ecbSPekka Enberg int i; 5797118d2caSPekka Enberg 5807118d2caSPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_REGS, ®s) < 0) 5817118d2caSPekka Enberg die("KVM_GET_REGS failed"); 5827118d2caSPekka Enberg 583a2fe6199SPekka Enberg rflags = regs.rflags; 584a2fe6199SPekka Enberg 5857118d2caSPekka Enberg rip = regs.rip; rsp = regs.rsp; 5867118d2caSPekka Enberg rax = regs.rax; rbx = regs.rbx; rcx = regs.rcx; 5877118d2caSPekka Enberg rdx = regs.rdx; rsi = regs.rsi; rdi = regs.rdi; 5887118d2caSPekka Enberg rbp = regs.rbp; r8 = regs.r8; r9 = regs.r9; 5897118d2caSPekka Enberg r10 = regs.r10; r11 = regs.r11; r12 = regs.r12; 5907118d2caSPekka Enberg r13 = regs.r13; r14 = regs.r14; r15 = regs.r15; 5917118d2caSPekka Enberg 5927118d2caSPekka Enberg printf("Registers:\n"); 5932177ec43SPekka Enberg printf(" rip: %016lx rsp: %016lx flags: %016lx\n", rip, rsp, rflags); 594ea2e4ea0SCyrill Gorcunov printf(" rax: %016lx rbx: %016lx rcx: %016lx\n", rax, rbx, rcx); 5957118d2caSPekka Enberg printf(" rdx: %016lx rsi: %016lx rdi: %016lx\n", rdx, rsi, rdi); 5967118d2caSPekka Enberg printf(" rbp: %016lx r8: %016lx r9: %016lx\n", rbp, r8, r9); 5977118d2caSPekka Enberg printf(" r10: %016lx r11: %016lx r12: %016lx\n", r10, r11, r12); 5987118d2caSPekka Enberg printf(" r13: %016lx r14: %016lx r15: %016lx\n", r13, r14, r15); 59953602077SPekka Enberg 60053602077SPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_SREGS, &sregs) < 0) 60153602077SPekka Enberg die("KVM_GET_REGS failed"); 60253602077SPekka Enberg 60353602077SPekka Enberg cr0 = sregs.cr0; cr2 = sregs.cr2; cr3 = sregs.cr3; 60453602077SPekka Enberg cr4 = sregs.cr4; cr8 = sregs.cr8; 60553602077SPekka Enberg 60653602077SPekka Enberg printf(" cr0: %016lx cr2: %016lx cr3: %016lx\n", cr0, cr2, cr3); 60753602077SPekka Enberg printf(" cr4: %016lx cr8: %016lx\n", cr4, cr8); 608ce5e0ecbSPekka Enberg printf("Segment registers:\n"); 609ce556636SPekka Enberg printf(" register selector base limit type p dpl db s l g avl\n"); 61053602077SPekka Enberg print_segment("cs ", &sregs.cs); 61153602077SPekka Enberg print_segment("ss ", &sregs.ss); 61253602077SPekka Enberg print_segment("ds ", &sregs.ds); 61353602077SPekka Enberg print_segment("es ", &sregs.es); 61453602077SPekka Enberg print_segment("fs ", &sregs.fs); 61553602077SPekka Enberg print_segment("gs ", &sregs.gs); 616ce5e0ecbSPekka Enberg print_segment("tr ", &sregs.tr); 617ce5e0ecbSPekka Enberg print_segment("ldt", &sregs.ldt); 6188351aaddSPekka Enberg print_dtable("gdt", &sregs.gdt); 6198351aaddSPekka Enberg print_dtable("idt", &sregs.idt); 6200f9983b2SCyrill Gorcunov printf(" [ efer: %016" PRIx64 " apic base: %016" PRIx64 " nmi: %s ]\n", 6210f9983b2SCyrill Gorcunov (uint64_t) sregs.efer, (uint64_t) sregs.apic_base, 6222049569dSPekka Enberg (self->nmi_disabled ? "disabled" : "enabled")); 623ce5e0ecbSPekka Enberg printf("Interrupt bitmap:\n"); 624ce5e0ecbSPekka Enberg printf(" "); 625ce5e0ecbSPekka Enberg for (i = 0; i < (KVM_NR_INTERRUPTS + 63) / 64; i++) 6260f9983b2SCyrill Gorcunov printf("%016" PRIx64 " ", (uint64_t) sregs.interrupt_bitmap[i]); 627ce5e0ecbSPekka Enberg printf("\n"); 6287118d2caSPekka Enberg } 6297118d2caSPekka Enberg 630ae1fae34SPekka Enberg void kvm__show_code(struct kvm *self) 6316f10be05SPekka Enberg { 6326f10be05SPekka Enberg unsigned int code_bytes = 64; 6336f10be05SPekka Enberg unsigned int code_prologue = code_bytes * 43 / 64; 6346f10be05SPekka Enberg unsigned int code_len = code_bytes; 6356f10be05SPekka Enberg unsigned char c; 636ae1fae34SPekka Enberg unsigned int i; 6376f10be05SPekka Enberg uint8_t *ip; 6386f10be05SPekka Enberg 6392a601aafSPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_REGS, &self->regs) < 0) 6402a601aafSPekka Enberg die("KVM_GET_REGS failed"); 6412a601aafSPekka Enberg 6422a601aafSPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_SREGS, &self->sregs) < 0) 6432a601aafSPekka Enberg die("KVM_GET_SREGS failed"); 6442a601aafSPekka Enberg 645f326512aSPekka Enberg ip = guest_flat_to_host(self, ip_to_flat(self, self->regs.rip) - code_prologue); 6466f10be05SPekka Enberg 6476f10be05SPekka Enberg printf("Code: "); 6486f10be05SPekka Enberg 6496f10be05SPekka Enberg for (i = 0; i < code_len; i++, ip++) { 65048cf3877SPekka Enberg if (!host_ptr_in_ram(self, ip)) 65148cf3877SPekka Enberg break; 65248cf3877SPekka Enberg 6536e8abc38SPekka Enberg c = *ip; 6546e8abc38SPekka Enberg 655f326512aSPekka Enberg if (ip == guest_flat_to_host(self, ip_to_flat(self, self->regs.rip))) 6566f10be05SPekka Enberg printf("<%02x> ", c); 6576f10be05SPekka Enberg else 6586f10be05SPekka Enberg printf("%02x ", c); 6596f10be05SPekka Enberg } 6606f10be05SPekka Enberg 6616f10be05SPekka Enberg printf("\n"); 6622a7d39a4SPekka Enberg 6632a7d39a4SPekka Enberg printf("Stack:\n"); 6642a7d39a4SPekka Enberg kvm__dump_mem(self, self->regs.rsp, 32); 6656f10be05SPekka Enberg } 666090f898eSCyrill Gorcunov 667f01944c8SPekka Enberg void kvm__show_page_tables(struct kvm *self) 668f01944c8SPekka Enberg { 669f01944c8SPekka Enberg uint64_t *pte1; 670f01944c8SPekka Enberg uint64_t *pte2; 671f01944c8SPekka Enberg uint64_t *pte3; 672f01944c8SPekka Enberg uint64_t *pte4; 673f01944c8SPekka Enberg 674f01944c8SPekka Enberg if (!is_in_protected_mode(self)) 675f01944c8SPekka Enberg return; 676f01944c8SPekka Enberg 677f01944c8SPekka Enberg if (ioctl(self->vcpu_fd, KVM_GET_SREGS, &self->sregs) < 0) 678f01944c8SPekka Enberg die("KVM_GET_SREGS failed"); 679f01944c8SPekka Enberg 680f01944c8SPekka Enberg pte4 = guest_flat_to_host(self, self->sregs.cr3); 68148cf3877SPekka Enberg if (!host_ptr_in_ram(self, pte4)) 68248cf3877SPekka Enberg return; 68348cf3877SPekka Enberg 684f01944c8SPekka Enberg pte3 = guest_flat_to_host(self, (*pte4 & ~0xfff)); 68548cf3877SPekka Enberg if (!host_ptr_in_ram(self, pte3)) 68648cf3877SPekka Enberg return; 68748cf3877SPekka Enberg 688f01944c8SPekka Enberg pte2 = guest_flat_to_host(self, (*pte3 & ~0xfff)); 68948cf3877SPekka Enberg if (!host_ptr_in_ram(self, pte2)) 69048cf3877SPekka Enberg return; 69148cf3877SPekka Enberg 692f01944c8SPekka Enberg pte1 = guest_flat_to_host(self, (*pte2 & ~0xfff)); 69348cf3877SPekka Enberg if (!host_ptr_in_ram(self, pte1)) 69448cf3877SPekka Enberg return; 695f01944c8SPekka Enberg 696f01944c8SPekka Enberg printf("Page Tables:\n"); 697f01944c8SPekka Enberg if (*pte2 & (1 << 7)) 6980f9983b2SCyrill Gorcunov printf(" pte4: %016" PRIx64 " pte3: %016" PRIx64 6990f9983b2SCyrill Gorcunov " pte2: %016" PRIx64 "\n", 7000f9983b2SCyrill Gorcunov *pte4, *pte3, *pte2); 701f01944c8SPekka Enberg else 7020f9983b2SCyrill Gorcunov printf(" pte4: %016" PRIx64 " pte3: %016" PRIx64 " pte2: %016" 7030f9983b2SCyrill Gorcunov PRIx64 " pte1: %016" PRIx64 "\n", 7040f9983b2SCyrill Gorcunov *pte4, *pte3, *pte2, *pte1); 705f01944c8SPekka Enberg } 706f01944c8SPekka Enberg 707090f898eSCyrill Gorcunov void kvm__dump_mem(struct kvm *self, unsigned long addr, unsigned long size) 708090f898eSCyrill Gorcunov { 709090f898eSCyrill Gorcunov unsigned char *p; 710090f898eSCyrill Gorcunov unsigned long n; 711090f898eSCyrill Gorcunov 712090f898eSCyrill Gorcunov size &= ~7; /* mod 8 */ 713090f898eSCyrill Gorcunov if (!size) 714090f898eSCyrill Gorcunov return; 715090f898eSCyrill Gorcunov 7162a7d39a4SPekka Enberg p = guest_flat_to_host(self, addr); 717090f898eSCyrill Gorcunov 71848cf3877SPekka Enberg for (n = 0; n < size; n+=8) { 71948cf3877SPekka Enberg if (!host_ptr_in_ram(self, p + n)) 72048cf3877SPekka Enberg break; 72148cf3877SPekka Enberg 722090f898eSCyrill Gorcunov printf(" 0x%08lx: %02x %02x %02x %02x %02x %02x %02x %02x\n", 723090f898eSCyrill Gorcunov addr + n, p[n + 0], p[n + 1], p[n + 2], p[n + 3], 724090f898eSCyrill Gorcunov p[n + 4], p[n + 5], p[n + 6], p[n + 7]); 725090f898eSCyrill Gorcunov } 72648cf3877SPekka Enberg } 727