Commit | Line | Data |
---|---|---|
3de42dc0 XZ |
1 | /* |
2 | * irq_comm.c: Common API for in kernel interrupt controller | |
3 | * Copyright (c) 2007, Intel Corporation. | |
4 | * | |
5 | * This program is free software; you can redistribute it and/or modify it | |
6 | * under the terms and conditions of the GNU General Public License, | |
7 | * version 2, as published by the Free Software Foundation. | |
8 | * | |
9 | * This program is distributed in the hope it will be useful, but WITHOUT | |
10 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or | |
11 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for | |
12 | * more details. | |
13 | * | |
14 | * You should have received a copy of the GNU General Public License along with | |
15 | * this program; if not, write to the Free Software Foundation, Inc., 59 Temple | |
16 | * Place - Suite 330, Boston, MA 02111-1307 USA. | |
17 | * Authors: | |
18 | * Yaozu (Eddie) Dong <Eddie.dong@intel.com> | |
19 | * | |
9611c187 | 20 | * Copyright 2010 Red Hat, Inc. and/or its affiliates. |
3de42dc0 XZ |
21 | */ |
22 | ||
23 | #include <linux/kvm_host.h> | |
5a0e3ad6 | 24 | #include <linux/slab.h> |
c7c9c56c | 25 | #include <linux/export.h> |
229456fc | 26 | #include <trace/events/kvm.h> |
79950e10 | 27 | |
79950e10 | 28 | #include <asm/msidef.h> |
79950e10 | 29 | |
3de42dc0 XZ |
30 | #include "irq.h" |
31 | ||
32 | #include "ioapic.h" | |
33 | ||
d1ebdbf9 JS |
34 | #include "lapic.h" |
35 | ||
5c919412 | 36 | #include "hyperv.h" |
52004014 | 37 | #include "x86.h" |
5c919412 | 38 | |
4925663a | 39 | static int kvm_set_pic_irq(struct kvm_kernel_irq_routing_entry *e, |
aa2fbe6d YZ |
40 | struct kvm *kvm, int irq_source_id, int level, |
41 | bool line_status) | |
399ec807 | 42 | { |
1a6e4a8c | 43 | struct kvm_pic *pic = pic_irqchip(kvm); |
1a577b72 | 44 | return kvm_pic_set_irq(pic, e->irqchip.pin, irq_source_id, level); |
399ec807 AK |
45 | } |
46 | ||
4925663a | 47 | static int kvm_set_ioapic_irq(struct kvm_kernel_irq_routing_entry *e, |
aa2fbe6d YZ |
48 | struct kvm *kvm, int irq_source_id, int level, |
49 | bool line_status) | |
399ec807 | 50 | { |
1a6e4a8c | 51 | struct kvm_ioapic *ioapic = kvm->arch.vioapic; |
aa2fbe6d YZ |
52 | return kvm_ioapic_set_irq(ioapic, e->irqchip.pin, irq_source_id, level, |
53 | line_status); | |
399ec807 AK |
54 | } |
55 | ||
58c2dde1 | 56 | int kvm_irq_delivery_to_apic(struct kvm *kvm, struct kvm_lapic *src, |
9e4aabe2 | 57 | struct kvm_lapic_irq *irq, struct dest_map *dest_map) |
58c2dde1 GN |
58 | { |
59 | int i, r = -1; | |
60 | struct kvm_vcpu *vcpu, *lowest = NULL; | |
52004014 FW |
61 | unsigned long dest_vcpu_bitmap[BITS_TO_LONGS(KVM_MAX_VCPUS)]; |
62 | unsigned int dest_vcpus = 0; | |
58c2dde1 GN |
63 | |
64 | if (irq->dest_mode == 0 && irq->dest_id == 0xff && | |
d1ebdbf9 | 65 | kvm_lowest_prio_delivery(irq)) { |
343f94fe | 66 | printk(KERN_INFO "kvm: apic: phys broadcast and lowest prio\n"); |
1e08ec4a GN |
67 | irq->delivery_mode = APIC_DM_FIXED; |
68 | } | |
69 | ||
b4f2225c | 70 | if (kvm_irq_delivery_to_apic_fast(kvm, src, irq, &r, dest_map)) |
1e08ec4a | 71 | return r; |
343f94fe | 72 | |
52004014 FW |
73 | memset(dest_vcpu_bitmap, 0, sizeof(dest_vcpu_bitmap)); |
74 | ||
988a2cae GN |
75 | kvm_for_each_vcpu(i, vcpu, kvm) { |
76 | if (!kvm_apic_present(vcpu)) | |
343f94fe GN |
77 | continue; |
78 | ||
58c2dde1 GN |
79 | if (!kvm_apic_match_dest(vcpu, src, irq->shorthand, |
80 | irq->dest_id, irq->dest_mode)) | |
343f94fe GN |
81 | continue; |
82 | ||
d1ebdbf9 | 83 | if (!kvm_lowest_prio_delivery(irq)) { |
58c2dde1 GN |
84 | if (r < 0) |
85 | r = 0; | |
b4f2225c | 86 | r += kvm_apic_set_irq(vcpu, irq, dest_map); |
aefd18f0 | 87 | } else if (kvm_lapic_enabled(vcpu)) { |
52004014 FW |
88 | if (!kvm_vector_hashing_enabled()) { |
89 | if (!lowest) | |
90 | lowest = vcpu; | |
91 | else if (kvm_apic_compare_prio(vcpu, lowest) < 0) | |
92 | lowest = vcpu; | |
93 | } else { | |
94 | __set_bit(i, dest_vcpu_bitmap); | |
95 | dest_vcpus++; | |
96 | } | |
e1035715 | 97 | } |
343f94fe GN |
98 | } |
99 | ||
52004014 FW |
100 | if (dest_vcpus != 0) { |
101 | int idx = kvm_vector_to_index(irq->vector, dest_vcpus, | |
102 | dest_vcpu_bitmap, KVM_MAX_VCPUS); | |
103 | ||
104 | lowest = kvm_get_vcpu(kvm, idx); | |
105 | } | |
106 | ||
58c2dde1 | 107 | if (lowest) |
b4f2225c | 108 | r = kvm_apic_set_irq(lowest, irq, dest_map); |
58c2dde1 GN |
109 | |
110 | return r; | |
116191b6 SY |
111 | } |
112 | ||
d84f1e07 FW |
113 | void kvm_set_msi_irq(struct kvm_kernel_irq_routing_entry *e, |
114 | struct kvm_lapic_irq *irq) | |
01f21880 MT |
115 | { |
116 | trace_kvm_msi_set_irq(e->msi.address_lo, e->msi.data); | |
117 | ||
118 | irq->dest_id = (e->msi.address_lo & | |
119 | MSI_ADDR_DEST_ID_MASK) >> MSI_ADDR_DEST_ID_SHIFT; | |
120 | irq->vector = (e->msi.data & | |
121 | MSI_DATA_VECTOR_MASK) >> MSI_DATA_VECTOR_SHIFT; | |
122 | irq->dest_mode = (1 << MSI_ADDR_DEST_MODE_SHIFT) & e->msi.address_lo; | |
123 | irq->trig_mode = (1 << MSI_DATA_TRIGGER_SHIFT) & e->msi.data; | |
124 | irq->delivery_mode = e->msi.data & 0x700; | |
93bbf0b8 JS |
125 | irq->msi_redir_hint = ((e->msi.address_lo |
126 | & MSI_ADDR_REDIRECTION_LOWPRI) > 0); | |
01f21880 MT |
127 | irq->level = 1; |
128 | irq->shorthand = 0; | |
01f21880 | 129 | } |
d84f1e07 | 130 | EXPORT_SYMBOL_GPL(kvm_set_msi_irq); |
01f21880 | 131 | |
bd2b53b2 | 132 | int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e, |
aa2fbe6d | 133 | struct kvm *kvm, int irq_source_id, int level, bool line_status) |
79950e10 | 134 | { |
58c2dde1 | 135 | struct kvm_lapic_irq irq; |
79950e10 | 136 | |
1a6e4a8c GN |
137 | if (!level) |
138 | return -1; | |
139 | ||
01f21880 | 140 | kvm_set_msi_irq(e, &irq); |
116191b6 | 141 | |
b4f2225c | 142 | return kvm_irq_delivery_to_apic(kvm, NULL, &irq, NULL); |
79950e10 SY |
143 | } |
144 | ||
01f21880 | 145 | |
b97e6de9 PB |
146 | int kvm_arch_set_irq_inatomic(struct kvm_kernel_irq_routing_entry *e, |
147 | struct kvm *kvm, int irq_source_id, int level, | |
148 | bool line_status) | |
01f21880 MT |
149 | { |
150 | struct kvm_lapic_irq irq; | |
151 | int r; | |
152 | ||
b97e6de9 PB |
153 | if (unlikely(e->type != KVM_IRQ_ROUTING_MSI)) |
154 | return -EWOULDBLOCK; | |
155 | ||
01f21880 MT |
156 | kvm_set_msi_irq(e, &irq); |
157 | ||
b4f2225c | 158 | if (kvm_irq_delivery_to_apic_fast(kvm, NULL, &irq, &r, NULL)) |
01f21880 MT |
159 | return r; |
160 | else | |
161 | return -EWOULDBLOCK; | |
162 | } | |
163 | ||
5550af4d SY |
164 | int kvm_request_irq_source_id(struct kvm *kvm) |
165 | { | |
166 | unsigned long *bitmap = &kvm->arch.irq_sources_bitmap; | |
fa40a821 MT |
167 | int irq_source_id; |
168 | ||
169 | mutex_lock(&kvm->irq_lock); | |
cd5a2685 | 170 | irq_source_id = find_first_zero_bit(bitmap, BITS_PER_LONG); |
61552367 | 171 | |
cd5a2685 | 172 | if (irq_source_id >= BITS_PER_LONG) { |
5550af4d | 173 | printk(KERN_WARNING "kvm: exhaust allocatable IRQ sources!\n"); |
0c6ddceb JS |
174 | irq_source_id = -EFAULT; |
175 | goto unlock; | |
61552367 MM |
176 | } |
177 | ||
178 | ASSERT(irq_source_id != KVM_USERSPACE_IRQ_SOURCE_ID); | |
7a84428a | 179 | ASSERT(irq_source_id != KVM_IRQFD_RESAMPLE_IRQ_SOURCE_ID); |
61552367 | 180 | set_bit(irq_source_id, bitmap); |
0c6ddceb | 181 | unlock: |
fa40a821 | 182 | mutex_unlock(&kvm->irq_lock); |
61552367 | 183 | |
5550af4d SY |
184 | return irq_source_id; |
185 | } | |
186 | ||
187 | void kvm_free_irq_source_id(struct kvm *kvm, int irq_source_id) | |
188 | { | |
61552367 | 189 | ASSERT(irq_source_id != KVM_USERSPACE_IRQ_SOURCE_ID); |
7a84428a | 190 | ASSERT(irq_source_id != KVM_IRQFD_RESAMPLE_IRQ_SOURCE_ID); |
61552367 | 191 | |
fa40a821 | 192 | mutex_lock(&kvm->irq_lock); |
61552367 | 193 | if (irq_source_id < 0 || |
cd5a2685 | 194 | irq_source_id >= BITS_PER_LONG) { |
5550af4d | 195 | printk(KERN_ERR "kvm: IRQ source ID out of range!\n"); |
0c6ddceb | 196 | goto unlock; |
5550af4d | 197 | } |
e50212bb | 198 | clear_bit(irq_source_id, &kvm->arch.irq_sources_bitmap); |
49df6397 | 199 | if (!ioapic_in_kernel(kvm)) |
e50212bb MT |
200 | goto unlock; |
201 | ||
1a577b72 | 202 | kvm_ioapic_clear_all(kvm->arch.vioapic, irq_source_id); |
1a577b72 | 203 | kvm_pic_clear_all(pic_irqchip(kvm), irq_source_id); |
0c6ddceb | 204 | unlock: |
fa40a821 | 205 | mutex_unlock(&kvm->irq_lock); |
5550af4d | 206 | } |
75858a84 AK |
207 | |
208 | void kvm_register_irq_mask_notifier(struct kvm *kvm, int irq, | |
209 | struct kvm_irq_mask_notifier *kimn) | |
210 | { | |
fa40a821 | 211 | mutex_lock(&kvm->irq_lock); |
75858a84 | 212 | kimn->irq = irq; |
6ef768fa | 213 | hlist_add_head_rcu(&kimn->link, &kvm->arch.mask_notifier_list); |
fa40a821 | 214 | mutex_unlock(&kvm->irq_lock); |
75858a84 AK |
215 | } |
216 | ||
217 | void kvm_unregister_irq_mask_notifier(struct kvm *kvm, int irq, | |
218 | struct kvm_irq_mask_notifier *kimn) | |
219 | { | |
fa40a821 | 220 | mutex_lock(&kvm->irq_lock); |
280aa177 | 221 | hlist_del_rcu(&kimn->link); |
fa40a821 | 222 | mutex_unlock(&kvm->irq_lock); |
719d93cd | 223 | synchronize_srcu(&kvm->irq_srcu); |
75858a84 AK |
224 | } |
225 | ||
4a994358 GN |
226 | void kvm_fire_mask_notifiers(struct kvm *kvm, unsigned irqchip, unsigned pin, |
227 | bool mask) | |
75858a84 AK |
228 | { |
229 | struct kvm_irq_mask_notifier *kimn; | |
719d93cd | 230 | int idx, gsi; |
75858a84 | 231 | |
719d93cd | 232 | idx = srcu_read_lock(&kvm->irq_srcu); |
9957c86d | 233 | gsi = kvm_irq_map_chip_pin(kvm, irqchip, pin); |
4a994358 | 234 | if (gsi != -1) |
6ef768fa | 235 | hlist_for_each_entry_rcu(kimn, &kvm->arch.mask_notifier_list, link) |
4a994358 GN |
236 | if (kimn->irq == gsi) |
237 | kimn->func(kimn, mask); | |
719d93cd | 238 | srcu_read_unlock(&kvm->irq_srcu, idx); |
75858a84 AK |
239 | } |
240 | ||
5c919412 AS |
241 | static int kvm_hv_set_sint(struct kvm_kernel_irq_routing_entry *e, |
242 | struct kvm *kvm, int irq_source_id, int level, | |
243 | bool line_status) | |
244 | { | |
245 | if (!level) | |
246 | return -1; | |
247 | ||
248 | return kvm_hv_synic_set_irq(kvm, e->hv_sint.vcpu, e->hv_sint.sint); | |
249 | } | |
250 | ||
8ba918d4 | 251 | int kvm_set_routing_entry(struct kvm_kernel_irq_routing_entry *e, |
e8cde093 | 252 | const struct kvm_irq_routing_entry *ue) |
399ec807 AK |
253 | { |
254 | int r = -EINVAL; | |
255 | int delta; | |
d72118ce | 256 | unsigned max_pin; |
46e624b9 | 257 | |
399ec807 AK |
258 | switch (ue->type) { |
259 | case KVM_IRQ_ROUTING_IRQCHIP: | |
260 | delta = 0; | |
261 | switch (ue->u.irqchip.irqchip) { | |
262 | case KVM_IRQCHIP_PIC_MASTER: | |
263 | e->set = kvm_set_pic_irq; | |
93b6547e | 264 | max_pin = PIC_NUM_PINS; |
399ec807 AK |
265 | break; |
266 | case KVM_IRQCHIP_PIC_SLAVE: | |
4925663a | 267 | e->set = kvm_set_pic_irq; |
93b6547e | 268 | max_pin = PIC_NUM_PINS; |
399ec807 AK |
269 | delta = 8; |
270 | break; | |
271 | case KVM_IRQCHIP_IOAPIC: | |
d72118ce | 272 | max_pin = KVM_IOAPIC_NUM_PINS; |
efbc100c | 273 | e->set = kvm_set_ioapic_irq; |
399ec807 AK |
274 | break; |
275 | default: | |
276 | goto out; | |
277 | } | |
278 | e->irqchip.irqchip = ue->u.irqchip.irqchip; | |
279 | e->irqchip.pin = ue->u.irqchip.pin + delta; | |
d72118ce | 280 | if (e->irqchip.pin >= max_pin) |
3e71f88b | 281 | goto out; |
399ec807 | 282 | break; |
79950e10 SY |
283 | case KVM_IRQ_ROUTING_MSI: |
284 | e->set = kvm_set_msi; | |
285 | e->msi.address_lo = ue->u.msi.address_lo; | |
286 | e->msi.address_hi = ue->u.msi.address_hi; | |
287 | e->msi.data = ue->u.msi.data; | |
288 | break; | |
5c919412 AS |
289 | case KVM_IRQ_ROUTING_HV_SINT: |
290 | e->set = kvm_hv_set_sint; | |
291 | e->hv_sint.vcpu = ue->u.hv_sint.vcpu; | |
292 | e->hv_sint.sint = ue->u.hv_sint.sint; | |
293 | break; | |
399ec807 AK |
294 | default: |
295 | goto out; | |
296 | } | |
46e624b9 | 297 | |
399ec807 AK |
298 | r = 0; |
299 | out: | |
300 | return r; | |
301 | } | |
302 | ||
8feb4a04 FW |
303 | bool kvm_intr_is_single_vcpu(struct kvm *kvm, struct kvm_lapic_irq *irq, |
304 | struct kvm_vcpu **dest_vcpu) | |
305 | { | |
306 | int i, r = 0; | |
307 | struct kvm_vcpu *vcpu; | |
308 | ||
309 | if (kvm_intr_is_single_vcpu_fast(kvm, irq, dest_vcpu)) | |
310 | return true; | |
311 | ||
312 | kvm_for_each_vcpu(i, vcpu, kvm) { | |
313 | if (!kvm_apic_present(vcpu)) | |
314 | continue; | |
315 | ||
316 | if (!kvm_apic_match_dest(vcpu, NULL, irq->shorthand, | |
317 | irq->dest_id, irq->dest_mode)) | |
318 | continue; | |
319 | ||
320 | if (++r == 2) | |
321 | return false; | |
322 | ||
323 | *dest_vcpu = vcpu; | |
324 | } | |
325 | ||
326 | return r == 1; | |
327 | } | |
328 | EXPORT_SYMBOL_GPL(kvm_intr_is_single_vcpu); | |
329 | ||
399ec807 AK |
330 | #define IOAPIC_ROUTING_ENTRY(irq) \ |
331 | { .gsi = irq, .type = KVM_IRQ_ROUTING_IRQCHIP, \ | |
25f97ff4 | 332 | .u.irqchip = { .irqchip = KVM_IRQCHIP_IOAPIC, .pin = (irq) } } |
399ec807 AK |
333 | #define ROUTING_ENTRY1(irq) IOAPIC_ROUTING_ENTRY(irq) |
334 | ||
3bf58e9a | 335 | #define PIC_ROUTING_ENTRY(irq) \ |
399ec807 | 336 | { .gsi = irq, .type = KVM_IRQ_ROUTING_IRQCHIP, \ |
25f97ff4 | 337 | .u.irqchip = { .irqchip = SELECT_PIC(irq), .pin = (irq) % 8 } } |
3bf58e9a | 338 | #define ROUTING_ENTRY2(irq) \ |
399ec807 | 339 | IOAPIC_ROUTING_ENTRY(irq), PIC_ROUTING_ENTRY(irq) |
399ec807 AK |
340 | |
341 | static const struct kvm_irq_routing_entry default_routing[] = { | |
342 | ROUTING_ENTRY2(0), ROUTING_ENTRY2(1), | |
343 | ROUTING_ENTRY2(2), ROUTING_ENTRY2(3), | |
344 | ROUTING_ENTRY2(4), ROUTING_ENTRY2(5), | |
345 | ROUTING_ENTRY2(6), ROUTING_ENTRY2(7), | |
346 | ROUTING_ENTRY2(8), ROUTING_ENTRY2(9), | |
347 | ROUTING_ENTRY2(10), ROUTING_ENTRY2(11), | |
348 | ROUTING_ENTRY2(12), ROUTING_ENTRY2(13), | |
349 | ROUTING_ENTRY2(14), ROUTING_ENTRY2(15), | |
350 | ROUTING_ENTRY1(16), ROUTING_ENTRY1(17), | |
351 | ROUTING_ENTRY1(18), ROUTING_ENTRY1(19), | |
352 | ROUTING_ENTRY1(20), ROUTING_ENTRY1(21), | |
353 | ROUTING_ENTRY1(22), ROUTING_ENTRY1(23), | |
399ec807 AK |
354 | }; |
355 | ||
356 | int kvm_setup_default_irq_routing(struct kvm *kvm) | |
357 | { | |
358 | return kvm_set_irq_routing(kvm, default_routing, | |
359 | ARRAY_SIZE(default_routing), 0); | |
360 | } | |
49df6397 SR |
361 | |
362 | static const struct kvm_irq_routing_entry empty_routing[] = {}; | |
363 | ||
364 | int kvm_setup_empty_irq_routing(struct kvm *kvm) | |
365 | { | |
366 | return kvm_set_irq_routing(kvm, empty_routing, 0, 0); | |
367 | } | |
b053b2ae | 368 | |
abdb080f | 369 | void kvm_arch_post_irq_routing_update(struct kvm *kvm) |
b053b2ae SR |
370 | { |
371 | if (ioapic_in_kernel(kvm) || !irqchip_in_kernel(kvm)) | |
372 | return; | |
373 | kvm_make_scan_ioapic_request(kvm); | |
374 | } | |
375 | ||
6308630b AS |
376 | void kvm_scan_ioapic_routes(struct kvm_vcpu *vcpu, |
377 | ulong *ioapic_handled_vectors) | |
b053b2ae SR |
378 | { |
379 | struct kvm *kvm = vcpu->kvm; | |
380 | struct kvm_kernel_irq_routing_entry *entry; | |
381 | struct kvm_irq_routing_table *table; | |
382 | u32 i, nr_ioapic_pins; | |
383 | int idx; | |
384 | ||
b053b2ae SR |
385 | idx = srcu_read_lock(&kvm->irq_srcu); |
386 | table = srcu_dereference(kvm->irq_routing, &kvm->irq_srcu); | |
387 | nr_ioapic_pins = min_t(u32, table->nr_rt_entries, | |
388 | kvm->arch.nr_reserved_ioapic_pins); | |
389 | for (i = 0; i < nr_ioapic_pins; ++i) { | |
390 | hlist_for_each_entry(entry, &table->map[i], link) { | |
391 | u32 dest_id, dest_mode; | |
13db7734 | 392 | bool level; |
b053b2ae SR |
393 | |
394 | if (entry->type != KVM_IRQ_ROUTING_MSI) | |
395 | continue; | |
396 | dest_id = (entry->msi.address_lo >> 12) & 0xff; | |
397 | dest_mode = (entry->msi.address_lo >> 2) & 0x1; | |
13db7734 RK |
398 | level = entry->msi.data & MSI_DATA_TRIGGER_LEVEL; |
399 | if (level && kvm_apic_match_dest(vcpu, NULL, 0, | |
400 | dest_id, dest_mode)) { | |
b053b2ae SR |
401 | u32 vector = entry->msi.data & 0xff; |
402 | ||
403 | __set_bit(vector, | |
6308630b | 404 | ioapic_handled_vectors); |
b053b2ae SR |
405 | } |
406 | } | |
407 | } | |
408 | srcu_read_unlock(&kvm->irq_srcu, idx); | |
409 | } | |
5c919412 AS |
410 | |
411 | int kvm_arch_set_irq(struct kvm_kernel_irq_routing_entry *irq, struct kvm *kvm, | |
412 | int irq_source_id, int level, bool line_status) | |
413 | { | |
414 | switch (irq->type) { | |
415 | case KVM_IRQ_ROUTING_HV_SINT: | |
416 | return kvm_hv_set_sint(irq, kvm, irq_source_id, level, | |
417 | line_status); | |
418 | default: | |
419 | return -EWOULDBLOCK; | |
420 | } | |
421 | } | |
422 | ||
423 | void kvm_arch_irq_routing_update(struct kvm *kvm) | |
424 | { | |
425 | kvm_hv_irq_routing_update(kvm); | |
426 | } |