1
2
3
4
5
6#include <linux/kvm.h>
7#include <linux/kvm_host.h>
8#include <trace/events/kvm.h>
9#include <kvm/arm_vgic.h>
10#include "vgic.h"
11
12
13
14
15
16
17
18static int vgic_irqfd_set_irq(struct kvm_kernel_irq_routing_entry *e,
19 struct kvm *kvm, int irq_source_id,
20 int level, bool line_status)
21{
22 unsigned int spi_id = e->irqchip.pin + VGIC_NR_PRIVATE_IRQS;
23
24 if (!vgic_valid_spi(kvm, spi_id))
25 return -EINVAL;
26 return kvm_vgic_inject_irq(kvm, 0, spi_id, level, NULL);
27}
28
29
30
31
32
33
34
35
36
37
38int kvm_set_routing_entry(struct kvm *kvm,
39 struct kvm_kernel_irq_routing_entry *e,
40 const struct kvm_irq_routing_entry *ue)
41{
42 int r = -EINVAL;
43
44 switch (ue->type) {
45 case KVM_IRQ_ROUTING_IRQCHIP:
46 e->set = vgic_irqfd_set_irq;
47 e->irqchip.irqchip = ue->u.irqchip.irqchip;
48 e->irqchip.pin = ue->u.irqchip.pin;
49 if ((e->irqchip.pin >= KVM_IRQCHIP_NUM_PINS) ||
50 (e->irqchip.irqchip >= KVM_NR_IRQCHIPS))
51 goto out;
52 break;
53 case KVM_IRQ_ROUTING_MSI:
54 e->set = kvm_set_msi;
55 e->msi.address_lo = ue->u.msi.address_lo;
56 e->msi.address_hi = ue->u.msi.address_hi;
57 e->msi.data = ue->u.msi.data;
58 e->msi.flags = ue->flags;
59 e->msi.devid = ue->u.msi.devid;
60 break;
61 default:
62 goto out;
63 }
64 r = 0;
65out:
66 return r;
67}
68
69
70
71
72
73
74
75
76int kvm_set_msi(struct kvm_kernel_irq_routing_entry *e,
77 struct kvm *kvm, int irq_source_id,
78 int level, bool line_status)
79{
80 struct kvm_msi msi;
81
82 msi.address_lo = e->msi.address_lo;
83 msi.address_hi = e->msi.address_hi;
84 msi.data = e->msi.data;
85 msi.flags = e->msi.flags;
86 msi.devid = e->msi.devid;
87
88 if (!vgic_has_its(kvm))
89 return -ENODEV;
90
91 if (!level)
92 return -1;
93
94 return vgic_its_inject_msi(kvm, &msi);
95}
96
97int kvm_vgic_setup_default_irq_routing(struct kvm *kvm)
98{
99 struct kvm_irq_routing_entry *entries;
100 struct vgic_dist *dist = &kvm->arch.vgic;
101 u32 nr = dist->nr_spis;
102 int i, ret;
103
104 entries = kcalloc(nr, sizeof(*entries), GFP_KERNEL);
105 if (!entries)
106 return -ENOMEM;
107
108 for (i = 0; i < nr; i++) {
109 entries[i].gsi = i;
110 entries[i].type = KVM_IRQ_ROUTING_IRQCHIP;
111 entries[i].u.irqchip.irqchip = 0;
112 entries[i].u.irqchip.pin = i;
113 }
114 ret = kvm_set_irq_routing(kvm, entries, nr, 0);
115 kfree(entries);
116 return ret;
117}
118