1
2
3
4
5
6
7#include <linux/cpu.h>
8#include <linux/debugfs.h>
9#include <linux/interrupt.h>
10#include <linux/kvm_host.h>
11#include <linux/seq_file.h>
12#include <kvm/arm_vgic.h>
13#include <asm/kvm_mmu.h>
14#include "vgic.h"
15
16
17
18
19
20
21
22
23
24
25struct vgic_state_iter {
26 int nr_cpus;
27 int nr_spis;
28 int nr_lpis;
29 int dist_id;
30 int vcpu_id;
31 int intid;
32 int lpi_idx;
33 u32 *lpi_array;
34};
35
36static void iter_next(struct vgic_state_iter *iter)
37{
38 if (iter->dist_id == 0) {
39 iter->dist_id++;
40 return;
41 }
42
43 iter->intid++;
44 if (iter->intid == VGIC_NR_PRIVATE_IRQS &&
45 ++iter->vcpu_id < iter->nr_cpus)
46 iter->intid = 0;
47
48 if (iter->intid >= (iter->nr_spis + VGIC_NR_PRIVATE_IRQS)) {
49 if (iter->lpi_idx < iter->nr_lpis)
50 iter->intid = iter->lpi_array[iter->lpi_idx];
51 iter->lpi_idx++;
52 }
53}
54
55static void iter_init(struct kvm *kvm, struct vgic_state_iter *iter,
56 loff_t pos)
57{
58 int nr_cpus = atomic_read(&kvm->online_vcpus);
59
60 memset(iter, 0, sizeof(*iter));
61
62 iter->nr_cpus = nr_cpus;
63 iter->nr_spis = kvm->arch.vgic.nr_spis;
64 if (kvm->arch.vgic.vgic_model == KVM_DEV_TYPE_ARM_VGIC_V3) {
65 iter->nr_lpis = vgic_copy_lpi_list(kvm, NULL, &iter->lpi_array);
66 if (iter->nr_lpis < 0)
67 iter->nr_lpis = 0;
68 }
69
70
71 while (pos--)
72 iter_next(iter);
73}
74
75static bool end_of_vgic(struct vgic_state_iter *iter)
76{
77 return iter->dist_id > 0 &&
78 iter->vcpu_id == iter->nr_cpus &&
79 iter->intid >= (iter->nr_spis + VGIC_NR_PRIVATE_IRQS) &&
80 iter->lpi_idx > iter->nr_lpis;
81}
82
83static void *vgic_debug_start(struct seq_file *s, loff_t *pos)
84{
85 struct kvm *kvm = (struct kvm *)s->private;
86 struct vgic_state_iter *iter;
87
88 mutex_lock(&kvm->lock);
89 iter = kvm->arch.vgic.iter;
90 if (iter) {
91 iter = ERR_PTR(-EBUSY);
92 goto out;
93 }
94
95 iter = kmalloc(sizeof(*iter), GFP_KERNEL);
96 if (!iter) {
97 iter = ERR_PTR(-ENOMEM);
98 goto out;
99 }
100
101 iter_init(kvm, iter, *pos);
102 kvm->arch.vgic.iter = iter;
103
104 if (end_of_vgic(iter))
105 iter = NULL;
106out:
107 mutex_unlock(&kvm->lock);
108 return iter;
109}
110
111static void *vgic_debug_next(struct seq_file *s, void *v, loff_t *pos)
112{
113 struct kvm *kvm = (struct kvm *)s->private;
114 struct vgic_state_iter *iter = kvm->arch.vgic.iter;
115
116 ++*pos;
117 iter_next(iter);
118 if (end_of_vgic(iter))
119 iter = NULL;
120 return iter;
121}
122
123static void vgic_debug_stop(struct seq_file *s, void *v)
124{
125 struct kvm *kvm = (struct kvm *)s->private;
126 struct vgic_state_iter *iter;
127
128
129
130
131
132 if (IS_ERR(v))
133 return;
134
135 mutex_lock(&kvm->lock);
136 iter = kvm->arch.vgic.iter;
137 kfree(iter->lpi_array);
138 kfree(iter);
139 kvm->arch.vgic.iter = NULL;
140 mutex_unlock(&kvm->lock);
141}
142
143static void print_dist_state(struct seq_file *s, struct vgic_dist *dist)
144{
145 bool v3 = dist->vgic_model == KVM_DEV_TYPE_ARM_VGIC_V3;
146
147 seq_printf(s, "Distributor\n");
148 seq_printf(s, "===========\n");
149 seq_printf(s, "vgic_model:\t%s\n", v3 ? "GICv3" : "GICv2");
150 seq_printf(s, "nr_spis:\t%d\n", dist->nr_spis);
151 if (v3)
152 seq_printf(s, "nr_lpis:\t%d\n", dist->lpi_list_count);
153 seq_printf(s, "enabled:\t%d\n", dist->enabled);
154 seq_printf(s, "\n");
155
156 seq_printf(s, "P=pending_latch, L=line_level, A=active\n");
157 seq_printf(s, "E=enabled, H=hw, C=config (level=1, edge=0)\n");
158 seq_printf(s, "G=group\n");
159}
160
161static void print_header(struct seq_file *s, struct vgic_irq *irq,
162 struct kvm_vcpu *vcpu)
163{
164 int id = 0;
165 char *hdr = "SPI ";
166
167 if (vcpu) {
168 hdr = "VCPU";
169 id = vcpu->vcpu_id;
170 }
171
172 seq_printf(s, "\n");
173 seq_printf(s, "%s%2d TYP ID TGT_ID PLAEHCG HWID TARGET SRC PRI VCPU_ID\n", hdr, id);
174 seq_printf(s, "----------------------------------------------------------------\n");
175}
176
177static void print_irq_state(struct seq_file *s, struct vgic_irq *irq,
178 struct kvm_vcpu *vcpu)
179{
180 char *type;
181 if (irq->intid < VGIC_NR_SGIS)
182 type = "SGI";
183 else if (irq->intid < VGIC_NR_PRIVATE_IRQS)
184 type = "PPI";
185 else if (irq->intid < VGIC_MAX_SPI)
186 type = "SPI";
187 else
188 type = "LPI";
189
190 if (irq->intid ==0 || irq->intid == VGIC_NR_PRIVATE_IRQS)
191 print_header(s, irq, vcpu);
192
193 seq_printf(s, " %s %4d "
194 " %2d "
195 "%d%d%d%d%d%d%d "
196 "%8d "
197 "%8x "
198 " %2x "
199 "%3d "
200 " %2d "
201 "\n",
202 type, irq->intid,
203 (irq->target_vcpu) ? irq->target_vcpu->vcpu_id : -1,
204 irq->pending_latch,
205 irq->line_level,
206 irq->active,
207 irq->enabled,
208 irq->hw,
209 irq->config == VGIC_CONFIG_LEVEL,
210 irq->group,
211 irq->hwintid,
212 irq->mpidr,
213 irq->source,
214 irq->priority,
215 (irq->vcpu) ? irq->vcpu->vcpu_id : -1);
216}
217
218static int vgic_debug_show(struct seq_file *s, void *v)
219{
220 struct kvm *kvm = (struct kvm *)s->private;
221 struct vgic_state_iter *iter = (struct vgic_state_iter *)v;
222 struct vgic_irq *irq;
223 struct kvm_vcpu *vcpu = NULL;
224 unsigned long flags;
225
226 if (iter->dist_id == 0) {
227 print_dist_state(s, &kvm->arch.vgic);
228 return 0;
229 }
230
231 if (!kvm->arch.vgic.initialized)
232 return 0;
233
234 if (iter->vcpu_id < iter->nr_cpus)
235 vcpu = kvm_get_vcpu(kvm, iter->vcpu_id);
236
237 irq = vgic_get_irq(kvm, vcpu, iter->intid);
238 if (!irq) {
239 seq_printf(s, " LPI %4d freed\n", iter->intid);
240 return 0;
241 }
242
243 raw_spin_lock_irqsave(&irq->irq_lock, flags);
244 print_irq_state(s, irq, vcpu);
245 raw_spin_unlock_irqrestore(&irq->irq_lock, flags);
246
247 vgic_put_irq(kvm, irq);
248 return 0;
249}
250
251static const struct seq_operations vgic_debug_seq_ops = {
252 .start = vgic_debug_start,
253 .next = vgic_debug_next,
254 .stop = vgic_debug_stop,
255 .show = vgic_debug_show
256};
257
258static int debug_open(struct inode *inode, struct file *file)
259{
260 int ret;
261 ret = seq_open(file, &vgic_debug_seq_ops);
262 if (!ret) {
263 struct seq_file *seq;
264
265 seq = file->private_data;
266 seq->private = inode->i_private;
267 }
268
269 return ret;
270};
271
272static const struct file_operations vgic_debug_fops = {
273 .owner = THIS_MODULE,
274 .open = debug_open,
275 .read = seq_read,
276 .llseek = seq_lseek,
277 .release = seq_release
278};
279
280void vgic_debug_init(struct kvm *kvm)
281{
282 debugfs_create_file("vgic-state", 0444, kvm->debugfs_dentry, kvm,
283 &vgic_debug_fops);
284}
285
286void vgic_debug_destroy(struct kvm *kvm)
287{
288}
289
