16c7d8514SPekka Enberg #include <linux/kvm.h> 2f5ab5f67SPekka Enberg 3f5ab5f67SPekka Enberg #include <asm/bootparam.h> 4f5ab5f67SPekka Enberg 51f9cff23SPekka Enberg #include <inttypes.h> 61f9cff23SPekka Enberg #include <sys/mman.h> 72da26a59SPekka Enberg #include <stdbool.h> 8f5ab5f67SPekka Enberg #include <stdarg.h> 9b8f6afcdSPekka Enberg #include <stdlib.h> 10f5ab5f67SPekka Enberg #include <string.h> 11*0d1f17ecSPekka Enberg #include <unistd.h> 121f9cff23SPekka Enberg #include <stdio.h> 13b8f6afcdSPekka Enberg #include <fcntl.h> 14b8f6afcdSPekka Enberg 151f9cff23SPekka Enberg /* 161f9cff23SPekka Enberg * Compatibility code. Remove this when we move to tools/kvm. 171f9cff23SPekka Enberg */ 181f9cff23SPekka Enberg #ifndef KVM_EXIT_INTERNAL_ERROR 191f9cff23SPekka Enberg # define KVM_EXIT_INTERNAL_ERROR 17 201f9cff23SPekka Enberg #endif 211f9cff23SPekka Enberg 229b1fb1c3SPekka Enberg struct kvm { 2373ac60e6SPekka Enberg int sys_fd; /* For system ioctls(), i.e. /dev/kvm */ 2473ac60e6SPekka Enberg int vm_fd; /* For VM ioctls() */ 2573ac60e6SPekka Enberg int vcpu_fd; /* For VCPU ioctls() */ 261f9cff23SPekka Enberg struct kvm_run *kvm_run; 27*0d1f17ecSPekka Enberg 28*0d1f17ecSPekka Enberg uint64_t ram_size; 29*0d1f17ecSPekka Enberg void *ram_start; 309b1fb1c3SPekka Enberg }; 319b1fb1c3SPekka Enberg 32f5ab5f67SPekka Enberg static void die_perror(const char *s) 33b8f6afcdSPekka Enberg { 34b8f6afcdSPekka Enberg perror(s); 35b8f6afcdSPekka Enberg exit(1); 36b8f6afcdSPekka Enberg } 37b8f6afcdSPekka Enberg 38f5ab5f67SPekka Enberg static void die(const char *format, ...) 39f5ab5f67SPekka Enberg { 40f5ab5f67SPekka Enberg va_list ap; 41f5ab5f67SPekka Enberg 42f5ab5f67SPekka Enberg va_start(ap, format); 43f5ab5f67SPekka Enberg vprintf(format, ap); 44f5ab5f67SPekka Enberg va_end(ap); 45f5ab5f67SPekka Enberg 46f5ab5f67SPekka Enberg printf("\n"); 47f5ab5f67SPekka Enberg exit(1); 48f5ab5f67SPekka Enberg } 49f5ab5f67SPekka Enberg 504076b041SPekka Enberg static inline bool kvm__supports_extension(struct kvm *self, unsigned int extension) 51b8f6afcdSPekka Enberg { 5228fa19c0SPekka Enberg int ret; 53b8f6afcdSPekka Enberg 5473ac60e6SPekka Enberg ret = ioctl(self->sys_fd, KVM_CHECK_EXTENSION, extension); 554076b041SPekka Enberg if (ret < 0) 564076b041SPekka Enberg return false; 574076b041SPekka Enberg 584076b041SPekka Enberg return ret; 594076b041SPekka Enberg } 604076b041SPekka Enberg 614076b041SPekka Enberg static struct kvm *kvm__new(void) 624076b041SPekka Enberg { 634076b041SPekka Enberg struct kvm *self = calloc(1, sizeof *self); 644076b041SPekka Enberg 654076b041SPekka Enberg if (!self) 664076b041SPekka Enberg die("out of memory"); 674076b041SPekka Enberg 684076b041SPekka Enberg return self; 694076b041SPekka Enberg } 704076b041SPekka Enberg 714076b041SPekka Enberg static struct kvm *kvm__init(void) 724076b041SPekka Enberg { 732b0e3342SPekka Enberg struct kvm_userspace_memory_region mem; 744076b041SPekka Enberg struct kvm *self; 75*0d1f17ecSPekka Enberg long page_size; 761f9cff23SPekka Enberg int mmap_size; 774076b041SPekka Enberg int ret; 784076b041SPekka Enberg 794076b041SPekka Enberg self = kvm__new(); 804076b041SPekka Enberg 8173ac60e6SPekka Enberg self->sys_fd = open("/dev/kvm", O_RDWR); 8273ac60e6SPekka Enberg if (self->sys_fd < 0) 83f5ab5f67SPekka Enberg die_perror("open"); 84b8f6afcdSPekka Enberg 8573ac60e6SPekka Enberg ret = ioctl(self->sys_fd, KVM_GET_API_VERSION, 0); 866c7d8514SPekka Enberg if (ret != KVM_API_VERSION) 87f5ab5f67SPekka Enberg die_perror("KVM_API_VERSION ioctl"); 886c7d8514SPekka Enberg 8973ac60e6SPekka Enberg self->vm_fd = ioctl(self->sys_fd, KVM_CREATE_VM, 0); 9073ac60e6SPekka Enberg if (self->vm_fd < 0) 91f5ab5f67SPekka Enberg die_perror("KVM_CREATE_VM ioctl"); 9228fa19c0SPekka Enberg 934076b041SPekka Enberg if (!kvm__supports_extension(self, KVM_CAP_USER_MEMORY)) 94f5ab5f67SPekka Enberg die("KVM_CAP_USER_MEMORY is not supported"); 952da26a59SPekka Enberg 96*0d1f17ecSPekka Enberg self->ram_size = 64UL * 1024UL * 1024UL; 97*0d1f17ecSPekka Enberg 98*0d1f17ecSPekka Enberg page_size = sysconf(_SC_PAGESIZE); 99*0d1f17ecSPekka Enberg if (posix_memalign(&self->ram_start, page_size, self->ram_size) != 0) 100*0d1f17ecSPekka Enberg die("out of memory"); 101*0d1f17ecSPekka Enberg 1022b0e3342SPekka Enberg mem = (struct kvm_userspace_memory_region) { 1032b0e3342SPekka Enberg .slot = 0, 1042b0e3342SPekka Enberg .guest_phys_addr = 0x0UL, 105*0d1f17ecSPekka Enberg .memory_size = self->ram_size, 106*0d1f17ecSPekka Enberg .userspace_addr = (unsigned long) self->ram_start, 1072b0e3342SPekka Enberg }; 1082b0e3342SPekka Enberg 10973ac60e6SPekka Enberg ret = ioctl(self->vm_fd, KVM_SET_USER_MEMORY_REGION, &mem, 1); 1102b0e3342SPekka Enberg if (ret < 0) 111f5ab5f67SPekka Enberg die_perror("KVM_SET_USER_MEMORY_REGION ioctl"); 1122b0e3342SPekka Enberg 113895c2fefSPekka Enberg if (!kvm__supports_extension(self, KVM_CAP_SET_TSS_ADDR)) 114f5ab5f67SPekka Enberg die("KVM_CAP_SET_TSS_ADDR is not supported"); 115895c2fefSPekka Enberg 11673ac60e6SPekka Enberg ret = ioctl(self->vm_fd, KVM_SET_TSS_ADDR, 0xfffbd000); 117895c2fefSPekka Enberg if (ret < 0) 118f5ab5f67SPekka Enberg die_perror("KVM_SET_TSS_ADDR ioctl"); 119895c2fefSPekka Enberg 12073ac60e6SPekka Enberg self->vcpu_fd = ioctl(self->vm_fd, KVM_CREATE_VCPU, 0); 1212b0e3342SPekka Enberg if (self->vcpu_fd < 0) 122f5ab5f67SPekka Enberg die_perror("KVM_CREATE_VCPU ioctl"); 1232b0e3342SPekka Enberg 1241f9cff23SPekka Enberg mmap_size = ioctl(self->sys_fd, KVM_GET_VCPU_MMAP_SIZE, 0); 1251f9cff23SPekka Enberg if (mmap_size < 0) 126f5ab5f67SPekka Enberg die_perror("KVM_GET_VCPU_MMAP_SIZE ioctl"); 1271f9cff23SPekka Enberg 1281f9cff23SPekka Enberg self->kvm_run = mmap(NULL, mmap_size, PROT_READ|PROT_WRITE, MAP_SHARED, self->vcpu_fd, 0); 1291f9cff23SPekka Enberg if (self->kvm_run == MAP_FAILED) 1301f9cff23SPekka Enberg die("unable to mmap vcpu fd"); 1311f9cff23SPekka Enberg 1324076b041SPekka Enberg return self; 1334076b041SPekka Enberg } 1344076b041SPekka Enberg 1352b0e3342SPekka Enberg static void kvm__run(struct kvm *self) 1362b0e3342SPekka Enberg { 1372b0e3342SPekka Enberg int ret; 1382b0e3342SPekka Enberg 1392b0e3342SPekka Enberg ret = ioctl(self->vcpu_fd, KVM_RUN, 0); 1402b0e3342SPekka Enberg if (ret < 0) 141f5ab5f67SPekka Enberg die_perror("KVM_RUN ioctl"); 142f5ab5f67SPekka Enberg } 143f5ab5f67SPekka Enberg 144f5ab5f67SPekka Enberg static const char *BZIMAGE_MAGIC = "HdrS"; 145f5ab5f67SPekka Enberg 146f5ab5f67SPekka Enberg static int load_bzimage(struct kvm *kvm, int fd) 147f5ab5f67SPekka Enberg { 148f5ab5f67SPekka Enberg struct boot_params boot; 149f5ab5f67SPekka Enberg 150f5ab5f67SPekka Enberg read(fd, &boot, sizeof(boot)); 151f5ab5f67SPekka Enberg 152f5ab5f67SPekka Enberg if (memcmp(&boot.hdr.header, BZIMAGE_MAGIC, strlen(BZIMAGE_MAGIC)) != 0) 153f5ab5f67SPekka Enberg return -1; 154f5ab5f67SPekka Enberg 155f5ab5f67SPekka Enberg return 0; 1562b0e3342SPekka Enberg } 1572b0e3342SPekka Enberg 158caf44df2SPekka Enberg static void kvm__load_kernel(struct kvm *kvm, const char *kernel_filename) 159caf44df2SPekka Enberg { 160f5ab5f67SPekka Enberg int fd; 161f5ab5f67SPekka Enberg 162f5ab5f67SPekka Enberg fd = open(kernel_filename, O_RDONLY); 163f5ab5f67SPekka Enberg if (fd < 0) 164f5ab5f67SPekka Enberg die("unable to open kernel"); 165f5ab5f67SPekka Enberg 166f5ab5f67SPekka Enberg if (load_bzimage(kvm, fd) < 0) 167f5ab5f67SPekka Enberg die("%s is not a valid bzImage", kernel_filename); 168caf44df2SPekka Enberg } 169caf44df2SPekka Enberg 1701f9cff23SPekka Enberg static const char *exit_reasons[] = { 1711f9cff23SPekka Enberg [KVM_EXIT_UNKNOWN] = "unknown", 1721f9cff23SPekka Enberg [KVM_EXIT_EXCEPTION] = "exception", 1731f9cff23SPekka Enberg [KVM_EXIT_IO] = "io", 1741f9cff23SPekka Enberg [KVM_EXIT_HYPERCALL] = "hypercall", 1751f9cff23SPekka Enberg [KVM_EXIT_DEBUG] = "debug", 1761f9cff23SPekka Enberg [KVM_EXIT_HLT] = "hlt", 1771f9cff23SPekka Enberg [KVM_EXIT_MMIO] = "mmio", 1781f9cff23SPekka Enberg [KVM_EXIT_IRQ_WINDOW_OPEN] = "irq window open", 1791f9cff23SPekka Enberg [KVM_EXIT_SHUTDOWN] = "shutdown", 1801f9cff23SPekka Enberg [KVM_EXIT_FAIL_ENTRY] = "fail entry", 1811f9cff23SPekka Enberg [KVM_EXIT_INTR] = "intr", 1821f9cff23SPekka Enberg [KVM_EXIT_SET_TPR] = "set tpr", 1831f9cff23SPekka Enberg [KVM_EXIT_TPR_ACCESS] = "trp access", 1841f9cff23SPekka Enberg [KVM_EXIT_S390_SIEIC] = "s390 sieic", 1851f9cff23SPekka Enberg [KVM_EXIT_S390_RESET] = "s390 reset", 1861f9cff23SPekka Enberg [KVM_EXIT_DCR] = "dcr", 1871f9cff23SPekka Enberg [KVM_EXIT_NMI] = "dmi", 1881f9cff23SPekka Enberg [KVM_EXIT_INTERNAL_ERROR] = "internal error", 1891f9cff23SPekka Enberg }; 1901f9cff23SPekka Enberg 191caf44df2SPekka Enberg static void usage(char *argv[]) 192caf44df2SPekka Enberg { 193caf44df2SPekka Enberg fprintf(stderr, " usage: %s <kernel-image>\n", argv[0]); 194caf44df2SPekka Enberg exit(1); 195caf44df2SPekka Enberg } 196caf44df2SPekka Enberg 1974076b041SPekka Enberg int main(int argc, char *argv[]) 1984076b041SPekka Enberg { 199caf44df2SPekka Enberg const char *kernel_filename; 2004076b041SPekka Enberg struct kvm *kvm; 2014076b041SPekka Enberg int ret; 2024076b041SPekka Enberg 203caf44df2SPekka Enberg if (argc < 2) 204caf44df2SPekka Enberg usage(argv); 205caf44df2SPekka Enberg 206caf44df2SPekka Enberg kernel_filename = argv[1]; 207caf44df2SPekka Enberg 2084076b041SPekka Enberg kvm = kvm__init(); 2094076b041SPekka Enberg 210caf44df2SPekka Enberg kvm__load_kernel(kvm, kernel_filename); 211b8f6afcdSPekka Enberg 2122b0e3342SPekka Enberg kvm__run(kvm); 2132b0e3342SPekka Enberg 2141f9cff23SPekka Enberg fprintf(stderr, "KVM exit reason: %" PRIu32 " (\"%s\")\n", 2151f9cff23SPekka Enberg kvm->kvm_run->exit_reason, exit_reasons[kvm->kvm_run->exit_reason]); 2161f9cff23SPekka Enberg 217b8f6afcdSPekka Enberg return 0; 218b8f6afcdSPekka Enberg } 219