xref: /kvmtool/kvm.c (revision 6d7c36ceeafa0dd4c7ea917b14a2b688891e178c)
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, &regs) < 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