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 218ef94f0bSPeter Maydell #include "qemu/osdep.h" 2283c9f4caSPaolo Bonzini #include "hw/sysbus.h" 2347b43a1fSPaolo Bonzini #include "gic_internal.h" 24da34e65cSMarkus Armbruster #include "qapi/error.h" 25dfc08079SAndreas Färber #include "qom/cpu.h" 2603dd024fSPaolo Bonzini #include "qemu/log.h" 272531088fSHollis Blanchard #include "trace.h" 285d721b78SAlexander Graf #include "sysemu/kvm.h" 29386e2955SPeter Maydell 3068bf93ceSAlex Bennée /* #define DEBUG_GIC */ 31e69954b9Spbrook 32e69954b9Spbrook #ifdef DEBUG_GIC 3368bf93ceSAlex Bennée #define DEBUG_GIC_GATE 1 34e69954b9Spbrook #else 3568bf93ceSAlex Bennée #define DEBUG_GIC_GATE 0 36e69954b9Spbrook #endif 37e69954b9Spbrook 3868bf93ceSAlex Bennée #define DPRINTF(fmt, ...) do { \ 3968bf93ceSAlex Bennée if (DEBUG_GIC_GATE) { \ 4068bf93ceSAlex Bennée fprintf(stderr, "%s: " fmt, __func__, ## __VA_ARGS__); \ 4168bf93ceSAlex Bennée } \ 4268bf93ceSAlex Bennée } while (0) 4368bf93ceSAlex Bennée 443355c360SAlistair Francis static const uint8_t gic_id_11mpcore[] = { 453355c360SAlistair Francis 0x00, 0x00, 0x00, 0x00, 0x90, 0x13, 0x04, 0x00, 0x0d, 0xf0, 0x05, 0xb1 463355c360SAlistair Francis }; 473355c360SAlistair Francis 483355c360SAlistair Francis static const uint8_t gic_id_gicv1[] = { 493355c360SAlistair Francis 0x04, 0x00, 0x00, 0x00, 0x90, 0xb3, 0x1b, 0x00, 0x0d, 0xf0, 0x05, 0xb1 503355c360SAlistair Francis }; 513355c360SAlistair Francis 523355c360SAlistair Francis static const uint8_t gic_id_gicv2[] = { 533355c360SAlistair Francis 0x04, 0x00, 0x00, 0x00, 0x90, 0xb4, 0x2b, 0x00, 0x0d, 0xf0, 0x05, 0xb1 542a29ddeeSPeter Maydell }; 552a29ddeeSPeter Maydell 56fae15286SPeter Maydell static inline int gic_get_current_cpu(GICState *s) 57926c4affSPeter Maydell { 58926c4affSPeter Maydell if (s->num_cpu > 1) { 594917cf44SAndreas Färber return current_cpu->cpu_index; 60926c4affSPeter Maydell } 61926c4affSPeter Maydell return 0; 62926c4affSPeter Maydell } 63926c4affSPeter Maydell 64c27a5ba9SFabian Aggeler /* Return true if this GIC config has interrupt groups, which is 65c27a5ba9SFabian Aggeler * true if we're a GICv2, or a GICv1 with the security extensions. 66c27a5ba9SFabian Aggeler */ 67c27a5ba9SFabian Aggeler static inline bool gic_has_groups(GICState *s) 68c27a5ba9SFabian Aggeler { 69c27a5ba9SFabian Aggeler return s->revision == 2 || s->security_extn; 70c27a5ba9SFabian Aggeler } 71c27a5ba9SFabian Aggeler 72e69954b9Spbrook /* TODO: Many places that call this routine could be optimized. */ 73e69954b9Spbrook /* Update interrupt status after enabled or pending bits have been changed. */ 74fae15286SPeter Maydell void gic_update(GICState *s) 75e69954b9Spbrook { 76e69954b9Spbrook int best_irq; 77e69954b9Spbrook int best_prio; 78e69954b9Spbrook int irq; 79dadbb58fSPeter Maydell int irq_level, fiq_level; 809ee6e8bbSpbrook int cpu; 819ee6e8bbSpbrook int cm; 82e69954b9Spbrook 83b95690c9SWei Huang for (cpu = 0; cpu < s->num_cpu; cpu++) { 849ee6e8bbSpbrook cm = 1 << cpu; 859ee6e8bbSpbrook s->current_pending[cpu] = 1023; 86679aa175SFabian Aggeler if (!(s->ctlr & (GICD_CTLR_EN_GRP0 | GICD_CTLR_EN_GRP1)) 8732951860SFabian Aggeler || !(s->cpu_ctlr[cpu] & (GICC_CTLR_EN_GRP0 | GICC_CTLR_EN_GRP1))) { 889ee6e8bbSpbrook qemu_irq_lower(s->parent_irq[cpu]); 89dadbb58fSPeter Maydell qemu_irq_lower(s->parent_fiq[cpu]); 90235069a3SJohan Karlsson continue; 91e69954b9Spbrook } 92e69954b9Spbrook best_prio = 0x100; 93e69954b9Spbrook best_irq = 1023; 94a32134aaSMark Langsdorf for (irq = 0; irq < s->num_irq; irq++) { 95b52b81e4SSergey Fedorov if (GIC_TEST_ENABLED(irq, cm) && gic_test_pending(s, irq, cm) && 96*91f4e18dSLuc MICHEL (!GIC_TEST_ACTIVE(irq, cm)) && 97b52b81e4SSergey Fedorov (irq < GIC_INTERNAL || GIC_TARGET(irq) & cm)) { 989ee6e8bbSpbrook if (GIC_GET_PRIORITY(irq, cpu) < best_prio) { 999ee6e8bbSpbrook best_prio = GIC_GET_PRIORITY(irq, cpu); 100e69954b9Spbrook best_irq = irq; 101e69954b9Spbrook } 102e69954b9Spbrook } 103e69954b9Spbrook } 104dadbb58fSPeter Maydell 1052531088fSHollis Blanchard if (best_irq != 1023) { 1062531088fSHollis Blanchard trace_gic_update_bestirq(cpu, best_irq, best_prio, 1072531088fSHollis Blanchard s->priority_mask[cpu], s->running_priority[cpu]); 1082531088fSHollis Blanchard } 1092531088fSHollis Blanchard 110dadbb58fSPeter Maydell irq_level = fiq_level = 0; 111dadbb58fSPeter Maydell 112cad065f1SPeter Maydell if (best_prio < s->priority_mask[cpu]) { 1139ee6e8bbSpbrook s->current_pending[cpu] = best_irq; 1149ee6e8bbSpbrook if (best_prio < s->running_priority[cpu]) { 115dadbb58fSPeter Maydell int group = GIC_TEST_GROUP(best_irq, cm); 116dadbb58fSPeter Maydell 117dadbb58fSPeter Maydell if (extract32(s->ctlr, group, 1) && 118dadbb58fSPeter Maydell extract32(s->cpu_ctlr[cpu], group, 1)) { 119dadbb58fSPeter Maydell if (group == 0 && s->cpu_ctlr[cpu] & GICC_CTLR_FIQ_EN) { 120dadbb58fSPeter Maydell DPRINTF("Raised pending FIQ %d (cpu %d)\n", 121dadbb58fSPeter Maydell best_irq, cpu); 122dadbb58fSPeter Maydell fiq_level = 1; 1232531088fSHollis Blanchard trace_gic_update_set_irq(cpu, "fiq", fiq_level); 124dadbb58fSPeter Maydell } else { 125dadbb58fSPeter Maydell DPRINTF("Raised pending IRQ %d (cpu %d)\n", 126dadbb58fSPeter Maydell best_irq, cpu); 127dadbb58fSPeter Maydell irq_level = 1; 1282531088fSHollis Blanchard trace_gic_update_set_irq(cpu, "irq", irq_level); 129e69954b9Spbrook } 130e69954b9Spbrook } 131dadbb58fSPeter Maydell } 132dadbb58fSPeter Maydell } 133dadbb58fSPeter Maydell 134dadbb58fSPeter Maydell qemu_set_irq(s->parent_irq[cpu], irq_level); 135dadbb58fSPeter Maydell qemu_set_irq(s->parent_fiq[cpu], fiq_level); 1369ee6e8bbSpbrook } 137e69954b9Spbrook } 138e69954b9Spbrook 139fae15286SPeter Maydell void gic_set_pending_private(GICState *s, int cpu, int irq) 1409ee6e8bbSpbrook { 1419ee6e8bbSpbrook int cm = 1 << cpu; 1429ee6e8bbSpbrook 1438d999995SChristoffer Dall if (gic_test_pending(s, irq, cm)) { 1449ee6e8bbSpbrook return; 1458d999995SChristoffer Dall } 1469ee6e8bbSpbrook 1479ee6e8bbSpbrook DPRINTF("Set %d pending cpu %d\n", irq, cpu); 1489ee6e8bbSpbrook GIC_SET_PENDING(irq, cm); 1499ee6e8bbSpbrook gic_update(s); 1509ee6e8bbSpbrook } 1519ee6e8bbSpbrook 1528d999995SChristoffer Dall static void gic_set_irq_11mpcore(GICState *s, int irq, int level, 1538d999995SChristoffer Dall int cm, int target) 1548d999995SChristoffer Dall { 1558d999995SChristoffer Dall if (level) { 1568d999995SChristoffer Dall GIC_SET_LEVEL(irq, cm); 1578d999995SChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq) || GIC_TEST_ENABLED(irq, cm)) { 1588d999995SChristoffer Dall DPRINTF("Set %d pending mask %x\n", irq, target); 1598d999995SChristoffer Dall GIC_SET_PENDING(irq, target); 1608d999995SChristoffer Dall } 1618d999995SChristoffer Dall } else { 1628d999995SChristoffer Dall GIC_CLEAR_LEVEL(irq, cm); 1638d999995SChristoffer Dall } 1648d999995SChristoffer Dall } 1658d999995SChristoffer Dall 1668d999995SChristoffer Dall static void gic_set_irq_generic(GICState *s, int irq, int level, 1678d999995SChristoffer Dall int cm, int target) 1688d999995SChristoffer Dall { 1698d999995SChristoffer Dall if (level) { 1708d999995SChristoffer Dall GIC_SET_LEVEL(irq, cm); 1718d999995SChristoffer Dall DPRINTF("Set %d pending mask %x\n", irq, target); 1728d999995SChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq)) { 1738d999995SChristoffer Dall GIC_SET_PENDING(irq, target); 1748d999995SChristoffer Dall } 1758d999995SChristoffer Dall } else { 1768d999995SChristoffer Dall GIC_CLEAR_LEVEL(irq, cm); 1778d999995SChristoffer Dall } 1788d999995SChristoffer Dall } 1798d999995SChristoffer Dall 1809ee6e8bbSpbrook /* Process a change in an external IRQ input. */ 181e69954b9Spbrook static void gic_set_irq(void *opaque, int irq, int level) 182e69954b9Spbrook { 183544d1afaSPeter Maydell /* Meaning of the 'irq' parameter: 184544d1afaSPeter Maydell * [0..N-1] : external interrupts 185544d1afaSPeter Maydell * [N..N+31] : PPI (internal) interrupts for CPU 0 186544d1afaSPeter Maydell * [N+32..N+63] : PPI (internal interrupts for CPU 1 187544d1afaSPeter Maydell * ... 188544d1afaSPeter Maydell */ 189fae15286SPeter Maydell GICState *s = (GICState *)opaque; 190544d1afaSPeter Maydell int cm, target; 191544d1afaSPeter Maydell if (irq < (s->num_irq - GIC_INTERNAL)) { 192e69954b9Spbrook /* The first external input line is internal interrupt 32. */ 193544d1afaSPeter Maydell cm = ALL_CPU_MASK; 19469253800SRusty Russell irq += GIC_INTERNAL; 195544d1afaSPeter Maydell target = GIC_TARGET(irq); 196544d1afaSPeter Maydell } else { 197544d1afaSPeter Maydell int cpu; 198544d1afaSPeter Maydell irq -= (s->num_irq - GIC_INTERNAL); 199544d1afaSPeter Maydell cpu = irq / GIC_INTERNAL; 200544d1afaSPeter Maydell irq %= GIC_INTERNAL; 201544d1afaSPeter Maydell cm = 1 << cpu; 202544d1afaSPeter Maydell target = cm; 203544d1afaSPeter Maydell } 204544d1afaSPeter Maydell 20540d22500SChristoffer Dall assert(irq >= GIC_NR_SGIS); 20640d22500SChristoffer Dall 207544d1afaSPeter Maydell if (level == GIC_TEST_LEVEL(irq, cm)) { 208e69954b9Spbrook return; 209544d1afaSPeter Maydell } 210e69954b9Spbrook 2113bc4b52cSMarcin Krzeminski if (s->revision == REV_11MPCORE) { 2128d999995SChristoffer Dall gic_set_irq_11mpcore(s, irq, level, cm, target); 213e69954b9Spbrook } else { 2148d999995SChristoffer Dall gic_set_irq_generic(s, irq, level, cm, target); 215e69954b9Spbrook } 2162531088fSHollis Blanchard trace_gic_set_irq(irq, level, cm, target); 2178d999995SChristoffer Dall 218e69954b9Spbrook gic_update(s); 219e69954b9Spbrook } 220e69954b9Spbrook 2217c0fa108SFabian Aggeler static uint16_t gic_get_current_pending_irq(GICState *s, int cpu, 2227c0fa108SFabian Aggeler MemTxAttrs attrs) 2237c0fa108SFabian Aggeler { 2247c0fa108SFabian Aggeler uint16_t pending_irq = s->current_pending[cpu]; 2257c0fa108SFabian Aggeler 2267c0fa108SFabian Aggeler if (pending_irq < GIC_MAXIRQ && gic_has_groups(s)) { 2277c0fa108SFabian Aggeler int group = GIC_TEST_GROUP(pending_irq, (1 << cpu)); 2287c0fa108SFabian Aggeler /* On a GIC without the security extensions, reading this register 2297c0fa108SFabian Aggeler * behaves in the same way as a secure access to a GIC with them. 2307c0fa108SFabian Aggeler */ 2317c0fa108SFabian Aggeler bool secure = !s->security_extn || attrs.secure; 2327c0fa108SFabian Aggeler 2337c0fa108SFabian Aggeler if (group == 0 && !secure) { 2347c0fa108SFabian Aggeler /* Group0 interrupts hidden from Non-secure access */ 2357c0fa108SFabian Aggeler return 1023; 2367c0fa108SFabian Aggeler } 2377c0fa108SFabian Aggeler if (group == 1 && secure && !(s->cpu_ctlr[cpu] & GICC_CTLR_ACK_CTL)) { 2387c0fa108SFabian Aggeler /* Group1 interrupts only seen by Secure access if 2397c0fa108SFabian Aggeler * AckCtl bit set. 2407c0fa108SFabian Aggeler */ 2417c0fa108SFabian Aggeler return 1022; 2427c0fa108SFabian Aggeler } 2437c0fa108SFabian Aggeler } 2447c0fa108SFabian Aggeler return pending_irq; 2457c0fa108SFabian Aggeler } 2467c0fa108SFabian Aggeler 247df92cfa6SPeter Maydell static int gic_get_group_priority(GICState *s, int cpu, int irq) 248df92cfa6SPeter Maydell { 249df92cfa6SPeter Maydell /* Return the group priority of the specified interrupt 250df92cfa6SPeter Maydell * (which is the top bits of its priority, with the number 251df92cfa6SPeter Maydell * of bits masked determined by the applicable binary point register). 252df92cfa6SPeter Maydell */ 253df92cfa6SPeter Maydell int bpr; 254df92cfa6SPeter Maydell uint32_t mask; 255df92cfa6SPeter Maydell 256df92cfa6SPeter Maydell if (gic_has_groups(s) && 257df92cfa6SPeter Maydell !(s->cpu_ctlr[cpu] & GICC_CTLR_CBPR) && 258df92cfa6SPeter Maydell GIC_TEST_GROUP(irq, (1 << cpu))) { 259df92cfa6SPeter Maydell bpr = s->abpr[cpu]; 260df92cfa6SPeter Maydell } else { 261df92cfa6SPeter Maydell bpr = s->bpr[cpu]; 262df92cfa6SPeter Maydell } 263df92cfa6SPeter Maydell 264df92cfa6SPeter Maydell /* a BPR of 0 means the group priority bits are [7:1]; 265df92cfa6SPeter Maydell * a BPR of 1 means they are [7:2], and so on down to 266df92cfa6SPeter Maydell * a BPR of 7 meaning no group priority bits at all. 267df92cfa6SPeter Maydell */ 268df92cfa6SPeter Maydell mask = ~0U << ((bpr & 7) + 1); 269df92cfa6SPeter Maydell 270df92cfa6SPeter Maydell return GIC_GET_PRIORITY(irq, cpu) & mask; 271df92cfa6SPeter Maydell } 272df92cfa6SPeter Maydell 27372889c8aSPeter Maydell static void gic_activate_irq(GICState *s, int cpu, int irq) 274e69954b9Spbrook { 27572889c8aSPeter Maydell /* Set the appropriate Active Priority Register bit for this IRQ, 27672889c8aSPeter Maydell * and update the running priority. 27772889c8aSPeter Maydell */ 27872889c8aSPeter Maydell int prio = gic_get_group_priority(s, cpu, irq); 27972889c8aSPeter Maydell int preemption_level = prio >> (GIC_MIN_BPR + 1); 28072889c8aSPeter Maydell int regno = preemption_level / 32; 28172889c8aSPeter Maydell int bitno = preemption_level % 32; 28272889c8aSPeter Maydell 28372889c8aSPeter Maydell if (gic_has_groups(s) && GIC_TEST_GROUP(irq, (1 << cpu))) { 284a8595957SFrançois Baldassari s->nsapr[regno][cpu] |= (1 << bitno); 2859ee6e8bbSpbrook } else { 286a8595957SFrançois Baldassari s->apr[regno][cpu] |= (1 << bitno); 2879ee6e8bbSpbrook } 28872889c8aSPeter Maydell 28972889c8aSPeter Maydell s->running_priority[cpu] = prio; 290d5523a13SPeter Maydell GIC_SET_ACTIVE(irq, 1 << cpu); 29172889c8aSPeter Maydell } 29272889c8aSPeter Maydell 29372889c8aSPeter Maydell static int gic_get_prio_from_apr_bits(GICState *s, int cpu) 29472889c8aSPeter Maydell { 29572889c8aSPeter Maydell /* Recalculate the current running priority for this CPU based 29672889c8aSPeter Maydell * on the set bits in the Active Priority Registers. 29772889c8aSPeter Maydell */ 29872889c8aSPeter Maydell int i; 29972889c8aSPeter Maydell for (i = 0; i < GIC_NR_APRS; i++) { 30072889c8aSPeter Maydell uint32_t apr = s->apr[i][cpu] | s->nsapr[i][cpu]; 30172889c8aSPeter Maydell if (!apr) { 30272889c8aSPeter Maydell continue; 30372889c8aSPeter Maydell } 30472889c8aSPeter Maydell return (i * 32 + ctz32(apr)) << (GIC_MIN_BPR + 1); 30572889c8aSPeter Maydell } 30672889c8aSPeter Maydell return 0x100; 30772889c8aSPeter Maydell } 30872889c8aSPeter Maydell 30972889c8aSPeter Maydell static void gic_drop_prio(GICState *s, int cpu, int group) 31072889c8aSPeter Maydell { 31172889c8aSPeter Maydell /* Drop the priority of the currently active interrupt in the 31272889c8aSPeter Maydell * specified group. 31372889c8aSPeter Maydell * 31472889c8aSPeter Maydell * Note that we can guarantee (because of the requirement to nest 31572889c8aSPeter Maydell * GICC_IAR reads [which activate an interrupt and raise priority] 31672889c8aSPeter Maydell * with GICC_EOIR writes [which drop the priority for the interrupt]) 31772889c8aSPeter Maydell * that the interrupt we're being called for is the highest priority 31872889c8aSPeter Maydell * active interrupt, meaning that it has the lowest set bit in the 31972889c8aSPeter Maydell * APR registers. 32072889c8aSPeter Maydell * 32172889c8aSPeter Maydell * If the guest does not honour the ordering constraints then the 32272889c8aSPeter Maydell * behaviour of the GIC is UNPREDICTABLE, which for us means that 32372889c8aSPeter Maydell * the values of the APR registers might become incorrect and the 32472889c8aSPeter Maydell * running priority will be wrong, so interrupts that should preempt 32572889c8aSPeter Maydell * might not do so, and interrupts that should not preempt might do so. 32672889c8aSPeter Maydell */ 32772889c8aSPeter Maydell int i; 32872889c8aSPeter Maydell 32972889c8aSPeter Maydell for (i = 0; i < GIC_NR_APRS; i++) { 33072889c8aSPeter Maydell uint32_t *papr = group ? &s->nsapr[i][cpu] : &s->apr[i][cpu]; 33172889c8aSPeter Maydell if (!*papr) { 33272889c8aSPeter Maydell continue; 33372889c8aSPeter Maydell } 33472889c8aSPeter Maydell /* Clear lowest set bit */ 33572889c8aSPeter Maydell *papr &= *papr - 1; 33672889c8aSPeter Maydell break; 33772889c8aSPeter Maydell } 33872889c8aSPeter Maydell 33972889c8aSPeter Maydell s->running_priority[cpu] = gic_get_prio_from_apr_bits(s, cpu); 340e69954b9Spbrook } 341e69954b9Spbrook 342c5619bf9SFabian Aggeler uint32_t gic_acknowledge_irq(GICState *s, int cpu, MemTxAttrs attrs) 343e69954b9Spbrook { 34440d22500SChristoffer Dall int ret, irq, src; 3459ee6e8bbSpbrook int cm = 1 << cpu; 346c5619bf9SFabian Aggeler 347c5619bf9SFabian Aggeler /* gic_get_current_pending_irq() will return 1022 or 1023 appropriately 348c5619bf9SFabian Aggeler * for the case where this GIC supports grouping and the pending interrupt 349c5619bf9SFabian Aggeler * is in the wrong group. 350c5619bf9SFabian Aggeler */ 351a8f15a27SDaniel P. Berrange irq = gic_get_current_pending_irq(s, cpu, attrs); 3522531088fSHollis Blanchard trace_gic_acknowledge_irq(cpu, irq); 353c5619bf9SFabian Aggeler 354c5619bf9SFabian Aggeler if (irq >= GIC_MAXIRQ) { 355c5619bf9SFabian Aggeler DPRINTF("ACK, no pending interrupt or it is hidden: %d\n", irq); 356c5619bf9SFabian Aggeler return irq; 357c5619bf9SFabian Aggeler } 358c5619bf9SFabian Aggeler 359c5619bf9SFabian Aggeler if (GIC_GET_PRIORITY(irq, cpu) >= s->running_priority[cpu]) { 360c5619bf9SFabian Aggeler DPRINTF("ACK, pending interrupt (%d) has insufficient priority\n", irq); 361e69954b9Spbrook return 1023; 362e69954b9Spbrook } 36340d22500SChristoffer Dall 3647c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 3659ee6e8bbSpbrook /* Clear pending flags for both level and edge triggered interrupts. 36640d22500SChristoffer Dall * Level triggered IRQs will be reasserted once they become inactive. 36740d22500SChristoffer Dall */ 36840d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 36940d22500SChristoffer Dall ret = irq; 37040d22500SChristoffer Dall } else { 37140d22500SChristoffer Dall if (irq < GIC_NR_SGIS) { 37240d22500SChristoffer Dall /* Lookup the source CPU for the SGI and clear this in the 37340d22500SChristoffer Dall * sgi_pending map. Return the src and clear the overall pending 37440d22500SChristoffer Dall * state on this CPU if the SGI is not pending from any CPUs. 37540d22500SChristoffer Dall */ 37640d22500SChristoffer Dall assert(s->sgi_pending[irq][cpu] != 0); 37740d22500SChristoffer Dall src = ctz32(s->sgi_pending[irq][cpu]); 37840d22500SChristoffer Dall s->sgi_pending[irq][cpu] &= ~(1 << src); 37940d22500SChristoffer Dall if (s->sgi_pending[irq][cpu] == 0) { 38040d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 38140d22500SChristoffer Dall } 38240d22500SChristoffer Dall ret = irq | ((src & 0x7) << 10); 38340d22500SChristoffer Dall } else { 38440d22500SChristoffer Dall /* Clear pending state for both level and edge triggered 38540d22500SChristoffer Dall * interrupts. (level triggered interrupts with an active line 38640d22500SChristoffer Dall * remain pending, see gic_test_pending) 38740d22500SChristoffer Dall */ 38840d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 38940d22500SChristoffer Dall ret = irq; 39040d22500SChristoffer Dall } 39140d22500SChristoffer Dall } 39240d22500SChristoffer Dall 39372889c8aSPeter Maydell gic_activate_irq(s, cpu, irq); 39472889c8aSPeter Maydell gic_update(s); 39540d22500SChristoffer Dall DPRINTF("ACK %d\n", irq); 39640d22500SChristoffer Dall return ret; 397e69954b9Spbrook } 398e69954b9Spbrook 39981508470SFabian Aggeler void gic_set_priority(GICState *s, int cpu, int irq, uint8_t val, 40081508470SFabian Aggeler MemTxAttrs attrs) 4019df90ad0SChristoffer Dall { 40281508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 40381508470SFabian Aggeler if (!GIC_TEST_GROUP(irq, (1 << cpu))) { 40481508470SFabian Aggeler return; /* Ignore Non-secure access of Group0 IRQ */ 40581508470SFabian Aggeler } 40681508470SFabian Aggeler val = 0x80 | (val >> 1); /* Non-secure view */ 40781508470SFabian Aggeler } 40881508470SFabian Aggeler 4099df90ad0SChristoffer Dall if (irq < GIC_INTERNAL) { 4109df90ad0SChristoffer Dall s->priority1[irq][cpu] = val; 4119df90ad0SChristoffer Dall } else { 4129df90ad0SChristoffer Dall s->priority2[(irq) - GIC_INTERNAL] = val; 4139df90ad0SChristoffer Dall } 4149df90ad0SChristoffer Dall } 4159df90ad0SChristoffer Dall 41681508470SFabian Aggeler static uint32_t gic_get_priority(GICState *s, int cpu, int irq, 41781508470SFabian Aggeler MemTxAttrs attrs) 41881508470SFabian Aggeler { 41981508470SFabian Aggeler uint32_t prio = GIC_GET_PRIORITY(irq, cpu); 42081508470SFabian Aggeler 42181508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 42281508470SFabian Aggeler if (!GIC_TEST_GROUP(irq, (1 << cpu))) { 42381508470SFabian Aggeler return 0; /* Non-secure access cannot read priority of Group0 IRQ */ 42481508470SFabian Aggeler } 42581508470SFabian Aggeler prio = (prio << 1) & 0xff; /* Non-secure view */ 42681508470SFabian Aggeler } 42781508470SFabian Aggeler return prio; 42881508470SFabian Aggeler } 42981508470SFabian Aggeler 43081508470SFabian Aggeler static void gic_set_priority_mask(GICState *s, int cpu, uint8_t pmask, 43181508470SFabian Aggeler MemTxAttrs attrs) 43281508470SFabian Aggeler { 43381508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 43481508470SFabian Aggeler if (s->priority_mask[cpu] & 0x80) { 43581508470SFabian Aggeler /* Priority Mask in upper half */ 43681508470SFabian Aggeler pmask = 0x80 | (pmask >> 1); 43781508470SFabian Aggeler } else { 43881508470SFabian Aggeler /* Non-secure write ignored if priority mask is in lower half */ 43981508470SFabian Aggeler return; 44081508470SFabian Aggeler } 44181508470SFabian Aggeler } 44281508470SFabian Aggeler s->priority_mask[cpu] = pmask; 44381508470SFabian Aggeler } 44481508470SFabian Aggeler 44581508470SFabian Aggeler static uint32_t gic_get_priority_mask(GICState *s, int cpu, MemTxAttrs attrs) 44681508470SFabian Aggeler { 44781508470SFabian Aggeler uint32_t pmask = s->priority_mask[cpu]; 44881508470SFabian Aggeler 44981508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 45081508470SFabian Aggeler if (pmask & 0x80) { 45181508470SFabian Aggeler /* Priority Mask in upper half, return Non-secure view */ 45281508470SFabian Aggeler pmask = (pmask << 1) & 0xff; 45381508470SFabian Aggeler } else { 45481508470SFabian Aggeler /* Priority Mask in lower half, RAZ */ 45581508470SFabian Aggeler pmask = 0; 45681508470SFabian Aggeler } 45781508470SFabian Aggeler } 45881508470SFabian Aggeler return pmask; 45981508470SFabian Aggeler } 46081508470SFabian Aggeler 46132951860SFabian Aggeler static uint32_t gic_get_cpu_control(GICState *s, int cpu, MemTxAttrs attrs) 46232951860SFabian Aggeler { 46332951860SFabian Aggeler uint32_t ret = s->cpu_ctlr[cpu]; 46432951860SFabian Aggeler 46532951860SFabian Aggeler if (s->security_extn && !attrs.secure) { 46632951860SFabian Aggeler /* Construct the NS banked view of GICC_CTLR from the correct 46732951860SFabian Aggeler * bits of the S banked view. We don't need to move the bypass 46832951860SFabian Aggeler * control bits because we don't implement that (IMPDEF) part 46932951860SFabian Aggeler * of the GIC architecture. 47032951860SFabian Aggeler */ 47132951860SFabian Aggeler ret = (ret & (GICC_CTLR_EN_GRP1 | GICC_CTLR_EOIMODE_NS)) >> 1; 47232951860SFabian Aggeler } 47332951860SFabian Aggeler return ret; 47432951860SFabian Aggeler } 47532951860SFabian Aggeler 47632951860SFabian Aggeler static void gic_set_cpu_control(GICState *s, int cpu, uint32_t value, 47732951860SFabian Aggeler MemTxAttrs attrs) 47832951860SFabian Aggeler { 47932951860SFabian Aggeler uint32_t mask; 48032951860SFabian Aggeler 48132951860SFabian Aggeler if (s->security_extn && !attrs.secure) { 48232951860SFabian Aggeler /* The NS view can only write certain bits in the register; 48332951860SFabian Aggeler * the rest are unchanged 48432951860SFabian Aggeler */ 48532951860SFabian Aggeler mask = GICC_CTLR_EN_GRP1; 48632951860SFabian Aggeler if (s->revision == 2) { 48732951860SFabian Aggeler mask |= GICC_CTLR_EOIMODE_NS; 48832951860SFabian Aggeler } 48932951860SFabian Aggeler s->cpu_ctlr[cpu] &= ~mask; 49032951860SFabian Aggeler s->cpu_ctlr[cpu] |= (value << 1) & mask; 49132951860SFabian Aggeler } else { 49232951860SFabian Aggeler if (s->revision == 2) { 49332951860SFabian Aggeler mask = s->security_extn ? GICC_CTLR_V2_S_MASK : GICC_CTLR_V2_MASK; 49432951860SFabian Aggeler } else { 49532951860SFabian Aggeler mask = s->security_extn ? GICC_CTLR_V1_S_MASK : GICC_CTLR_V1_MASK; 49632951860SFabian Aggeler } 49732951860SFabian Aggeler s->cpu_ctlr[cpu] = value & mask; 49832951860SFabian Aggeler } 49932951860SFabian Aggeler DPRINTF("CPU Interface %d: Group0 Interrupts %sabled, " 50032951860SFabian Aggeler "Group1 Interrupts %sabled\n", cpu, 50132951860SFabian Aggeler (s->cpu_ctlr[cpu] & GICC_CTLR_EN_GRP0) ? "En" : "Dis", 50232951860SFabian Aggeler (s->cpu_ctlr[cpu] & GICC_CTLR_EN_GRP1) ? "En" : "Dis"); 50332951860SFabian Aggeler } 50432951860SFabian Aggeler 50508efa9f2SFabian Aggeler static uint8_t gic_get_running_priority(GICState *s, int cpu, MemTxAttrs attrs) 50608efa9f2SFabian Aggeler { 50708efa9f2SFabian Aggeler if (s->security_extn && !attrs.secure) { 50808efa9f2SFabian Aggeler if (s->running_priority[cpu] & 0x80) { 50908efa9f2SFabian Aggeler /* Running priority in upper half of range: return the Non-secure 51008efa9f2SFabian Aggeler * view of the priority. 51108efa9f2SFabian Aggeler */ 51208efa9f2SFabian Aggeler return s->running_priority[cpu] << 1; 51308efa9f2SFabian Aggeler } else { 51408efa9f2SFabian Aggeler /* Running priority in lower half of range: RAZ */ 51508efa9f2SFabian Aggeler return 0; 51608efa9f2SFabian Aggeler } 51708efa9f2SFabian Aggeler } else { 51808efa9f2SFabian Aggeler return s->running_priority[cpu]; 51908efa9f2SFabian Aggeler } 52008efa9f2SFabian Aggeler } 52108efa9f2SFabian Aggeler 522a55c910eSPeter Maydell /* Return true if we should split priority drop and interrupt deactivation, 523a55c910eSPeter Maydell * ie whether the relevant EOIMode bit is set. 524a55c910eSPeter Maydell */ 525a55c910eSPeter Maydell static bool gic_eoi_split(GICState *s, int cpu, MemTxAttrs attrs) 526a55c910eSPeter Maydell { 527a55c910eSPeter Maydell if (s->revision != 2) { 528a55c910eSPeter Maydell /* Before GICv2 prio-drop and deactivate are not separable */ 529a55c910eSPeter Maydell return false; 530a55c910eSPeter Maydell } 531a55c910eSPeter Maydell if (s->security_extn && !attrs.secure) { 532a55c910eSPeter Maydell return s->cpu_ctlr[cpu] & GICC_CTLR_EOIMODE_NS; 533a55c910eSPeter Maydell } 534a55c910eSPeter Maydell return s->cpu_ctlr[cpu] & GICC_CTLR_EOIMODE; 535a55c910eSPeter Maydell } 536a55c910eSPeter Maydell 537a55c910eSPeter Maydell static void gic_deactivate_irq(GICState *s, int cpu, int irq, MemTxAttrs attrs) 538a55c910eSPeter Maydell { 539a55c910eSPeter Maydell int cm = 1 << cpu; 540a55c910eSPeter Maydell int group = gic_has_groups(s) && GIC_TEST_GROUP(irq, cm); 541a55c910eSPeter Maydell 542a55c910eSPeter Maydell if (!gic_eoi_split(s, cpu, attrs)) { 543a55c910eSPeter Maydell /* This is UNPREDICTABLE; we choose to ignore it */ 544a55c910eSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 545a55c910eSPeter Maydell "gic_deactivate_irq: GICC_DIR write when EOIMode clear"); 546a55c910eSPeter Maydell return; 547a55c910eSPeter Maydell } 548a55c910eSPeter Maydell 549a55c910eSPeter Maydell if (s->security_extn && !attrs.secure && !group) { 550a55c910eSPeter Maydell DPRINTF("Non-secure DI for Group0 interrupt %d ignored\n", irq); 551a55c910eSPeter Maydell return; 552a55c910eSPeter Maydell } 553a55c910eSPeter Maydell 554a55c910eSPeter Maydell GIC_CLEAR_ACTIVE(irq, cm); 555a55c910eSPeter Maydell } 556a55c910eSPeter Maydell 557f9c6a7f1SFabian Aggeler void gic_complete_irq(GICState *s, int cpu, int irq, MemTxAttrs attrs) 558e69954b9Spbrook { 5599ee6e8bbSpbrook int cm = 1 << cpu; 56072889c8aSPeter Maydell int group; 56172889c8aSPeter Maydell 562df628ff1Spbrook DPRINTF("EOI %d\n", irq); 563a32134aaSMark Langsdorf if (irq >= s->num_irq) { 564217bfb44SPeter Maydell /* This handles two cases: 565217bfb44SPeter Maydell * 1. If software writes the ID of a spurious interrupt [ie 1023] 566217bfb44SPeter Maydell * to the GICC_EOIR, the GIC ignores that write. 567217bfb44SPeter Maydell * 2. If software writes the number of a non-existent interrupt 568217bfb44SPeter Maydell * this must be a subcase of "value written does not match the last 569217bfb44SPeter Maydell * valid interrupt value read from the Interrupt Acknowledge 570217bfb44SPeter Maydell * register" and so this is UNPREDICTABLE. We choose to ignore it. 571217bfb44SPeter Maydell */ 572217bfb44SPeter Maydell return; 573217bfb44SPeter Maydell } 57472889c8aSPeter Maydell if (s->running_priority[cpu] == 0x100) { 575e69954b9Spbrook return; /* No active IRQ. */ 57672889c8aSPeter Maydell } 5778d999995SChristoffer Dall 5783bc4b52cSMarcin Krzeminski if (s->revision == REV_11MPCORE) { 579e69954b9Spbrook /* Mark level triggered interrupts as pending if they are still 580e69954b9Spbrook raised. */ 58104050c5cSChristoffer Dall if (!GIC_TEST_EDGE_TRIGGER(irq) && GIC_TEST_ENABLED(irq, cm) 5829ee6e8bbSpbrook && GIC_TEST_LEVEL(irq, cm) && (GIC_TARGET(irq) & cm) != 0) { 5839ee6e8bbSpbrook DPRINTF("Set %d pending mask %x\n", irq, cm); 5849ee6e8bbSpbrook GIC_SET_PENDING(irq, cm); 585e69954b9Spbrook } 5868d999995SChristoffer Dall } 5878d999995SChristoffer Dall 58872889c8aSPeter Maydell group = gic_has_groups(s) && GIC_TEST_GROUP(irq, cm); 58972889c8aSPeter Maydell 59072889c8aSPeter Maydell if (s->security_extn && !attrs.secure && !group) { 591f9c6a7f1SFabian Aggeler DPRINTF("Non-secure EOI for Group0 interrupt %d ignored\n", irq); 592f9c6a7f1SFabian Aggeler return; 593f9c6a7f1SFabian Aggeler } 594f9c6a7f1SFabian Aggeler 595f9c6a7f1SFabian Aggeler /* Secure EOI with GICC_CTLR.AckCtl == 0 when the IRQ is a Group 1 596f9c6a7f1SFabian Aggeler * interrupt is UNPREDICTABLE. We choose to handle it as if AckCtl == 1, 597f9c6a7f1SFabian Aggeler * i.e. go ahead and complete the irq anyway. 598f9c6a7f1SFabian Aggeler */ 599f9c6a7f1SFabian Aggeler 60072889c8aSPeter Maydell gic_drop_prio(s, cpu, group); 601a55c910eSPeter Maydell 602a55c910eSPeter Maydell /* In GICv2 the guest can choose to split priority-drop and deactivate */ 603a55c910eSPeter Maydell if (!gic_eoi_split(s, cpu, attrs)) { 604d5523a13SPeter Maydell GIC_CLEAR_ACTIVE(irq, cm); 605a55c910eSPeter Maydell } 606e69954b9Spbrook gic_update(s); 607e69954b9Spbrook } 608e69954b9Spbrook 609a9d85353SPeter Maydell static uint32_t gic_dist_readb(void *opaque, hwaddr offset, MemTxAttrs attrs) 610e69954b9Spbrook { 611fae15286SPeter Maydell GICState *s = (GICState *)opaque; 612e69954b9Spbrook uint32_t res; 613e69954b9Spbrook int irq; 614e69954b9Spbrook int i; 6159ee6e8bbSpbrook int cpu; 6169ee6e8bbSpbrook int cm; 6179ee6e8bbSpbrook int mask; 618e69954b9Spbrook 619926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 6209ee6e8bbSpbrook cm = 1 << cpu; 621e69954b9Spbrook if (offset < 0x100) { 622679aa175SFabian Aggeler if (offset == 0) { /* GICD_CTLR */ 623679aa175SFabian Aggeler if (s->security_extn && !attrs.secure) { 624679aa175SFabian Aggeler /* The NS bank of this register is just an alias of the 625679aa175SFabian Aggeler * EnableGrp1 bit in the S bank version. 626679aa175SFabian Aggeler */ 627679aa175SFabian Aggeler return extract32(s->ctlr, 1, 1); 628679aa175SFabian Aggeler } else { 629679aa175SFabian Aggeler return s->ctlr; 630679aa175SFabian Aggeler } 631679aa175SFabian Aggeler } 632e69954b9Spbrook if (offset == 4) 6335543d1abSFabian Aggeler /* Interrupt Controller Type Register */ 6345543d1abSFabian Aggeler return ((s->num_irq / 32) - 1) 635b95690c9SWei Huang | ((s->num_cpu - 1) << 5) 6365543d1abSFabian Aggeler | (s->security_extn << 10); 637e69954b9Spbrook if (offset < 0x08) 638e69954b9Spbrook return 0; 639b79f2265SRob Herring if (offset >= 0x80) { 640c27a5ba9SFabian Aggeler /* Interrupt Group Registers: these RAZ/WI if this is an NS 641c27a5ba9SFabian Aggeler * access to a GIC with the security extensions, or if the GIC 642c27a5ba9SFabian Aggeler * doesn't have groups at all. 643c27a5ba9SFabian Aggeler */ 644c27a5ba9SFabian Aggeler res = 0; 645c27a5ba9SFabian Aggeler if (!(s->security_extn && !attrs.secure) && gic_has_groups(s)) { 646c27a5ba9SFabian Aggeler /* Every byte offset holds 8 group status bits */ 647c27a5ba9SFabian Aggeler irq = (offset - 0x080) * 8 + GIC_BASE_IRQ; 648c27a5ba9SFabian Aggeler if (irq >= s->num_irq) { 649c27a5ba9SFabian Aggeler goto bad_reg; 650c27a5ba9SFabian Aggeler } 651c27a5ba9SFabian Aggeler for (i = 0; i < 8; i++) { 652c27a5ba9SFabian Aggeler if (GIC_TEST_GROUP(irq + i, cm)) { 653c27a5ba9SFabian Aggeler res |= (1 << i); 654c27a5ba9SFabian Aggeler } 655c27a5ba9SFabian Aggeler } 656c27a5ba9SFabian Aggeler } 657c27a5ba9SFabian Aggeler return res; 658b79f2265SRob Herring } 659e69954b9Spbrook goto bad_reg; 660e69954b9Spbrook } else if (offset < 0x200) { 661e69954b9Spbrook /* Interrupt Set/Clear Enable. */ 662e69954b9Spbrook if (offset < 0x180) 663e69954b9Spbrook irq = (offset - 0x100) * 8; 664e69954b9Spbrook else 665e69954b9Spbrook irq = (offset - 0x180) * 8; 6669ee6e8bbSpbrook irq += GIC_BASE_IRQ; 667a32134aaSMark Langsdorf if (irq >= s->num_irq) 668e69954b9Spbrook goto bad_reg; 669e69954b9Spbrook res = 0; 670e69954b9Spbrook for (i = 0; i < 8; i++) { 671fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 672fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 673fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 674fea8a08eSJens Wiklander } 675fea8a08eSJens Wiklander 67641bf234dSRabin Vincent if (GIC_TEST_ENABLED(irq + i, cm)) { 677e69954b9Spbrook res |= (1 << i); 678e69954b9Spbrook } 679e69954b9Spbrook } 680e69954b9Spbrook } else if (offset < 0x300) { 681e69954b9Spbrook /* Interrupt Set/Clear Pending. */ 682e69954b9Spbrook if (offset < 0x280) 683e69954b9Spbrook irq = (offset - 0x200) * 8; 684e69954b9Spbrook else 685e69954b9Spbrook irq = (offset - 0x280) * 8; 6869ee6e8bbSpbrook irq += GIC_BASE_IRQ; 687a32134aaSMark Langsdorf if (irq >= s->num_irq) 688e69954b9Spbrook goto bad_reg; 689e69954b9Spbrook res = 0; 69069253800SRusty Russell mask = (irq < GIC_INTERNAL) ? cm : ALL_CPU_MASK; 691e69954b9Spbrook for (i = 0; i < 8; i++) { 692fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 693fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 694fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 695fea8a08eSJens Wiklander } 696fea8a08eSJens Wiklander 6978d999995SChristoffer Dall if (gic_test_pending(s, irq + i, mask)) { 698e69954b9Spbrook res |= (1 << i); 699e69954b9Spbrook } 700e69954b9Spbrook } 701e69954b9Spbrook } else if (offset < 0x400) { 702e69954b9Spbrook /* Interrupt Active. */ 7039ee6e8bbSpbrook irq = (offset - 0x300) * 8 + GIC_BASE_IRQ; 704a32134aaSMark Langsdorf if (irq >= s->num_irq) 705e69954b9Spbrook goto bad_reg; 706e69954b9Spbrook res = 0; 70769253800SRusty Russell mask = (irq < GIC_INTERNAL) ? cm : ALL_CPU_MASK; 708e69954b9Spbrook for (i = 0; i < 8; i++) { 709fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 710fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 711fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 712fea8a08eSJens Wiklander } 713fea8a08eSJens Wiklander 7149ee6e8bbSpbrook if (GIC_TEST_ACTIVE(irq + i, mask)) { 715e69954b9Spbrook res |= (1 << i); 716e69954b9Spbrook } 717e69954b9Spbrook } 718e69954b9Spbrook } else if (offset < 0x800) { 719e69954b9Spbrook /* Interrupt Priority. */ 7209ee6e8bbSpbrook irq = (offset - 0x400) + GIC_BASE_IRQ; 721a32134aaSMark Langsdorf if (irq >= s->num_irq) 722e69954b9Spbrook goto bad_reg; 72381508470SFabian Aggeler res = gic_get_priority(s, cpu, irq, attrs); 724e69954b9Spbrook } else if (offset < 0xc00) { 725e69954b9Spbrook /* Interrupt CPU Target. */ 7266b9680bbSPeter Maydell if (s->num_cpu == 1 && s->revision != REV_11MPCORE) { 7276b9680bbSPeter Maydell /* For uniprocessor GICs these RAZ/WI */ 7286b9680bbSPeter Maydell res = 0; 7296b9680bbSPeter Maydell } else { 7309ee6e8bbSpbrook irq = (offset - 0x800) + GIC_BASE_IRQ; 7316b9680bbSPeter Maydell if (irq >= s->num_irq) { 732e69954b9Spbrook goto bad_reg; 7336b9680bbSPeter Maydell } 7349ee6e8bbSpbrook if (irq >= 29 && irq <= 31) { 7359ee6e8bbSpbrook res = cm; 7369ee6e8bbSpbrook } else { 7379ee6e8bbSpbrook res = GIC_TARGET(irq); 7389ee6e8bbSpbrook } 7396b9680bbSPeter Maydell } 740e69954b9Spbrook } else if (offset < 0xf00) { 741e69954b9Spbrook /* Interrupt Configuration. */ 74271a62046SAdam Lackorzynski irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ; 743a32134aaSMark Langsdorf if (irq >= s->num_irq) 744e69954b9Spbrook goto bad_reg; 745e69954b9Spbrook res = 0; 746e69954b9Spbrook for (i = 0; i < 4; i++) { 747fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 748fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 749fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 750fea8a08eSJens Wiklander } 751fea8a08eSJens Wiklander 752e69954b9Spbrook if (GIC_TEST_MODEL(irq + i)) 753e69954b9Spbrook res |= (1 << (i * 2)); 75404050c5cSChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq + i)) 755e69954b9Spbrook res |= (2 << (i * 2)); 756e69954b9Spbrook } 75740d22500SChristoffer Dall } else if (offset < 0xf10) { 75840d22500SChristoffer Dall goto bad_reg; 75940d22500SChristoffer Dall } else if (offset < 0xf30) { 7607c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 76140d22500SChristoffer Dall goto bad_reg; 76240d22500SChristoffer Dall } 76340d22500SChristoffer Dall 76440d22500SChristoffer Dall if (offset < 0xf20) { 76540d22500SChristoffer Dall /* GICD_CPENDSGIRn */ 76640d22500SChristoffer Dall irq = (offset - 0xf10); 76740d22500SChristoffer Dall } else { 76840d22500SChristoffer Dall irq = (offset - 0xf20); 76940d22500SChristoffer Dall /* GICD_SPENDSGIRn */ 77040d22500SChristoffer Dall } 77140d22500SChristoffer Dall 772fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 773fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq, 1 << cpu)) { 774fea8a08eSJens Wiklander res = 0; /* Ignore Non-secure access of Group0 IRQ */ 775fea8a08eSJens Wiklander } else { 77640d22500SChristoffer Dall res = s->sgi_pending[irq][cpu]; 777fea8a08eSJens Wiklander } 7783355c360SAlistair Francis } else if (offset < 0xfd0) { 779e69954b9Spbrook goto bad_reg; 7803355c360SAlistair Francis } else if (offset < 0x1000) { 781e69954b9Spbrook if (offset & 3) { 782e69954b9Spbrook res = 0; 783e69954b9Spbrook } else { 7843355c360SAlistair Francis switch (s->revision) { 7853355c360SAlistair Francis case REV_11MPCORE: 7863355c360SAlistair Francis res = gic_id_11mpcore[(offset - 0xfd0) >> 2]; 7873355c360SAlistair Francis break; 7883355c360SAlistair Francis case 1: 7893355c360SAlistair Francis res = gic_id_gicv1[(offset - 0xfd0) >> 2]; 7903355c360SAlistair Francis break; 7913355c360SAlistair Francis case 2: 7923355c360SAlistair Francis res = gic_id_gicv2[(offset - 0xfd0) >> 2]; 7933355c360SAlistair Francis break; 7943355c360SAlistair Francis default: 7953355c360SAlistair Francis res = 0; 796e69954b9Spbrook } 797e69954b9Spbrook } 7983355c360SAlistair Francis } else { 7993355c360SAlistair Francis g_assert_not_reached(); 8003355c360SAlistair Francis } 801e69954b9Spbrook return res; 802e69954b9Spbrook bad_reg: 8038c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 8048c8dc39fSPeter Maydell "gic_dist_readb: Bad offset %x\n", (int)offset); 805e69954b9Spbrook return 0; 806e69954b9Spbrook } 807e69954b9Spbrook 808a9d85353SPeter Maydell static MemTxResult gic_dist_read(void *opaque, hwaddr offset, uint64_t *data, 809a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 810e69954b9Spbrook { 811a9d85353SPeter Maydell switch (size) { 812a9d85353SPeter Maydell case 1: 813a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 814a9d85353SPeter Maydell return MEMTX_OK; 815a9d85353SPeter Maydell case 2: 816a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 817a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 1, attrs) << 8; 818a9d85353SPeter Maydell return MEMTX_OK; 819a9d85353SPeter Maydell case 4: 820a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 821a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 1, attrs) << 8; 822a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 2, attrs) << 16; 823a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 3, attrs) << 24; 824a9d85353SPeter Maydell return MEMTX_OK; 825a9d85353SPeter Maydell default: 826a9d85353SPeter Maydell return MEMTX_ERROR; 827e69954b9Spbrook } 828e69954b9Spbrook } 829e69954b9Spbrook 830a8170e5eSAvi Kivity static void gic_dist_writeb(void *opaque, hwaddr offset, 831a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 832e69954b9Spbrook { 833fae15286SPeter Maydell GICState *s = (GICState *)opaque; 834e69954b9Spbrook int irq; 835e69954b9Spbrook int i; 8369ee6e8bbSpbrook int cpu; 837e69954b9Spbrook 838926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 839e69954b9Spbrook if (offset < 0x100) { 840e69954b9Spbrook if (offset == 0) { 841679aa175SFabian Aggeler if (s->security_extn && !attrs.secure) { 842679aa175SFabian Aggeler /* NS version is just an alias of the S version's bit 1 */ 843679aa175SFabian Aggeler s->ctlr = deposit32(s->ctlr, 1, 1, value); 844679aa175SFabian Aggeler } else if (gic_has_groups(s)) { 845679aa175SFabian Aggeler s->ctlr = value & (GICD_CTLR_EN_GRP0 | GICD_CTLR_EN_GRP1); 846679aa175SFabian Aggeler } else { 847679aa175SFabian Aggeler s->ctlr = value & GICD_CTLR_EN_GRP0; 848679aa175SFabian Aggeler } 849679aa175SFabian Aggeler DPRINTF("Distributor: Group0 %sabled; Group 1 %sabled\n", 850679aa175SFabian Aggeler s->ctlr & GICD_CTLR_EN_GRP0 ? "En" : "Dis", 851679aa175SFabian Aggeler s->ctlr & GICD_CTLR_EN_GRP1 ? "En" : "Dis"); 852e69954b9Spbrook } else if (offset < 4) { 853e69954b9Spbrook /* ignored. */ 854b79f2265SRob Herring } else if (offset >= 0x80) { 855c27a5ba9SFabian Aggeler /* Interrupt Group Registers: RAZ/WI for NS access to secure 856c27a5ba9SFabian Aggeler * GIC, or for GICs without groups. 857c27a5ba9SFabian Aggeler */ 858c27a5ba9SFabian Aggeler if (!(s->security_extn && !attrs.secure) && gic_has_groups(s)) { 859c27a5ba9SFabian Aggeler /* Every byte offset holds 8 group status bits */ 860c27a5ba9SFabian Aggeler irq = (offset - 0x80) * 8 + GIC_BASE_IRQ; 861c27a5ba9SFabian Aggeler if (irq >= s->num_irq) { 862c27a5ba9SFabian Aggeler goto bad_reg; 863c27a5ba9SFabian Aggeler } 864c27a5ba9SFabian Aggeler for (i = 0; i < 8; i++) { 865c27a5ba9SFabian Aggeler /* Group bits are banked for private interrupts */ 866c27a5ba9SFabian Aggeler int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 867c27a5ba9SFabian Aggeler if (value & (1 << i)) { 868c27a5ba9SFabian Aggeler /* Group1 (Non-secure) */ 869c27a5ba9SFabian Aggeler GIC_SET_GROUP(irq + i, cm); 870c27a5ba9SFabian Aggeler } else { 871c27a5ba9SFabian Aggeler /* Group0 (Secure) */ 872c27a5ba9SFabian Aggeler GIC_CLEAR_GROUP(irq + i, cm); 873c27a5ba9SFabian Aggeler } 874c27a5ba9SFabian Aggeler } 875c27a5ba9SFabian Aggeler } 876e69954b9Spbrook } else { 877e69954b9Spbrook goto bad_reg; 878e69954b9Spbrook } 879e69954b9Spbrook } else if (offset < 0x180) { 880e69954b9Spbrook /* Interrupt Set Enable. */ 8819ee6e8bbSpbrook irq = (offset - 0x100) * 8 + GIC_BASE_IRQ; 882a32134aaSMark Langsdorf if (irq >= s->num_irq) 883e69954b9Spbrook goto bad_reg; 88441ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 8859ee6e8bbSpbrook value = 0xff; 88641ab7b55SChristoffer Dall } 88741ab7b55SChristoffer Dall 888e69954b9Spbrook for (i = 0; i < 8; i++) { 889e69954b9Spbrook if (value & (1 << i)) { 890f47b48fbSDaniel Sangorrin int mask = 891f47b48fbSDaniel Sangorrin (irq < GIC_INTERNAL) ? (1 << cpu) : GIC_TARGET(irq + i); 89269253800SRusty Russell int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 89341bf234dSRabin Vincent 894fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 895fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 896fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 897fea8a08eSJens Wiklander } 898fea8a08eSJens Wiklander 89941bf234dSRabin Vincent if (!GIC_TEST_ENABLED(irq + i, cm)) { 900e69954b9Spbrook DPRINTF("Enabled IRQ %d\n", irq + i); 9012531088fSHollis Blanchard trace_gic_enable_irq(irq + i); 90241bf234dSRabin Vincent } 90341bf234dSRabin Vincent GIC_SET_ENABLED(irq + i, cm); 904e69954b9Spbrook /* If a raised level triggered IRQ enabled then mark 905e69954b9Spbrook is as pending. */ 9069ee6e8bbSpbrook if (GIC_TEST_LEVEL(irq + i, mask) 90704050c5cSChristoffer Dall && !GIC_TEST_EDGE_TRIGGER(irq + i)) { 9089ee6e8bbSpbrook DPRINTF("Set %d pending mask %x\n", irq + i, mask); 9099ee6e8bbSpbrook GIC_SET_PENDING(irq + i, mask); 9109ee6e8bbSpbrook } 911e69954b9Spbrook } 912e69954b9Spbrook } 913e69954b9Spbrook } else if (offset < 0x200) { 914e69954b9Spbrook /* Interrupt Clear Enable. */ 9159ee6e8bbSpbrook irq = (offset - 0x180) * 8 + GIC_BASE_IRQ; 916a32134aaSMark Langsdorf if (irq >= s->num_irq) 917e69954b9Spbrook goto bad_reg; 91841ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 9199ee6e8bbSpbrook value = 0; 92041ab7b55SChristoffer Dall } 92141ab7b55SChristoffer Dall 922e69954b9Spbrook for (i = 0; i < 8; i++) { 923e69954b9Spbrook if (value & (1 << i)) { 92469253800SRusty Russell int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 92541bf234dSRabin Vincent 926fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 927fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 928fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 929fea8a08eSJens Wiklander } 930fea8a08eSJens Wiklander 93141bf234dSRabin Vincent if (GIC_TEST_ENABLED(irq + i, cm)) { 932e69954b9Spbrook DPRINTF("Disabled IRQ %d\n", irq + i); 9332531088fSHollis Blanchard trace_gic_disable_irq(irq + i); 93441bf234dSRabin Vincent } 93541bf234dSRabin Vincent GIC_CLEAR_ENABLED(irq + i, cm); 936e69954b9Spbrook } 937e69954b9Spbrook } 938e69954b9Spbrook } else if (offset < 0x280) { 939e69954b9Spbrook /* Interrupt Set Pending. */ 9409ee6e8bbSpbrook irq = (offset - 0x200) * 8 + GIC_BASE_IRQ; 941a32134aaSMark Langsdorf if (irq >= s->num_irq) 942e69954b9Spbrook goto bad_reg; 94341ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 9445b0adce1SChristoffer Dall value = 0; 94541ab7b55SChristoffer Dall } 9469ee6e8bbSpbrook 947e69954b9Spbrook for (i = 0; i < 8; i++) { 948e69954b9Spbrook if (value & (1 << i)) { 949fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 950fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 951fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 952fea8a08eSJens Wiklander } 953fea8a08eSJens Wiklander 954f47b48fbSDaniel Sangorrin GIC_SET_PENDING(irq + i, GIC_TARGET(irq + i)); 955e69954b9Spbrook } 956e69954b9Spbrook } 957e69954b9Spbrook } else if (offset < 0x300) { 958e69954b9Spbrook /* Interrupt Clear Pending. */ 9599ee6e8bbSpbrook irq = (offset - 0x280) * 8 + GIC_BASE_IRQ; 960a32134aaSMark Langsdorf if (irq >= s->num_irq) 961e69954b9Spbrook goto bad_reg; 9625b0adce1SChristoffer Dall if (irq < GIC_NR_SGIS) { 9635b0adce1SChristoffer Dall value = 0; 9645b0adce1SChristoffer Dall } 9655b0adce1SChristoffer Dall 966e69954b9Spbrook for (i = 0; i < 8; i++) { 967fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 968fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 969fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 970fea8a08eSJens Wiklander } 971fea8a08eSJens Wiklander 9729ee6e8bbSpbrook /* ??? This currently clears the pending bit for all CPUs, even 9739ee6e8bbSpbrook for per-CPU interrupts. It's unclear whether this is the 9749ee6e8bbSpbrook corect behavior. */ 975e69954b9Spbrook if (value & (1 << i)) { 9769ee6e8bbSpbrook GIC_CLEAR_PENDING(irq + i, ALL_CPU_MASK); 977e69954b9Spbrook } 978e69954b9Spbrook } 979e69954b9Spbrook } else if (offset < 0x400) { 980e69954b9Spbrook /* Interrupt Active. */ 981e69954b9Spbrook goto bad_reg; 982e69954b9Spbrook } else if (offset < 0x800) { 983e69954b9Spbrook /* Interrupt Priority. */ 9849ee6e8bbSpbrook irq = (offset - 0x400) + GIC_BASE_IRQ; 985a32134aaSMark Langsdorf if (irq >= s->num_irq) 986e69954b9Spbrook goto bad_reg; 98781508470SFabian Aggeler gic_set_priority(s, cpu, irq, value, attrs); 988e69954b9Spbrook } else if (offset < 0xc00) { 9896b9680bbSPeter Maydell /* Interrupt CPU Target. RAZ/WI on uniprocessor GICs, with the 9906b9680bbSPeter Maydell * annoying exception of the 11MPCore's GIC. 9916b9680bbSPeter Maydell */ 9926b9680bbSPeter Maydell if (s->num_cpu != 1 || s->revision == REV_11MPCORE) { 9939ee6e8bbSpbrook irq = (offset - 0x800) + GIC_BASE_IRQ; 9946b9680bbSPeter Maydell if (irq >= s->num_irq) { 995e69954b9Spbrook goto bad_reg; 9966b9680bbSPeter Maydell } 9976b9680bbSPeter Maydell if (irq < 29) { 9989ee6e8bbSpbrook value = 0; 9996b9680bbSPeter Maydell } else if (irq < GIC_INTERNAL) { 10009ee6e8bbSpbrook value = ALL_CPU_MASK; 10016b9680bbSPeter Maydell } 10029ee6e8bbSpbrook s->irq_target[irq] = value & ALL_CPU_MASK; 10036b9680bbSPeter Maydell } 1004e69954b9Spbrook } else if (offset < 0xf00) { 1005e69954b9Spbrook /* Interrupt Configuration. */ 10069ee6e8bbSpbrook irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ; 1007a32134aaSMark Langsdorf if (irq >= s->num_irq) 1008e69954b9Spbrook goto bad_reg; 1009de7a900fSAdam Lackorzynski if (irq < GIC_NR_SGIS) 10109ee6e8bbSpbrook value |= 0xaa; 1011e69954b9Spbrook for (i = 0; i < 4; i++) { 1012fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 1013fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 1014fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 1015fea8a08eSJens Wiklander } 1016fea8a08eSJens Wiklander 10177c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 1018e69954b9Spbrook if (value & (1 << (i * 2))) { 1019e69954b9Spbrook GIC_SET_MODEL(irq + i); 1020e69954b9Spbrook } else { 1021e69954b9Spbrook GIC_CLEAR_MODEL(irq + i); 1022e69954b9Spbrook } 102324b790dfSAdam Lackorzynski } 1024e69954b9Spbrook if (value & (2 << (i * 2))) { 102504050c5cSChristoffer Dall GIC_SET_EDGE_TRIGGER(irq + i); 1026e69954b9Spbrook } else { 102704050c5cSChristoffer Dall GIC_CLEAR_EDGE_TRIGGER(irq + i); 1028e69954b9Spbrook } 1029e69954b9Spbrook } 103040d22500SChristoffer Dall } else if (offset < 0xf10) { 10319ee6e8bbSpbrook /* 0xf00 is only handled for 32-bit writes. */ 1032e69954b9Spbrook goto bad_reg; 103340d22500SChristoffer Dall } else if (offset < 0xf20) { 103440d22500SChristoffer Dall /* GICD_CPENDSGIRn */ 10357c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 103640d22500SChristoffer Dall goto bad_reg; 103740d22500SChristoffer Dall } 103840d22500SChristoffer Dall irq = (offset - 0xf10); 103940d22500SChristoffer Dall 1040fea8a08eSJens Wiklander if (!s->security_extn || attrs.secure || 1041fea8a08eSJens Wiklander GIC_TEST_GROUP(irq, 1 << cpu)) { 104240d22500SChristoffer Dall s->sgi_pending[irq][cpu] &= ~value; 104340d22500SChristoffer Dall if (s->sgi_pending[irq][cpu] == 0) { 104440d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, 1 << cpu); 104540d22500SChristoffer Dall } 1046fea8a08eSJens Wiklander } 104740d22500SChristoffer Dall } else if (offset < 0xf30) { 104840d22500SChristoffer Dall /* GICD_SPENDSGIRn */ 10497c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 105040d22500SChristoffer Dall goto bad_reg; 105140d22500SChristoffer Dall } 105240d22500SChristoffer Dall irq = (offset - 0xf20); 105340d22500SChristoffer Dall 1054fea8a08eSJens Wiklander if (!s->security_extn || attrs.secure || 1055fea8a08eSJens Wiklander GIC_TEST_GROUP(irq, 1 << cpu)) { 105640d22500SChristoffer Dall GIC_SET_PENDING(irq, 1 << cpu); 105740d22500SChristoffer Dall s->sgi_pending[irq][cpu] |= value; 1058fea8a08eSJens Wiklander } 105940d22500SChristoffer Dall } else { 106040d22500SChristoffer Dall goto bad_reg; 1061e69954b9Spbrook } 1062e69954b9Spbrook gic_update(s); 1063e69954b9Spbrook return; 1064e69954b9Spbrook bad_reg: 10658c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 10668c8dc39fSPeter Maydell "gic_dist_writeb: Bad offset %x\n", (int)offset); 1067e69954b9Spbrook } 1068e69954b9Spbrook 1069a8170e5eSAvi Kivity static void gic_dist_writew(void *opaque, hwaddr offset, 1070a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1071e69954b9Spbrook { 1072a9d85353SPeter Maydell gic_dist_writeb(opaque, offset, value & 0xff, attrs); 1073a9d85353SPeter Maydell gic_dist_writeb(opaque, offset + 1, value >> 8, attrs); 1074e69954b9Spbrook } 1075e69954b9Spbrook 1076a8170e5eSAvi Kivity static void gic_dist_writel(void *opaque, hwaddr offset, 1077a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1078e69954b9Spbrook { 1079fae15286SPeter Maydell GICState *s = (GICState *)opaque; 10808da3ff18Spbrook if (offset == 0xf00) { 10819ee6e8bbSpbrook int cpu; 10829ee6e8bbSpbrook int irq; 10839ee6e8bbSpbrook int mask; 108440d22500SChristoffer Dall int target_cpu; 10859ee6e8bbSpbrook 1086926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 10879ee6e8bbSpbrook irq = value & 0x3ff; 10889ee6e8bbSpbrook switch ((value >> 24) & 3) { 10899ee6e8bbSpbrook case 0: 10909ee6e8bbSpbrook mask = (value >> 16) & ALL_CPU_MASK; 10919ee6e8bbSpbrook break; 10929ee6e8bbSpbrook case 1: 1093fa250144SAdam Lackorzynski mask = ALL_CPU_MASK ^ (1 << cpu); 10949ee6e8bbSpbrook break; 10959ee6e8bbSpbrook case 2: 1096fa250144SAdam Lackorzynski mask = 1 << cpu; 10979ee6e8bbSpbrook break; 10989ee6e8bbSpbrook default: 10999ee6e8bbSpbrook DPRINTF("Bad Soft Int target filter\n"); 11009ee6e8bbSpbrook mask = ALL_CPU_MASK; 11019ee6e8bbSpbrook break; 11029ee6e8bbSpbrook } 11039ee6e8bbSpbrook GIC_SET_PENDING(irq, mask); 110440d22500SChristoffer Dall target_cpu = ctz32(mask); 110540d22500SChristoffer Dall while (target_cpu < GIC_NCPU) { 110640d22500SChristoffer Dall s->sgi_pending[irq][target_cpu] |= (1 << cpu); 110740d22500SChristoffer Dall mask &= ~(1 << target_cpu); 110840d22500SChristoffer Dall target_cpu = ctz32(mask); 110940d22500SChristoffer Dall } 11109ee6e8bbSpbrook gic_update(s); 11119ee6e8bbSpbrook return; 11129ee6e8bbSpbrook } 1113a9d85353SPeter Maydell gic_dist_writew(opaque, offset, value & 0xffff, attrs); 1114a9d85353SPeter Maydell gic_dist_writew(opaque, offset + 2, value >> 16, attrs); 1115a9d85353SPeter Maydell } 1116a9d85353SPeter Maydell 1117a9d85353SPeter Maydell static MemTxResult gic_dist_write(void *opaque, hwaddr offset, uint64_t data, 1118a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1119a9d85353SPeter Maydell { 1120a9d85353SPeter Maydell switch (size) { 1121a9d85353SPeter Maydell case 1: 1122a9d85353SPeter Maydell gic_dist_writeb(opaque, offset, data, attrs); 1123a9d85353SPeter Maydell return MEMTX_OK; 1124a9d85353SPeter Maydell case 2: 1125a9d85353SPeter Maydell gic_dist_writew(opaque, offset, data, attrs); 1126a9d85353SPeter Maydell return MEMTX_OK; 1127a9d85353SPeter Maydell case 4: 1128a9d85353SPeter Maydell gic_dist_writel(opaque, offset, data, attrs); 1129a9d85353SPeter Maydell return MEMTX_OK; 1130a9d85353SPeter Maydell default: 1131a9d85353SPeter Maydell return MEMTX_ERROR; 1132a9d85353SPeter Maydell } 1133e69954b9Spbrook } 1134e69954b9Spbrook 113551fd06e0SPeter Maydell static inline uint32_t gic_apr_ns_view(GICState *s, int cpu, int regno) 113651fd06e0SPeter Maydell { 113751fd06e0SPeter Maydell /* Return the Nonsecure view of GICC_APR<regno>. This is the 113851fd06e0SPeter Maydell * second half of GICC_NSAPR. 113951fd06e0SPeter Maydell */ 114051fd06e0SPeter Maydell switch (GIC_MIN_BPR) { 114151fd06e0SPeter Maydell case 0: 114251fd06e0SPeter Maydell if (regno < 2) { 114351fd06e0SPeter Maydell return s->nsapr[regno + 2][cpu]; 114451fd06e0SPeter Maydell } 114551fd06e0SPeter Maydell break; 114651fd06e0SPeter Maydell case 1: 114751fd06e0SPeter Maydell if (regno == 0) { 114851fd06e0SPeter Maydell return s->nsapr[regno + 1][cpu]; 114951fd06e0SPeter Maydell } 115051fd06e0SPeter Maydell break; 115151fd06e0SPeter Maydell case 2: 115251fd06e0SPeter Maydell if (regno == 0) { 115351fd06e0SPeter Maydell return extract32(s->nsapr[0][cpu], 16, 16); 115451fd06e0SPeter Maydell } 115551fd06e0SPeter Maydell break; 115651fd06e0SPeter Maydell case 3: 115751fd06e0SPeter Maydell if (regno == 0) { 115851fd06e0SPeter Maydell return extract32(s->nsapr[0][cpu], 8, 8); 115951fd06e0SPeter Maydell } 116051fd06e0SPeter Maydell break; 116151fd06e0SPeter Maydell default: 116251fd06e0SPeter Maydell g_assert_not_reached(); 116351fd06e0SPeter Maydell } 116451fd06e0SPeter Maydell return 0; 116551fd06e0SPeter Maydell } 116651fd06e0SPeter Maydell 116751fd06e0SPeter Maydell static inline void gic_apr_write_ns_view(GICState *s, int cpu, int regno, 116851fd06e0SPeter Maydell uint32_t value) 116951fd06e0SPeter Maydell { 117051fd06e0SPeter Maydell /* Write the Nonsecure view of GICC_APR<regno>. */ 117151fd06e0SPeter Maydell switch (GIC_MIN_BPR) { 117251fd06e0SPeter Maydell case 0: 117351fd06e0SPeter Maydell if (regno < 2) { 117451fd06e0SPeter Maydell s->nsapr[regno + 2][cpu] = value; 117551fd06e0SPeter Maydell } 117651fd06e0SPeter Maydell break; 117751fd06e0SPeter Maydell case 1: 117851fd06e0SPeter Maydell if (regno == 0) { 117951fd06e0SPeter Maydell s->nsapr[regno + 1][cpu] = value; 118051fd06e0SPeter Maydell } 118151fd06e0SPeter Maydell break; 118251fd06e0SPeter Maydell case 2: 118351fd06e0SPeter Maydell if (regno == 0) { 118451fd06e0SPeter Maydell s->nsapr[0][cpu] = deposit32(s->nsapr[0][cpu], 16, 16, value); 118551fd06e0SPeter Maydell } 118651fd06e0SPeter Maydell break; 118751fd06e0SPeter Maydell case 3: 118851fd06e0SPeter Maydell if (regno == 0) { 118951fd06e0SPeter Maydell s->nsapr[0][cpu] = deposit32(s->nsapr[0][cpu], 8, 8, value); 119051fd06e0SPeter Maydell } 119151fd06e0SPeter Maydell break; 119251fd06e0SPeter Maydell default: 119351fd06e0SPeter Maydell g_assert_not_reached(); 119451fd06e0SPeter Maydell } 119551fd06e0SPeter Maydell } 119651fd06e0SPeter Maydell 1197a9d85353SPeter Maydell static MemTxResult gic_cpu_read(GICState *s, int cpu, int offset, 1198a9d85353SPeter Maydell uint64_t *data, MemTxAttrs attrs) 1199e69954b9Spbrook { 1200e69954b9Spbrook switch (offset) { 1201e69954b9Spbrook case 0x00: /* Control */ 120232951860SFabian Aggeler *data = gic_get_cpu_control(s, cpu, attrs); 1203a9d85353SPeter Maydell break; 1204e69954b9Spbrook case 0x04: /* Priority mask */ 120581508470SFabian Aggeler *data = gic_get_priority_mask(s, cpu, attrs); 1206a9d85353SPeter Maydell break; 1207e69954b9Spbrook case 0x08: /* Binary Point */ 1208822e9cc3SFabian Aggeler if (s->security_extn && !attrs.secure) { 1209822e9cc3SFabian Aggeler /* BPR is banked. Non-secure copy stored in ABPR. */ 1210822e9cc3SFabian Aggeler *data = s->abpr[cpu]; 1211822e9cc3SFabian Aggeler } else { 1212a9d85353SPeter Maydell *data = s->bpr[cpu]; 1213822e9cc3SFabian Aggeler } 1214a9d85353SPeter Maydell break; 1215e69954b9Spbrook case 0x0c: /* Acknowledge */ 1216c5619bf9SFabian Aggeler *data = gic_acknowledge_irq(s, cpu, attrs); 1217a9d85353SPeter Maydell break; 121866a0a2cbSDong Xu Wang case 0x14: /* Running Priority */ 121908efa9f2SFabian Aggeler *data = gic_get_running_priority(s, cpu, attrs); 1220a9d85353SPeter Maydell break; 1221e69954b9Spbrook case 0x18: /* Highest Pending Interrupt */ 12227c0fa108SFabian Aggeler *data = gic_get_current_pending_irq(s, cpu, attrs); 1223a9d85353SPeter Maydell break; 1224aa7d461aSChristoffer Dall case 0x1c: /* Aliased Binary Point */ 1225822e9cc3SFabian Aggeler /* GIC v2, no security: ABPR 1226822e9cc3SFabian Aggeler * GIC v1, no security: not implemented (RAZ/WI) 1227822e9cc3SFabian Aggeler * With security extensions, secure access: ABPR (alias of NS BPR) 1228822e9cc3SFabian Aggeler * With security extensions, nonsecure access: RAZ/WI 1229822e9cc3SFabian Aggeler */ 1230822e9cc3SFabian Aggeler if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 1231822e9cc3SFabian Aggeler *data = 0; 1232822e9cc3SFabian Aggeler } else { 1233a9d85353SPeter Maydell *data = s->abpr[cpu]; 1234822e9cc3SFabian Aggeler } 1235a9d85353SPeter Maydell break; 1236a9d477c4SChristoffer Dall case 0xd0: case 0xd4: case 0xd8: case 0xdc: 123751fd06e0SPeter Maydell { 123851fd06e0SPeter Maydell int regno = (offset - 0xd0) / 4; 123951fd06e0SPeter Maydell 124051fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 124151fd06e0SPeter Maydell *data = 0; 124251fd06e0SPeter Maydell } else if (s->security_extn && !attrs.secure) { 124351fd06e0SPeter Maydell /* NS view of GICC_APR<n> is the top half of GIC_NSAPR<n> */ 124451fd06e0SPeter Maydell *data = gic_apr_ns_view(s, regno, cpu); 124551fd06e0SPeter Maydell } else { 124651fd06e0SPeter Maydell *data = s->apr[regno][cpu]; 124751fd06e0SPeter Maydell } 1248a9d85353SPeter Maydell break; 124951fd06e0SPeter Maydell } 125051fd06e0SPeter Maydell case 0xe0: case 0xe4: case 0xe8: case 0xec: 125151fd06e0SPeter Maydell { 125251fd06e0SPeter Maydell int regno = (offset - 0xe0) / 4; 125351fd06e0SPeter Maydell 125451fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2 || !gic_has_groups(s) || 125551fd06e0SPeter Maydell (s->security_extn && !attrs.secure)) { 125651fd06e0SPeter Maydell *data = 0; 125751fd06e0SPeter Maydell } else { 125851fd06e0SPeter Maydell *data = s->nsapr[regno][cpu]; 125951fd06e0SPeter Maydell } 126051fd06e0SPeter Maydell break; 126151fd06e0SPeter Maydell } 1262e69954b9Spbrook default: 12638c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 12648c8dc39fSPeter Maydell "gic_cpu_read: Bad offset %x\n", (int)offset); 12650cf09852SPeter Maydell *data = 0; 12660cf09852SPeter Maydell break; 1267e69954b9Spbrook } 1268a9d85353SPeter Maydell return MEMTX_OK; 1269e69954b9Spbrook } 1270e69954b9Spbrook 1271a9d85353SPeter Maydell static MemTxResult gic_cpu_write(GICState *s, int cpu, int offset, 1272a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1273e69954b9Spbrook { 1274e69954b9Spbrook switch (offset) { 1275e69954b9Spbrook case 0x00: /* Control */ 127632951860SFabian Aggeler gic_set_cpu_control(s, cpu, value, attrs); 1277e69954b9Spbrook break; 1278e69954b9Spbrook case 0x04: /* Priority mask */ 127981508470SFabian Aggeler gic_set_priority_mask(s, cpu, value, attrs); 1280e69954b9Spbrook break; 1281e69954b9Spbrook case 0x08: /* Binary Point */ 1282822e9cc3SFabian Aggeler if (s->security_extn && !attrs.secure) { 1283822e9cc3SFabian Aggeler s->abpr[cpu] = MAX(value & 0x7, GIC_MIN_ABPR); 1284822e9cc3SFabian Aggeler } else { 1285822e9cc3SFabian Aggeler s->bpr[cpu] = MAX(value & 0x7, GIC_MIN_BPR); 1286822e9cc3SFabian Aggeler } 1287e69954b9Spbrook break; 1288e69954b9Spbrook case 0x10: /* End Of Interrupt */ 1289f9c6a7f1SFabian Aggeler gic_complete_irq(s, cpu, value & 0x3ff, attrs); 1290a9d85353SPeter Maydell return MEMTX_OK; 1291aa7d461aSChristoffer Dall case 0x1c: /* Aliased Binary Point */ 1292822e9cc3SFabian Aggeler if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 1293822e9cc3SFabian Aggeler /* unimplemented, or NS access: RAZ/WI */ 1294822e9cc3SFabian Aggeler return MEMTX_OK; 1295822e9cc3SFabian Aggeler } else { 1296822e9cc3SFabian Aggeler s->abpr[cpu] = MAX(value & 0x7, GIC_MIN_ABPR); 1297aa7d461aSChristoffer Dall } 1298aa7d461aSChristoffer Dall break; 1299a9d477c4SChristoffer Dall case 0xd0: case 0xd4: case 0xd8: case 0xdc: 130051fd06e0SPeter Maydell { 130151fd06e0SPeter Maydell int regno = (offset - 0xd0) / 4; 130251fd06e0SPeter Maydell 130351fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 130451fd06e0SPeter Maydell return MEMTX_OK; 130551fd06e0SPeter Maydell } 130651fd06e0SPeter Maydell if (s->security_extn && !attrs.secure) { 130751fd06e0SPeter Maydell /* NS view of GICC_APR<n> is the top half of GIC_NSAPR<n> */ 130851fd06e0SPeter Maydell gic_apr_write_ns_view(s, regno, cpu, value); 130951fd06e0SPeter Maydell } else { 131051fd06e0SPeter Maydell s->apr[regno][cpu] = value; 131151fd06e0SPeter Maydell } 1312a9d477c4SChristoffer Dall break; 131351fd06e0SPeter Maydell } 131451fd06e0SPeter Maydell case 0xe0: case 0xe4: case 0xe8: case 0xec: 131551fd06e0SPeter Maydell { 131651fd06e0SPeter Maydell int regno = (offset - 0xe0) / 4; 131751fd06e0SPeter Maydell 131851fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 131951fd06e0SPeter Maydell return MEMTX_OK; 132051fd06e0SPeter Maydell } 132151fd06e0SPeter Maydell if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 132251fd06e0SPeter Maydell return MEMTX_OK; 132351fd06e0SPeter Maydell } 132451fd06e0SPeter Maydell s->nsapr[regno][cpu] = value; 132551fd06e0SPeter Maydell break; 132651fd06e0SPeter Maydell } 1327a55c910eSPeter Maydell case 0x1000: 1328a55c910eSPeter Maydell /* GICC_DIR */ 1329a55c910eSPeter Maydell gic_deactivate_irq(s, cpu, value & 0x3ff, attrs); 1330a55c910eSPeter Maydell break; 1331e69954b9Spbrook default: 13328c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 13338c8dc39fSPeter Maydell "gic_cpu_write: Bad offset %x\n", (int)offset); 13340cf09852SPeter Maydell return MEMTX_OK; 1335e69954b9Spbrook } 1336e69954b9Spbrook gic_update(s); 1337a9d85353SPeter Maydell return MEMTX_OK; 1338e69954b9Spbrook } 1339e2c56465SPeter Maydell 1340e2c56465SPeter Maydell /* Wrappers to read/write the GIC CPU interface for the current CPU */ 1341a9d85353SPeter Maydell static MemTxResult gic_thiscpu_read(void *opaque, hwaddr addr, uint64_t *data, 1342a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1343e2c56465SPeter Maydell { 1344fae15286SPeter Maydell GICState *s = (GICState *)opaque; 1345a9d85353SPeter Maydell return gic_cpu_read(s, gic_get_current_cpu(s), addr, data, attrs); 1346e2c56465SPeter Maydell } 1347e2c56465SPeter Maydell 1348a9d85353SPeter Maydell static MemTxResult gic_thiscpu_write(void *opaque, hwaddr addr, 1349a9d85353SPeter Maydell uint64_t value, unsigned size, 1350a9d85353SPeter Maydell MemTxAttrs attrs) 1351e2c56465SPeter Maydell { 1352fae15286SPeter Maydell GICState *s = (GICState *)opaque; 1353a9d85353SPeter Maydell return gic_cpu_write(s, gic_get_current_cpu(s), addr, value, attrs); 1354e2c56465SPeter Maydell } 1355e2c56465SPeter Maydell 1356e2c56465SPeter Maydell /* Wrappers to read/write the GIC CPU interface for a specific CPU. 1357fae15286SPeter Maydell * These just decode the opaque pointer into GICState* + cpu id. 1358e2c56465SPeter Maydell */ 1359a9d85353SPeter Maydell static MemTxResult gic_do_cpu_read(void *opaque, hwaddr addr, uint64_t *data, 1360a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1361e2c56465SPeter Maydell { 1362fae15286SPeter Maydell GICState **backref = (GICState **)opaque; 1363fae15286SPeter Maydell GICState *s = *backref; 1364e2c56465SPeter Maydell int id = (backref - s->backref); 1365a9d85353SPeter Maydell return gic_cpu_read(s, id, addr, data, attrs); 1366e2c56465SPeter Maydell } 1367e2c56465SPeter Maydell 1368a9d85353SPeter Maydell static MemTxResult gic_do_cpu_write(void *opaque, hwaddr addr, 1369a9d85353SPeter Maydell uint64_t value, unsigned size, 1370a9d85353SPeter Maydell MemTxAttrs attrs) 1371e2c56465SPeter Maydell { 1372fae15286SPeter Maydell GICState **backref = (GICState **)opaque; 1373fae15286SPeter Maydell GICState *s = *backref; 1374e2c56465SPeter Maydell int id = (backref - s->backref); 1375a9d85353SPeter Maydell return gic_cpu_write(s, id, addr, value, attrs); 1376e2c56465SPeter Maydell } 1377e2c56465SPeter Maydell 13787926c210SPavel Fedin static const MemoryRegionOps gic_ops[2] = { 13797926c210SPavel Fedin { 13807926c210SPavel Fedin .read_with_attrs = gic_dist_read, 13817926c210SPavel Fedin .write_with_attrs = gic_dist_write, 13827926c210SPavel Fedin .endianness = DEVICE_NATIVE_ENDIAN, 13837926c210SPavel Fedin }, 13847926c210SPavel Fedin { 1385a9d85353SPeter Maydell .read_with_attrs = gic_thiscpu_read, 1386a9d85353SPeter Maydell .write_with_attrs = gic_thiscpu_write, 1387e2c56465SPeter Maydell .endianness = DEVICE_NATIVE_ENDIAN, 13887926c210SPavel Fedin } 1389e2c56465SPeter Maydell }; 1390e2c56465SPeter Maydell 1391e2c56465SPeter Maydell static const MemoryRegionOps gic_cpu_ops = { 1392a9d85353SPeter Maydell .read_with_attrs = gic_do_cpu_read, 1393a9d85353SPeter Maydell .write_with_attrs = gic_do_cpu_write, 1394e2c56465SPeter Maydell .endianness = DEVICE_NATIVE_ENDIAN, 1395e2c56465SPeter Maydell }; 1396e69954b9Spbrook 13977926c210SPavel Fedin /* This function is used by nvic model */ 13987b95a508SKONRAD Frederic void gic_init_irqs_and_distributor(GICState *s) 1399e69954b9Spbrook { 14007926c210SPavel Fedin gic_init_irqs_and_mmio(s, gic_set_irq, gic_ops); 14012b518c56SPeter Maydell } 14022b518c56SPeter Maydell 140353111180SPeter Maydell static void arm_gic_realize(DeviceState *dev, Error **errp) 14042b518c56SPeter Maydell { 140553111180SPeter Maydell /* Device instance realize function for the GIC sysbus device */ 14062b518c56SPeter Maydell int i; 140753111180SPeter Maydell GICState *s = ARM_GIC(dev); 140853111180SPeter Maydell SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 14091e8cae4dSPeter Maydell ARMGICClass *agc = ARM_GIC_GET_CLASS(s); 14100175ba10SMarkus Armbruster Error *local_err = NULL; 14111e8cae4dSPeter Maydell 14120175ba10SMarkus Armbruster agc->parent_realize(dev, &local_err); 14130175ba10SMarkus Armbruster if (local_err) { 14140175ba10SMarkus Armbruster error_propagate(errp, local_err); 141553111180SPeter Maydell return; 141653111180SPeter Maydell } 14171e8cae4dSPeter Maydell 14185d721b78SAlexander Graf if (kvm_enabled() && !kvm_arm_supports_user_irq()) { 14195d721b78SAlexander Graf error_setg(errp, "KVM with user space irqchip only works when the " 14205d721b78SAlexander Graf "host kernel supports KVM_CAP_ARM_USER_IRQ"); 14215d721b78SAlexander Graf return; 14225d721b78SAlexander Graf } 14235d721b78SAlexander Graf 14247926c210SPavel Fedin /* This creates distributor and main CPU interface (s->cpuiomem[0]) */ 14257926c210SPavel Fedin gic_init_irqs_and_mmio(s, gic_set_irq, gic_ops); 14262b518c56SPeter Maydell 14277926c210SPavel Fedin /* Extra core-specific regions for the CPU interfaces. This is 14287926c210SPavel Fedin * necessary for "franken-GIC" implementations, for example on 14297926c210SPavel Fedin * Exynos 4. 1430e2c56465SPeter Maydell * NB that the memory region size of 0x100 applies for the 11MPCore 1431e2c56465SPeter Maydell * and also cores following the GIC v1 spec (ie A9). 1432e2c56465SPeter Maydell * GIC v2 defines a larger memory region (0x1000) so this will need 1433e2c56465SPeter Maydell * to be extended when we implement A15. 1434e2c56465SPeter Maydell */ 1435b95690c9SWei Huang for (i = 0; i < s->num_cpu; i++) { 1436e2c56465SPeter Maydell s->backref[i] = s; 14371437c94bSPaolo Bonzini memory_region_init_io(&s->cpuiomem[i+1], OBJECT(s), &gic_cpu_ops, 14381437c94bSPaolo Bonzini &s->backref[i], "gic_cpu", 0x100); 14397926c210SPavel Fedin sysbus_init_mmio(sbd, &s->cpuiomem[i+1]); 1440496dbcd1SPeter Maydell } 1441496dbcd1SPeter Maydell } 1442496dbcd1SPeter Maydell 1443496dbcd1SPeter Maydell static void arm_gic_class_init(ObjectClass *klass, void *data) 1444496dbcd1SPeter Maydell { 1445496dbcd1SPeter Maydell DeviceClass *dc = DEVICE_CLASS(klass); 14461e8cae4dSPeter Maydell ARMGICClass *agc = ARM_GIC_CLASS(klass); 144753111180SPeter Maydell 144853111180SPeter Maydell agc->parent_realize = dc->realize; 144953111180SPeter Maydell dc->realize = arm_gic_realize; 1450496dbcd1SPeter Maydell } 1451496dbcd1SPeter Maydell 14528c43a6f0SAndreas Färber static const TypeInfo arm_gic_info = { 14531e8cae4dSPeter Maydell .name = TYPE_ARM_GIC, 14541e8cae4dSPeter Maydell .parent = TYPE_ARM_GIC_COMMON, 1455fae15286SPeter Maydell .instance_size = sizeof(GICState), 1456496dbcd1SPeter Maydell .class_init = arm_gic_class_init, 1457998a74bcSPeter Maydell .class_size = sizeof(ARMGICClass), 1458496dbcd1SPeter Maydell }; 1459496dbcd1SPeter Maydell 1460496dbcd1SPeter Maydell static void arm_gic_register_types(void) 1461496dbcd1SPeter Maydell { 1462496dbcd1SPeter Maydell type_register_static(&arm_gic_info); 1463496dbcd1SPeter Maydell } 1464496dbcd1SPeter Maydell 1465496dbcd1SPeter Maydell type_init(arm_gic_register_types) 1466