xref: /qemu/hw/intc/arm_gic.c (revision 41ab7b55108e2699e7c2e77788465cb52a0b2c08)
1e69954b9Spbrook /*
29ee6e8bbSpbrook  * ARM Generic/Distributed Interrupt Controller
3e69954b9Spbrook  *
49ee6e8bbSpbrook  * Copyright (c) 2006-2007 CodeSourcery.
5e69954b9Spbrook  * Written by Paul Brook
6e69954b9Spbrook  *
78e31bf38SMatthew Fernandez  * This code is licensed under the GPL.
8e69954b9Spbrook  */
9e69954b9Spbrook 
109ee6e8bbSpbrook /* This file contains implementation code for the RealView EB interrupt
110d256bdcSPeter Maydell  * controller, MPCore distributed interrupt controller and ARMv7-M
120d256bdcSPeter Maydell  * Nested Vectored Interrupt Controller.
130d256bdcSPeter Maydell  * It is compiled in two ways:
140d256bdcSPeter Maydell  *  (1) as a standalone file to produce a sysbus device which is a GIC
150d256bdcSPeter Maydell  *  that can be used on the realview board and as one of the builtin
160d256bdcSPeter Maydell  *  private peripherals for the ARM MP CPUs (11MPCore, A9, etc)
170d256bdcSPeter Maydell  *  (2) by being directly #included into armv7m_nvic.c to produce the
180d256bdcSPeter Maydell  *  armv7m_nvic device.
190d256bdcSPeter Maydell  */
20e69954b9Spbrook 
2183c9f4caSPaolo Bonzini #include "hw/sysbus.h"
2247b43a1fSPaolo Bonzini #include "gic_internal.h"
23dfc08079SAndreas Färber #include "qom/cpu.h"
24386e2955SPeter Maydell 
25e69954b9Spbrook //#define DEBUG_GIC
26e69954b9Spbrook 
27e69954b9Spbrook #ifdef DEBUG_GIC
28001faf32SBlue Swirl #define DPRINTF(fmt, ...) \
295eb98401SPeter A. G. Crosthwaite do { fprintf(stderr, "arm_gic: " fmt , ## __VA_ARGS__); } while (0)
30e69954b9Spbrook #else
31001faf32SBlue Swirl #define DPRINTF(fmt, ...) do {} while(0)
32e69954b9Spbrook #endif
33e69954b9Spbrook 
342a29ddeeSPeter Maydell static const uint8_t gic_id[] = {
352a29ddeeSPeter Maydell     0x90, 0x13, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1
362a29ddeeSPeter Maydell };
372a29ddeeSPeter Maydell 
38c988bfadSPaul Brook #define NUM_CPU(s) ((s)->num_cpu)
399ee6e8bbSpbrook 
40fae15286SPeter Maydell static inline int gic_get_current_cpu(GICState *s)
41926c4affSPeter Maydell {
42926c4affSPeter Maydell     if (s->num_cpu > 1) {
434917cf44SAndreas Färber         return current_cpu->cpu_index;
44926c4affSPeter Maydell     }
45926c4affSPeter Maydell     return 0;
46926c4affSPeter Maydell }
47926c4affSPeter Maydell 
48e69954b9Spbrook /* TODO: Many places that call this routine could be optimized.  */
49e69954b9Spbrook /* Update interrupt status after enabled or pending bits have been changed.  */
50fae15286SPeter Maydell void gic_update(GICState *s)
51e69954b9Spbrook {
52e69954b9Spbrook     int best_irq;
53e69954b9Spbrook     int best_prio;
54e69954b9Spbrook     int irq;
559ee6e8bbSpbrook     int level;
569ee6e8bbSpbrook     int cpu;
579ee6e8bbSpbrook     int cm;
58e69954b9Spbrook 
59c988bfadSPaul Brook     for (cpu = 0; cpu < NUM_CPU(s); cpu++) {
609ee6e8bbSpbrook         cm = 1 << cpu;
619ee6e8bbSpbrook         s->current_pending[cpu] = 1023;
629ee6e8bbSpbrook         if (!s->enabled || !s->cpu_enabled[cpu]) {
639ee6e8bbSpbrook             qemu_irq_lower(s->parent_irq[cpu]);
64e69954b9Spbrook             return;
65e69954b9Spbrook         }
66e69954b9Spbrook         best_prio = 0x100;
67e69954b9Spbrook         best_irq = 1023;
68a32134aaSMark Langsdorf         for (irq = 0; irq < s->num_irq; irq++) {
6941bf234dSRabin Vincent             if (GIC_TEST_ENABLED(irq, cm) && GIC_TEST_PENDING(irq, cm)) {
709ee6e8bbSpbrook                 if (GIC_GET_PRIORITY(irq, cpu) < best_prio) {
719ee6e8bbSpbrook                     best_prio = GIC_GET_PRIORITY(irq, cpu);
72e69954b9Spbrook                     best_irq = irq;
73e69954b9Spbrook                 }
74e69954b9Spbrook             }
75e69954b9Spbrook         }
769ee6e8bbSpbrook         level = 0;
77cad065f1SPeter Maydell         if (best_prio < s->priority_mask[cpu]) {
789ee6e8bbSpbrook             s->current_pending[cpu] = best_irq;
799ee6e8bbSpbrook             if (best_prio < s->running_priority[cpu]) {
808c815fb3SPeter Crosthwaite                 DPRINTF("Raised pending IRQ %d (cpu %d)\n", best_irq, cpu);
819ee6e8bbSpbrook                 level = 1;
82e69954b9Spbrook             }
83e69954b9Spbrook         }
849ee6e8bbSpbrook         qemu_set_irq(s->parent_irq[cpu], level);
859ee6e8bbSpbrook     }
86e69954b9Spbrook }
87e69954b9Spbrook 
88fae15286SPeter Maydell void gic_set_pending_private(GICState *s, int cpu, int irq)
899ee6e8bbSpbrook {
909ee6e8bbSpbrook     int cm = 1 << cpu;
919ee6e8bbSpbrook 
929ee6e8bbSpbrook     if (GIC_TEST_PENDING(irq, cm))
939ee6e8bbSpbrook         return;
949ee6e8bbSpbrook 
959ee6e8bbSpbrook     DPRINTF("Set %d pending cpu %d\n", irq, cpu);
969ee6e8bbSpbrook     GIC_SET_PENDING(irq, cm);
979ee6e8bbSpbrook     gic_update(s);
989ee6e8bbSpbrook }
999ee6e8bbSpbrook 
1009ee6e8bbSpbrook /* Process a change in an external IRQ input.  */
101e69954b9Spbrook static void gic_set_irq(void *opaque, int irq, int level)
102e69954b9Spbrook {
103544d1afaSPeter Maydell     /* Meaning of the 'irq' parameter:
104544d1afaSPeter Maydell      *  [0..N-1] : external interrupts
105544d1afaSPeter Maydell      *  [N..N+31] : PPI (internal) interrupts for CPU 0
106544d1afaSPeter Maydell      *  [N+32..N+63] : PPI (internal interrupts for CPU 1
107544d1afaSPeter Maydell      *  ...
108544d1afaSPeter Maydell      */
109fae15286SPeter Maydell     GICState *s = (GICState *)opaque;
110544d1afaSPeter Maydell     int cm, target;
111544d1afaSPeter Maydell     if (irq < (s->num_irq - GIC_INTERNAL)) {
112e69954b9Spbrook         /* The first external input line is internal interrupt 32.  */
113544d1afaSPeter Maydell         cm = ALL_CPU_MASK;
11469253800SRusty Russell         irq += GIC_INTERNAL;
115544d1afaSPeter Maydell         target = GIC_TARGET(irq);
116544d1afaSPeter Maydell     } else {
117544d1afaSPeter Maydell         int cpu;
118544d1afaSPeter Maydell         irq -= (s->num_irq - GIC_INTERNAL);
119544d1afaSPeter Maydell         cpu = irq / GIC_INTERNAL;
120544d1afaSPeter Maydell         irq %= GIC_INTERNAL;
121544d1afaSPeter Maydell         cm = 1 << cpu;
122544d1afaSPeter Maydell         target = cm;
123544d1afaSPeter Maydell     }
124544d1afaSPeter Maydell 
125544d1afaSPeter Maydell     if (level == GIC_TEST_LEVEL(irq, cm)) {
126e69954b9Spbrook         return;
127544d1afaSPeter Maydell     }
128e69954b9Spbrook 
129e69954b9Spbrook     if (level) {
130544d1afaSPeter Maydell         GIC_SET_LEVEL(irq, cm);
13104050c5cSChristoffer Dall         if (GIC_TEST_EDGE_TRIGGER(irq) || GIC_TEST_ENABLED(irq, cm)) {
132544d1afaSPeter Maydell             DPRINTF("Set %d pending mask %x\n", irq, target);
133544d1afaSPeter Maydell             GIC_SET_PENDING(irq, target);
134e69954b9Spbrook         }
135e69954b9Spbrook     } else {
136544d1afaSPeter Maydell         GIC_CLEAR_LEVEL(irq, cm);
137e69954b9Spbrook     }
138e69954b9Spbrook     gic_update(s);
139e69954b9Spbrook }
140e69954b9Spbrook 
141fae15286SPeter Maydell static void gic_set_running_irq(GICState *s, int cpu, int irq)
142e69954b9Spbrook {
1439ee6e8bbSpbrook     s->running_irq[cpu] = irq;
1449ee6e8bbSpbrook     if (irq == 1023) {
1459ee6e8bbSpbrook         s->running_priority[cpu] = 0x100;
1469ee6e8bbSpbrook     } else {
1479ee6e8bbSpbrook         s->running_priority[cpu] = GIC_GET_PRIORITY(irq, cpu);
1489ee6e8bbSpbrook     }
149e69954b9Spbrook     gic_update(s);
150e69954b9Spbrook }
151e69954b9Spbrook 
152fae15286SPeter Maydell uint32_t gic_acknowledge_irq(GICState *s, int cpu)
153e69954b9Spbrook {
154e69954b9Spbrook     int new_irq;
1559ee6e8bbSpbrook     int cm = 1 << cpu;
1569ee6e8bbSpbrook     new_irq = s->current_pending[cpu];
1579ee6e8bbSpbrook     if (new_irq == 1023
1589ee6e8bbSpbrook             || GIC_GET_PRIORITY(new_irq, cpu) >= s->running_priority[cpu]) {
159e69954b9Spbrook         DPRINTF("ACK no pending IRQ\n");
160e69954b9Spbrook         return 1023;
161e69954b9Spbrook     }
1629ee6e8bbSpbrook     s->last_active[new_irq][cpu] = s->running_irq[cpu];
1639ee6e8bbSpbrook     /* Clear pending flags for both level and edge triggered interrupts.
1649ee6e8bbSpbrook        Level triggered IRQs will be reasserted once they become inactive.  */
1659ee6e8bbSpbrook     GIC_CLEAR_PENDING(new_irq, GIC_TEST_MODEL(new_irq) ? ALL_CPU_MASK : cm);
1669ee6e8bbSpbrook     gic_set_running_irq(s, cpu, new_irq);
167e69954b9Spbrook     DPRINTF("ACK %d\n", new_irq);
168e69954b9Spbrook     return new_irq;
169e69954b9Spbrook }
170e69954b9Spbrook 
1719df90ad0SChristoffer Dall void gic_set_priority(GICState *s, int cpu, int irq, uint8_t val)
1729df90ad0SChristoffer Dall {
1739df90ad0SChristoffer Dall     if (irq < GIC_INTERNAL) {
1749df90ad0SChristoffer Dall         s->priority1[irq][cpu] = val;
1759df90ad0SChristoffer Dall     } else {
1769df90ad0SChristoffer Dall         s->priority2[(irq) - GIC_INTERNAL] = val;
1779df90ad0SChristoffer Dall     }
1789df90ad0SChristoffer Dall }
1799df90ad0SChristoffer Dall 
180fae15286SPeter Maydell void gic_complete_irq(GICState *s, int cpu, int irq)
181e69954b9Spbrook {
182e69954b9Spbrook     int update = 0;
1839ee6e8bbSpbrook     int cm = 1 << cpu;
184df628ff1Spbrook     DPRINTF("EOI %d\n", irq);
185a32134aaSMark Langsdorf     if (irq >= s->num_irq) {
186217bfb44SPeter Maydell         /* This handles two cases:
187217bfb44SPeter Maydell          * 1. If software writes the ID of a spurious interrupt [ie 1023]
188217bfb44SPeter Maydell          * to the GICC_EOIR, the GIC ignores that write.
189217bfb44SPeter Maydell          * 2. If software writes the number of a non-existent interrupt
190217bfb44SPeter Maydell          * this must be a subcase of "value written does not match the last
191217bfb44SPeter Maydell          * valid interrupt value read from the Interrupt Acknowledge
192217bfb44SPeter Maydell          * register" and so this is UNPREDICTABLE. We choose to ignore it.
193217bfb44SPeter Maydell          */
194217bfb44SPeter Maydell         return;
195217bfb44SPeter Maydell     }
1969ee6e8bbSpbrook     if (s->running_irq[cpu] == 1023)
197e69954b9Spbrook         return; /* No active IRQ.  */
198e69954b9Spbrook     /* Mark level triggered interrupts as pending if they are still
199e69954b9Spbrook        raised.  */
20004050c5cSChristoffer Dall     if (!GIC_TEST_EDGE_TRIGGER(irq) && GIC_TEST_ENABLED(irq, cm)
2019ee6e8bbSpbrook         && GIC_TEST_LEVEL(irq, cm) && (GIC_TARGET(irq) & cm) != 0) {
2029ee6e8bbSpbrook         DPRINTF("Set %d pending mask %x\n", irq, cm);
2039ee6e8bbSpbrook         GIC_SET_PENDING(irq, cm);
204e69954b9Spbrook         update = 1;
205e69954b9Spbrook     }
2069ee6e8bbSpbrook     if (irq != s->running_irq[cpu]) {
207e69954b9Spbrook         /* Complete an IRQ that is not currently running.  */
2089ee6e8bbSpbrook         int tmp = s->running_irq[cpu];
2099ee6e8bbSpbrook         while (s->last_active[tmp][cpu] != 1023) {
2109ee6e8bbSpbrook             if (s->last_active[tmp][cpu] == irq) {
2119ee6e8bbSpbrook                 s->last_active[tmp][cpu] = s->last_active[irq][cpu];
212e69954b9Spbrook                 break;
213e69954b9Spbrook             }
2149ee6e8bbSpbrook             tmp = s->last_active[tmp][cpu];
215e69954b9Spbrook         }
216e69954b9Spbrook         if (update) {
217e69954b9Spbrook             gic_update(s);
218e69954b9Spbrook         }
219e69954b9Spbrook     } else {
220e69954b9Spbrook         /* Complete the current running IRQ.  */
2219ee6e8bbSpbrook         gic_set_running_irq(s, cpu, s->last_active[s->running_irq[cpu]][cpu]);
222e69954b9Spbrook     }
223e69954b9Spbrook }
224e69954b9Spbrook 
225a8170e5eSAvi Kivity static uint32_t gic_dist_readb(void *opaque, hwaddr offset)
226e69954b9Spbrook {
227fae15286SPeter Maydell     GICState *s = (GICState *)opaque;
228e69954b9Spbrook     uint32_t res;
229e69954b9Spbrook     int irq;
230e69954b9Spbrook     int i;
2319ee6e8bbSpbrook     int cpu;
2329ee6e8bbSpbrook     int cm;
2339ee6e8bbSpbrook     int mask;
234e69954b9Spbrook 
235926c4affSPeter Maydell     cpu = gic_get_current_cpu(s);
2369ee6e8bbSpbrook     cm = 1 << cpu;
237e69954b9Spbrook     if (offset < 0x100) {
238e69954b9Spbrook         if (offset == 0)
239e69954b9Spbrook             return s->enabled;
240e69954b9Spbrook         if (offset == 4)
241a32134aaSMark Langsdorf             return ((s->num_irq / 32) - 1) | ((NUM_CPU(s) - 1) << 5);
242e69954b9Spbrook         if (offset < 0x08)
243e69954b9Spbrook             return 0;
244b79f2265SRob Herring         if (offset >= 0x80) {
245b79f2265SRob Herring             /* Interrupt Security , RAZ/WI */
246b79f2265SRob Herring             return 0;
247b79f2265SRob Herring         }
248e69954b9Spbrook         goto bad_reg;
249e69954b9Spbrook     } else if (offset < 0x200) {
250e69954b9Spbrook         /* Interrupt Set/Clear Enable.  */
251e69954b9Spbrook         if (offset < 0x180)
252e69954b9Spbrook             irq = (offset - 0x100) * 8;
253e69954b9Spbrook         else
254e69954b9Spbrook             irq = (offset - 0x180) * 8;
2559ee6e8bbSpbrook         irq += GIC_BASE_IRQ;
256a32134aaSMark Langsdorf         if (irq >= s->num_irq)
257e69954b9Spbrook             goto bad_reg;
258e69954b9Spbrook         res = 0;
259e69954b9Spbrook         for (i = 0; i < 8; i++) {
26041bf234dSRabin Vincent             if (GIC_TEST_ENABLED(irq + i, cm)) {
261e69954b9Spbrook                 res |= (1 << i);
262e69954b9Spbrook             }
263e69954b9Spbrook         }
264e69954b9Spbrook     } else if (offset < 0x300) {
265e69954b9Spbrook         /* Interrupt Set/Clear Pending.  */
266e69954b9Spbrook         if (offset < 0x280)
267e69954b9Spbrook             irq = (offset - 0x200) * 8;
268e69954b9Spbrook         else
269e69954b9Spbrook             irq = (offset - 0x280) * 8;
2709ee6e8bbSpbrook         irq += GIC_BASE_IRQ;
271a32134aaSMark Langsdorf         if (irq >= s->num_irq)
272e69954b9Spbrook             goto bad_reg;
273e69954b9Spbrook         res = 0;
27469253800SRusty Russell         mask = (irq < GIC_INTERNAL) ?  cm : ALL_CPU_MASK;
275e69954b9Spbrook         for (i = 0; i < 8; i++) {
2769ee6e8bbSpbrook             if (GIC_TEST_PENDING(irq + i, mask)) {
277e69954b9Spbrook                 res |= (1 << i);
278e69954b9Spbrook             }
279e69954b9Spbrook         }
280e69954b9Spbrook     } else if (offset < 0x400) {
281e69954b9Spbrook         /* Interrupt Active.  */
2829ee6e8bbSpbrook         irq = (offset - 0x300) * 8 + GIC_BASE_IRQ;
283a32134aaSMark Langsdorf         if (irq >= s->num_irq)
284e69954b9Spbrook             goto bad_reg;
285e69954b9Spbrook         res = 0;
28669253800SRusty Russell         mask = (irq < GIC_INTERNAL) ?  cm : ALL_CPU_MASK;
287e69954b9Spbrook         for (i = 0; i < 8; i++) {
2889ee6e8bbSpbrook             if (GIC_TEST_ACTIVE(irq + i, mask)) {
289e69954b9Spbrook                 res |= (1 << i);
290e69954b9Spbrook             }
291e69954b9Spbrook         }
292e69954b9Spbrook     } else if (offset < 0x800) {
293e69954b9Spbrook         /* Interrupt Priority.  */
2949ee6e8bbSpbrook         irq = (offset - 0x400) + GIC_BASE_IRQ;
295a32134aaSMark Langsdorf         if (irq >= s->num_irq)
296e69954b9Spbrook             goto bad_reg;
2979ee6e8bbSpbrook         res = GIC_GET_PRIORITY(irq, cpu);
298e69954b9Spbrook     } else if (offset < 0xc00) {
299e69954b9Spbrook         /* Interrupt CPU Target.  */
3006b9680bbSPeter Maydell         if (s->num_cpu == 1 && s->revision != REV_11MPCORE) {
3016b9680bbSPeter Maydell             /* For uniprocessor GICs these RAZ/WI */
3026b9680bbSPeter Maydell             res = 0;
3036b9680bbSPeter Maydell         } else {
3049ee6e8bbSpbrook             irq = (offset - 0x800) + GIC_BASE_IRQ;
3056b9680bbSPeter Maydell             if (irq >= s->num_irq) {
306e69954b9Spbrook                 goto bad_reg;
3076b9680bbSPeter Maydell             }
3089ee6e8bbSpbrook             if (irq >= 29 && irq <= 31) {
3099ee6e8bbSpbrook                 res = cm;
3109ee6e8bbSpbrook             } else {
3119ee6e8bbSpbrook                 res = GIC_TARGET(irq);
3129ee6e8bbSpbrook             }
3136b9680bbSPeter Maydell         }
314e69954b9Spbrook     } else if (offset < 0xf00) {
315e69954b9Spbrook         /* Interrupt Configuration.  */
3169ee6e8bbSpbrook         irq = (offset - 0xc00) * 2 + GIC_BASE_IRQ;
317a32134aaSMark Langsdorf         if (irq >= s->num_irq)
318e69954b9Spbrook             goto bad_reg;
319e69954b9Spbrook         res = 0;
320e69954b9Spbrook         for (i = 0; i < 4; i++) {
321e69954b9Spbrook             if (GIC_TEST_MODEL(irq + i))
322e69954b9Spbrook                 res |= (1 << (i * 2));
32304050c5cSChristoffer Dall             if (GIC_TEST_EDGE_TRIGGER(irq + i))
324e69954b9Spbrook                 res |= (2 << (i * 2));
325e69954b9Spbrook         }
326e69954b9Spbrook     } else if (offset < 0xfe0) {
327e69954b9Spbrook         goto bad_reg;
328e69954b9Spbrook     } else /* offset >= 0xfe0 */ {
329e69954b9Spbrook         if (offset & 3) {
330e69954b9Spbrook             res = 0;
331e69954b9Spbrook         } else {
332e69954b9Spbrook             res = gic_id[(offset - 0xfe0) >> 2];
333e69954b9Spbrook         }
334e69954b9Spbrook     }
335e69954b9Spbrook     return res;
336e69954b9Spbrook bad_reg:
3378c8dc39fSPeter Maydell     qemu_log_mask(LOG_GUEST_ERROR,
3388c8dc39fSPeter Maydell                   "gic_dist_readb: Bad offset %x\n", (int)offset);
339e69954b9Spbrook     return 0;
340e69954b9Spbrook }
341e69954b9Spbrook 
342a8170e5eSAvi Kivity static uint32_t gic_dist_readw(void *opaque, hwaddr offset)
343e69954b9Spbrook {
344e69954b9Spbrook     uint32_t val;
345e69954b9Spbrook     val = gic_dist_readb(opaque, offset);
346e69954b9Spbrook     val |= gic_dist_readb(opaque, offset + 1) << 8;
347e69954b9Spbrook     return val;
348e69954b9Spbrook }
349e69954b9Spbrook 
350a8170e5eSAvi Kivity static uint32_t gic_dist_readl(void *opaque, hwaddr offset)
351e69954b9Spbrook {
352e69954b9Spbrook     uint32_t val;
353e69954b9Spbrook     val = gic_dist_readw(opaque, offset);
354e69954b9Spbrook     val |= gic_dist_readw(opaque, offset + 2) << 16;
355e69954b9Spbrook     return val;
356e69954b9Spbrook }
357e69954b9Spbrook 
358a8170e5eSAvi Kivity static void gic_dist_writeb(void *opaque, hwaddr offset,
359e69954b9Spbrook                             uint32_t value)
360e69954b9Spbrook {
361fae15286SPeter Maydell     GICState *s = (GICState *)opaque;
362e69954b9Spbrook     int irq;
363e69954b9Spbrook     int i;
3649ee6e8bbSpbrook     int cpu;
365e69954b9Spbrook 
366926c4affSPeter Maydell     cpu = gic_get_current_cpu(s);
367e69954b9Spbrook     if (offset < 0x100) {
368e69954b9Spbrook         if (offset == 0) {
369e69954b9Spbrook             s->enabled = (value & 1);
370e69954b9Spbrook             DPRINTF("Distribution %sabled\n", s->enabled ? "En" : "Dis");
371e69954b9Spbrook         } else if (offset < 4) {
372e69954b9Spbrook             /* ignored.  */
373b79f2265SRob Herring         } else if (offset >= 0x80) {
374b79f2265SRob Herring             /* Interrupt Security Registers, RAZ/WI */
375e69954b9Spbrook         } else {
376e69954b9Spbrook             goto bad_reg;
377e69954b9Spbrook         }
378e69954b9Spbrook     } else if (offset < 0x180) {
379e69954b9Spbrook         /* Interrupt Set Enable.  */
3809ee6e8bbSpbrook         irq = (offset - 0x100) * 8 + GIC_BASE_IRQ;
381a32134aaSMark Langsdorf         if (irq >= s->num_irq)
382e69954b9Spbrook             goto bad_reg;
383*41ab7b55SChristoffer Dall         if (irq < GIC_NR_SGIS) {
3849ee6e8bbSpbrook             value = 0xff;
385*41ab7b55SChristoffer Dall         }
386*41ab7b55SChristoffer Dall 
387e69954b9Spbrook         for (i = 0; i < 8; i++) {
388e69954b9Spbrook             if (value & (1 << i)) {
389f47b48fbSDaniel Sangorrin                 int mask =
390f47b48fbSDaniel Sangorrin                     (irq < GIC_INTERNAL) ? (1 << cpu) : GIC_TARGET(irq + i);
39169253800SRusty Russell                 int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK;
39241bf234dSRabin Vincent 
39341bf234dSRabin Vincent                 if (!GIC_TEST_ENABLED(irq + i, cm)) {
394e69954b9Spbrook                     DPRINTF("Enabled IRQ %d\n", irq + i);
39541bf234dSRabin Vincent                 }
39641bf234dSRabin Vincent                 GIC_SET_ENABLED(irq + i, cm);
397e69954b9Spbrook                 /* If a raised level triggered IRQ enabled then mark
398e69954b9Spbrook                    is as pending.  */
3999ee6e8bbSpbrook                 if (GIC_TEST_LEVEL(irq + i, mask)
40004050c5cSChristoffer Dall                         && !GIC_TEST_EDGE_TRIGGER(irq + i)) {
4019ee6e8bbSpbrook                     DPRINTF("Set %d pending mask %x\n", irq + i, mask);
4029ee6e8bbSpbrook                     GIC_SET_PENDING(irq + i, mask);
4039ee6e8bbSpbrook                 }
404e69954b9Spbrook             }
405e69954b9Spbrook         }
406e69954b9Spbrook     } else if (offset < 0x200) {
407e69954b9Spbrook         /* Interrupt Clear Enable.  */
4089ee6e8bbSpbrook         irq = (offset - 0x180) * 8 + GIC_BASE_IRQ;
409a32134aaSMark Langsdorf         if (irq >= s->num_irq)
410e69954b9Spbrook             goto bad_reg;
411*41ab7b55SChristoffer Dall         if (irq < GIC_NR_SGIS) {
4129ee6e8bbSpbrook             value = 0;
413*41ab7b55SChristoffer Dall         }
414*41ab7b55SChristoffer Dall 
415e69954b9Spbrook         for (i = 0; i < 8; i++) {
416e69954b9Spbrook             if (value & (1 << i)) {
41769253800SRusty Russell                 int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK;
41841bf234dSRabin Vincent 
41941bf234dSRabin Vincent                 if (GIC_TEST_ENABLED(irq + i, cm)) {
420e69954b9Spbrook                     DPRINTF("Disabled IRQ %d\n", irq + i);
42141bf234dSRabin Vincent                 }
42241bf234dSRabin Vincent                 GIC_CLEAR_ENABLED(irq + i, cm);
423e69954b9Spbrook             }
424e69954b9Spbrook         }
425e69954b9Spbrook     } else if (offset < 0x280) {
426e69954b9Spbrook         /* Interrupt Set Pending.  */
4279ee6e8bbSpbrook         irq = (offset - 0x200) * 8 + GIC_BASE_IRQ;
428a32134aaSMark Langsdorf         if (irq >= s->num_irq)
429e69954b9Spbrook             goto bad_reg;
430*41ab7b55SChristoffer Dall         if (irq < GIC_NR_SGIS) {
4319ee6e8bbSpbrook             irq = 0;
432*41ab7b55SChristoffer Dall         }
4339ee6e8bbSpbrook 
434e69954b9Spbrook         for (i = 0; i < 8; i++) {
435e69954b9Spbrook             if (value & (1 << i)) {
436f47b48fbSDaniel Sangorrin                 GIC_SET_PENDING(irq + i, GIC_TARGET(irq + i));
437e69954b9Spbrook             }
438e69954b9Spbrook         }
439e69954b9Spbrook     } else if (offset < 0x300) {
440e69954b9Spbrook         /* Interrupt Clear Pending.  */
4419ee6e8bbSpbrook         irq = (offset - 0x280) * 8 + GIC_BASE_IRQ;
442a32134aaSMark Langsdorf         if (irq >= s->num_irq)
443e69954b9Spbrook             goto bad_reg;
444e69954b9Spbrook         for (i = 0; i < 8; i++) {
4459ee6e8bbSpbrook             /* ??? This currently clears the pending bit for all CPUs, even
4469ee6e8bbSpbrook                for per-CPU interrupts.  It's unclear whether this is the
4479ee6e8bbSpbrook                corect behavior.  */
448e69954b9Spbrook             if (value & (1 << i)) {
4499ee6e8bbSpbrook                 GIC_CLEAR_PENDING(irq + i, ALL_CPU_MASK);
450e69954b9Spbrook             }
451e69954b9Spbrook         }
452e69954b9Spbrook     } else if (offset < 0x400) {
453e69954b9Spbrook         /* Interrupt Active.  */
454e69954b9Spbrook         goto bad_reg;
455e69954b9Spbrook     } else if (offset < 0x800) {
456e69954b9Spbrook         /* Interrupt Priority.  */
4579ee6e8bbSpbrook         irq = (offset - 0x400) + GIC_BASE_IRQ;
458a32134aaSMark Langsdorf         if (irq >= s->num_irq)
459e69954b9Spbrook             goto bad_reg;
4609df90ad0SChristoffer Dall         gic_set_priority(s, cpu, irq, value);
461e69954b9Spbrook     } else if (offset < 0xc00) {
4626b9680bbSPeter Maydell         /* Interrupt CPU Target. RAZ/WI on uniprocessor GICs, with the
4636b9680bbSPeter Maydell          * annoying exception of the 11MPCore's GIC.
4646b9680bbSPeter Maydell          */
4656b9680bbSPeter Maydell         if (s->num_cpu != 1 || s->revision == REV_11MPCORE) {
4669ee6e8bbSpbrook             irq = (offset - 0x800) + GIC_BASE_IRQ;
4676b9680bbSPeter Maydell             if (irq >= s->num_irq) {
468e69954b9Spbrook                 goto bad_reg;
4696b9680bbSPeter Maydell             }
4706b9680bbSPeter Maydell             if (irq < 29) {
4719ee6e8bbSpbrook                 value = 0;
4726b9680bbSPeter Maydell             } else if (irq < GIC_INTERNAL) {
4739ee6e8bbSpbrook                 value = ALL_CPU_MASK;
4746b9680bbSPeter Maydell             }
4759ee6e8bbSpbrook             s->irq_target[irq] = value & ALL_CPU_MASK;
4766b9680bbSPeter Maydell         }
477e69954b9Spbrook     } else if (offset < 0xf00) {
478e69954b9Spbrook         /* Interrupt Configuration.  */
4799ee6e8bbSpbrook         irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ;
480a32134aaSMark Langsdorf         if (irq >= s->num_irq)
481e69954b9Spbrook             goto bad_reg;
48269253800SRusty Russell         if (irq < GIC_INTERNAL)
4839ee6e8bbSpbrook             value |= 0xaa;
484e69954b9Spbrook         for (i = 0; i < 4; i++) {
485e69954b9Spbrook             if (value & (1 << (i * 2))) {
486e69954b9Spbrook                 GIC_SET_MODEL(irq + i);
487e69954b9Spbrook             } else {
488e69954b9Spbrook                 GIC_CLEAR_MODEL(irq + i);
489e69954b9Spbrook             }
490e69954b9Spbrook             if (value & (2 << (i * 2))) {
49104050c5cSChristoffer Dall                 GIC_SET_EDGE_TRIGGER(irq + i);
492e69954b9Spbrook             } else {
49304050c5cSChristoffer Dall                 GIC_CLEAR_EDGE_TRIGGER(irq + i);
494e69954b9Spbrook             }
495e69954b9Spbrook         }
496e69954b9Spbrook     } else {
4979ee6e8bbSpbrook         /* 0xf00 is only handled for 32-bit writes.  */
498e69954b9Spbrook         goto bad_reg;
499e69954b9Spbrook     }
500e69954b9Spbrook     gic_update(s);
501e69954b9Spbrook     return;
502e69954b9Spbrook bad_reg:
5038c8dc39fSPeter Maydell     qemu_log_mask(LOG_GUEST_ERROR,
5048c8dc39fSPeter Maydell                   "gic_dist_writeb: Bad offset %x\n", (int)offset);
505e69954b9Spbrook }
506e69954b9Spbrook 
507a8170e5eSAvi Kivity static void gic_dist_writew(void *opaque, hwaddr offset,
508e69954b9Spbrook                             uint32_t value)
509e69954b9Spbrook {
510e69954b9Spbrook     gic_dist_writeb(opaque, offset, value & 0xff);
511e69954b9Spbrook     gic_dist_writeb(opaque, offset + 1, value >> 8);
512e69954b9Spbrook }
513e69954b9Spbrook 
514a8170e5eSAvi Kivity static void gic_dist_writel(void *opaque, hwaddr offset,
515e69954b9Spbrook                             uint32_t value)
516e69954b9Spbrook {
517fae15286SPeter Maydell     GICState *s = (GICState *)opaque;
5188da3ff18Spbrook     if (offset == 0xf00) {
5199ee6e8bbSpbrook         int cpu;
5209ee6e8bbSpbrook         int irq;
5219ee6e8bbSpbrook         int mask;
5229ee6e8bbSpbrook 
523926c4affSPeter Maydell         cpu = gic_get_current_cpu(s);
5249ee6e8bbSpbrook         irq = value & 0x3ff;
5259ee6e8bbSpbrook         switch ((value >> 24) & 3) {
5269ee6e8bbSpbrook         case 0:
5279ee6e8bbSpbrook             mask = (value >> 16) & ALL_CPU_MASK;
5289ee6e8bbSpbrook             break;
5299ee6e8bbSpbrook         case 1:
530fa250144SAdam Lackorzynski             mask = ALL_CPU_MASK ^ (1 << cpu);
5319ee6e8bbSpbrook             break;
5329ee6e8bbSpbrook         case 2:
533fa250144SAdam Lackorzynski             mask = 1 << cpu;
5349ee6e8bbSpbrook             break;
5359ee6e8bbSpbrook         default:
5369ee6e8bbSpbrook             DPRINTF("Bad Soft Int target filter\n");
5379ee6e8bbSpbrook             mask = ALL_CPU_MASK;
5389ee6e8bbSpbrook             break;
5399ee6e8bbSpbrook         }
5409ee6e8bbSpbrook         GIC_SET_PENDING(irq, mask);
5419ee6e8bbSpbrook         gic_update(s);
5429ee6e8bbSpbrook         return;
5439ee6e8bbSpbrook     }
544e69954b9Spbrook     gic_dist_writew(opaque, offset, value & 0xffff);
545e69954b9Spbrook     gic_dist_writew(opaque, offset + 2, value >> 16);
546e69954b9Spbrook }
547e69954b9Spbrook 
548755c0802SAvi Kivity static const MemoryRegionOps gic_dist_ops = {
549755c0802SAvi Kivity     .old_mmio = {
550755c0802SAvi Kivity         .read = { gic_dist_readb, gic_dist_readw, gic_dist_readl, },
551755c0802SAvi Kivity         .write = { gic_dist_writeb, gic_dist_writew, gic_dist_writel, },
552755c0802SAvi Kivity     },
553755c0802SAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
554e69954b9Spbrook };
555e69954b9Spbrook 
556fae15286SPeter Maydell static uint32_t gic_cpu_read(GICState *s, int cpu, int offset)
557e69954b9Spbrook {
558e69954b9Spbrook     switch (offset) {
559e69954b9Spbrook     case 0x00: /* Control */
5609ee6e8bbSpbrook         return s->cpu_enabled[cpu];
561e69954b9Spbrook     case 0x04: /* Priority mask */
5629ee6e8bbSpbrook         return s->priority_mask[cpu];
563e69954b9Spbrook     case 0x08: /* Binary Point */
564e69954b9Spbrook         /* ??? Not implemented.  */
565e69954b9Spbrook         return 0;
566e69954b9Spbrook     case 0x0c: /* Acknowledge */
5679ee6e8bbSpbrook         return gic_acknowledge_irq(s, cpu);
56866a0a2cbSDong Xu Wang     case 0x14: /* Running Priority */
5699ee6e8bbSpbrook         return s->running_priority[cpu];
570e69954b9Spbrook     case 0x18: /* Highest Pending Interrupt */
5719ee6e8bbSpbrook         return s->current_pending[cpu];
572e69954b9Spbrook     default:
5738c8dc39fSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
5748c8dc39fSPeter Maydell                       "gic_cpu_read: Bad offset %x\n", (int)offset);
575e69954b9Spbrook         return 0;
576e69954b9Spbrook     }
577e69954b9Spbrook }
578e69954b9Spbrook 
579fae15286SPeter Maydell static void gic_cpu_write(GICState *s, int cpu, int offset, uint32_t value)
580e69954b9Spbrook {
581e69954b9Spbrook     switch (offset) {
582e69954b9Spbrook     case 0x00: /* Control */
5839ee6e8bbSpbrook         s->cpu_enabled[cpu] = (value & 1);
5849ab1b605SEvgeny Voevodin         DPRINTF("CPU %d %sabled\n", cpu, s->cpu_enabled[cpu] ? "En" : "Dis");
585e69954b9Spbrook         break;
586e69954b9Spbrook     case 0x04: /* Priority mask */
5879ee6e8bbSpbrook         s->priority_mask[cpu] = (value & 0xff);
588e69954b9Spbrook         break;
589e69954b9Spbrook     case 0x08: /* Binary Point */
590e69954b9Spbrook         /* ??? Not implemented.  */
591e69954b9Spbrook         break;
592e69954b9Spbrook     case 0x10: /* End Of Interrupt */
5939ee6e8bbSpbrook         return gic_complete_irq(s, cpu, value & 0x3ff);
594e69954b9Spbrook     default:
5958c8dc39fSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
5968c8dc39fSPeter Maydell                       "gic_cpu_write: Bad offset %x\n", (int)offset);
597e69954b9Spbrook         return;
598e69954b9Spbrook     }
599e69954b9Spbrook     gic_update(s);
600e69954b9Spbrook }
601e2c56465SPeter Maydell 
602e2c56465SPeter Maydell /* Wrappers to read/write the GIC CPU interface for the current CPU */
603a8170e5eSAvi Kivity static uint64_t gic_thiscpu_read(void *opaque, hwaddr addr,
604e2c56465SPeter Maydell                                  unsigned size)
605e2c56465SPeter Maydell {
606fae15286SPeter Maydell     GICState *s = (GICState *)opaque;
607926c4affSPeter Maydell     return gic_cpu_read(s, gic_get_current_cpu(s), addr);
608e2c56465SPeter Maydell }
609e2c56465SPeter Maydell 
610a8170e5eSAvi Kivity static void gic_thiscpu_write(void *opaque, hwaddr addr,
611e2c56465SPeter Maydell                               uint64_t value, unsigned size)
612e2c56465SPeter Maydell {
613fae15286SPeter Maydell     GICState *s = (GICState *)opaque;
614926c4affSPeter Maydell     gic_cpu_write(s, gic_get_current_cpu(s), addr, value);
615e2c56465SPeter Maydell }
616e2c56465SPeter Maydell 
617e2c56465SPeter Maydell /* Wrappers to read/write the GIC CPU interface for a specific CPU.
618fae15286SPeter Maydell  * These just decode the opaque pointer into GICState* + cpu id.
619e2c56465SPeter Maydell  */
620a8170e5eSAvi Kivity static uint64_t gic_do_cpu_read(void *opaque, hwaddr addr,
621e2c56465SPeter Maydell                                 unsigned size)
622e2c56465SPeter Maydell {
623fae15286SPeter Maydell     GICState **backref = (GICState **)opaque;
624fae15286SPeter Maydell     GICState *s = *backref;
625e2c56465SPeter Maydell     int id = (backref - s->backref);
6260e4a398aSPeter Maydell     return gic_cpu_read(s, id, addr);
627e2c56465SPeter Maydell }
628e2c56465SPeter Maydell 
629a8170e5eSAvi Kivity static void gic_do_cpu_write(void *opaque, hwaddr addr,
630e2c56465SPeter Maydell                              uint64_t value, unsigned size)
631e2c56465SPeter Maydell {
632fae15286SPeter Maydell     GICState **backref = (GICState **)opaque;
633fae15286SPeter Maydell     GICState *s = *backref;
634e2c56465SPeter Maydell     int id = (backref - s->backref);
6350e4a398aSPeter Maydell     gic_cpu_write(s, id, addr, value);
636e2c56465SPeter Maydell }
637e2c56465SPeter Maydell 
638e2c56465SPeter Maydell static const MemoryRegionOps gic_thiscpu_ops = {
639e2c56465SPeter Maydell     .read = gic_thiscpu_read,
640e2c56465SPeter Maydell     .write = gic_thiscpu_write,
641e2c56465SPeter Maydell     .endianness = DEVICE_NATIVE_ENDIAN,
642e2c56465SPeter Maydell };
643e2c56465SPeter Maydell 
644e2c56465SPeter Maydell static const MemoryRegionOps gic_cpu_ops = {
645e2c56465SPeter Maydell     .read = gic_do_cpu_read,
646e2c56465SPeter Maydell     .write = gic_do_cpu_write,
647e2c56465SPeter Maydell     .endianness = DEVICE_NATIVE_ENDIAN,
648e2c56465SPeter Maydell };
649e69954b9Spbrook 
650fae15286SPeter Maydell void gic_init_irqs_and_distributor(GICState *s, int num_irq)
651e69954b9Spbrook {
652285b4432SAndreas Färber     SysBusDevice *sbd = SYS_BUS_DEVICE(s);
6539ee6e8bbSpbrook     int i;
654e69954b9Spbrook 
655544d1afaSPeter Maydell     i = s->num_irq - GIC_INTERNAL;
656544d1afaSPeter Maydell     /* For the GIC, also expose incoming GPIO lines for PPIs for each CPU.
657544d1afaSPeter Maydell      * GPIO array layout is thus:
658544d1afaSPeter Maydell      *  [0..N-1] SPIs
659544d1afaSPeter Maydell      *  [N..N+31] PPIs for CPU 0
660544d1afaSPeter Maydell      *  [N+32..N+63] PPIs for CPU 1
661544d1afaSPeter Maydell      *   ...
662544d1afaSPeter Maydell      */
66384e4fccbSPeter Maydell     if (s->revision != REV_NVIC) {
664c48c6522SPeter Maydell         i += (GIC_INTERNAL * s->num_cpu);
66584e4fccbSPeter Maydell     }
666285b4432SAndreas Färber     qdev_init_gpio_in(DEVICE(s), gic_set_irq, i);
667c988bfadSPaul Brook     for (i = 0; i < NUM_CPU(s); i++) {
668285b4432SAndreas Färber         sysbus_init_irq(sbd, &s->parent_irq[i]);
6699ee6e8bbSpbrook     }
6701437c94bSPaolo Bonzini     memory_region_init_io(&s->iomem, OBJECT(s), &gic_dist_ops, s,
6711437c94bSPaolo Bonzini                           "gic_dist", 0x1000);
6722b518c56SPeter Maydell }
6732b518c56SPeter Maydell 
67453111180SPeter Maydell static void arm_gic_realize(DeviceState *dev, Error **errp)
6752b518c56SPeter Maydell {
67653111180SPeter Maydell     /* Device instance realize function for the GIC sysbus device */
6772b518c56SPeter Maydell     int i;
67853111180SPeter Maydell     GICState *s = ARM_GIC(dev);
67953111180SPeter Maydell     SysBusDevice *sbd = SYS_BUS_DEVICE(dev);
6801e8cae4dSPeter Maydell     ARMGICClass *agc = ARM_GIC_GET_CLASS(s);
6811e8cae4dSPeter Maydell 
68253111180SPeter Maydell     agc->parent_realize(dev, errp);
68353111180SPeter Maydell     if (error_is_set(errp)) {
68453111180SPeter Maydell         return;
68553111180SPeter Maydell     }
6861e8cae4dSPeter Maydell 
6872b518c56SPeter Maydell     gic_init_irqs_and_distributor(s, s->num_irq);
6882b518c56SPeter Maydell 
689e2c56465SPeter Maydell     /* Memory regions for the CPU interfaces (NVIC doesn't have these):
690e2c56465SPeter Maydell      * a region for "CPU interface for this core", then a region for
691e2c56465SPeter Maydell      * "CPU interface for core 0", "for core 1", ...
692e2c56465SPeter Maydell      * NB that the memory region size of 0x100 applies for the 11MPCore
693e2c56465SPeter Maydell      * and also cores following the GIC v1 spec (ie A9).
694e2c56465SPeter Maydell      * GIC v2 defines a larger memory region (0x1000) so this will need
695e2c56465SPeter Maydell      * to be extended when we implement A15.
696e2c56465SPeter Maydell      */
6971437c94bSPaolo Bonzini     memory_region_init_io(&s->cpuiomem[0], OBJECT(s), &gic_thiscpu_ops, s,
698e2c56465SPeter Maydell                           "gic_cpu", 0x100);
699e2c56465SPeter Maydell     for (i = 0; i < NUM_CPU(s); i++) {
700e2c56465SPeter Maydell         s->backref[i] = s;
7011437c94bSPaolo Bonzini         memory_region_init_io(&s->cpuiomem[i+1], OBJECT(s), &gic_cpu_ops,
7021437c94bSPaolo Bonzini                               &s->backref[i], "gic_cpu", 0x100);
703e2c56465SPeter Maydell     }
704496dbcd1SPeter Maydell     /* Distributor */
70553111180SPeter Maydell     sysbus_init_mmio(sbd, &s->iomem);
706496dbcd1SPeter Maydell     /* cpu interfaces (one for "current cpu" plus one per cpu) */
707496dbcd1SPeter Maydell     for (i = 0; i <= NUM_CPU(s); i++) {
70853111180SPeter Maydell         sysbus_init_mmio(sbd, &s->cpuiomem[i]);
709496dbcd1SPeter Maydell     }
710496dbcd1SPeter Maydell }
711496dbcd1SPeter Maydell 
712496dbcd1SPeter Maydell static void arm_gic_class_init(ObjectClass *klass, void *data)
713496dbcd1SPeter Maydell {
714496dbcd1SPeter Maydell     DeviceClass *dc = DEVICE_CLASS(klass);
7151e8cae4dSPeter Maydell     ARMGICClass *agc = ARM_GIC_CLASS(klass);
71653111180SPeter Maydell 
71753111180SPeter Maydell     agc->parent_realize = dc->realize;
71853111180SPeter Maydell     dc->realize = arm_gic_realize;
719496dbcd1SPeter Maydell }
720496dbcd1SPeter Maydell 
7218c43a6f0SAndreas Färber static const TypeInfo arm_gic_info = {
7221e8cae4dSPeter Maydell     .name = TYPE_ARM_GIC,
7231e8cae4dSPeter Maydell     .parent = TYPE_ARM_GIC_COMMON,
724fae15286SPeter Maydell     .instance_size = sizeof(GICState),
725496dbcd1SPeter Maydell     .class_init = arm_gic_class_init,
726998a74bcSPeter Maydell     .class_size = sizeof(ARMGICClass),
727496dbcd1SPeter Maydell };
728496dbcd1SPeter Maydell 
729496dbcd1SPeter Maydell static void arm_gic_register_types(void)
730496dbcd1SPeter Maydell {
731496dbcd1SPeter Maydell     type_register_static(&arm_gic_info);
732496dbcd1SPeter Maydell }
733496dbcd1SPeter Maydell 
734496dbcd1SPeter Maydell type_init(arm_gic_register_types)
735