Commit | Line | Data |
---|---|---|
3b20eb23 | 1 | // SPDX-License-Identifier: GPL-2.0-only |
1c9f8520 AG |
2 | /* |
3 | * irqchip.c: Common API for in kernel interrupt controllers | |
4 | * Copyright (c) 2007, Intel Corporation. | |
5 | * Copyright 2010 Red Hat, Inc. and/or its affiliates. | |
6 | * Copyright (c) 2013, Alexander Graf <agraf@suse.de> | |
7 | * | |
1c9f8520 AG |
8 | * This file is derived from virt/kvm/irq_comm.c. |
9 | * | |
10 | * Authors: | |
11 | * Yaozu (Eddie) Dong <Eddie.dong@intel.com> | |
12 | * Alexander Graf <agraf@suse.de> | |
13 | */ | |
14 | ||
15 | #include <linux/kvm_host.h> | |
16 | #include <linux/slab.h> | |
719d93cd | 17 | #include <linux/srcu.h> |
1c9f8520 AG |
18 | #include <linux/export.h> |
19 | #include <trace/events/kvm.h> | |
1c9f8520 | 20 | |
9957c86d PM |
21 | int kvm_irq_map_gsi(struct kvm *kvm, |
22 | struct kvm_kernel_irq_routing_entry *entries, int gsi) | |
8ba918d4 | 23 | { |
9957c86d | 24 | struct kvm_irq_routing_table *irq_rt; |
8ba918d4 PM |
25 | struct kvm_kernel_irq_routing_entry *e; |
26 | int n = 0; | |
27 | ||
9957c86d PM |
28 | irq_rt = srcu_dereference_check(kvm->irq_routing, &kvm->irq_srcu, |
29 | lockdep_is_held(&kvm->irq_lock)); | |
c622a3c2 | 30 | if (irq_rt && gsi < irq_rt->nr_rt_entries) { |
8ba918d4 PM |
31 | hlist_for_each_entry(e, &irq_rt->map[gsi], link) { |
32 | entries[n] = *e; | |
33 | ++n; | |
34 | } | |
35 | } | |
36 | ||
37 | return n; | |
38 | } | |
39 | ||
9957c86d | 40 | int kvm_irq_map_chip_pin(struct kvm *kvm, unsigned irqchip, unsigned pin) |
8ba918d4 | 41 | { |
9957c86d PM |
42 | struct kvm_irq_routing_table *irq_rt; |
43 | ||
44 | irq_rt = srcu_dereference(kvm->irq_routing, &kvm->irq_srcu); | |
8ba918d4 PM |
45 | return irq_rt->chip[irqchip][pin]; |
46 | } | |
47 | ||
1c9f8520 AG |
48 | int kvm_send_userspace_msi(struct kvm *kvm, struct kvm_msi *msi) |
49 | { | |
50 | struct kvm_kernel_irq_routing_entry route; | |
51 | ||
d663b8a2 | 52 | if (!kvm_arch_irqchip_in_kernel(kvm) || (msi->flags & ~KVM_MSI_VALID_DEVID)) |
1c9f8520 AG |
53 | return -EINVAL; |
54 | ||
55 | route.msi.address_lo = msi->address_lo; | |
56 | route.msi.address_hi = msi->address_hi; | |
57 | route.msi.data = msi->data; | |
ebe91525 EA |
58 | route.msi.flags = msi->flags; |
59 | route.msi.devid = msi->devid; | |
1c9f8520 AG |
60 | |
61 | return kvm_set_msi(&route, kvm, KVM_USERSPACE_IRQ_SOURCE_ID, 1, false); | |
62 | } | |
63 | ||
64 | /* | |
65 | * Return value: | |
66 | * < 0 Interrupt was ignored (masked or not delivered for other reasons) | |
67 | * = 0 Interrupt was coalesced (previous irq is still pending) | |
68 | * > 0 Number of CPUs interrupt was delivered to | |
69 | */ | |
70 | int kvm_set_irq(struct kvm *kvm, int irq_source_id, u32 irq, int level, | |
71 | bool line_status) | |
72 | { | |
8ba918d4 PM |
73 | struct kvm_kernel_irq_routing_entry irq_set[KVM_NR_IRQCHIPS]; |
74 | int ret = -1, i, idx; | |
1c9f8520 AG |
75 | |
76 | trace_kvm_set_irq(irq, level, irq_source_id); | |
77 | ||
78 | /* Not possible to detect if the guest uses the PIC or the | |
79 | * IOAPIC. So set the bit in both. The guest will ignore | |
80 | * writes to the unused one. | |
81 | */ | |
719d93cd | 82 | idx = srcu_read_lock(&kvm->irq_srcu); |
9957c86d | 83 | i = kvm_irq_map_gsi(kvm, irq_set, irq); |
719d93cd | 84 | srcu_read_unlock(&kvm->irq_srcu, idx); |
1c9f8520 | 85 | |
ae548c5c | 86 | while (i--) { |
1c9f8520 AG |
87 | int r; |
88 | r = irq_set[i].set(&irq_set[i], kvm, irq_source_id, level, | |
89 | line_status); | |
90 | if (r < 0) | |
91 | continue; | |
92 | ||
93 | ret = r + ((ret < 0) ? 0 : ret); | |
94 | } | |
95 | ||
96 | return ret; | |
97 | } | |
98 | ||
e73f61e4 JR |
99 | static void free_irq_routing_table(struct kvm_irq_routing_table *rt) |
100 | { | |
101 | int i; | |
102 | ||
103 | if (!rt) | |
104 | return; | |
105 | ||
106 | for (i = 0; i < rt->nr_rt_entries; ++i) { | |
107 | struct kvm_kernel_irq_routing_entry *e; | |
108 | struct hlist_node *n; | |
109 | ||
110 | hlist_for_each_entry_safe(e, n, &rt->map[i], link) { | |
111 | hlist_del(&e->link); | |
112 | kfree(e); | |
113 | } | |
114 | } | |
115 | ||
116 | kfree(rt); | |
117 | } | |
118 | ||
1c9f8520 AG |
119 | void kvm_free_irq_routing(struct kvm *kvm) |
120 | { | |
121 | /* Called only during vm destruction. Nobody can use the pointer | |
122 | at this stage */ | |
e73f61e4 JR |
123 | struct kvm_irq_routing_table *rt = rcu_access_pointer(kvm->irq_routing); |
124 | free_irq_routing_table(rt); | |
1c9f8520 | 125 | } |
e8cde093 | 126 | |
c63cf538 RK |
127 | static int setup_routing_entry(struct kvm *kvm, |
128 | struct kvm_irq_routing_table *rt, | |
e8cde093 AG |
129 | struct kvm_kernel_irq_routing_entry *e, |
130 | const struct kvm_irq_routing_entry *ue) | |
131 | { | |
e8cde093 | 132 | struct kvm_kernel_irq_routing_entry *ei; |
8c6b7828 | 133 | int r; |
1d487e9b | 134 | u32 gsi = array_index_nospec(ue->gsi, KVM_MAX_IRQ_ROUTES); |
e8cde093 AG |
135 | |
136 | /* | |
137 | * Do not allow GSI to be mapped to the same irqchip more than once. | |
f33143d8 | 138 | * Allow only one to one mapping between GSI and non-irqchip routing. |
e8cde093 | 139 | */ |
1d487e9b | 140 | hlist_for_each_entry(ei, &rt->map[gsi], link) |
f33143d8 AS |
141 | if (ei->type != KVM_IRQ_ROUTING_IRQCHIP || |
142 | ue->type != KVM_IRQ_ROUTING_IRQCHIP || | |
e8cde093 | 143 | ue->u.irqchip.irqchip == ei->irqchip.irqchip) |
8c6b7828 | 144 | return -EINVAL; |
e8cde093 | 145 | |
1d487e9b | 146 | e->gsi = gsi; |
e8cde093 | 147 | e->type = ue->type; |
c63cf538 | 148 | r = kvm_set_routing_entry(kvm, e, ue); |
e8cde093 | 149 | if (r) |
8c6b7828 | 150 | return r; |
8ba918d4 PM |
151 | if (e->type == KVM_IRQ_ROUTING_IRQCHIP) |
152 | rt->chip[e->irqchip.irqchip][e->irqchip.pin] = e->gsi; | |
e8cde093 AG |
153 | |
154 | hlist_add_head(&e->link, &rt->map[e->gsi]); | |
8c6b7828 DH |
155 | |
156 | return 0; | |
e8cde093 AG |
157 | } |
158 | ||
abdb080f AS |
159 | void __attribute__((weak)) kvm_arch_irq_routing_update(struct kvm *kvm) |
160 | { | |
161 | } | |
162 | ||
5c0aea0e DH |
163 | bool __weak kvm_arch_can_set_irq_routing(struct kvm *kvm) |
164 | { | |
165 | return true; | |
166 | } | |
167 | ||
e8cde093 AG |
168 | int kvm_set_irq_routing(struct kvm *kvm, |
169 | const struct kvm_irq_routing_entry *ue, | |
170 | unsigned nr, | |
171 | unsigned flags) | |
172 | { | |
173 | struct kvm_irq_routing_table *new, *old; | |
995a0ee9 | 174 | struct kvm_kernel_irq_routing_entry *e; |
e8cde093 AG |
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 | ||
b3ffd74a | 186 | new = kzalloc(struct_size(new, map, nr_rt_entries), GFP_KERNEL_ACCOUNT); |
e8cde093 AG |
187 | if (!new) |
188 | return -ENOMEM; | |
189 | ||
e8cde093 AG |
190 | new->nr_rt_entries = nr_rt_entries; |
191 | for (i = 0; i < KVM_NR_IRQCHIPS; i++) | |
192 | for (j = 0; j < KVM_IRQCHIP_NUM_PINS; j++) | |
193 | new->chip[i][j] = -1; | |
194 | ||
195 | for (i = 0; i < nr; ++i) { | |
e73f61e4 | 196 | r = -ENOMEM; |
b12ce36a | 197 | e = kzalloc(sizeof(*e), GFP_KERNEL_ACCOUNT); |
e73f61e4 JR |
198 | if (!e) |
199 | goto out; | |
200 | ||
e8cde093 | 201 | r = -EINVAL; |
995a0ee9 EA |
202 | switch (ue->type) { |
203 | case KVM_IRQ_ROUTING_MSI: | |
204 | if (ue->flags & ~KVM_MSI_VALID_DEVID) | |
205 | goto free_entry; | |
206 | break; | |
207 | default: | |
208 | if (ue->flags) | |
209 | goto free_entry; | |
210 | break; | |
ba60c41a | 211 | } |
c63cf538 | 212 | r = setup_routing_entry(kvm, new, e, ue); |
995a0ee9 EA |
213 | if (r) |
214 | goto free_entry; | |
e8cde093 AG |
215 | ++ue; |
216 | } | |
217 | ||
218 | mutex_lock(&kvm->irq_lock); | |
5535f800 | 219 | old = rcu_dereference_protected(kvm->irq_routing, 1); |
9957c86d PM |
220 | rcu_assign_pointer(kvm->irq_routing, new); |
221 | kvm_irq_routing_update(kvm); | |
abdb080f | 222 | kvm_arch_irq_routing_update(kvm); |
e8cde093 AG |
223 | mutex_unlock(&kvm->irq_lock); |
224 | ||
abdb080f | 225 | kvm_arch_post_irq_routing_update(kvm); |
b053b2ae | 226 | |
719d93cd | 227 | synchronize_srcu_expedited(&kvm->irq_srcu); |
e8cde093 AG |
228 | |
229 | new = old; | |
230 | r = 0; | |
995a0ee9 | 231 | goto out; |
e8cde093 | 232 | |
995a0ee9 EA |
233 | free_entry: |
234 | kfree(e); | |
e8cde093 | 235 | out: |
e73f61e4 JR |
236 | free_irq_routing_table(new); |
237 | ||
e8cde093 AG |
238 | return r; |
239 | } |