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