]>
Commit | Line | Data |
---|---|---|
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 | 27 | static inline hwaddr bitband_addr(BitBandState *s, hwaddr offset) |
9ee6e8bb | 28 | { |
f68d881c | 29 | return s->base | (offset & 0x1ffffff) >> 5; |
9ee6e8bb PB |
30 | } |
31 | ||
f68d881c PM |
32 | static 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 |
57 | static 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 | 86 | static 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 | 96 | static 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 |
106 | static 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 |
120 | static const hwaddr bitband_input_addr[ARMV7M_NUM_BITBANDS] = { |
121 | 0x20000000, 0x40000000 | |
122 | }; | |
123 | ||
124 | static const hwaddr bitband_output_addr[ARMV7M_NUM_BITBANDS] = { | |
125 | 0x22000000, 0x42000000 | |
126 | }; | |
127 | ||
128 | static 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 | ||
147 | static 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 PM |
180 | |
181 | /* Tell the CPU where the NVIC is; it will fail realize if it doesn't | |
182 | * have one. | |
183 | */ | |
184 | s->cpu->env.nvic = &s->nvic; | |
185 | ||
56b7c66f PM |
186 | object_property_set_bool(OBJECT(s->cpu), true, "realized", &err); |
187 | if (err != NULL) { | |
188 | error_propagate(errp, err); | |
189 | return; | |
190 | } | |
191 | ||
192 | /* Note that we must realize the NVIC after the CPU */ | |
193 | object_property_set_bool(OBJECT(&s->nvic), true, "realized", &err); | |
194 | if (err != NULL) { | |
195 | error_propagate(errp, err); | |
196 | return; | |
197 | } | |
198 | ||
199 | /* Alias the NVIC's input and output GPIOs as our own so the board | |
200 | * code can wire them up. (We do this in realize because the | |
201 | * NVIC doesn't create the input GPIO array until realize.) | |
202 | */ | |
203 | qdev_pass_gpios(DEVICE(&s->nvic), dev, NULL); | |
204 | qdev_pass_gpios(DEVICE(&s->nvic), dev, "SYSRESETREQ"); | |
514b4f36 | 205 | qdev_pass_gpios(DEVICE(&s->nvic), dev, "NMI"); |
56b7c66f PM |
206 | |
207 | /* Wire the NVIC up to the CPU */ | |
98957a94 PM |
208 | sbd = SYS_BUS_DEVICE(&s->nvic); |
209 | sysbus_connect_irq(sbd, 0, | |
56b7c66f | 210 | qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ)); |
56b7c66f | 211 | |
98957a94 PM |
212 | memory_region_add_subregion(&s->container, 0xe000e000, |
213 | sysbus_mmio_get_region(sbd, 0)); | |
214 | ||
a1c5a062 SH |
215 | if (s->enable_bitband) { |
216 | for (i = 0; i < ARRAY_SIZE(s->bitband); i++) { | |
217 | Object *obj = OBJECT(&s->bitband[i]); | |
218 | SysBusDevice *sbd = SYS_BUS_DEVICE(&s->bitband[i]); | |
219 | ||
220 | object_property_set_int(obj, bitband_input_addr[i], "base", &err); | |
221 | if (err != NULL) { | |
222 | error_propagate(errp, err); | |
223 | return; | |
224 | } | |
225 | object_property_set_link(obj, OBJECT(s->board_memory), | |
226 | "source-memory", &error_abort); | |
227 | object_property_set_bool(obj, true, "realized", &err); | |
228 | if (err != NULL) { | |
229 | error_propagate(errp, err); | |
230 | return; | |
231 | } | |
232 | ||
233 | memory_region_add_subregion(&s->container, bitband_output_addr[i], | |
234 | sysbus_mmio_get_region(sbd, 0)); | |
56b7c66f | 235 | } |
56b7c66f PM |
236 | } |
237 | } | |
238 | ||
239 | static Property armv7m_properties[] = { | |
ba1ba5cc | 240 | DEFINE_PROP_STRING("cpu-type", ARMv7MState, cpu_type), |
e2ff1215 FZ |
241 | DEFINE_PROP_LINK("memory", ARMv7MState, board_memory, TYPE_MEMORY_REGION, |
242 | MemoryRegion *), | |
c60c1b0d | 243 | DEFINE_PROP_LINK("idau", ARMv7MState, idau, TYPE_IDAU_INTERFACE, Object *), |
60d75d81 | 244 | DEFINE_PROP_UINT32("init-svtor", ARMv7MState, init_svtor, 0), |
a1c5a062 | 245 | DEFINE_PROP_BOOL("enable-bitband", ARMv7MState, enable_bitband, false), |
56b7c66f PM |
246 | DEFINE_PROP_END_OF_LIST(), |
247 | }; | |
248 | ||
249 | static void armv7m_class_init(ObjectClass *klass, void *data) | |
250 | { | |
251 | DeviceClass *dc = DEVICE_CLASS(klass); | |
252 | ||
253 | dc->realize = armv7m_realize; | |
254 | dc->props = armv7m_properties; | |
255 | } | |
256 | ||
257 | static const TypeInfo armv7m_info = { | |
258 | .name = TYPE_ARMV7M, | |
259 | .parent = TYPE_SYS_BUS_DEVICE, | |
260 | .instance_size = sizeof(ARMv7MState), | |
261 | .instance_init = armv7m_instance_init, | |
262 | .class_init = armv7m_class_init, | |
263 | }; | |
264 | ||
983fe826 PB |
265 | static void armv7m_reset(void *opaque) |
266 | { | |
31363f12 AF |
267 | ARMCPU *cpu = opaque; |
268 | ||
269 | cpu_reset(CPU(cpu)); | |
983fe826 PB |
270 | } |
271 | ||
3651c285 PM |
272 | void armv7m_load_kernel(ARMCPU *cpu, const char *kernel_filename, int mem_size) |
273 | { | |
274 | int image_size; | |
275 | uint64_t entry; | |
276 | uint64_t lowaddr; | |
277 | int big_endian; | |
891f3bc3 PM |
278 | AddressSpace *as; |
279 | int asidx; | |
280 | CPUState *cs = CPU(cpu); | |
9ee6e8bb | 281 | |
ca20cf32 BS |
282 | #ifdef TARGET_WORDS_BIGENDIAN |
283 | big_endian = 1; | |
284 | #else | |
285 | big_endian = 0; | |
286 | #endif | |
287 | ||
5633b90a | 288 | if (!kernel_filename && !qtest_enabled()) { |
c0dbca36 | 289 | error_report("Guest image must be specified (using -kernel)"); |
01fd41ab PC |
290 | exit(1); |
291 | } | |
292 | ||
891f3bc3 PM |
293 | if (arm_feature(&cpu->env, ARM_FEATURE_EL3)) { |
294 | asidx = ARMASIdx_S; | |
295 | } else { | |
296 | asidx = ARMASIdx_NS; | |
297 | } | |
298 | as = cpu_get_address_space(cs, asidx); | |
299 | ||
5633b90a | 300 | if (kernel_filename) { |
891f3bc3 PM |
301 | image_size = load_elf_as(kernel_filename, NULL, NULL, &entry, &lowaddr, |
302 | NULL, big_endian, EM_ARM, 1, 0, as); | |
5633b90a | 303 | if (image_size < 0) { |
891f3bc3 PM |
304 | image_size = load_image_targphys_as(kernel_filename, 0, |
305 | mem_size, as); | |
5633b90a AF |
306 | lowaddr = 0; |
307 | } | |
308 | if (image_size < 0) { | |
309 | error_report("Could not load kernel '%s'", kernel_filename); | |
310 | exit(1); | |
311 | } | |
9ee6e8bb PB |
312 | } |
313 | ||
3651c285 PM |
314 | /* CPU objects (unlike devices) are not automatically reset on system |
315 | * reset, so we must always register a handler to do so. Unlike | |
316 | * A-profile CPUs, we don't need to do anything special in the | |
317 | * handler to arrange that it starts correctly. | |
318 | * This is arguably the wrong place to do this, but it matches the | |
319 | * way A-profile does it. Note that this means that every M profile | |
320 | * board must call this function! | |
321 | */ | |
31363f12 | 322 | qemu_register_reset(armv7m_reset, cpu); |
9ee6e8bb | 323 | } |
40905a6a | 324 | |
999e12bb AL |
325 | static Property bitband_properties[] = { |
326 | DEFINE_PROP_UINT32("base", BitBandState, base, 0), | |
5f486f97 FZ |
327 | DEFINE_PROP_LINK("source-memory", BitBandState, source_memory, |
328 | TYPE_MEMORY_REGION, MemoryRegion *), | |
999e12bb AL |
329 | DEFINE_PROP_END_OF_LIST(), |
330 | }; | |
331 | ||
332 | static void bitband_class_init(ObjectClass *klass, void *data) | |
333 | { | |
39bffca2 | 334 | DeviceClass *dc = DEVICE_CLASS(klass); |
999e12bb | 335 | |
f68d881c | 336 | dc->realize = bitband_realize; |
39bffca2 | 337 | dc->props = bitband_properties; |
999e12bb AL |
338 | } |
339 | ||
8c43a6f0 | 340 | static const TypeInfo bitband_info = { |
936230a7 | 341 | .name = TYPE_BITBAND, |
39bffca2 AL |
342 | .parent = TYPE_SYS_BUS_DEVICE, |
343 | .instance_size = sizeof(BitBandState), | |
3f5ab254 | 344 | .instance_init = bitband_init, |
39bffca2 | 345 | .class_init = bitband_class_init, |
ee6847d1 GH |
346 | }; |
347 | ||
83f7d43a | 348 | static void armv7m_register_types(void) |
40905a6a | 349 | { |
39bffca2 | 350 | type_register_static(&bitband_info); |
56b7c66f | 351 | type_register_static(&armv7m_info); |
40905a6a PB |
352 | } |
353 | ||
83f7d43a | 354 | type_init(armv7m_register_types) |