]> Git Repo - qemu.git/blame - hw/arm/armv7m.c
armv7m: Don't assume the NVIC's CPU is CPU 0
[qemu.git] / hw / arm / armv7m.c
CommitLineData
9ee6e8bb
PB
1/*
2 * ARMV7M System emulation.
3 *
4 * Copyright (c) 2006-2007 CodeSourcery.
5 * Written by Paul Brook
6 *
2167f7bc 7 * This code is licensed under the GPL.
9ee6e8bb
PB
8 */
9
12b16722 10#include "qemu/osdep.h"
56b7c66f 11#include "hw/arm/armv7m.h"
da34e65c 12#include "qapi/error.h"
4771d756
PB
13#include "qemu-common.h"
14#include "cpu.h"
83c9f4ca 15#include "hw/sysbus.h"
bd2be150 16#include "hw/arm/arm.h"
83c9f4ca 17#include "hw/loader.h"
ca20cf32 18#include "elf.h"
5633b90a
AF
19#include "sysemu/qtest.h"
20#include "qemu/error-report.h"
618119c2 21#include "exec/address-spaces.h"
c60c1b0d 22#include "target/arm/idau.h"
9ee6e8bb
PB
23
24/* Bitbanded IO. Each word corresponds to a single bit. */
25
2167f7bc 26/* Get the byte address of the real memory for a bitband access. */
f68d881c 27static inline hwaddr bitband_addr(BitBandState *s, hwaddr offset)
9ee6e8bb 28{
f68d881c 29 return s->base | (offset & 0x1ffffff) >> 5;
9ee6e8bb
PB
30}
31
f68d881c
PM
32static MemTxResult bitband_read(void *opaque, hwaddr offset,
33 uint64_t *data, unsigned size, MemTxAttrs attrs)
9ee6e8bb 34{
f68d881c
PM
35 BitBandState *s = opaque;
36 uint8_t buf[4];
37 MemTxResult res;
38 int bitpos, bit;
39 hwaddr addr;
40
41 assert(size <= 4);
42
43 /* Find address in underlying memory and round down to multiple of size */
44 addr = bitband_addr(s, offset) & (-size);
b516572f 45 res = address_space_read(&s->source_as, addr, attrs, buf, size);
f68d881c
PM
46 if (res) {
47 return res;
48 }
49 /* Bit position in the N bytes read... */
50 bitpos = (offset >> 2) & ((size * 8) - 1);
51 /* ...converted to byte in buffer and bit in byte */
52 bit = (buf[bitpos >> 3] >> (bitpos & 7)) & 1;
53 *data = bit;
54 return MEMTX_OK;
9ee6e8bb
PB
55}
56
f68d881c
PM
57static MemTxResult bitband_write(void *opaque, hwaddr offset, uint64_t value,
58 unsigned size, MemTxAttrs attrs)
9ee6e8bb 59{
f68d881c
PM
60 BitBandState *s = opaque;
61 uint8_t buf[4];
62 MemTxResult res;
63 int bitpos, bit;
64 hwaddr addr;
65
66 assert(size <= 4);
67
68 /* Find address in underlying memory and round down to multiple of size */
69 addr = bitband_addr(s, offset) & (-size);
b516572f 70 res = address_space_read(&s->source_as, addr, attrs, buf, size);
f68d881c
PM
71 if (res) {
72 return res;
73 }
74 /* Bit position in the N bytes read... */
75 bitpos = (offset >> 2) & ((size * 8) - 1);
76 /* ...converted to byte in buffer and bit in byte */
77 bit = 1 << (bitpos & 7);
78 if (value & 1) {
79 buf[bitpos >> 3] |= bit;
80 } else {
81 buf[bitpos >> 3] &= ~bit;
82 }
b516572f 83 return address_space_write(&s->source_as, addr, attrs, buf, size);
9ee6e8bb
PB
84}
85
f69bf9d4 86static const MemoryRegionOps bitband_ops = {
f68d881c
PM
87 .read_with_attrs = bitband_read,
88 .write_with_attrs = bitband_write,
f69bf9d4 89 .endianness = DEVICE_NATIVE_ENDIAN,
f68d881c
PM
90 .impl.min_access_size = 1,
91 .impl.max_access_size = 4,
92 .valid.min_access_size = 1,
93 .valid.max_access_size = 4,
9ee6e8bb
PB
94};
95
3f5ab254 96static void bitband_init(Object *obj)
9ee6e8bb 97{
3f5ab254
XZ
98 BitBandState *s = BITBAND(obj);
99 SysBusDevice *dev = SYS_BUS_DEVICE(obj);
9ee6e8bb 100
f68d881c 101 memory_region_init_io(&s->iomem, obj, &bitband_ops, s,
64bde0f3 102 "bitband", 0x02000000);
750ecd44 103 sysbus_init_mmio(dev, &s->iomem);
40905a6a
PB
104}
105
f68d881c
PM
106static void bitband_realize(DeviceState *dev, Error **errp)
107{
108 BitBandState *s = BITBAND(dev);
109
110 if (!s->source_memory) {
111 error_setg(errp, "source-memory property not set");
112 return;
113 }
114
b516572f 115 address_space_init(&s->source_as, s->source_memory, "bitband-source");
f68d881c
PM
116}
117
9ee6e8bb 118/* Board init. */
983fe826 119
56b7c66f
PM
120static const hwaddr bitband_input_addr[ARMV7M_NUM_BITBANDS] = {
121 0x20000000, 0x40000000
122};
123
124static const hwaddr bitband_output_addr[ARMV7M_NUM_BITBANDS] = {
125 0x22000000, 0x42000000
126};
127
128static void armv7m_instance_init(Object *obj)
129{
130 ARMv7MState *s = ARMV7M(obj);
131 int i;
132
133 /* Can't init the cpu here, we don't yet know which model to use */
134
618119c2
PM
135 memory_region_init(&s->container, obj, "armv7m-container", UINT64_MAX);
136
955cbc6b 137 sysbus_init_child_obj(obj, "nvnic", &s->nvic, sizeof(s->nvic), TYPE_NVIC);
56b7c66f
PM
138 object_property_add_alias(obj, "num-irq",
139 OBJECT(&s->nvic), "num-irq", &error_abort);
140
141 for (i = 0; i < ARRAY_SIZE(s->bitband); i++) {
955cbc6b
TH
142 sysbus_init_child_obj(obj, "bitband[*]", &s->bitband[i],
143 sizeof(s->bitband[i]), TYPE_BITBAND);
56b7c66f
PM
144 }
145}
146
147static void armv7m_realize(DeviceState *dev, Error **errp)
148{
149 ARMv7MState *s = ARMV7M(dev);
98957a94 150 SysBusDevice *sbd;
56b7c66f
PM
151 Error *err = NULL;
152 int i;
56b7c66f 153
618119c2
PM
154 if (!s->board_memory) {
155 error_setg(errp, "memory property was not set");
156 return;
157 }
158
159 memory_region_add_subregion_overlap(&s->container, 0, s->board_memory, -1);
160
ba1ba5cc 161 s->cpu = ARM_CPU(object_new(s->cpu_type));
56b7c66f 162
618119c2
PM
163 object_property_set_link(OBJECT(s->cpu), OBJECT(&s->container), "memory",
164 &error_abort);
c60c1b0d
PM
165 if (object_property_find(OBJECT(s->cpu), "idau", NULL)) {
166 object_property_set_link(OBJECT(s->cpu), s->idau, "idau", &err);
167 if (err != NULL) {
168 error_propagate(errp, err);
169 return;
170 }
171 }
60d75d81
PM
172 if (object_property_find(OBJECT(s->cpu), "init-svtor", NULL)) {
173 object_property_set_uint(OBJECT(s->cpu), s->init_svtor,
174 "init-svtor", &err);
175 if (err != NULL) {
176 error_propagate(errp, err);
177 return;
178 }
179 }
95f87565 180
3693f217
PM
181 /*
182 * Tell the CPU where the NVIC is; it will fail realize if it doesn't
183 * have one. Similarly, tell the NVIC where its CPU is.
95f87565
PM
184 */
185 s->cpu->env.nvic = &s->nvic;
3693f217 186 s->nvic.cpu = s->cpu;
95f87565 187
56b7c66f
PM
188 object_property_set_bool(OBJECT(s->cpu), true, "realized", &err);
189 if (err != NULL) {
190 error_propagate(errp, err);
191 return;
192 }
193
194 /* Note that we must realize the NVIC after the CPU */
195 object_property_set_bool(OBJECT(&s->nvic), true, "realized", &err);
196 if (err != NULL) {
197 error_propagate(errp, err);
198 return;
199 }
200
201 /* Alias the NVIC's input and output GPIOs as our own so the board
202 * code can wire them up. (We do this in realize because the
203 * NVIC doesn't create the input GPIO array until realize.)
204 */
205 qdev_pass_gpios(DEVICE(&s->nvic), dev, NULL);
206 qdev_pass_gpios(DEVICE(&s->nvic), dev, "SYSRESETREQ");
514b4f36 207 qdev_pass_gpios(DEVICE(&s->nvic), dev, "NMI");
56b7c66f
PM
208
209 /* Wire the NVIC up to the CPU */
98957a94
PM
210 sbd = SYS_BUS_DEVICE(&s->nvic);
211 sysbus_connect_irq(sbd, 0,
56b7c66f 212 qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ));
56b7c66f 213
98957a94
PM
214 memory_region_add_subregion(&s->container, 0xe000e000,
215 sysbus_mmio_get_region(sbd, 0));
216
a1c5a062
SH
217 if (s->enable_bitband) {
218 for (i = 0; i < ARRAY_SIZE(s->bitband); i++) {
219 Object *obj = OBJECT(&s->bitband[i]);
220 SysBusDevice *sbd = SYS_BUS_DEVICE(&s->bitband[i]);
221
222 object_property_set_int(obj, bitband_input_addr[i], "base", &err);
223 if (err != NULL) {
224 error_propagate(errp, err);
225 return;
226 }
227 object_property_set_link(obj, OBJECT(s->board_memory),
228 "source-memory", &error_abort);
229 object_property_set_bool(obj, true, "realized", &err);
230 if (err != NULL) {
231 error_propagate(errp, err);
232 return;
233 }
234
235 memory_region_add_subregion(&s->container, bitband_output_addr[i],
236 sysbus_mmio_get_region(sbd, 0));
56b7c66f 237 }
56b7c66f
PM
238 }
239}
240
241static Property armv7m_properties[] = {
ba1ba5cc 242 DEFINE_PROP_STRING("cpu-type", ARMv7MState, cpu_type),
e2ff1215
FZ
243 DEFINE_PROP_LINK("memory", ARMv7MState, board_memory, TYPE_MEMORY_REGION,
244 MemoryRegion *),
c60c1b0d 245 DEFINE_PROP_LINK("idau", ARMv7MState, idau, TYPE_IDAU_INTERFACE, Object *),
60d75d81 246 DEFINE_PROP_UINT32("init-svtor", ARMv7MState, init_svtor, 0),
a1c5a062 247 DEFINE_PROP_BOOL("enable-bitband", ARMv7MState, enable_bitband, false),
56b7c66f
PM
248 DEFINE_PROP_END_OF_LIST(),
249};
250
251static void armv7m_class_init(ObjectClass *klass, void *data)
252{
253 DeviceClass *dc = DEVICE_CLASS(klass);
254
255 dc->realize = armv7m_realize;
256 dc->props = armv7m_properties;
257}
258
259static const TypeInfo armv7m_info = {
260 .name = TYPE_ARMV7M,
261 .parent = TYPE_SYS_BUS_DEVICE,
262 .instance_size = sizeof(ARMv7MState),
263 .instance_init = armv7m_instance_init,
264 .class_init = armv7m_class_init,
265};
266
983fe826
PB
267static void armv7m_reset(void *opaque)
268{
31363f12
AF
269 ARMCPU *cpu = opaque;
270
271 cpu_reset(CPU(cpu));
983fe826
PB
272}
273
3651c285
PM
274void armv7m_load_kernel(ARMCPU *cpu, const char *kernel_filename, int mem_size)
275{
276 int image_size;
277 uint64_t entry;
278 uint64_t lowaddr;
279 int big_endian;
891f3bc3
PM
280 AddressSpace *as;
281 int asidx;
282 CPUState *cs = CPU(cpu);
9ee6e8bb 283
ca20cf32
BS
284#ifdef TARGET_WORDS_BIGENDIAN
285 big_endian = 1;
286#else
287 big_endian = 0;
288#endif
289
891f3bc3
PM
290 if (arm_feature(&cpu->env, ARM_FEATURE_EL3)) {
291 asidx = ARMASIdx_S;
292 } else {
293 asidx = ARMASIdx_NS;
294 }
295 as = cpu_get_address_space(cs, asidx);
296
5633b90a 297 if (kernel_filename) {
891f3bc3
PM
298 image_size = load_elf_as(kernel_filename, NULL, NULL, &entry, &lowaddr,
299 NULL, big_endian, EM_ARM, 1, 0, as);
5633b90a 300 if (image_size < 0) {
891f3bc3
PM
301 image_size = load_image_targphys_as(kernel_filename, 0,
302 mem_size, as);
5633b90a
AF
303 lowaddr = 0;
304 }
305 if (image_size < 0) {
306 error_report("Could not load kernel '%s'", kernel_filename);
307 exit(1);
308 }
9ee6e8bb
PB
309 }
310
3651c285
PM
311 /* CPU objects (unlike devices) are not automatically reset on system
312 * reset, so we must always register a handler to do so. Unlike
313 * A-profile CPUs, we don't need to do anything special in the
314 * handler to arrange that it starts correctly.
315 * This is arguably the wrong place to do this, but it matches the
316 * way A-profile does it. Note that this means that every M profile
317 * board must call this function!
318 */
31363f12 319 qemu_register_reset(armv7m_reset, cpu);
9ee6e8bb 320}
40905a6a 321
999e12bb
AL
322static Property bitband_properties[] = {
323 DEFINE_PROP_UINT32("base", BitBandState, base, 0),
5f486f97
FZ
324 DEFINE_PROP_LINK("source-memory", BitBandState, source_memory,
325 TYPE_MEMORY_REGION, MemoryRegion *),
999e12bb
AL
326 DEFINE_PROP_END_OF_LIST(),
327};
328
329static void bitband_class_init(ObjectClass *klass, void *data)
330{
39bffca2 331 DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb 332
f68d881c 333 dc->realize = bitband_realize;
39bffca2 334 dc->props = bitband_properties;
999e12bb
AL
335}
336
8c43a6f0 337static const TypeInfo bitband_info = {
936230a7 338 .name = TYPE_BITBAND,
39bffca2
AL
339 .parent = TYPE_SYS_BUS_DEVICE,
340 .instance_size = sizeof(BitBandState),
3f5ab254 341 .instance_init = bitband_init,
39bffca2 342 .class_init = bitband_class_init,
ee6847d1
GH
343};
344
83f7d43a 345static void armv7m_register_types(void)
40905a6a 346{
39bffca2 347 type_register_static(&bitband_info);
56b7c66f 348 type_register_static(&armv7m_info);
40905a6a
PB
349}
350
83f7d43a 351type_init(armv7m_register_types)
This page took 0.817419 seconds and 4 git commands to generate.