1 #include "kvm/kvm.h" 2 #include "kvm/kvm-cpu.h" 3 4 static int debug_fd; 5 6 void kvm_cpu__set_debug_fd(int fd) 7 { 8 debug_fd = fd; 9 } 10 11 int kvm_cpu__get_debug_fd(void) 12 { 13 return debug_fd; 14 } 15 16 static struct kvm_arm_target *kvm_arm_generic_target; 17 static struct kvm_arm_target *kvm_arm_targets[KVM_ARM_NUM_TARGETS]; 18 19 void kvm_cpu__set_kvm_arm_generic_target(struct kvm_arm_target *target) 20 { 21 kvm_arm_generic_target = target; 22 } 23 24 int kvm_cpu__register_kvm_arm_target(struct kvm_arm_target *target) 25 { 26 unsigned int i = 0; 27 28 for (i = 0; i < ARRAY_SIZE(kvm_arm_targets); ++i) { 29 if (!kvm_arm_targets[i]) { 30 kvm_arm_targets[i] = target; 31 return 0; 32 } 33 } 34 35 return -ENOSPC; 36 } 37 38 struct kvm_cpu *kvm_cpu__arch_init(struct kvm *kvm, unsigned long cpu_id) 39 { 40 struct kvm_arm_target *target; 41 struct kvm_cpu *vcpu; 42 int coalesced_offset, mmap_size, err = -1; 43 unsigned int i; 44 struct kvm_vcpu_init preferred_init; 45 struct kvm_vcpu_init vcpu_init = { 46 .features = ARM_VCPU_FEATURE_FLAGS(kvm, cpu_id) 47 }; 48 49 vcpu = calloc(1, sizeof(struct kvm_cpu)); 50 if (!vcpu) 51 return NULL; 52 53 vcpu->vcpu_fd = ioctl(kvm->vm_fd, KVM_CREATE_VCPU, cpu_id); 54 if (vcpu->vcpu_fd < 0) 55 die_perror("KVM_CREATE_VCPU ioctl"); 56 57 mmap_size = ioctl(kvm->sys_fd, KVM_GET_VCPU_MMAP_SIZE, 0); 58 if (mmap_size < 0) 59 die_perror("KVM_GET_VCPU_MMAP_SIZE ioctl"); 60 61 vcpu->kvm_run = mmap(NULL, mmap_size, PROT_RW, MAP_SHARED, 62 vcpu->vcpu_fd, 0); 63 if (vcpu->kvm_run == MAP_FAILED) 64 die("unable to mmap vcpu fd"); 65 66 /* Set KVM_ARM_VCPU_PSCI_0_2 if available */ 67 if (kvm__supports_extension(kvm, KVM_CAP_ARM_PSCI_0_2)) { 68 vcpu_init.features[0] |= (1UL << KVM_ARM_VCPU_PSCI_0_2); 69 } 70 71 /* 72 * If the preferred target ioctl is successful then 73 * use preferred target else try each and every target type 74 */ 75 err = ioctl(kvm->vm_fd, KVM_ARM_PREFERRED_TARGET, &preferred_init); 76 if (!err) { 77 /* Match preferred target CPU type. */ 78 target = NULL; 79 for (i = 0; i < ARRAY_SIZE(kvm_arm_targets); ++i) { 80 if (!kvm_arm_targets[i]) 81 continue; 82 if (kvm_arm_targets[i]->id == preferred_init.target) { 83 target = kvm_arm_targets[i]; 84 break; 85 } 86 } 87 if (!target) { 88 target = kvm_arm_generic_target; 89 vcpu_init.target = preferred_init.target; 90 } else { 91 vcpu_init.target = target->id; 92 } 93 err = ioctl(vcpu->vcpu_fd, KVM_ARM_VCPU_INIT, &vcpu_init); 94 } else { 95 /* Find an appropriate target CPU type. */ 96 for (i = 0; i < ARRAY_SIZE(kvm_arm_targets); ++i) { 97 if (!kvm_arm_targets[i]) 98 continue; 99 target = kvm_arm_targets[i]; 100 vcpu_init.target = target->id; 101 err = ioctl(vcpu->vcpu_fd, KVM_ARM_VCPU_INIT, &vcpu_init); 102 if (!err) 103 break; 104 } 105 if (err) 106 die("Unable to find matching target"); 107 } 108 109 if (err || target->init(vcpu)) 110 die("Unable to initialise vcpu"); 111 112 coalesced_offset = ioctl(kvm->sys_fd, KVM_CHECK_EXTENSION, 113 KVM_CAP_COALESCED_MMIO); 114 if (coalesced_offset) 115 vcpu->ring = (void *)vcpu->kvm_run + 116 (coalesced_offset * PAGE_SIZE); 117 118 /* Populate the vcpu structure. */ 119 vcpu->kvm = kvm; 120 vcpu->cpu_id = cpu_id; 121 vcpu->cpu_type = vcpu_init.target; 122 vcpu->cpu_compatible = target->compatible; 123 vcpu->is_running = true; 124 125 return vcpu; 126 } 127 128 void kvm_cpu__arch_nmi(struct kvm_cpu *cpu) 129 { 130 } 131 132 void kvm_cpu__delete(struct kvm_cpu *vcpu) 133 { 134 free(vcpu); 135 } 136 137 bool kvm_cpu__handle_exit(struct kvm_cpu *vcpu) 138 { 139 return false; 140 } 141 142 void kvm_cpu__show_page_tables(struct kvm_cpu *vcpu) 143 { 144 } 145