1
2
3
4
5
6
7
8
9
10#include "qemu/osdep.h"
11#include "qapi/error.h"
12#include "hw/cpu/arm11mpcore.h"
13#include "hw/intc/realview_gic.h"
14
15
16static void mpcore_priv_set_irq(void *opaque, int irq, int level)
17{
18 ARM11MPCorePriveState *s = (ARM11MPCorePriveState *)opaque;
19
20 qemu_set_irq(qdev_get_gpio_in(DEVICE(&s->gic), irq), level);
21}
22
23static void mpcore_priv_map_setup(ARM11MPCorePriveState *s)
24{
25 int i;
26 SysBusDevice *scubusdev = SYS_BUS_DEVICE(&s->scu);
27 DeviceState *gicdev = DEVICE(&s->gic);
28 SysBusDevice *gicbusdev = SYS_BUS_DEVICE(&s->gic);
29 SysBusDevice *timerbusdev = SYS_BUS_DEVICE(&s->mptimer);
30 SysBusDevice *wdtbusdev = SYS_BUS_DEVICE(&s->wdtimer);
31
32 memory_region_add_subregion(&s->container, 0,
33 sysbus_mmio_get_region(scubusdev, 0));
34
35
36
37 for (i = 0; i < (s->num_cpu + 1); i++) {
38 hwaddr offset = 0x100 + (i * 0x100);
39 memory_region_add_subregion(&s->container, offset,
40 sysbus_mmio_get_region(gicbusdev, i + 1));
41 }
42
43
44
45 for (i = 0; i < (s->num_cpu + 1); i++) {
46
47 hwaddr offset = 0x600 + i * 0x100;
48 memory_region_add_subregion(&s->container, offset,
49 sysbus_mmio_get_region(timerbusdev, i));
50 memory_region_add_subregion(&s->container, offset + 0x20,
51 sysbus_mmio_get_region(wdtbusdev, i));
52 }
53 memory_region_add_subregion(&s->container, 0x1000,
54 sysbus_mmio_get_region(gicbusdev, 0));
55
56
57
58 for (i = 0; i < s->num_cpu; i++) {
59 int ppibase = (s->num_irq - 32) + i * 32;
60 sysbus_connect_irq(timerbusdev, i,
61 qdev_get_gpio_in(gicdev, ppibase + 29));
62 sysbus_connect_irq(wdtbusdev, i,
63 qdev_get_gpio_in(gicdev, ppibase + 30));
64 }
65}
66
67static void mpcore_priv_realize(DeviceState *dev, Error **errp)
68{
69 SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
70 ARM11MPCorePriveState *s = ARM11MPCORE_PRIV(dev);
71 DeviceState *scudev = DEVICE(&s->scu);
72 DeviceState *gicdev = DEVICE(&s->gic);
73 DeviceState *mptimerdev = DEVICE(&s->mptimer);
74 DeviceState *wdtimerdev = DEVICE(&s->wdtimer);
75 Error *err = NULL;
76
77 qdev_prop_set_uint32(scudev, "num-cpu", s->num_cpu);
78 object_property_set_bool(OBJECT(&s->scu), true, "realized", &err);
79 if (err != NULL) {
80 error_propagate(errp, err);
81 return;
82 }
83
84 qdev_prop_set_uint32(gicdev, "num-cpu", s->num_cpu);
85 qdev_prop_set_uint32(gicdev, "num-irq", s->num_irq);
86 object_property_set_bool(OBJECT(&s->gic), true, "realized", &err);
87 if (err != NULL) {
88 error_propagate(errp, err);
89 return;
90 }
91
92
93 sysbus_pass_irq(sbd, SYS_BUS_DEVICE(&s->gic));
94
95
96 qdev_init_gpio_in(dev, mpcore_priv_set_irq, s->num_irq - 32);
97
98 qdev_prop_set_uint32(mptimerdev, "num-cpu", s->num_cpu);
99 object_property_set_bool(OBJECT(&s->mptimer), true, "realized", &err);
100 if (err != NULL) {
101 error_propagate(errp, err);
102 return;
103 }
104
105 qdev_prop_set_uint32(wdtimerdev, "num-cpu", s->num_cpu);
106 object_property_set_bool(OBJECT(&s->wdtimer), true, "realized", &err);
107 if (err != NULL) {
108 error_propagate(errp, err);
109 return;
110 }
111
112 mpcore_priv_map_setup(s);
113}
114
115static void mpcore_priv_initfn(Object *obj)
116{
117 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
118 ARM11MPCorePriveState *s = ARM11MPCORE_PRIV(obj);
119
120 memory_region_init(&s->container, OBJECT(s),
121 "mpcore-priv-container", 0x2000);
122 sysbus_init_mmio(sbd, &s->container);
123
124 object_initialize(&s->scu, sizeof(s->scu), TYPE_ARM11_SCU);
125 qdev_set_parent_bus(DEVICE(&s->scu), sysbus_get_default());
126
127 object_initialize(&s->gic, sizeof(s->gic), TYPE_ARM_GIC);
128 qdev_set_parent_bus(DEVICE(&s->gic), sysbus_get_default());
129
130 qdev_prop_set_uint32(DEVICE(&s->gic), "revision", 0);
131
132 object_initialize(&s->mptimer, sizeof(s->mptimer), TYPE_ARM_MPTIMER);
133 qdev_set_parent_bus(DEVICE(&s->mptimer), sysbus_get_default());
134
135 object_initialize(&s->wdtimer, sizeof(s->wdtimer), TYPE_ARM_MPTIMER);
136 qdev_set_parent_bus(DEVICE(&s->wdtimer), sysbus_get_default());
137}
138
139static Property mpcore_priv_properties[] = {
140 DEFINE_PROP_UINT32("num-cpu", ARM11MPCorePriveState, num_cpu, 1),
141
142
143
144
145
146
147
148
149 DEFINE_PROP_UINT32("num-irq", ARM11MPCorePriveState, num_irq, 64),
150 DEFINE_PROP_END_OF_LIST(),
151};
152
153static void mpcore_priv_class_init(ObjectClass *klass, void *data)
154{
155 DeviceClass *dc = DEVICE_CLASS(klass);
156
157 dc->realize = mpcore_priv_realize;
158 dc->props = mpcore_priv_properties;
159}
160
161static const TypeInfo mpcore_priv_info = {
162 .name = TYPE_ARM11MPCORE_PRIV,
163 .parent = TYPE_SYS_BUS_DEVICE,
164 .instance_size = sizeof(ARM11MPCorePriveState),
165 .instance_init = mpcore_priv_initfn,
166 .class_init = mpcore_priv_class_init,
167};
168
169static void arm11mpcore_register_types(void)
170{
171 type_register_static(&mpcore_priv_info);
172}
173
174type_init(arm11mpcore_register_types)
175