]> git.proxmox.com Git - qemu.git/blame - hw/arm_gic.c
hw/arm_gic: Fix comparison with priority mask register
[qemu.git] / hw / arm_gic.c
CommitLineData
5fafdf24 1/*
9ee6e8bb 2 * ARM Generic/Distributed Interrupt Controller
e69954b9 3 *
9ee6e8bb 4 * Copyright (c) 2006-2007 CodeSourcery.
e69954b9
PB
5 * Written by Paul Brook
6 *
8e31bf38 7 * This code is licensed under the GPL.
e69954b9
PB
8 */
9
9ee6e8bb 10/* This file contains implementation code for the RealView EB interrupt
0d256bdc
PM
11 * controller, MPCore distributed interrupt controller and ARMv7-M
12 * Nested Vectored Interrupt Controller.
13 * It is compiled in two ways:
14 * (1) as a standalone file to produce a sysbus device which is a GIC
15 * that can be used on the realview board and as one of the builtin
16 * private peripherals for the ARM MP CPUs (11MPCore, A9, etc)
17 * (2) by being directly #included into armv7m_nvic.c to produce the
18 * armv7m_nvic device.
19 */
e69954b9 20
496dbcd1 21#include "sysbus.h"
1e8cae4d 22#include "arm_gic_internal.h"
386e2955 23
e69954b9
PB
24//#define DEBUG_GIC
25
26#ifdef DEBUG_GIC
001faf32 27#define DPRINTF(fmt, ...) \
5eb98401 28do { fprintf(stderr, "arm_gic: " fmt , ## __VA_ARGS__); } while (0)
e69954b9 29#else
001faf32 30#define DPRINTF(fmt, ...) do {} while(0)
e69954b9
PB
31#endif
32
2a29ddee
PM
33static const uint8_t gic_id[] = {
34 0x90, 0x13, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1
35};
36
c988bfad 37#define NUM_CPU(s) ((s)->num_cpu)
9ee6e8bb 38
fae15286 39static inline int gic_get_current_cpu(GICState *s)
926c4aff 40{
926c4aff
PM
41 if (s->num_cpu > 1) {
42 return cpu_single_env->cpu_index;
43 }
926c4aff
PM
44 return 0;
45}
46
e69954b9
PB
47/* TODO: Many places that call this routine could be optimized. */
48/* Update interrupt status after enabled or pending bits have been changed. */
fae15286 49void gic_update(GICState *s)
e69954b9
PB
50{
51 int best_irq;
52 int best_prio;
53 int irq;
9ee6e8bb
PB
54 int level;
55 int cpu;
56 int cm;
57
c988bfad 58 for (cpu = 0; cpu < NUM_CPU(s); cpu++) {
9ee6e8bb
PB
59 cm = 1 << cpu;
60 s->current_pending[cpu] = 1023;
61 if (!s->enabled || !s->cpu_enabled[cpu]) {
c79981ce 62 qemu_irq_lower(s->parent_irq[cpu]);
9ee6e8bb
PB
63 return;
64 }
65 best_prio = 0x100;
66 best_irq = 1023;
a32134aa 67 for (irq = 0; irq < s->num_irq; irq++) {
41bf234d 68 if (GIC_TEST_ENABLED(irq, cm) && GIC_TEST_PENDING(irq, cm)) {
9ee6e8bb
PB
69 if (GIC_GET_PRIORITY(irq, cpu) < best_prio) {
70 best_prio = GIC_GET_PRIORITY(irq, cpu);
71 best_irq = irq;
72 }
e69954b9
PB
73 }
74 }
9ee6e8bb 75 level = 0;
cad065f1 76 if (best_prio < s->priority_mask[cpu]) {
9ee6e8bb
PB
77 s->current_pending[cpu] = best_irq;
78 if (best_prio < s->running_priority[cpu]) {
79 DPRINTF("Raised pending IRQ %d\n", best_irq);
80 level = 1;
81 }
e69954b9 82 }
9ee6e8bb 83 qemu_set_irq(s->parent_irq[cpu], level);
e69954b9
PB
84 }
85}
86
fae15286 87void gic_set_pending_private(GICState *s, int cpu, int irq)
9ee6e8bb
PB
88{
89 int cm = 1 << cpu;
90
91 if (GIC_TEST_PENDING(irq, cm))
92 return;
93
94 DPRINTF("Set %d pending cpu %d\n", irq, cpu);
95 GIC_SET_PENDING(irq, cm);
96 gic_update(s);
97}
98
99/* Process a change in an external IRQ input. */
e69954b9
PB
100static void gic_set_irq(void *opaque, int irq, int level)
101{
544d1afa
PM
102 /* Meaning of the 'irq' parameter:
103 * [0..N-1] : external interrupts
104 * [N..N+31] : PPI (internal) interrupts for CPU 0
105 * [N+32..N+63] : PPI (internal interrupts for CPU 1
106 * ...
107 */
fae15286 108 GICState *s = (GICState *)opaque;
544d1afa
PM
109 int cm, target;
110 if (irq < (s->num_irq - GIC_INTERNAL)) {
111 /* The first external input line is internal interrupt 32. */
112 cm = ALL_CPU_MASK;
113 irq += GIC_INTERNAL;
114 target = GIC_TARGET(irq);
115 } else {
116 int cpu;
117 irq -= (s->num_irq - GIC_INTERNAL);
118 cpu = irq / GIC_INTERNAL;
119 irq %= GIC_INTERNAL;
120 cm = 1 << cpu;
121 target = cm;
122 }
123
124 if (level == GIC_TEST_LEVEL(irq, cm)) {
e69954b9 125 return;
544d1afa 126 }
e69954b9
PB
127
128 if (level) {
544d1afa
PM
129 GIC_SET_LEVEL(irq, cm);
130 if (GIC_TEST_TRIGGER(irq) || GIC_TEST_ENABLED(irq, cm)) {
131 DPRINTF("Set %d pending mask %x\n", irq, target);
132 GIC_SET_PENDING(irq, target);
e69954b9
PB
133 }
134 } else {
544d1afa 135 GIC_CLEAR_LEVEL(irq, cm);
e69954b9
PB
136 }
137 gic_update(s);
138}
139
fae15286 140static void gic_set_running_irq(GICState *s, int cpu, int irq)
e69954b9 141{
9ee6e8bb
PB
142 s->running_irq[cpu] = irq;
143 if (irq == 1023) {
144 s->running_priority[cpu] = 0x100;
145 } else {
146 s->running_priority[cpu] = GIC_GET_PRIORITY(irq, cpu);
147 }
e69954b9
PB
148 gic_update(s);
149}
150
fae15286 151uint32_t gic_acknowledge_irq(GICState *s, int cpu)
e69954b9
PB
152{
153 int new_irq;
9ee6e8bb
PB
154 int cm = 1 << cpu;
155 new_irq = s->current_pending[cpu];
156 if (new_irq == 1023
157 || GIC_GET_PRIORITY(new_irq, cpu) >= s->running_priority[cpu]) {
e69954b9
PB
158 DPRINTF("ACK no pending IRQ\n");
159 return 1023;
160 }
9ee6e8bb
PB
161 s->last_active[new_irq][cpu] = s->running_irq[cpu];
162 /* Clear pending flags for both level and edge triggered interrupts.
163 Level triggered IRQs will be reasserted once they become inactive. */
164 GIC_CLEAR_PENDING(new_irq, GIC_TEST_MODEL(new_irq) ? ALL_CPU_MASK : cm);
165 gic_set_running_irq(s, cpu, new_irq);
e69954b9
PB
166 DPRINTF("ACK %d\n", new_irq);
167 return new_irq;
168}
169
fae15286 170void gic_complete_irq(GICState *s, int cpu, int irq)
e69954b9
PB
171{
172 int update = 0;
9ee6e8bb 173 int cm = 1 << cpu;
df628ff1 174 DPRINTF("EOI %d\n", irq);
a32134aa 175 if (irq >= s->num_irq) {
217bfb44
PM
176 /* This handles two cases:
177 * 1. If software writes the ID of a spurious interrupt [ie 1023]
178 * to the GICC_EOIR, the GIC ignores that write.
179 * 2. If software writes the number of a non-existent interrupt
180 * this must be a subcase of "value written does not match the last
181 * valid interrupt value read from the Interrupt Acknowledge
182 * register" and so this is UNPREDICTABLE. We choose to ignore it.
183 */
184 return;
185 }
9ee6e8bb 186 if (s->running_irq[cpu] == 1023)
e69954b9 187 return; /* No active IRQ. */
217bfb44
PM
188 /* Mark level triggered interrupts as pending if they are still
189 raised. */
190 if (!GIC_TEST_TRIGGER(irq) && GIC_TEST_ENABLED(irq, cm)
191 && GIC_TEST_LEVEL(irq, cm) && (GIC_TARGET(irq) & cm) != 0) {
192 DPRINTF("Set %d pending mask %x\n", irq, cm);
193 GIC_SET_PENDING(irq, cm);
194 update = 1;
e69954b9 195 }
9ee6e8bb 196 if (irq != s->running_irq[cpu]) {
e69954b9 197 /* Complete an IRQ that is not currently running. */
9ee6e8bb
PB
198 int tmp = s->running_irq[cpu];
199 while (s->last_active[tmp][cpu] != 1023) {
200 if (s->last_active[tmp][cpu] == irq) {
201 s->last_active[tmp][cpu] = s->last_active[irq][cpu];
e69954b9
PB
202 break;
203 }
9ee6e8bb 204 tmp = s->last_active[tmp][cpu];
e69954b9
PB
205 }
206 if (update) {
207 gic_update(s);
208 }
209 } else {
210 /* Complete the current running IRQ. */
9ee6e8bb 211 gic_set_running_irq(s, cpu, s->last_active[s->running_irq[cpu]][cpu]);
e69954b9
PB
212 }
213}
214
a8170e5e 215static uint32_t gic_dist_readb(void *opaque, hwaddr offset)
e69954b9 216{
fae15286 217 GICState *s = (GICState *)opaque;
e69954b9
PB
218 uint32_t res;
219 int irq;
220 int i;
9ee6e8bb
PB
221 int cpu;
222 int cm;
223 int mask;
e69954b9 224
926c4aff 225 cpu = gic_get_current_cpu(s);
9ee6e8bb 226 cm = 1 << cpu;
e69954b9
PB
227 if (offset < 0x100) {
228 if (offset == 0)
229 return s->enabled;
230 if (offset == 4)
a32134aa 231 return ((s->num_irq / 32) - 1) | ((NUM_CPU(s) - 1) << 5);
e69954b9
PB
232 if (offset < 0x08)
233 return 0;
b79f2265
RH
234 if (offset >= 0x80) {
235 /* Interrupt Security , RAZ/WI */
236 return 0;
237 }
e69954b9
PB
238 goto bad_reg;
239 } else if (offset < 0x200) {
240 /* Interrupt Set/Clear Enable. */
241 if (offset < 0x180)
242 irq = (offset - 0x100) * 8;
243 else
244 irq = (offset - 0x180) * 8;
9ee6e8bb 245 irq += GIC_BASE_IRQ;
a32134aa 246 if (irq >= s->num_irq)
e69954b9
PB
247 goto bad_reg;
248 res = 0;
249 for (i = 0; i < 8; i++) {
41bf234d 250 if (GIC_TEST_ENABLED(irq + i, cm)) {
e69954b9
PB
251 res |= (1 << i);
252 }
253 }
254 } else if (offset < 0x300) {
255 /* Interrupt Set/Clear Pending. */
256 if (offset < 0x280)
257 irq = (offset - 0x200) * 8;
258 else
259 irq = (offset - 0x280) * 8;
9ee6e8bb 260 irq += GIC_BASE_IRQ;
a32134aa 261 if (irq >= s->num_irq)
e69954b9
PB
262 goto bad_reg;
263 res = 0;
69253800 264 mask = (irq < GIC_INTERNAL) ? cm : ALL_CPU_MASK;
e69954b9 265 for (i = 0; i < 8; i++) {
9ee6e8bb 266 if (GIC_TEST_PENDING(irq + i, mask)) {
e69954b9
PB
267 res |= (1 << i);
268 }
269 }
270 } else if (offset < 0x400) {
271 /* Interrupt Active. */
9ee6e8bb 272 irq = (offset - 0x300) * 8 + GIC_BASE_IRQ;
a32134aa 273 if (irq >= s->num_irq)
e69954b9
PB
274 goto bad_reg;
275 res = 0;
69253800 276 mask = (irq < GIC_INTERNAL) ? cm : ALL_CPU_MASK;
e69954b9 277 for (i = 0; i < 8; i++) {
9ee6e8bb 278 if (GIC_TEST_ACTIVE(irq + i, mask)) {
e69954b9
PB
279 res |= (1 << i);
280 }
281 }
282 } else if (offset < 0x800) {
283 /* Interrupt Priority. */
9ee6e8bb 284 irq = (offset - 0x400) + GIC_BASE_IRQ;
a32134aa 285 if (irq >= s->num_irq)
e69954b9 286 goto bad_reg;
9ee6e8bb 287 res = GIC_GET_PRIORITY(irq, cpu);
e69954b9
PB
288 } else if (offset < 0xc00) {
289 /* Interrupt CPU Target. */
6b9680bb
PM
290 if (s->num_cpu == 1 && s->revision != REV_11MPCORE) {
291 /* For uniprocessor GICs these RAZ/WI */
292 res = 0;
9ee6e8bb 293 } else {
6b9680bb
PM
294 irq = (offset - 0x800) + GIC_BASE_IRQ;
295 if (irq >= s->num_irq) {
296 goto bad_reg;
297 }
298 if (irq >= 29 && irq <= 31) {
299 res = cm;
300 } else {
301 res = GIC_TARGET(irq);
302 }
9ee6e8bb 303 }
e69954b9
PB
304 } else if (offset < 0xf00) {
305 /* Interrupt Configuration. */
9ee6e8bb 306 irq = (offset - 0xc00) * 2 + GIC_BASE_IRQ;
a32134aa 307 if (irq >= s->num_irq)
e69954b9
PB
308 goto bad_reg;
309 res = 0;
310 for (i = 0; i < 4; i++) {
311 if (GIC_TEST_MODEL(irq + i))
312 res |= (1 << (i * 2));
313 if (GIC_TEST_TRIGGER(irq + i))
314 res |= (2 << (i * 2));
315 }
316 } else if (offset < 0xfe0) {
317 goto bad_reg;
318 } else /* offset >= 0xfe0 */ {
319 if (offset & 3) {
320 res = 0;
321 } else {
322 res = gic_id[(offset - 0xfe0) >> 2];
323 }
324 }
325 return res;
326bad_reg:
8c8dc39f
PM
327 qemu_log_mask(LOG_GUEST_ERROR,
328 "gic_dist_readb: Bad offset %x\n", (int)offset);
e69954b9
PB
329 return 0;
330}
331
a8170e5e 332static uint32_t gic_dist_readw(void *opaque, hwaddr offset)
e69954b9
PB
333{
334 uint32_t val;
335 val = gic_dist_readb(opaque, offset);
336 val |= gic_dist_readb(opaque, offset + 1) << 8;
337 return val;
338}
339
a8170e5e 340static uint32_t gic_dist_readl(void *opaque, hwaddr offset)
e69954b9
PB
341{
342 uint32_t val;
343 val = gic_dist_readw(opaque, offset);
344 val |= gic_dist_readw(opaque, offset + 2) << 16;
345 return val;
346}
347
a8170e5e 348static void gic_dist_writeb(void *opaque, hwaddr offset,
e69954b9
PB
349 uint32_t value)
350{
fae15286 351 GICState *s = (GICState *)opaque;
e69954b9
PB
352 int irq;
353 int i;
9ee6e8bb 354 int cpu;
e69954b9 355
926c4aff 356 cpu = gic_get_current_cpu(s);
e69954b9
PB
357 if (offset < 0x100) {
358 if (offset == 0) {
359 s->enabled = (value & 1);
360 DPRINTF("Distribution %sabled\n", s->enabled ? "En" : "Dis");
361 } else if (offset < 4) {
362 /* ignored. */
b79f2265
RH
363 } else if (offset >= 0x80) {
364 /* Interrupt Security Registers, RAZ/WI */
e69954b9
PB
365 } else {
366 goto bad_reg;
367 }
368 } else if (offset < 0x180) {
369 /* Interrupt Set Enable. */
9ee6e8bb 370 irq = (offset - 0x100) * 8 + GIC_BASE_IRQ;
a32134aa 371 if (irq >= s->num_irq)
e69954b9 372 goto bad_reg;
9ee6e8bb
PB
373 if (irq < 16)
374 value = 0xff;
e69954b9
PB
375 for (i = 0; i < 8; i++) {
376 if (value & (1 << i)) {
69253800
RR
377 int mask = (irq < GIC_INTERNAL) ? (1 << cpu) : GIC_TARGET(irq);
378 int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK;
41bf234d
RV
379
380 if (!GIC_TEST_ENABLED(irq + i, cm)) {
e69954b9 381 DPRINTF("Enabled IRQ %d\n", irq + i);
41bf234d
RV
382 }
383 GIC_SET_ENABLED(irq + i, cm);
e69954b9
PB
384 /* If a raised level triggered IRQ enabled then mark
385 is as pending. */
9ee6e8bb
PB
386 if (GIC_TEST_LEVEL(irq + i, mask)
387 && !GIC_TEST_TRIGGER(irq + i)) {
388 DPRINTF("Set %d pending mask %x\n", irq + i, mask);
389 GIC_SET_PENDING(irq + i, mask);
390 }
e69954b9
PB
391 }
392 }
393 } else if (offset < 0x200) {
394 /* Interrupt Clear Enable. */
9ee6e8bb 395 irq = (offset - 0x180) * 8 + GIC_BASE_IRQ;
a32134aa 396 if (irq >= s->num_irq)
e69954b9 397 goto bad_reg;
9ee6e8bb
PB
398 if (irq < 16)
399 value = 0;
e69954b9
PB
400 for (i = 0; i < 8; i++) {
401 if (value & (1 << i)) {
69253800 402 int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK;
41bf234d
RV
403
404 if (GIC_TEST_ENABLED(irq + i, cm)) {
e69954b9 405 DPRINTF("Disabled IRQ %d\n", irq + i);
41bf234d
RV
406 }
407 GIC_CLEAR_ENABLED(irq + i, cm);
e69954b9
PB
408 }
409 }
410 } else if (offset < 0x280) {
411 /* Interrupt Set Pending. */
9ee6e8bb 412 irq = (offset - 0x200) * 8 + GIC_BASE_IRQ;
a32134aa 413 if (irq >= s->num_irq)
e69954b9 414 goto bad_reg;
9ee6e8bb
PB
415 if (irq < 16)
416 irq = 0;
417
e69954b9
PB
418 for (i = 0; i < 8; i++) {
419 if (value & (1 << i)) {
9ee6e8bb 420 GIC_SET_PENDING(irq + i, GIC_TARGET(irq));
e69954b9
PB
421 }
422 }
423 } else if (offset < 0x300) {
424 /* Interrupt Clear Pending. */
9ee6e8bb 425 irq = (offset - 0x280) * 8 + GIC_BASE_IRQ;
a32134aa 426 if (irq >= s->num_irq)
e69954b9
PB
427 goto bad_reg;
428 for (i = 0; i < 8; i++) {
9ee6e8bb
PB
429 /* ??? This currently clears the pending bit for all CPUs, even
430 for per-CPU interrupts. It's unclear whether this is the
431 corect behavior. */
e69954b9 432 if (value & (1 << i)) {
9ee6e8bb 433 GIC_CLEAR_PENDING(irq + i, ALL_CPU_MASK);
e69954b9
PB
434 }
435 }
436 } else if (offset < 0x400) {
437 /* Interrupt Active. */
438 goto bad_reg;
439 } else if (offset < 0x800) {
440 /* Interrupt Priority. */
9ee6e8bb 441 irq = (offset - 0x400) + GIC_BASE_IRQ;
a32134aa 442 if (irq >= s->num_irq)
e69954b9 443 goto bad_reg;
69253800 444 if (irq < GIC_INTERNAL) {
9ee6e8bb
PB
445 s->priority1[irq][cpu] = value;
446 } else {
69253800 447 s->priority2[irq - GIC_INTERNAL] = value;
9ee6e8bb 448 }
e69954b9 449 } else if (offset < 0xc00) {
6b9680bb
PM
450 /* Interrupt CPU Target. RAZ/WI on uniprocessor GICs, with the
451 * annoying exception of the 11MPCore's GIC.
452 */
453 if (s->num_cpu != 1 || s->revision == REV_11MPCORE) {
454 irq = (offset - 0x800) + GIC_BASE_IRQ;
455 if (irq >= s->num_irq) {
456 goto bad_reg;
457 }
458 if (irq < 29) {
459 value = 0;
460 } else if (irq < GIC_INTERNAL) {
461 value = ALL_CPU_MASK;
462 }
463 s->irq_target[irq] = value & ALL_CPU_MASK;
464 }
e69954b9
PB
465 } else if (offset < 0xf00) {
466 /* Interrupt Configuration. */
9ee6e8bb 467 irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ;
a32134aa 468 if (irq >= s->num_irq)
e69954b9 469 goto bad_reg;
69253800 470 if (irq < GIC_INTERNAL)
9ee6e8bb 471 value |= 0xaa;
e69954b9
PB
472 for (i = 0; i < 4; i++) {
473 if (value & (1 << (i * 2))) {
474 GIC_SET_MODEL(irq + i);
475 } else {
476 GIC_CLEAR_MODEL(irq + i);
477 }
478 if (value & (2 << (i * 2))) {
479 GIC_SET_TRIGGER(irq + i);
480 } else {
481 GIC_CLEAR_TRIGGER(irq + i);
482 }
483 }
484 } else {
9ee6e8bb 485 /* 0xf00 is only handled for 32-bit writes. */
e69954b9
PB
486 goto bad_reg;
487 }
488 gic_update(s);
489 return;
490bad_reg:
8c8dc39f
PM
491 qemu_log_mask(LOG_GUEST_ERROR,
492 "gic_dist_writeb: Bad offset %x\n", (int)offset);
e69954b9
PB
493}
494
a8170e5e 495static void gic_dist_writew(void *opaque, hwaddr offset,
e69954b9
PB
496 uint32_t value)
497{
e69954b9
PB
498 gic_dist_writeb(opaque, offset, value & 0xff);
499 gic_dist_writeb(opaque, offset + 1, value >> 8);
500}
501
a8170e5e 502static void gic_dist_writel(void *opaque, hwaddr offset,
e69954b9
PB
503 uint32_t value)
504{
fae15286 505 GICState *s = (GICState *)opaque;
8da3ff18 506 if (offset == 0xf00) {
9ee6e8bb
PB
507 int cpu;
508 int irq;
509 int mask;
510
926c4aff 511 cpu = gic_get_current_cpu(s);
9ee6e8bb
PB
512 irq = value & 0x3ff;
513 switch ((value >> 24) & 3) {
514 case 0:
515 mask = (value >> 16) & ALL_CPU_MASK;
516 break;
517 case 1:
fa250144 518 mask = ALL_CPU_MASK ^ (1 << cpu);
9ee6e8bb
PB
519 break;
520 case 2:
fa250144 521 mask = 1 << cpu;
9ee6e8bb
PB
522 break;
523 default:
524 DPRINTF("Bad Soft Int target filter\n");
525 mask = ALL_CPU_MASK;
526 break;
527 }
528 GIC_SET_PENDING(irq, mask);
529 gic_update(s);
530 return;
531 }
e69954b9
PB
532 gic_dist_writew(opaque, offset, value & 0xffff);
533 gic_dist_writew(opaque, offset + 2, value >> 16);
534}
535
755c0802
AK
536static const MemoryRegionOps gic_dist_ops = {
537 .old_mmio = {
538 .read = { gic_dist_readb, gic_dist_readw, gic_dist_readl, },
539 .write = { gic_dist_writeb, gic_dist_writew, gic_dist_writel, },
540 },
541 .endianness = DEVICE_NATIVE_ENDIAN,
e69954b9
PB
542};
543
fae15286 544static uint32_t gic_cpu_read(GICState *s, int cpu, int offset)
e69954b9 545{
e69954b9
PB
546 switch (offset) {
547 case 0x00: /* Control */
9ee6e8bb 548 return s->cpu_enabled[cpu];
e69954b9 549 case 0x04: /* Priority mask */
9ee6e8bb 550 return s->priority_mask[cpu];
e69954b9
PB
551 case 0x08: /* Binary Point */
552 /* ??? Not implemented. */
553 return 0;
554 case 0x0c: /* Acknowledge */
9ee6e8bb 555 return gic_acknowledge_irq(s, cpu);
66a0a2cb 556 case 0x14: /* Running Priority */
9ee6e8bb 557 return s->running_priority[cpu];
e69954b9 558 case 0x18: /* Highest Pending Interrupt */
9ee6e8bb 559 return s->current_pending[cpu];
e69954b9 560 default:
8c8dc39f
PM
561 qemu_log_mask(LOG_GUEST_ERROR,
562 "gic_cpu_read: Bad offset %x\n", (int)offset);
e69954b9
PB
563 return 0;
564 }
565}
566
fae15286 567static void gic_cpu_write(GICState *s, int cpu, int offset, uint32_t value)
e69954b9 568{
e69954b9
PB
569 switch (offset) {
570 case 0x00: /* Control */
9ee6e8bb 571 s->cpu_enabled[cpu] = (value & 1);
9ab1b605 572 DPRINTF("CPU %d %sabled\n", cpu, s->cpu_enabled[cpu] ? "En" : "Dis");
e69954b9
PB
573 break;
574 case 0x04: /* Priority mask */
9ee6e8bb 575 s->priority_mask[cpu] = (value & 0xff);
e69954b9
PB
576 break;
577 case 0x08: /* Binary Point */
578 /* ??? Not implemented. */
579 break;
580 case 0x10: /* End Of Interrupt */
9ee6e8bb 581 return gic_complete_irq(s, cpu, value & 0x3ff);
e69954b9 582 default:
8c8dc39f
PM
583 qemu_log_mask(LOG_GUEST_ERROR,
584 "gic_cpu_write: Bad offset %x\n", (int)offset);
e69954b9
PB
585 return;
586 }
587 gic_update(s);
588}
e2c56465
PM
589
590/* Wrappers to read/write the GIC CPU interface for the current CPU */
a8170e5e 591static uint64_t gic_thiscpu_read(void *opaque, hwaddr addr,
e2c56465
PM
592 unsigned size)
593{
fae15286 594 GICState *s = (GICState *)opaque;
926c4aff 595 return gic_cpu_read(s, gic_get_current_cpu(s), addr);
e2c56465
PM
596}
597
a8170e5e 598static void gic_thiscpu_write(void *opaque, hwaddr addr,
e2c56465
PM
599 uint64_t value, unsigned size)
600{
fae15286 601 GICState *s = (GICState *)opaque;
926c4aff 602 gic_cpu_write(s, gic_get_current_cpu(s), addr, value);
e2c56465
PM
603}
604
605/* Wrappers to read/write the GIC CPU interface for a specific CPU.
fae15286 606 * These just decode the opaque pointer into GICState* + cpu id.
e2c56465 607 */
a8170e5e 608static uint64_t gic_do_cpu_read(void *opaque, hwaddr addr,
e2c56465
PM
609 unsigned size)
610{
fae15286
PM
611 GICState **backref = (GICState **)opaque;
612 GICState *s = *backref;
e2c56465 613 int id = (backref - s->backref);
0e4a398a 614 return gic_cpu_read(s, id, addr);
e2c56465
PM
615}
616
a8170e5e 617static void gic_do_cpu_write(void *opaque, hwaddr addr,
e2c56465
PM
618 uint64_t value, unsigned size)
619{
fae15286
PM
620 GICState **backref = (GICState **)opaque;
621 GICState *s = *backref;
e2c56465 622 int id = (backref - s->backref);
0e4a398a 623 gic_cpu_write(s, id, addr, value);
e2c56465
PM
624}
625
626static const MemoryRegionOps gic_thiscpu_ops = {
627 .read = gic_thiscpu_read,
628 .write = gic_thiscpu_write,
629 .endianness = DEVICE_NATIVE_ENDIAN,
630};
631
632static const MemoryRegionOps gic_cpu_ops = {
633 .read = gic_do_cpu_read,
634 .write = gic_do_cpu_write,
635 .endianness = DEVICE_NATIVE_ENDIAN,
636};
e69954b9 637
fae15286 638void gic_init_irqs_and_distributor(GICState *s, int num_irq)
e69954b9 639{
23e39294 640 int i;
41c1e2f5 641
544d1afa 642 i = s->num_irq - GIC_INTERNAL;
544d1afa
PM
643 /* For the GIC, also expose incoming GPIO lines for PPIs for each CPU.
644 * GPIO array layout is thus:
645 * [0..N-1] SPIs
646 * [N..N+31] PPIs for CPU 0
647 * [N+32..N+63] PPIs for CPU 1
648 * ...
649 */
84e4fccb
PM
650 if (s->revision != REV_NVIC) {
651 i += (GIC_INTERNAL * s->num_cpu);
652 }
544d1afa 653 qdev_init_gpio_in(&s->busdev.qdev, gic_set_irq, i);
c988bfad 654 for (i = 0; i < NUM_CPU(s); i++) {
fe7e8758 655 sysbus_init_irq(&s->busdev, &s->parent_irq[i]);
e69954b9 656 }
755c0802 657 memory_region_init_io(&s->iomem, &gic_dist_ops, s, "gic_dist", 0x1000);
2b518c56
PM
658}
659
2b518c56
PM
660static int arm_gic_init(SysBusDevice *dev)
661{
662 /* Device instance init function for the GIC sysbus device */
663 int i;
fae15286 664 GICState *s = FROM_SYSBUS(GICState, dev);
1e8cae4d
PM
665 ARMGICClass *agc = ARM_GIC_GET_CLASS(s);
666
667 agc->parent_init(dev);
668
2b518c56
PM
669 gic_init_irqs_and_distributor(s, s->num_irq);
670
e2c56465
PM
671 /* Memory regions for the CPU interfaces (NVIC doesn't have these):
672 * a region for "CPU interface for this core", then a region for
673 * "CPU interface for core 0", "for core 1", ...
674 * NB that the memory region size of 0x100 applies for the 11MPCore
675 * and also cores following the GIC v1 spec (ie A9).
676 * GIC v2 defines a larger memory region (0x1000) so this will need
677 * to be extended when we implement A15.
678 */
679 memory_region_init_io(&s->cpuiomem[0], &gic_thiscpu_ops, s,
680 "gic_cpu", 0x100);
681 for (i = 0; i < NUM_CPU(s); i++) {
682 s->backref[i] = s;
683 memory_region_init_io(&s->cpuiomem[i+1], &gic_cpu_ops, &s->backref[i],
684 "gic_cpu", 0x100);
685 }
496dbcd1
PM
686 /* Distributor */
687 sysbus_init_mmio(dev, &s->iomem);
688 /* cpu interfaces (one for "current cpu" plus one per cpu) */
689 for (i = 0; i <= NUM_CPU(s); i++) {
690 sysbus_init_mmio(dev, &s->cpuiomem[i]);
691 }
692 return 0;
693}
694
496dbcd1
PM
695static void arm_gic_class_init(ObjectClass *klass, void *data)
696{
697 DeviceClass *dc = DEVICE_CLASS(klass);
698 SysBusDeviceClass *sbc = SYS_BUS_DEVICE_CLASS(klass);
1e8cae4d
PM
699 ARMGICClass *agc = ARM_GIC_CLASS(klass);
700 agc->parent_init = sbc->init;
496dbcd1 701 sbc->init = arm_gic_init;
496dbcd1
PM
702 dc->no_user = 1;
703}
704
705static TypeInfo arm_gic_info = {
1e8cae4d
PM
706 .name = TYPE_ARM_GIC,
707 .parent = TYPE_ARM_GIC_COMMON,
fae15286 708 .instance_size = sizeof(GICState),
496dbcd1 709 .class_init = arm_gic_class_init,
998a74bc 710 .class_size = sizeof(ARMGICClass),
496dbcd1
PM
711};
712
713static void arm_gic_register_types(void)
714{
715 type_register_static(&arm_gic_info);
716}
717
718type_init(arm_gic_register_types)