1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27#include <linux/kvm_host.h>
28#include <linux/slab.h>
29#include <linux/srcu.h>
30#include <linux/export.h>
31#include <trace/events/kvm.h>
32#include "irq.h"
33
34int kvm_irq_map_gsi(struct kvm *kvm,
35 struct kvm_kernel_irq_routing_entry *entries, int gsi)
36{
37 struct kvm_irq_routing_table *irq_rt;
38 struct kvm_kernel_irq_routing_entry *e;
39 int n = 0;
40
41 irq_rt = srcu_dereference_check(kvm->irq_routing, &kvm->irq_srcu,
42 lockdep_is_held(&kvm->irq_lock));
43 if (gsi < irq_rt->nr_rt_entries) {
44 hlist_for_each_entry(e, &irq_rt->map[gsi], link) {
45 entries[n] = *e;
46 ++n;
47 }
48 }
49
50 return n;
51}
52
53int kvm_irq_map_chip_pin(struct kvm *kvm, unsigned irqchip, unsigned pin)
54{
55 struct kvm_irq_routing_table *irq_rt;
56
57 irq_rt = srcu_dereference(kvm->irq_routing, &kvm->irq_srcu);
58 return irq_rt->chip[irqchip][pin];
59}
60
61int kvm_send_userspace_msi(struct kvm *kvm, struct kvm_msi *msi)
62{
63 struct kvm_kernel_irq_routing_entry route;
64
65 if (!irqchip_in_kernel(kvm) || msi->flags != 0)
66 return -EINVAL;
67
68 route.msi.address_lo = msi->address_lo;
69 route.msi.address_hi = msi->address_hi;
70 route.msi.data = msi->data;
71
72 return kvm_set_msi(&route, kvm, KVM_USERSPACE_IRQ_SOURCE_ID, 1, false);
73}
74
75
76
77
78
79
80
81int kvm_set_irq(struct kvm *kvm, int irq_source_id, u32 irq, int level,
82 bool line_status)
83{
84 struct kvm_kernel_irq_routing_entry irq_set[KVM_NR_IRQCHIPS];
85 int ret = -1, i, idx;
86
87 trace_kvm_set_irq(irq, level, irq_source_id);
88
89
90
91
92
93 idx = srcu_read_lock(&kvm->irq_srcu);
94 i = kvm_irq_map_gsi(kvm, irq_set, irq);
95 srcu_read_unlock(&kvm->irq_srcu, idx);
96
97 while (i--) {
98 int r;
99 r = irq_set[i].set(&irq_set[i], kvm, irq_source_id, level,
100 line_status);
101 if (r < 0)
102 continue;
103
104 ret = r + ((ret < 0) ? 0 : ret);
105 }
106
107 return ret;
108}
109
110static void free_irq_routing_table(struct kvm_irq_routing_table *rt)
111{
112 int i;
113
114 if (!rt)
115 return;
116
117 for (i = 0; i < rt->nr_rt_entries; ++i) {
118 struct kvm_kernel_irq_routing_entry *e;
119 struct hlist_node *n;
120
121 hlist_for_each_entry_safe(e, n, &rt->map[i], link) {
122 hlist_del(&e->link);
123 kfree(e);
124 }
125 }
126
127 kfree(rt);
128}
129
130void kvm_free_irq_routing(struct kvm *kvm)
131{
132
133
134 struct kvm_irq_routing_table *rt = rcu_access_pointer(kvm->irq_routing);
135 free_irq_routing_table(rt);
136}
137
138static int setup_routing_entry(struct kvm_irq_routing_table *rt,
139 struct kvm_kernel_irq_routing_entry *e,
140 const struct kvm_irq_routing_entry *ue)
141{
142 int r = -EINVAL;
143 struct kvm_kernel_irq_routing_entry *ei;
144
145
146
147
148
149 hlist_for_each_entry(ei, &rt->map[ue->gsi], link)
150 if (ei->type != KVM_IRQ_ROUTING_IRQCHIP ||
151 ue->type != KVM_IRQ_ROUTING_IRQCHIP ||
152 ue->u.irqchip.irqchip == ei->irqchip.irqchip)
153 return r;
154
155 e->gsi = ue->gsi;
156 e->type = ue->type;
157 r = kvm_set_routing_entry(e, ue);
158 if (r)
159 goto out;
160 if (e->type == KVM_IRQ_ROUTING_IRQCHIP)
161 rt->chip[e->irqchip.irqchip][e->irqchip.pin] = e->gsi;
162
163 hlist_add_head(&e->link, &rt->map[e->gsi]);
164 r = 0;
165out:
166 return r;
167}
168
169int kvm_set_irq_routing(struct kvm *kvm,
170 const struct kvm_irq_routing_entry *ue,
171 unsigned nr,
172 unsigned flags)
173{
174 struct kvm_irq_routing_table *new, *old;
175 u32 i, j, nr_rt_entries = 0;
176 int r;
177
178 for (i = 0; i < nr; ++i) {
179 if (ue[i].gsi >= KVM_MAX_IRQ_ROUTES)
180 return -EINVAL;
181 nr_rt_entries = max(nr_rt_entries, ue[i].gsi);
182 }
183
184 nr_rt_entries += 1;
185
186 new = kzalloc(sizeof(*new) + (nr_rt_entries * sizeof(struct hlist_head)),
187 GFP_KERNEL);
188
189 if (!new)
190 return -ENOMEM;
191
192 new->nr_rt_entries = nr_rt_entries;
193 for (i = 0; i < KVM_NR_IRQCHIPS; i++)
194 for (j = 0; j < KVM_IRQCHIP_NUM_PINS; j++)
195 new->chip[i][j] = -1;
196
197 for (i = 0; i < nr; ++i) {
198 struct kvm_kernel_irq_routing_entry *e;
199
200 r = -ENOMEM;
201 e = kzalloc(sizeof(*e), GFP_KERNEL);
202 if (!e)
203 goto out;
204
205 r = -EINVAL;
206 if (ue->flags) {
207 kfree(e);
208 goto out;
209 }
210 r = setup_routing_entry(new, e, ue);
211 if (r) {
212 kfree(e);
213 goto out;
214 }
215 ++ue;
216 }
217
218 mutex_lock(&kvm->irq_lock);
219 old = kvm->irq_routing;
220 rcu_assign_pointer(kvm->irq_routing, new);
221 kvm_irq_routing_update(kvm);
222 mutex_unlock(&kvm->irq_lock);
223
224 kvm_arch_irq_routing_update(kvm);
225
226 synchronize_srcu_expedited(&kvm->irq_srcu);
227
228 new = old;
229 r = 0;
230
231out:
232 free_irq_routing_table(new);
233
234 return r;
235}
236