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 kvm_cpu__select_features(kvm, &vcpu_init); 72 73 /* 74 * If the preferred target ioctl is successful then 75 * use preferred target else try each and every target type 76 */ 77 err = ioctl(kvm->vm_fd, KVM_ARM_PREFERRED_TARGET, &preferred_init); 78 if (!err) { 79 /* Match preferred target CPU type. */ 80 target = NULL; 81 for (i = 0; i < ARRAY_SIZE(kvm_arm_targets); ++i) { 82 if (!kvm_arm_targets[i]) 83 continue; 84 if (kvm_arm_targets[i]->id == preferred_init.target) { 85 target = kvm_arm_targets[i]; 86 break; 87 } 88 } 89 if (!target) { 90 target = kvm_arm_generic_target; 91 vcpu_init.target = preferred_init.target; 92 } else { 93 vcpu_init.target = target->id; 94 } 95 err = ioctl(vcpu->vcpu_fd, KVM_ARM_VCPU_INIT, &vcpu_init); 96 } else { 97 /* Find an appropriate target CPU type. */ 98 for (i = 0; i < ARRAY_SIZE(kvm_arm_targets); ++i) { 99 if (!kvm_arm_targets[i]) 100 continue; 101 target = kvm_arm_targets[i]; 102 vcpu_init.target = target->id; 103 err = ioctl(vcpu->vcpu_fd, KVM_ARM_VCPU_INIT, &vcpu_init); 104 if (!err) 105 break; 106 } 107 if (err) 108 die("Unable to find matching target"); 109 } 110 111 if (err || target->init(vcpu)) 112 die("Unable to initialise vcpu"); 113 114 coalesced_offset = ioctl(kvm->sys_fd, KVM_CHECK_EXTENSION, 115 KVM_CAP_COALESCED_MMIO); 116 if (coalesced_offset) 117 vcpu->ring = (void *)vcpu->kvm_run + 118 (coalesced_offset * PAGE_SIZE); 119 120 /* Populate the vcpu structure. */ 121 vcpu->kvm = kvm; 122 vcpu->cpu_id = cpu_id; 123 vcpu->cpu_type = vcpu_init.target; 124 vcpu->cpu_compatible = target->compatible; 125 vcpu->is_running = true; 126 127 if (kvm_cpu__configure_features(vcpu)) 128 die("Unable to configure requested vcpu features"); 129 130 return vcpu; 131 } 132 133 void kvm_cpu__arch_nmi(struct kvm_cpu *cpu) 134 { 135 } 136 137 void kvm_cpu__delete(struct kvm_cpu *vcpu) 138 { 139 free(vcpu); 140 } 141 142 bool kvm_cpu__handle_exit(struct kvm_cpu *vcpu) 143 { 144 return false; 145 } 146 147 void kvm_cpu__show_page_tables(struct kvm_cpu *vcpu) 148 { 149 } 150