1
2
3
4
5
6
7
8
9
10
11
12
13#define GIC_NIRQ 64
14#include "mpcore.c"
15
16
17
18
19typedef struct {
20 SysBusDevice busdev;
21 SysBusDevice *priv;
22 qemu_irq cpuic[32];
23 qemu_irq rvic[4][64];
24 uint32_t num_cpu;
25} mpcore_rirq_state;
26
27
28static const int mpcore_irq_map[32] = {
29 -1, -1, -1, -1, 1, 2, -1, -1,
30 -1, -1, 6, -1, 4, 5, -1, -1,
31 -1, 14, 15, 0, 7, 8, -1, -1,
32 -1, -1, -1, -1, 9, 3, -1, -1,
33};
34
35static void mpcore_rirq_set_irq(void *opaque, int irq, int level)
36{
37 mpcore_rirq_state *s = (mpcore_rirq_state *)opaque;
38 int i;
39
40 for (i = 0; i < 4; i++) {
41 qemu_set_irq(s->rvic[i][irq], level);
42 }
43 if (irq < 32) {
44 irq = mpcore_irq_map[irq];
45 if (irq >= 0) {
46 qemu_set_irq(s->cpuic[irq], level);
47 }
48 }
49}
50
51static void mpcore_rirq_map(SysBusDevice *dev, target_phys_addr_t base)
52{
53 mpcore_rirq_state *s = FROM_SYSBUS(mpcore_rirq_state, dev);
54 sysbus_mmio_map(s->priv, 0, base);
55}
56
57static int realview_mpcore_init(SysBusDevice *dev)
58{
59 mpcore_rirq_state *s = FROM_SYSBUS(mpcore_rirq_state, dev);
60 DeviceState *gic;
61 DeviceState *priv;
62 int n;
63 int i;
64
65 priv = qdev_create(NULL, "arm11mpcore_priv");
66 qdev_prop_set_uint32(priv, "num-cpu", s->num_cpu);
67 qdev_init_nofail(priv);
68 s->priv = sysbus_from_qdev(priv);
69 sysbus_pass_irq(dev, s->priv);
70 for (i = 0; i < 32; i++) {
71 s->cpuic[i] = qdev_get_gpio_in(priv, i);
72 }
73
74 for (n = 0; n < 4; n++) {
75 gic = sysbus_create_simple("realview_gic", 0x10040000 + n * 0x10000,
76 s->cpuic[10 + n]);
77 for (i = 0; i < 64; i++) {
78 s->rvic[n][i] = qdev_get_gpio_in(gic, i);
79 }
80 }
81 qdev_init_gpio_in(&dev->qdev, mpcore_rirq_set_irq, 64);
82 sysbus_init_mmio_cb(dev, 0x2000, mpcore_rirq_map);
83 return 0;
84}
85
86static SysBusDeviceInfo mpcore_rirq_info = {
87 .init = realview_mpcore_init,
88 .qdev.name = "realview_mpcore",
89 .qdev.size = sizeof(mpcore_rirq_state),
90 .qdev.props = (Property[]) {
91 DEFINE_PROP_UINT32("num-cpu", mpcore_rirq_state, num_cpu, 1),
92 DEFINE_PROP_END_OF_LIST(),
93 }
94};
95
96static SysBusDeviceInfo mpcore_priv_info = {
97 .init = mpcore_priv_init,
98 .qdev.name = "arm11mpcore_priv",
99 .qdev.size = sizeof(mpcore_priv_state),
100 .qdev.props = (Property[]) {
101 DEFINE_PROP_UINT32("num-cpu", mpcore_priv_state, num_cpu, 1),
102 DEFINE_PROP_END_OF_LIST(),
103 }
104};
105
106static void arm11mpcore_register_devices(void)
107{
108 sysbus_register_withprop(&mpcore_rirq_info);
109 sysbus_register_withprop(&mpcore_priv_info);
110}
111
112device_init(arm11mpcore_register_devices)
113