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#include "qemu/osdep.h"
26#include "migration/vmstate.h"
27#include "monitor/monitor.h"
28#include "qemu/module.h"
29#include "hw/sysbus.h"
30#include "hw/intc/intc.h"
31#include "hw/irq.h"
32#include "trace.h"
33#include "qom/object.h"
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48#define MAX_CPUS 16
49#define MAX_PILS 16
50
51struct SLAVIO_INTCTLState;
52
53typedef struct SLAVIO_CPUINTCTLState {
54 MemoryRegion iomem;
55 struct SLAVIO_INTCTLState *master;
56 uint32_t intreg_pending;
57 uint32_t cpu;
58 uint32_t irl_out;
59} SLAVIO_CPUINTCTLState;
60
61#define TYPE_SLAVIO_INTCTL "slavio_intctl"
62OBJECT_DECLARE_SIMPLE_TYPE(SLAVIO_INTCTLState, SLAVIO_INTCTL)
63
64struct SLAVIO_INTCTLState {
65 SysBusDevice parent_obj;
66
67 MemoryRegion iomem;
68#ifdef DEBUG_IRQ_COUNT
69 uint64_t irq_count[32];
70#endif
71 qemu_irq cpu_irqs[MAX_CPUS][MAX_PILS];
72 SLAVIO_CPUINTCTLState slaves[MAX_CPUS];
73 uint32_t intregm_pending;
74 uint32_t intregm_disabled;
75 uint32_t target_cpu;
76};
77
78#define INTCTL_MAXADDR 0xf
79#define INTCTL_SIZE (INTCTL_MAXADDR + 1)
80#define INTCTLM_SIZE 0x14
81#define MASTER_IRQ_MASK ~0x0fa2007f
82#define MASTER_DISABLE 0x80000000
83#define CPU_SOFTIRQ_MASK 0xfffe0000
84#define CPU_IRQ_INT15_IN (1 << 15)
85#define CPU_IRQ_TIMER_IN (1 << 14)
86
87static void slavio_check_interrupts(SLAVIO_INTCTLState *s, int set_irqs);
88
89
90static uint64_t slavio_intctl_mem_readl(void *opaque, hwaddr addr,
91 unsigned size)
92{
93 SLAVIO_CPUINTCTLState *s = opaque;
94 uint32_t saddr, ret;
95
96 saddr = addr >> 2;
97 switch (saddr) {
98 case 0:
99 ret = s->intreg_pending;
100 break;
101 default:
102 ret = 0;
103 break;
104 }
105 trace_slavio_intctl_mem_readl(s->cpu, addr, ret);
106
107 return ret;
108}
109
110static void slavio_intctl_mem_writel(void *opaque, hwaddr addr,
111 uint64_t val, unsigned size)
112{
113 SLAVIO_CPUINTCTLState *s = opaque;
114 uint32_t saddr;
115
116 saddr = addr >> 2;
117 trace_slavio_intctl_mem_writel(s->cpu, addr, val);
118 switch (saddr) {
119 case 1:
120 val &= CPU_SOFTIRQ_MASK | CPU_IRQ_INT15_IN;
121 s->intreg_pending &= ~val;
122 slavio_check_interrupts(s->master, 1);
123 trace_slavio_intctl_mem_writel_clear(s->cpu, val, s->intreg_pending);
124 break;
125 case 2:
126 val &= CPU_SOFTIRQ_MASK;
127 s->intreg_pending |= val;
128 slavio_check_interrupts(s->master, 1);
129 trace_slavio_intctl_mem_writel_set(s->cpu, val, s->intreg_pending);
130 break;
131 default:
132 break;
133 }
134}
135
136static const MemoryRegionOps slavio_intctl_mem_ops = {
137 .read = slavio_intctl_mem_readl,
138 .write = slavio_intctl_mem_writel,
139 .endianness = DEVICE_NATIVE_ENDIAN,
140 .valid = {
141 .min_access_size = 4,
142 .max_access_size = 4,
143 },
144};
145
146
147static uint64_t slavio_intctlm_mem_readl(void *opaque, hwaddr addr,
148 unsigned size)
149{
150 SLAVIO_INTCTLState *s = opaque;
151 uint32_t saddr, ret;
152
153 saddr = addr >> 2;
154 switch (saddr) {
155 case 0:
156 ret = s->intregm_pending & ~MASTER_DISABLE;
157 break;
158 case 1:
159 ret = s->intregm_disabled & MASTER_IRQ_MASK;
160 break;
161 case 4:
162 ret = s->target_cpu;
163 break;
164 default:
165 ret = 0;
166 break;
167 }
168 trace_slavio_intctlm_mem_readl(addr, ret);
169
170 return ret;
171}
172
173static void slavio_intctlm_mem_writel(void *opaque, hwaddr addr,
174 uint64_t val, unsigned size)
175{
176 SLAVIO_INTCTLState *s = opaque;
177 uint32_t saddr;
178
179 saddr = addr >> 2;
180 trace_slavio_intctlm_mem_writel(addr, val);
181 switch (saddr) {
182 case 2:
183
184 val &= MASTER_IRQ_MASK;
185 s->intregm_disabled &= ~val;
186 trace_slavio_intctlm_mem_writel_enable(val, s->intregm_disabled);
187 slavio_check_interrupts(s, 1);
188 break;
189 case 3:
190
191 val &= MASTER_IRQ_MASK;
192 s->intregm_disabled |= val;
193 slavio_check_interrupts(s, 1);
194 trace_slavio_intctlm_mem_writel_disable(val, s->intregm_disabled);
195 break;
196 case 4:
197 s->target_cpu = val & (MAX_CPUS - 1);
198 slavio_check_interrupts(s, 1);
199 trace_slavio_intctlm_mem_writel_target(s->target_cpu);
200 break;
201 default:
202 break;
203 }
204}
205
206static const MemoryRegionOps slavio_intctlm_mem_ops = {
207 .read = slavio_intctlm_mem_readl,
208 .write = slavio_intctlm_mem_writel,
209 .endianness = DEVICE_NATIVE_ENDIAN,
210 .valid = {
211 .min_access_size = 4,
212 .max_access_size = 4,
213 },
214};
215
216static const uint32_t intbit_to_level[] = {
217 2, 3, 5, 7, 9, 11, 13, 2, 3, 5, 7, 9, 11, 13, 12, 12,
218 6, 13, 4, 10, 8, 9, 11, 0, 0, 0, 0, 15, 15, 15, 15, 0,
219};
220
221static void slavio_check_interrupts(SLAVIO_INTCTLState *s, int set_irqs)
222{
223 uint32_t pending = s->intregm_pending, pil_pending;
224 unsigned int i, j;
225
226 pending &= ~s->intregm_disabled;
227
228 trace_slavio_check_interrupts(pending, s->intregm_disabled);
229 for (i = 0; i < MAX_CPUS; i++) {
230 pil_pending = 0;
231
232
233 if (pending && !(s->intregm_disabled & MASTER_DISABLE) &&
234 (i == s->target_cpu)) {
235 for (j = 0; j < 32; j++) {
236 if ((pending & (1 << j)) && intbit_to_level[j]) {
237 pil_pending |= 1 << intbit_to_level[j];
238 }
239 }
240 }
241
242
243 s->slaves[i].intreg_pending &= CPU_SOFTIRQ_MASK | CPU_IRQ_INT15_IN |
244 CPU_IRQ_TIMER_IN;
245 if (i == s->target_cpu) {
246 for (j = 0; j < 32; j++) {
247 if ((s->intregm_pending & (1U << j)) && intbit_to_level[j]) {
248 s->slaves[i].intreg_pending |= 1 << intbit_to_level[j];
249 }
250 }
251 }
252
253
254
255 if (!(s->intregm_disabled & MASTER_DISABLE)) {
256 pil_pending |= s->slaves[i].intreg_pending &
257 (CPU_IRQ_INT15_IN | CPU_IRQ_TIMER_IN);
258 }
259
260
261 pil_pending |= (s->slaves[i].intreg_pending & CPU_SOFTIRQ_MASK) >> 16;
262
263 if (set_irqs) {
264
265
266
267
268
269 for (j = MAX_PILS-1; j > 0; j--) {
270 if (pil_pending & (1 << j)) {
271 if (!(s->slaves[i].irl_out & (1 << j))) {
272 qemu_irq_raise(s->cpu_irqs[i][j]);
273 }
274 } else {
275 if (s->slaves[i].irl_out & (1 << j)) {
276 qemu_irq_lower(s->cpu_irqs[i][j]);
277 }
278 }
279 }
280 }
281 s->slaves[i].irl_out = pil_pending;
282 }
283}
284
285
286
287
288
289static void slavio_set_irq(void *opaque, int irq, int level)
290{
291 SLAVIO_INTCTLState *s = opaque;
292 uint32_t mask = 1 << irq;
293 uint32_t pil = intbit_to_level[irq];
294 unsigned int i;
295
296 trace_slavio_set_irq(s->target_cpu, irq, pil, level);
297 if (pil > 0) {
298 if (level) {
299#ifdef DEBUG_IRQ_COUNT
300 s->irq_count[pil]++;
301#endif
302 s->intregm_pending |= mask;
303 if (pil == 15) {
304 for (i = 0; i < MAX_CPUS; i++) {
305 s->slaves[i].intreg_pending |= 1 << pil;
306 }
307 }
308 } else {
309 s->intregm_pending &= ~mask;
310 if (pil == 15) {
311 for (i = 0; i < MAX_CPUS; i++) {
312 s->slaves[i].intreg_pending &= ~(1 << pil);
313 }
314 }
315 }
316 slavio_check_interrupts(s, 1);
317 }
318}
319
320static void slavio_set_timer_irq_cpu(void *opaque, int cpu, int level)
321{
322 SLAVIO_INTCTLState *s = opaque;
323
324 trace_slavio_set_timer_irq_cpu(cpu, level);
325
326 if (level) {
327 s->slaves[cpu].intreg_pending |= CPU_IRQ_TIMER_IN;
328 } else {
329 s->slaves[cpu].intreg_pending &= ~CPU_IRQ_TIMER_IN;
330 }
331
332 slavio_check_interrupts(s, 1);
333}
334
335static void slavio_set_irq_all(void *opaque, int irq, int level)
336{
337 if (irq < 32) {
338 slavio_set_irq(opaque, irq, level);
339 } else {
340 slavio_set_timer_irq_cpu(opaque, irq - 32, level);
341 }
342}
343
344static int vmstate_intctl_post_load(void *opaque, int version_id)
345{
346 SLAVIO_INTCTLState *s = opaque;
347
348 slavio_check_interrupts(s, 0);
349 return 0;
350}
351
352static const VMStateDescription vmstate_intctl_cpu = {
353 .name ="slavio_intctl_cpu",
354 .version_id = 1,
355 .minimum_version_id = 1,
356 .fields = (VMStateField[]) {
357 VMSTATE_UINT32(intreg_pending, SLAVIO_CPUINTCTLState),
358 VMSTATE_END_OF_LIST()
359 }
360};
361
362static const VMStateDescription vmstate_intctl = {
363 .name ="slavio_intctl",
364 .version_id = 1,
365 .minimum_version_id = 1,
366 .post_load = vmstate_intctl_post_load,
367 .fields = (VMStateField[]) {
368 VMSTATE_STRUCT_ARRAY(slaves, SLAVIO_INTCTLState, MAX_CPUS, 1,
369 vmstate_intctl_cpu, SLAVIO_CPUINTCTLState),
370 VMSTATE_UINT32(intregm_pending, SLAVIO_INTCTLState),
371 VMSTATE_UINT32(intregm_disabled, SLAVIO_INTCTLState),
372 VMSTATE_UINT32(target_cpu, SLAVIO_INTCTLState),
373 VMSTATE_END_OF_LIST()
374 }
375};
376
377static void slavio_intctl_reset(DeviceState *d)
378{
379 SLAVIO_INTCTLState *s = SLAVIO_INTCTL(d);
380 int i;
381
382 for (i = 0; i < MAX_CPUS; i++) {
383 s->slaves[i].intreg_pending = 0;
384 s->slaves[i].irl_out = 0;
385 }
386 s->intregm_disabled = ~MASTER_IRQ_MASK;
387 s->intregm_pending = 0;
388 s->target_cpu = 0;
389 slavio_check_interrupts(s, 0);
390}
391
392#ifdef DEBUG_IRQ_COUNT
393static bool slavio_intctl_get_statistics(InterruptStatsProvider *obj,
394 uint64_t **irq_counts,
395 unsigned int *nb_irqs)
396{
397 SLAVIO_INTCTLState *s = SLAVIO_INTCTL(obj);
398 *irq_counts = s->irq_count;
399 *nb_irqs = ARRAY_SIZE(s->irq_count);
400 return true;
401}
402#endif
403
404static void slavio_intctl_print_info(InterruptStatsProvider *obj, Monitor *mon)
405{
406 SLAVIO_INTCTLState *s = SLAVIO_INTCTL(obj);
407 int i;
408
409 for (i = 0; i < MAX_CPUS; i++) {
410 monitor_printf(mon, "per-cpu %d: pending 0x%08x\n", i,
411 s->slaves[i].intreg_pending);
412 }
413 monitor_printf(mon, "master: pending 0x%08x, disabled 0x%08x\n",
414 s->intregm_pending, s->intregm_disabled);
415}
416
417static void slavio_intctl_init(Object *obj)
418{
419 DeviceState *dev = DEVICE(obj);
420 SLAVIO_INTCTLState *s = SLAVIO_INTCTL(obj);
421 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
422 unsigned int i, j;
423 char slave_name[45];
424
425 qdev_init_gpio_in(dev, slavio_set_irq_all, 32 + MAX_CPUS);
426 memory_region_init_io(&s->iomem, obj, &slavio_intctlm_mem_ops, s,
427 "master-interrupt-controller", INTCTLM_SIZE);
428 sysbus_init_mmio(sbd, &s->iomem);
429
430 for (i = 0; i < MAX_CPUS; i++) {
431 snprintf(slave_name, sizeof(slave_name),
432 "slave-interrupt-controller-%i", i);
433 for (j = 0; j < MAX_PILS; j++) {
434 sysbus_init_irq(sbd, &s->cpu_irqs[i][j]);
435 }
436 memory_region_init_io(&s->slaves[i].iomem, OBJECT(s),
437 &slavio_intctl_mem_ops,
438 &s->slaves[i], slave_name, INTCTL_SIZE);
439 sysbus_init_mmio(sbd, &s->slaves[i].iomem);
440 s->slaves[i].cpu = i;
441 s->slaves[i].master = s;
442 }
443}
444
445static void slavio_intctl_class_init(ObjectClass *klass, void *data)
446{
447 DeviceClass *dc = DEVICE_CLASS(klass);
448 InterruptStatsProviderClass *ic = INTERRUPT_STATS_PROVIDER_CLASS(klass);
449
450 dc->reset = slavio_intctl_reset;
451 dc->vmsd = &vmstate_intctl;
452#ifdef DEBUG_IRQ_COUNT
453 ic->get_statistics = slavio_intctl_get_statistics;
454#endif
455 ic->print_info = slavio_intctl_print_info;
456}
457
458static const TypeInfo slavio_intctl_info = {
459 .name = TYPE_SLAVIO_INTCTL,
460 .parent = TYPE_SYS_BUS_DEVICE,
461 .instance_size = sizeof(SLAVIO_INTCTLState),
462 .instance_init = slavio_intctl_init,
463 .class_init = slavio_intctl_class_init,
464 .interfaces = (InterfaceInfo[]) {
465 { TYPE_INTERRUPT_STATS_PROVIDER },
466 { }
467 },
468};
469
470static void slavio_intctl_register_types(void)
471{
472 type_register_static(&slavio_intctl_info);
473}
474
475type_init(slavio_intctl_register_types)
476