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) && 96b52b81e4SSergey Fedorov (irq < GIC_INTERNAL || GIC_TARGET(irq) & cm)) { 979ee6e8bbSpbrook if (GIC_GET_PRIORITY(irq, cpu) < best_prio) { 989ee6e8bbSpbrook best_prio = GIC_GET_PRIORITY(irq, cpu); 99e69954b9Spbrook best_irq = irq; 100e69954b9Spbrook } 101e69954b9Spbrook } 102e69954b9Spbrook } 103dadbb58fSPeter Maydell 1042531088fSHollis Blanchard if (best_irq != 1023) { 1052531088fSHollis Blanchard trace_gic_update_bestirq(cpu, best_irq, best_prio, 1062531088fSHollis Blanchard s->priority_mask[cpu], s->running_priority[cpu]); 1072531088fSHollis Blanchard } 1082531088fSHollis Blanchard 109dadbb58fSPeter Maydell irq_level = fiq_level = 0; 110dadbb58fSPeter Maydell 111cad065f1SPeter Maydell if (best_prio < s->priority_mask[cpu]) { 1129ee6e8bbSpbrook s->current_pending[cpu] = best_irq; 1139ee6e8bbSpbrook if (best_prio < s->running_priority[cpu]) { 114dadbb58fSPeter Maydell int group = GIC_TEST_GROUP(best_irq, cm); 115dadbb58fSPeter Maydell 116dadbb58fSPeter Maydell if (extract32(s->ctlr, group, 1) && 117dadbb58fSPeter Maydell extract32(s->cpu_ctlr[cpu], group, 1)) { 118dadbb58fSPeter Maydell if (group == 0 && s->cpu_ctlr[cpu] & GICC_CTLR_FIQ_EN) { 119dadbb58fSPeter Maydell DPRINTF("Raised pending FIQ %d (cpu %d)\n", 120dadbb58fSPeter Maydell best_irq, cpu); 121dadbb58fSPeter Maydell fiq_level = 1; 1222531088fSHollis Blanchard trace_gic_update_set_irq(cpu, "fiq", fiq_level); 123dadbb58fSPeter Maydell } else { 124dadbb58fSPeter Maydell DPRINTF("Raised pending IRQ %d (cpu %d)\n", 125dadbb58fSPeter Maydell best_irq, cpu); 126dadbb58fSPeter Maydell irq_level = 1; 1272531088fSHollis Blanchard trace_gic_update_set_irq(cpu, "irq", irq_level); 128e69954b9Spbrook } 129e69954b9Spbrook } 130dadbb58fSPeter Maydell } 131dadbb58fSPeter Maydell } 132dadbb58fSPeter Maydell 133dadbb58fSPeter Maydell qemu_set_irq(s->parent_irq[cpu], irq_level); 134dadbb58fSPeter Maydell qemu_set_irq(s->parent_fiq[cpu], fiq_level); 1359ee6e8bbSpbrook } 136e69954b9Spbrook } 137e69954b9Spbrook 138fae15286SPeter Maydell void gic_set_pending_private(GICState *s, int cpu, int irq) 1399ee6e8bbSpbrook { 1409ee6e8bbSpbrook int cm = 1 << cpu; 1419ee6e8bbSpbrook 1428d999995SChristoffer Dall if (gic_test_pending(s, irq, cm)) { 1439ee6e8bbSpbrook return; 1448d999995SChristoffer Dall } 1459ee6e8bbSpbrook 1469ee6e8bbSpbrook DPRINTF("Set %d pending cpu %d\n", irq, cpu); 1479ee6e8bbSpbrook GIC_SET_PENDING(irq, cm); 1489ee6e8bbSpbrook gic_update(s); 1499ee6e8bbSpbrook } 1509ee6e8bbSpbrook 1518d999995SChristoffer Dall static void gic_set_irq_11mpcore(GICState *s, int irq, int level, 1528d999995SChristoffer Dall int cm, int target) 1538d999995SChristoffer Dall { 1548d999995SChristoffer Dall if (level) { 1558d999995SChristoffer Dall GIC_SET_LEVEL(irq, cm); 1568d999995SChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq) || GIC_TEST_ENABLED(irq, cm)) { 1578d999995SChristoffer Dall DPRINTF("Set %d pending mask %x\n", irq, target); 1588d999995SChristoffer Dall GIC_SET_PENDING(irq, target); 1598d999995SChristoffer Dall } 1608d999995SChristoffer Dall } else { 1618d999995SChristoffer Dall GIC_CLEAR_LEVEL(irq, cm); 1628d999995SChristoffer Dall } 1638d999995SChristoffer Dall } 1648d999995SChristoffer Dall 1658d999995SChristoffer Dall static void gic_set_irq_generic(GICState *s, int irq, int level, 1668d999995SChristoffer Dall int cm, int target) 1678d999995SChristoffer Dall { 1688d999995SChristoffer Dall if (level) { 1698d999995SChristoffer Dall GIC_SET_LEVEL(irq, cm); 1708d999995SChristoffer Dall DPRINTF("Set %d pending mask %x\n", irq, target); 1718d999995SChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq)) { 1728d999995SChristoffer Dall GIC_SET_PENDING(irq, target); 1738d999995SChristoffer Dall } 1748d999995SChristoffer Dall } else { 1758d999995SChristoffer Dall GIC_CLEAR_LEVEL(irq, cm); 1768d999995SChristoffer Dall } 1778d999995SChristoffer Dall } 1788d999995SChristoffer Dall 1799ee6e8bbSpbrook /* Process a change in an external IRQ input. */ 180e69954b9Spbrook static void gic_set_irq(void *opaque, int irq, int level) 181e69954b9Spbrook { 182544d1afaSPeter Maydell /* Meaning of the 'irq' parameter: 183544d1afaSPeter Maydell * [0..N-1] : external interrupts 184544d1afaSPeter Maydell * [N..N+31] : PPI (internal) interrupts for CPU 0 185544d1afaSPeter Maydell * [N+32..N+63] : PPI (internal interrupts for CPU 1 186544d1afaSPeter Maydell * ... 187544d1afaSPeter Maydell */ 188fae15286SPeter Maydell GICState *s = (GICState *)opaque; 189544d1afaSPeter Maydell int cm, target; 190544d1afaSPeter Maydell if (irq < (s->num_irq - GIC_INTERNAL)) { 191e69954b9Spbrook /* The first external input line is internal interrupt 32. */ 192544d1afaSPeter Maydell cm = ALL_CPU_MASK; 19369253800SRusty Russell irq += GIC_INTERNAL; 194544d1afaSPeter Maydell target = GIC_TARGET(irq); 195544d1afaSPeter Maydell } else { 196544d1afaSPeter Maydell int cpu; 197544d1afaSPeter Maydell irq -= (s->num_irq - GIC_INTERNAL); 198544d1afaSPeter Maydell cpu = irq / GIC_INTERNAL; 199544d1afaSPeter Maydell irq %= GIC_INTERNAL; 200544d1afaSPeter Maydell cm = 1 << cpu; 201544d1afaSPeter Maydell target = cm; 202544d1afaSPeter Maydell } 203544d1afaSPeter Maydell 20440d22500SChristoffer Dall assert(irq >= GIC_NR_SGIS); 20540d22500SChristoffer Dall 206544d1afaSPeter Maydell if (level == GIC_TEST_LEVEL(irq, cm)) { 207e69954b9Spbrook return; 208544d1afaSPeter Maydell } 209e69954b9Spbrook 2103bc4b52cSMarcin Krzeminski if (s->revision == REV_11MPCORE) { 2118d999995SChristoffer Dall gic_set_irq_11mpcore(s, irq, level, cm, target); 212e69954b9Spbrook } else { 2138d999995SChristoffer Dall gic_set_irq_generic(s, irq, level, cm, target); 214e69954b9Spbrook } 2152531088fSHollis Blanchard trace_gic_set_irq(irq, level, cm, target); 2168d999995SChristoffer Dall 217e69954b9Spbrook gic_update(s); 218e69954b9Spbrook } 219e69954b9Spbrook 2207c0fa108SFabian Aggeler static uint16_t gic_get_current_pending_irq(GICState *s, int cpu, 2217c0fa108SFabian Aggeler MemTxAttrs attrs) 2227c0fa108SFabian Aggeler { 2237c0fa108SFabian Aggeler uint16_t pending_irq = s->current_pending[cpu]; 2247c0fa108SFabian Aggeler 2257c0fa108SFabian Aggeler if (pending_irq < GIC_MAXIRQ && gic_has_groups(s)) { 2267c0fa108SFabian Aggeler int group = GIC_TEST_GROUP(pending_irq, (1 << cpu)); 2277c0fa108SFabian Aggeler /* On a GIC without the security extensions, reading this register 2287c0fa108SFabian Aggeler * behaves in the same way as a secure access to a GIC with them. 2297c0fa108SFabian Aggeler */ 2307c0fa108SFabian Aggeler bool secure = !s->security_extn || attrs.secure; 2317c0fa108SFabian Aggeler 2327c0fa108SFabian Aggeler if (group == 0 && !secure) { 2337c0fa108SFabian Aggeler /* Group0 interrupts hidden from Non-secure access */ 2347c0fa108SFabian Aggeler return 1023; 2357c0fa108SFabian Aggeler } 2367c0fa108SFabian Aggeler if (group == 1 && secure && !(s->cpu_ctlr[cpu] & GICC_CTLR_ACK_CTL)) { 2377c0fa108SFabian Aggeler /* Group1 interrupts only seen by Secure access if 2387c0fa108SFabian Aggeler * AckCtl bit set. 2397c0fa108SFabian Aggeler */ 2407c0fa108SFabian Aggeler return 1022; 2417c0fa108SFabian Aggeler } 2427c0fa108SFabian Aggeler } 2437c0fa108SFabian Aggeler return pending_irq; 2447c0fa108SFabian Aggeler } 2457c0fa108SFabian Aggeler 246df92cfa6SPeter Maydell static int gic_get_group_priority(GICState *s, int cpu, int irq) 247df92cfa6SPeter Maydell { 248df92cfa6SPeter Maydell /* Return the group priority of the specified interrupt 249df92cfa6SPeter Maydell * (which is the top bits of its priority, with the number 250df92cfa6SPeter Maydell * of bits masked determined by the applicable binary point register). 251df92cfa6SPeter Maydell */ 252df92cfa6SPeter Maydell int bpr; 253df92cfa6SPeter Maydell uint32_t mask; 254df92cfa6SPeter Maydell 255df92cfa6SPeter Maydell if (gic_has_groups(s) && 256df92cfa6SPeter Maydell !(s->cpu_ctlr[cpu] & GICC_CTLR_CBPR) && 257df92cfa6SPeter Maydell GIC_TEST_GROUP(irq, (1 << cpu))) { 258df92cfa6SPeter Maydell bpr = s->abpr[cpu]; 259df92cfa6SPeter Maydell } else { 260df92cfa6SPeter Maydell bpr = s->bpr[cpu]; 261df92cfa6SPeter Maydell } 262df92cfa6SPeter Maydell 263df92cfa6SPeter Maydell /* a BPR of 0 means the group priority bits are [7:1]; 264df92cfa6SPeter Maydell * a BPR of 1 means they are [7:2], and so on down to 265df92cfa6SPeter Maydell * a BPR of 7 meaning no group priority bits at all. 266df92cfa6SPeter Maydell */ 267df92cfa6SPeter Maydell mask = ~0U << ((bpr & 7) + 1); 268df92cfa6SPeter Maydell 269df92cfa6SPeter Maydell return GIC_GET_PRIORITY(irq, cpu) & mask; 270df92cfa6SPeter Maydell } 271df92cfa6SPeter Maydell 27272889c8aSPeter Maydell static void gic_activate_irq(GICState *s, int cpu, int irq) 273e69954b9Spbrook { 27472889c8aSPeter Maydell /* Set the appropriate Active Priority Register bit for this IRQ, 27572889c8aSPeter Maydell * and update the running priority. 27672889c8aSPeter Maydell */ 27772889c8aSPeter Maydell int prio = gic_get_group_priority(s, cpu, irq); 27872889c8aSPeter Maydell int preemption_level = prio >> (GIC_MIN_BPR + 1); 27972889c8aSPeter Maydell int regno = preemption_level / 32; 28072889c8aSPeter Maydell int bitno = preemption_level % 32; 28172889c8aSPeter Maydell 28272889c8aSPeter Maydell if (gic_has_groups(s) && GIC_TEST_GROUP(irq, (1 << cpu))) { 283a8595957SFrançois Baldassari s->nsapr[regno][cpu] |= (1 << bitno); 2849ee6e8bbSpbrook } else { 285a8595957SFrançois Baldassari s->apr[regno][cpu] |= (1 << bitno); 2869ee6e8bbSpbrook } 28772889c8aSPeter Maydell 28872889c8aSPeter Maydell s->running_priority[cpu] = prio; 289d5523a13SPeter Maydell GIC_SET_ACTIVE(irq, 1 << cpu); 29072889c8aSPeter Maydell } 29172889c8aSPeter Maydell 29272889c8aSPeter Maydell static int gic_get_prio_from_apr_bits(GICState *s, int cpu) 29372889c8aSPeter Maydell { 29472889c8aSPeter Maydell /* Recalculate the current running priority for this CPU based 29572889c8aSPeter Maydell * on the set bits in the Active Priority Registers. 29672889c8aSPeter Maydell */ 29772889c8aSPeter Maydell int i; 29872889c8aSPeter Maydell for (i = 0; i < GIC_NR_APRS; i++) { 29972889c8aSPeter Maydell uint32_t apr = s->apr[i][cpu] | s->nsapr[i][cpu]; 30072889c8aSPeter Maydell if (!apr) { 30172889c8aSPeter Maydell continue; 30272889c8aSPeter Maydell } 30372889c8aSPeter Maydell return (i * 32 + ctz32(apr)) << (GIC_MIN_BPR + 1); 30472889c8aSPeter Maydell } 30572889c8aSPeter Maydell return 0x100; 30672889c8aSPeter Maydell } 30772889c8aSPeter Maydell 30872889c8aSPeter Maydell static void gic_drop_prio(GICState *s, int cpu, int group) 30972889c8aSPeter Maydell { 31072889c8aSPeter Maydell /* Drop the priority of the currently active interrupt in the 31172889c8aSPeter Maydell * specified group. 31272889c8aSPeter Maydell * 31372889c8aSPeter Maydell * Note that we can guarantee (because of the requirement to nest 31472889c8aSPeter Maydell * GICC_IAR reads [which activate an interrupt and raise priority] 31572889c8aSPeter Maydell * with GICC_EOIR writes [which drop the priority for the interrupt]) 31672889c8aSPeter Maydell * that the interrupt we're being called for is the highest priority 31772889c8aSPeter Maydell * active interrupt, meaning that it has the lowest set bit in the 31872889c8aSPeter Maydell * APR registers. 31972889c8aSPeter Maydell * 32072889c8aSPeter Maydell * If the guest does not honour the ordering constraints then the 32172889c8aSPeter Maydell * behaviour of the GIC is UNPREDICTABLE, which for us means that 32272889c8aSPeter Maydell * the values of the APR registers might become incorrect and the 32372889c8aSPeter Maydell * running priority will be wrong, so interrupts that should preempt 32472889c8aSPeter Maydell * might not do so, and interrupts that should not preempt might do so. 32572889c8aSPeter Maydell */ 32672889c8aSPeter Maydell int i; 32772889c8aSPeter Maydell 32872889c8aSPeter Maydell for (i = 0; i < GIC_NR_APRS; i++) { 32972889c8aSPeter Maydell uint32_t *papr = group ? &s->nsapr[i][cpu] : &s->apr[i][cpu]; 33072889c8aSPeter Maydell if (!*papr) { 33172889c8aSPeter Maydell continue; 33272889c8aSPeter Maydell } 33372889c8aSPeter Maydell /* Clear lowest set bit */ 33472889c8aSPeter Maydell *papr &= *papr - 1; 33572889c8aSPeter Maydell break; 33672889c8aSPeter Maydell } 33772889c8aSPeter Maydell 33872889c8aSPeter Maydell s->running_priority[cpu] = gic_get_prio_from_apr_bits(s, cpu); 339e69954b9Spbrook } 340e69954b9Spbrook 341c5619bf9SFabian Aggeler uint32_t gic_acknowledge_irq(GICState *s, int cpu, MemTxAttrs attrs) 342e69954b9Spbrook { 34340d22500SChristoffer Dall int ret, irq, src; 3449ee6e8bbSpbrook int cm = 1 << cpu; 345c5619bf9SFabian Aggeler 346c5619bf9SFabian Aggeler /* gic_get_current_pending_irq() will return 1022 or 1023 appropriately 347c5619bf9SFabian Aggeler * for the case where this GIC supports grouping and the pending interrupt 348c5619bf9SFabian Aggeler * is in the wrong group. 349c5619bf9SFabian Aggeler */ 350a8f15a27SDaniel P. Berrange irq = gic_get_current_pending_irq(s, cpu, attrs); 3512531088fSHollis Blanchard trace_gic_acknowledge_irq(cpu, irq); 352c5619bf9SFabian Aggeler 353c5619bf9SFabian Aggeler if (irq >= GIC_MAXIRQ) { 354c5619bf9SFabian Aggeler DPRINTF("ACK, no pending interrupt or it is hidden: %d\n", irq); 355c5619bf9SFabian Aggeler return irq; 356c5619bf9SFabian Aggeler } 357c5619bf9SFabian Aggeler 358c5619bf9SFabian Aggeler if (GIC_GET_PRIORITY(irq, cpu) >= s->running_priority[cpu]) { 359c5619bf9SFabian Aggeler DPRINTF("ACK, pending interrupt (%d) has insufficient priority\n", irq); 360e69954b9Spbrook return 1023; 361e69954b9Spbrook } 36240d22500SChristoffer Dall 3637c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 3649ee6e8bbSpbrook /* Clear pending flags for both level and edge triggered interrupts. 36540d22500SChristoffer Dall * Level triggered IRQs will be reasserted once they become inactive. 36640d22500SChristoffer Dall */ 36740d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 36840d22500SChristoffer Dall ret = irq; 36940d22500SChristoffer Dall } else { 37040d22500SChristoffer Dall if (irq < GIC_NR_SGIS) { 37140d22500SChristoffer Dall /* Lookup the source CPU for the SGI and clear this in the 37240d22500SChristoffer Dall * sgi_pending map. Return the src and clear the overall pending 37340d22500SChristoffer Dall * state on this CPU if the SGI is not pending from any CPUs. 37440d22500SChristoffer Dall */ 37540d22500SChristoffer Dall assert(s->sgi_pending[irq][cpu] != 0); 37640d22500SChristoffer Dall src = ctz32(s->sgi_pending[irq][cpu]); 37740d22500SChristoffer Dall s->sgi_pending[irq][cpu] &= ~(1 << src); 37840d22500SChristoffer Dall if (s->sgi_pending[irq][cpu] == 0) { 37940d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 38040d22500SChristoffer Dall } 38140d22500SChristoffer Dall ret = irq | ((src & 0x7) << 10); 38240d22500SChristoffer Dall } else { 38340d22500SChristoffer Dall /* Clear pending state for both level and edge triggered 38440d22500SChristoffer Dall * interrupts. (level triggered interrupts with an active line 38540d22500SChristoffer Dall * remain pending, see gic_test_pending) 38640d22500SChristoffer Dall */ 38740d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, GIC_TEST_MODEL(irq) ? ALL_CPU_MASK : cm); 38840d22500SChristoffer Dall ret = irq; 38940d22500SChristoffer Dall } 39040d22500SChristoffer Dall } 39140d22500SChristoffer Dall 39272889c8aSPeter Maydell gic_activate_irq(s, cpu, irq); 39372889c8aSPeter Maydell gic_update(s); 39440d22500SChristoffer Dall DPRINTF("ACK %d\n", irq); 39540d22500SChristoffer Dall return ret; 396e69954b9Spbrook } 397e69954b9Spbrook 39881508470SFabian Aggeler void gic_set_priority(GICState *s, int cpu, int irq, uint8_t val, 39981508470SFabian Aggeler MemTxAttrs attrs) 4009df90ad0SChristoffer Dall { 40181508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 40281508470SFabian Aggeler if (!GIC_TEST_GROUP(irq, (1 << cpu))) { 40381508470SFabian Aggeler return; /* Ignore Non-secure access of Group0 IRQ */ 40481508470SFabian Aggeler } 40581508470SFabian Aggeler val = 0x80 | (val >> 1); /* Non-secure view */ 40681508470SFabian Aggeler } 40781508470SFabian Aggeler 4089df90ad0SChristoffer Dall if (irq < GIC_INTERNAL) { 4099df90ad0SChristoffer Dall s->priority1[irq][cpu] = val; 4109df90ad0SChristoffer Dall } else { 4119df90ad0SChristoffer Dall s->priority2[(irq) - GIC_INTERNAL] = val; 4129df90ad0SChristoffer Dall } 4139df90ad0SChristoffer Dall } 4149df90ad0SChristoffer Dall 41581508470SFabian Aggeler static uint32_t gic_get_priority(GICState *s, int cpu, int irq, 41681508470SFabian Aggeler MemTxAttrs attrs) 41781508470SFabian Aggeler { 41881508470SFabian Aggeler uint32_t prio = GIC_GET_PRIORITY(irq, cpu); 41981508470SFabian Aggeler 42081508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 42181508470SFabian Aggeler if (!GIC_TEST_GROUP(irq, (1 << cpu))) { 42281508470SFabian Aggeler return 0; /* Non-secure access cannot read priority of Group0 IRQ */ 42381508470SFabian Aggeler } 42481508470SFabian Aggeler prio = (prio << 1) & 0xff; /* Non-secure view */ 42581508470SFabian Aggeler } 42681508470SFabian Aggeler return prio; 42781508470SFabian Aggeler } 42881508470SFabian Aggeler 42981508470SFabian Aggeler static void gic_set_priority_mask(GICState *s, int cpu, uint8_t pmask, 43081508470SFabian Aggeler MemTxAttrs attrs) 43181508470SFabian Aggeler { 43281508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 43381508470SFabian Aggeler if (s->priority_mask[cpu] & 0x80) { 43481508470SFabian Aggeler /* Priority Mask in upper half */ 43581508470SFabian Aggeler pmask = 0x80 | (pmask >> 1); 43681508470SFabian Aggeler } else { 43781508470SFabian Aggeler /* Non-secure write ignored if priority mask is in lower half */ 43881508470SFabian Aggeler return; 43981508470SFabian Aggeler } 44081508470SFabian Aggeler } 44181508470SFabian Aggeler s->priority_mask[cpu] = pmask; 44281508470SFabian Aggeler } 44381508470SFabian Aggeler 44481508470SFabian Aggeler static uint32_t gic_get_priority_mask(GICState *s, int cpu, MemTxAttrs attrs) 44581508470SFabian Aggeler { 44681508470SFabian Aggeler uint32_t pmask = s->priority_mask[cpu]; 44781508470SFabian Aggeler 44881508470SFabian Aggeler if (s->security_extn && !attrs.secure) { 44981508470SFabian Aggeler if (pmask & 0x80) { 45081508470SFabian Aggeler /* Priority Mask in upper half, return Non-secure view */ 45181508470SFabian Aggeler pmask = (pmask << 1) & 0xff; 45281508470SFabian Aggeler } else { 45381508470SFabian Aggeler /* Priority Mask in lower half, RAZ */ 45481508470SFabian Aggeler pmask = 0; 45581508470SFabian Aggeler } 45681508470SFabian Aggeler } 45781508470SFabian Aggeler return pmask; 45881508470SFabian Aggeler } 45981508470SFabian Aggeler 46032951860SFabian Aggeler static uint32_t gic_get_cpu_control(GICState *s, int cpu, MemTxAttrs attrs) 46132951860SFabian Aggeler { 46232951860SFabian Aggeler uint32_t ret = s->cpu_ctlr[cpu]; 46332951860SFabian Aggeler 46432951860SFabian Aggeler if (s->security_extn && !attrs.secure) { 46532951860SFabian Aggeler /* Construct the NS banked view of GICC_CTLR from the correct 46632951860SFabian Aggeler * bits of the S banked view. We don't need to move the bypass 46732951860SFabian Aggeler * control bits because we don't implement that (IMPDEF) part 46832951860SFabian Aggeler * of the GIC architecture. 46932951860SFabian Aggeler */ 47032951860SFabian Aggeler ret = (ret & (GICC_CTLR_EN_GRP1 | GICC_CTLR_EOIMODE_NS)) >> 1; 47132951860SFabian Aggeler } 47232951860SFabian Aggeler return ret; 47332951860SFabian Aggeler } 47432951860SFabian Aggeler 47532951860SFabian Aggeler static void gic_set_cpu_control(GICState *s, int cpu, uint32_t value, 47632951860SFabian Aggeler MemTxAttrs attrs) 47732951860SFabian Aggeler { 47832951860SFabian Aggeler uint32_t mask; 47932951860SFabian Aggeler 48032951860SFabian Aggeler if (s->security_extn && !attrs.secure) { 48132951860SFabian Aggeler /* The NS view can only write certain bits in the register; 48232951860SFabian Aggeler * the rest are unchanged 48332951860SFabian Aggeler */ 48432951860SFabian Aggeler mask = GICC_CTLR_EN_GRP1; 48532951860SFabian Aggeler if (s->revision == 2) { 48632951860SFabian Aggeler mask |= GICC_CTLR_EOIMODE_NS; 48732951860SFabian Aggeler } 48832951860SFabian Aggeler s->cpu_ctlr[cpu] &= ~mask; 48932951860SFabian Aggeler s->cpu_ctlr[cpu] |= (value << 1) & mask; 49032951860SFabian Aggeler } else { 49132951860SFabian Aggeler if (s->revision == 2) { 49232951860SFabian Aggeler mask = s->security_extn ? GICC_CTLR_V2_S_MASK : GICC_CTLR_V2_MASK; 49332951860SFabian Aggeler } else { 49432951860SFabian Aggeler mask = s->security_extn ? GICC_CTLR_V1_S_MASK : GICC_CTLR_V1_MASK; 49532951860SFabian Aggeler } 49632951860SFabian Aggeler s->cpu_ctlr[cpu] = value & mask; 49732951860SFabian Aggeler } 49832951860SFabian Aggeler DPRINTF("CPU Interface %d: Group0 Interrupts %sabled, " 49932951860SFabian Aggeler "Group1 Interrupts %sabled\n", cpu, 50032951860SFabian Aggeler (s->cpu_ctlr[cpu] & GICC_CTLR_EN_GRP0) ? "En" : "Dis", 50132951860SFabian Aggeler (s->cpu_ctlr[cpu] & GICC_CTLR_EN_GRP1) ? "En" : "Dis"); 50232951860SFabian Aggeler } 50332951860SFabian Aggeler 50408efa9f2SFabian Aggeler static uint8_t gic_get_running_priority(GICState *s, int cpu, MemTxAttrs attrs) 50508efa9f2SFabian Aggeler { 50608efa9f2SFabian Aggeler if (s->security_extn && !attrs.secure) { 50708efa9f2SFabian Aggeler if (s->running_priority[cpu] & 0x80) { 50808efa9f2SFabian Aggeler /* Running priority in upper half of range: return the Non-secure 50908efa9f2SFabian Aggeler * view of the priority. 51008efa9f2SFabian Aggeler */ 51108efa9f2SFabian Aggeler return s->running_priority[cpu] << 1; 51208efa9f2SFabian Aggeler } else { 51308efa9f2SFabian Aggeler /* Running priority in lower half of range: RAZ */ 51408efa9f2SFabian Aggeler return 0; 51508efa9f2SFabian Aggeler } 51608efa9f2SFabian Aggeler } else { 51708efa9f2SFabian Aggeler return s->running_priority[cpu]; 51808efa9f2SFabian Aggeler } 51908efa9f2SFabian Aggeler } 52008efa9f2SFabian Aggeler 521a55c910eSPeter Maydell /* Return true if we should split priority drop and interrupt deactivation, 522a55c910eSPeter Maydell * ie whether the relevant EOIMode bit is set. 523a55c910eSPeter Maydell */ 524a55c910eSPeter Maydell static bool gic_eoi_split(GICState *s, int cpu, MemTxAttrs attrs) 525a55c910eSPeter Maydell { 526a55c910eSPeter Maydell if (s->revision != 2) { 527a55c910eSPeter Maydell /* Before GICv2 prio-drop and deactivate are not separable */ 528a55c910eSPeter Maydell return false; 529a55c910eSPeter Maydell } 530a55c910eSPeter Maydell if (s->security_extn && !attrs.secure) { 531a55c910eSPeter Maydell return s->cpu_ctlr[cpu] & GICC_CTLR_EOIMODE_NS; 532a55c910eSPeter Maydell } 533a55c910eSPeter Maydell return s->cpu_ctlr[cpu] & GICC_CTLR_EOIMODE; 534a55c910eSPeter Maydell } 535a55c910eSPeter Maydell 536a55c910eSPeter Maydell static void gic_deactivate_irq(GICState *s, int cpu, int irq, MemTxAttrs attrs) 537a55c910eSPeter Maydell { 538a55c910eSPeter Maydell int cm = 1 << cpu; 539a55c910eSPeter Maydell int group = gic_has_groups(s) && GIC_TEST_GROUP(irq, cm); 540a55c910eSPeter Maydell 541a55c910eSPeter Maydell if (!gic_eoi_split(s, cpu, attrs)) { 542a55c910eSPeter Maydell /* This is UNPREDICTABLE; we choose to ignore it */ 543a55c910eSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 544a55c910eSPeter Maydell "gic_deactivate_irq: GICC_DIR write when EOIMode clear"); 545a55c910eSPeter Maydell return; 546a55c910eSPeter Maydell } 547a55c910eSPeter Maydell 548a55c910eSPeter Maydell if (s->security_extn && !attrs.secure && !group) { 549a55c910eSPeter Maydell DPRINTF("Non-secure DI for Group0 interrupt %d ignored\n", irq); 550a55c910eSPeter Maydell return; 551a55c910eSPeter Maydell } 552a55c910eSPeter Maydell 553a55c910eSPeter Maydell GIC_CLEAR_ACTIVE(irq, cm); 554a55c910eSPeter Maydell } 555a55c910eSPeter Maydell 556f9c6a7f1SFabian Aggeler void gic_complete_irq(GICState *s, int cpu, int irq, MemTxAttrs attrs) 557e69954b9Spbrook { 5589ee6e8bbSpbrook int cm = 1 << cpu; 55972889c8aSPeter Maydell int group; 56072889c8aSPeter Maydell 561df628ff1Spbrook DPRINTF("EOI %d\n", irq); 562a32134aaSMark Langsdorf if (irq >= s->num_irq) { 563217bfb44SPeter Maydell /* This handles two cases: 564217bfb44SPeter Maydell * 1. If software writes the ID of a spurious interrupt [ie 1023] 565217bfb44SPeter Maydell * to the GICC_EOIR, the GIC ignores that write. 566217bfb44SPeter Maydell * 2. If software writes the number of a non-existent interrupt 567217bfb44SPeter Maydell * this must be a subcase of "value written does not match the last 568217bfb44SPeter Maydell * valid interrupt value read from the Interrupt Acknowledge 569217bfb44SPeter Maydell * register" and so this is UNPREDICTABLE. We choose to ignore it. 570217bfb44SPeter Maydell */ 571217bfb44SPeter Maydell return; 572217bfb44SPeter Maydell } 57372889c8aSPeter Maydell if (s->running_priority[cpu] == 0x100) { 574e69954b9Spbrook return; /* No active IRQ. */ 57572889c8aSPeter Maydell } 5768d999995SChristoffer Dall 5773bc4b52cSMarcin Krzeminski if (s->revision == REV_11MPCORE) { 578e69954b9Spbrook /* Mark level triggered interrupts as pending if they are still 579e69954b9Spbrook raised. */ 58004050c5cSChristoffer Dall if (!GIC_TEST_EDGE_TRIGGER(irq) && GIC_TEST_ENABLED(irq, cm) 5819ee6e8bbSpbrook && GIC_TEST_LEVEL(irq, cm) && (GIC_TARGET(irq) & cm) != 0) { 5829ee6e8bbSpbrook DPRINTF("Set %d pending mask %x\n", irq, cm); 5839ee6e8bbSpbrook GIC_SET_PENDING(irq, cm); 584e69954b9Spbrook } 5858d999995SChristoffer Dall } 5868d999995SChristoffer Dall 58772889c8aSPeter Maydell group = gic_has_groups(s) && GIC_TEST_GROUP(irq, cm); 58872889c8aSPeter Maydell 58972889c8aSPeter Maydell if (s->security_extn && !attrs.secure && !group) { 590f9c6a7f1SFabian Aggeler DPRINTF("Non-secure EOI for Group0 interrupt %d ignored\n", irq); 591f9c6a7f1SFabian Aggeler return; 592f9c6a7f1SFabian Aggeler } 593f9c6a7f1SFabian Aggeler 594f9c6a7f1SFabian Aggeler /* Secure EOI with GICC_CTLR.AckCtl == 0 when the IRQ is a Group 1 595f9c6a7f1SFabian Aggeler * interrupt is UNPREDICTABLE. We choose to handle it as if AckCtl == 1, 596f9c6a7f1SFabian Aggeler * i.e. go ahead and complete the irq anyway. 597f9c6a7f1SFabian Aggeler */ 598f9c6a7f1SFabian Aggeler 59972889c8aSPeter Maydell gic_drop_prio(s, cpu, group); 600a55c910eSPeter Maydell 601a55c910eSPeter Maydell /* In GICv2 the guest can choose to split priority-drop and deactivate */ 602a55c910eSPeter Maydell if (!gic_eoi_split(s, cpu, attrs)) { 603d5523a13SPeter Maydell GIC_CLEAR_ACTIVE(irq, cm); 604a55c910eSPeter Maydell } 605e69954b9Spbrook gic_update(s); 606e69954b9Spbrook } 607e69954b9Spbrook 608a9d85353SPeter Maydell static uint32_t gic_dist_readb(void *opaque, hwaddr offset, MemTxAttrs attrs) 609e69954b9Spbrook { 610fae15286SPeter Maydell GICState *s = (GICState *)opaque; 611e69954b9Spbrook uint32_t res; 612e69954b9Spbrook int irq; 613e69954b9Spbrook int i; 6149ee6e8bbSpbrook int cpu; 6159ee6e8bbSpbrook int cm; 6169ee6e8bbSpbrook int mask; 617e69954b9Spbrook 618926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 6199ee6e8bbSpbrook cm = 1 << cpu; 620e69954b9Spbrook if (offset < 0x100) { 621679aa175SFabian Aggeler if (offset == 0) { /* GICD_CTLR */ 622679aa175SFabian Aggeler if (s->security_extn && !attrs.secure) { 623679aa175SFabian Aggeler /* The NS bank of this register is just an alias of the 624679aa175SFabian Aggeler * EnableGrp1 bit in the S bank version. 625679aa175SFabian Aggeler */ 626679aa175SFabian Aggeler return extract32(s->ctlr, 1, 1); 627679aa175SFabian Aggeler } else { 628679aa175SFabian Aggeler return s->ctlr; 629679aa175SFabian Aggeler } 630679aa175SFabian Aggeler } 631e69954b9Spbrook if (offset == 4) 6325543d1abSFabian Aggeler /* Interrupt Controller Type Register */ 6335543d1abSFabian Aggeler return ((s->num_irq / 32) - 1) 634b95690c9SWei Huang | ((s->num_cpu - 1) << 5) 6355543d1abSFabian Aggeler | (s->security_extn << 10); 636e69954b9Spbrook if (offset < 0x08) 637e69954b9Spbrook return 0; 638b79f2265SRob Herring if (offset >= 0x80) { 639c27a5ba9SFabian Aggeler /* Interrupt Group Registers: these RAZ/WI if this is an NS 640c27a5ba9SFabian Aggeler * access to a GIC with the security extensions, or if the GIC 641c27a5ba9SFabian Aggeler * doesn't have groups at all. 642c27a5ba9SFabian Aggeler */ 643c27a5ba9SFabian Aggeler res = 0; 644c27a5ba9SFabian Aggeler if (!(s->security_extn && !attrs.secure) && gic_has_groups(s)) { 645c27a5ba9SFabian Aggeler /* Every byte offset holds 8 group status bits */ 646c27a5ba9SFabian Aggeler irq = (offset - 0x080) * 8 + GIC_BASE_IRQ; 647c27a5ba9SFabian Aggeler if (irq >= s->num_irq) { 648c27a5ba9SFabian Aggeler goto bad_reg; 649c27a5ba9SFabian Aggeler } 650c27a5ba9SFabian Aggeler for (i = 0; i < 8; i++) { 651c27a5ba9SFabian Aggeler if (GIC_TEST_GROUP(irq + i, cm)) { 652c27a5ba9SFabian Aggeler res |= (1 << i); 653c27a5ba9SFabian Aggeler } 654c27a5ba9SFabian Aggeler } 655c27a5ba9SFabian Aggeler } 656c27a5ba9SFabian Aggeler return res; 657b79f2265SRob Herring } 658e69954b9Spbrook goto bad_reg; 659e69954b9Spbrook } else if (offset < 0x200) { 660e69954b9Spbrook /* Interrupt Set/Clear Enable. */ 661e69954b9Spbrook if (offset < 0x180) 662e69954b9Spbrook irq = (offset - 0x100) * 8; 663e69954b9Spbrook else 664e69954b9Spbrook irq = (offset - 0x180) * 8; 6659ee6e8bbSpbrook irq += GIC_BASE_IRQ; 666a32134aaSMark Langsdorf if (irq >= s->num_irq) 667e69954b9Spbrook goto bad_reg; 668e69954b9Spbrook res = 0; 669e69954b9Spbrook for (i = 0; i < 8; i++) { 670fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 671fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 672fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 673fea8a08eSJens Wiklander } 674fea8a08eSJens Wiklander 67541bf234dSRabin Vincent if (GIC_TEST_ENABLED(irq + i, cm)) { 676e69954b9Spbrook res |= (1 << i); 677e69954b9Spbrook } 678e69954b9Spbrook } 679e69954b9Spbrook } else if (offset < 0x300) { 680e69954b9Spbrook /* Interrupt Set/Clear Pending. */ 681e69954b9Spbrook if (offset < 0x280) 682e69954b9Spbrook irq = (offset - 0x200) * 8; 683e69954b9Spbrook else 684e69954b9Spbrook irq = (offset - 0x280) * 8; 6859ee6e8bbSpbrook irq += GIC_BASE_IRQ; 686a32134aaSMark Langsdorf if (irq >= s->num_irq) 687e69954b9Spbrook goto bad_reg; 688e69954b9Spbrook res = 0; 68969253800SRusty Russell mask = (irq < GIC_INTERNAL) ? cm : ALL_CPU_MASK; 690e69954b9Spbrook for (i = 0; i < 8; i++) { 691fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 692fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 693fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 694fea8a08eSJens Wiklander } 695fea8a08eSJens Wiklander 6968d999995SChristoffer Dall if (gic_test_pending(s, irq + i, mask)) { 697e69954b9Spbrook res |= (1 << i); 698e69954b9Spbrook } 699e69954b9Spbrook } 700e69954b9Spbrook } else if (offset < 0x400) { 701e69954b9Spbrook /* Interrupt Active. */ 7029ee6e8bbSpbrook irq = (offset - 0x300) * 8 + GIC_BASE_IRQ; 703a32134aaSMark Langsdorf if (irq >= s->num_irq) 704e69954b9Spbrook goto bad_reg; 705e69954b9Spbrook res = 0; 70669253800SRusty Russell mask = (irq < GIC_INTERNAL) ? cm : ALL_CPU_MASK; 707e69954b9Spbrook for (i = 0; i < 8; i++) { 708fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 709fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 710fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 711fea8a08eSJens Wiklander } 712fea8a08eSJens Wiklander 7139ee6e8bbSpbrook if (GIC_TEST_ACTIVE(irq + i, mask)) { 714e69954b9Spbrook res |= (1 << i); 715e69954b9Spbrook } 716e69954b9Spbrook } 717e69954b9Spbrook } else if (offset < 0x800) { 718e69954b9Spbrook /* Interrupt Priority. */ 7199ee6e8bbSpbrook irq = (offset - 0x400) + GIC_BASE_IRQ; 720a32134aaSMark Langsdorf if (irq >= s->num_irq) 721e69954b9Spbrook goto bad_reg; 72281508470SFabian Aggeler res = gic_get_priority(s, cpu, irq, attrs); 723e69954b9Spbrook } else if (offset < 0xc00) { 724e69954b9Spbrook /* Interrupt CPU Target. */ 7256b9680bbSPeter Maydell if (s->num_cpu == 1 && s->revision != REV_11MPCORE) { 7266b9680bbSPeter Maydell /* For uniprocessor GICs these RAZ/WI */ 7276b9680bbSPeter Maydell res = 0; 7286b9680bbSPeter Maydell } else { 7299ee6e8bbSpbrook irq = (offset - 0x800) + GIC_BASE_IRQ; 7306b9680bbSPeter Maydell if (irq >= s->num_irq) { 731e69954b9Spbrook goto bad_reg; 7326b9680bbSPeter Maydell } 7339ee6e8bbSpbrook if (irq >= 29 && irq <= 31) { 7349ee6e8bbSpbrook res = cm; 7359ee6e8bbSpbrook } else { 7369ee6e8bbSpbrook res = GIC_TARGET(irq); 7379ee6e8bbSpbrook } 7386b9680bbSPeter Maydell } 739e69954b9Spbrook } else if (offset < 0xf00) { 740e69954b9Spbrook /* Interrupt Configuration. */ 74171a62046SAdam Lackorzynski irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ; 742a32134aaSMark Langsdorf if (irq >= s->num_irq) 743e69954b9Spbrook goto bad_reg; 744e69954b9Spbrook res = 0; 745e69954b9Spbrook for (i = 0; i < 4; i++) { 746fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 747fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 748fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 749fea8a08eSJens Wiklander } 750fea8a08eSJens Wiklander 751e69954b9Spbrook if (GIC_TEST_MODEL(irq + i)) 752e69954b9Spbrook res |= (1 << (i * 2)); 75304050c5cSChristoffer Dall if (GIC_TEST_EDGE_TRIGGER(irq + i)) 754e69954b9Spbrook res |= (2 << (i * 2)); 755e69954b9Spbrook } 75640d22500SChristoffer Dall } else if (offset < 0xf10) { 75740d22500SChristoffer Dall goto bad_reg; 75840d22500SChristoffer Dall } else if (offset < 0xf30) { 7597c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 76040d22500SChristoffer Dall goto bad_reg; 76140d22500SChristoffer Dall } 76240d22500SChristoffer Dall 76340d22500SChristoffer Dall if (offset < 0xf20) { 76440d22500SChristoffer Dall /* GICD_CPENDSGIRn */ 76540d22500SChristoffer Dall irq = (offset - 0xf10); 76640d22500SChristoffer Dall } else { 76740d22500SChristoffer Dall irq = (offset - 0xf20); 76840d22500SChristoffer Dall /* GICD_SPENDSGIRn */ 76940d22500SChristoffer Dall } 77040d22500SChristoffer Dall 771fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 772fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq, 1 << cpu)) { 773fea8a08eSJens Wiklander res = 0; /* Ignore Non-secure access of Group0 IRQ */ 774fea8a08eSJens Wiklander } else { 77540d22500SChristoffer Dall res = s->sgi_pending[irq][cpu]; 776fea8a08eSJens Wiklander } 7773355c360SAlistair Francis } else if (offset < 0xfd0) { 778e69954b9Spbrook goto bad_reg; 7793355c360SAlistair Francis } else if (offset < 0x1000) { 780e69954b9Spbrook if (offset & 3) { 781e69954b9Spbrook res = 0; 782e69954b9Spbrook } else { 7833355c360SAlistair Francis switch (s->revision) { 7843355c360SAlistair Francis case REV_11MPCORE: 7853355c360SAlistair Francis res = gic_id_11mpcore[(offset - 0xfd0) >> 2]; 7863355c360SAlistair Francis break; 7873355c360SAlistair Francis case 1: 7883355c360SAlistair Francis res = gic_id_gicv1[(offset - 0xfd0) >> 2]; 7893355c360SAlistair Francis break; 7903355c360SAlistair Francis case 2: 7913355c360SAlistair Francis res = gic_id_gicv2[(offset - 0xfd0) >> 2]; 7923355c360SAlistair Francis break; 7933355c360SAlistair Francis default: 7943355c360SAlistair Francis res = 0; 795e69954b9Spbrook } 796e69954b9Spbrook } 7973355c360SAlistair Francis } else { 7983355c360SAlistair Francis g_assert_not_reached(); 7993355c360SAlistair Francis } 800e69954b9Spbrook return res; 801e69954b9Spbrook bad_reg: 8028c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 8038c8dc39fSPeter Maydell "gic_dist_readb: Bad offset %x\n", (int)offset); 804e69954b9Spbrook return 0; 805e69954b9Spbrook } 806e69954b9Spbrook 807a9d85353SPeter Maydell static MemTxResult gic_dist_read(void *opaque, hwaddr offset, uint64_t *data, 808a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 809e69954b9Spbrook { 810a9d85353SPeter Maydell switch (size) { 811a9d85353SPeter Maydell case 1: 812a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 813a9d85353SPeter Maydell return MEMTX_OK; 814a9d85353SPeter Maydell case 2: 815a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 816a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 1, attrs) << 8; 817a9d85353SPeter Maydell return MEMTX_OK; 818a9d85353SPeter Maydell case 4: 819a9d85353SPeter Maydell *data = gic_dist_readb(opaque, offset, attrs); 820a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 1, attrs) << 8; 821a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 2, attrs) << 16; 822a9d85353SPeter Maydell *data |= gic_dist_readb(opaque, offset + 3, attrs) << 24; 823a9d85353SPeter Maydell return MEMTX_OK; 824a9d85353SPeter Maydell default: 825a9d85353SPeter Maydell return MEMTX_ERROR; 826e69954b9Spbrook } 827e69954b9Spbrook } 828e69954b9Spbrook 829a8170e5eSAvi Kivity static void gic_dist_writeb(void *opaque, hwaddr offset, 830a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 831e69954b9Spbrook { 832fae15286SPeter Maydell GICState *s = (GICState *)opaque; 833e69954b9Spbrook int irq; 834e69954b9Spbrook int i; 8359ee6e8bbSpbrook int cpu; 836e69954b9Spbrook 837926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 838e69954b9Spbrook if (offset < 0x100) { 839e69954b9Spbrook if (offset == 0) { 840679aa175SFabian Aggeler if (s->security_extn && !attrs.secure) { 841679aa175SFabian Aggeler /* NS version is just an alias of the S version's bit 1 */ 842679aa175SFabian Aggeler s->ctlr = deposit32(s->ctlr, 1, 1, value); 843679aa175SFabian Aggeler } else if (gic_has_groups(s)) { 844679aa175SFabian Aggeler s->ctlr = value & (GICD_CTLR_EN_GRP0 | GICD_CTLR_EN_GRP1); 845679aa175SFabian Aggeler } else { 846679aa175SFabian Aggeler s->ctlr = value & GICD_CTLR_EN_GRP0; 847679aa175SFabian Aggeler } 848679aa175SFabian Aggeler DPRINTF("Distributor: Group0 %sabled; Group 1 %sabled\n", 849679aa175SFabian Aggeler s->ctlr & GICD_CTLR_EN_GRP0 ? "En" : "Dis", 850679aa175SFabian Aggeler s->ctlr & GICD_CTLR_EN_GRP1 ? "En" : "Dis"); 851e69954b9Spbrook } else if (offset < 4) { 852e69954b9Spbrook /* ignored. */ 853b79f2265SRob Herring } else if (offset >= 0x80) { 854c27a5ba9SFabian Aggeler /* Interrupt Group Registers: RAZ/WI for NS access to secure 855c27a5ba9SFabian Aggeler * GIC, or for GICs without groups. 856c27a5ba9SFabian Aggeler */ 857c27a5ba9SFabian Aggeler if (!(s->security_extn && !attrs.secure) && gic_has_groups(s)) { 858c27a5ba9SFabian Aggeler /* Every byte offset holds 8 group status bits */ 859c27a5ba9SFabian Aggeler irq = (offset - 0x80) * 8 + GIC_BASE_IRQ; 860c27a5ba9SFabian Aggeler if (irq >= s->num_irq) { 861c27a5ba9SFabian Aggeler goto bad_reg; 862c27a5ba9SFabian Aggeler } 863c27a5ba9SFabian Aggeler for (i = 0; i < 8; i++) { 864c27a5ba9SFabian Aggeler /* Group bits are banked for private interrupts */ 865c27a5ba9SFabian Aggeler int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 866c27a5ba9SFabian Aggeler if (value & (1 << i)) { 867c27a5ba9SFabian Aggeler /* Group1 (Non-secure) */ 868c27a5ba9SFabian Aggeler GIC_SET_GROUP(irq + i, cm); 869c27a5ba9SFabian Aggeler } else { 870c27a5ba9SFabian Aggeler /* Group0 (Secure) */ 871c27a5ba9SFabian Aggeler GIC_CLEAR_GROUP(irq + i, cm); 872c27a5ba9SFabian Aggeler } 873c27a5ba9SFabian Aggeler } 874c27a5ba9SFabian Aggeler } 875e69954b9Spbrook } else { 876e69954b9Spbrook goto bad_reg; 877e69954b9Spbrook } 878e69954b9Spbrook } else if (offset < 0x180) { 879e69954b9Spbrook /* Interrupt Set Enable. */ 8809ee6e8bbSpbrook irq = (offset - 0x100) * 8 + GIC_BASE_IRQ; 881a32134aaSMark Langsdorf if (irq >= s->num_irq) 882e69954b9Spbrook goto bad_reg; 88341ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 8849ee6e8bbSpbrook value = 0xff; 88541ab7b55SChristoffer Dall } 88641ab7b55SChristoffer Dall 887e69954b9Spbrook for (i = 0; i < 8; i++) { 888e69954b9Spbrook if (value & (1 << i)) { 889f47b48fbSDaniel Sangorrin int mask = 890f47b48fbSDaniel Sangorrin (irq < GIC_INTERNAL) ? (1 << cpu) : GIC_TARGET(irq + i); 89169253800SRusty Russell int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 89241bf234dSRabin Vincent 893fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 894fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 895fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 896fea8a08eSJens Wiklander } 897fea8a08eSJens Wiklander 89841bf234dSRabin Vincent if (!GIC_TEST_ENABLED(irq + i, cm)) { 899e69954b9Spbrook DPRINTF("Enabled IRQ %d\n", irq + i); 9002531088fSHollis Blanchard trace_gic_enable_irq(irq + i); 90141bf234dSRabin Vincent } 90241bf234dSRabin Vincent GIC_SET_ENABLED(irq + i, cm); 903e69954b9Spbrook /* If a raised level triggered IRQ enabled then mark 904e69954b9Spbrook is as pending. */ 9059ee6e8bbSpbrook if (GIC_TEST_LEVEL(irq + i, mask) 90604050c5cSChristoffer Dall && !GIC_TEST_EDGE_TRIGGER(irq + i)) { 9079ee6e8bbSpbrook DPRINTF("Set %d pending mask %x\n", irq + i, mask); 9089ee6e8bbSpbrook GIC_SET_PENDING(irq + i, mask); 9099ee6e8bbSpbrook } 910e69954b9Spbrook } 911e69954b9Spbrook } 912e69954b9Spbrook } else if (offset < 0x200) { 913e69954b9Spbrook /* Interrupt Clear Enable. */ 9149ee6e8bbSpbrook irq = (offset - 0x180) * 8 + GIC_BASE_IRQ; 915a32134aaSMark Langsdorf if (irq >= s->num_irq) 916e69954b9Spbrook goto bad_reg; 91741ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 9189ee6e8bbSpbrook value = 0; 91941ab7b55SChristoffer Dall } 92041ab7b55SChristoffer Dall 921e69954b9Spbrook for (i = 0; i < 8; i++) { 922e69954b9Spbrook if (value & (1 << i)) { 92369253800SRusty Russell int cm = (irq < GIC_INTERNAL) ? (1 << cpu) : ALL_CPU_MASK; 92441bf234dSRabin Vincent 925fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 926fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 927fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 928fea8a08eSJens Wiklander } 929fea8a08eSJens Wiklander 93041bf234dSRabin Vincent if (GIC_TEST_ENABLED(irq + i, cm)) { 931e69954b9Spbrook DPRINTF("Disabled IRQ %d\n", irq + i); 9322531088fSHollis Blanchard trace_gic_disable_irq(irq + i); 93341bf234dSRabin Vincent } 93441bf234dSRabin Vincent GIC_CLEAR_ENABLED(irq + i, cm); 935e69954b9Spbrook } 936e69954b9Spbrook } 937e69954b9Spbrook } else if (offset < 0x280) { 938e69954b9Spbrook /* Interrupt Set Pending. */ 9399ee6e8bbSpbrook irq = (offset - 0x200) * 8 + GIC_BASE_IRQ; 940a32134aaSMark Langsdorf if (irq >= s->num_irq) 941e69954b9Spbrook goto bad_reg; 94241ab7b55SChristoffer Dall if (irq < GIC_NR_SGIS) { 9435b0adce1SChristoffer Dall value = 0; 94441ab7b55SChristoffer Dall } 9459ee6e8bbSpbrook 946e69954b9Spbrook for (i = 0; i < 8; i++) { 947e69954b9Spbrook if (value & (1 << i)) { 948fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 949fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 950fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 951fea8a08eSJens Wiklander } 952fea8a08eSJens Wiklander 953f47b48fbSDaniel Sangorrin GIC_SET_PENDING(irq + i, GIC_TARGET(irq + i)); 954e69954b9Spbrook } 955e69954b9Spbrook } 956e69954b9Spbrook } else if (offset < 0x300) { 957e69954b9Spbrook /* Interrupt Clear Pending. */ 9589ee6e8bbSpbrook irq = (offset - 0x280) * 8 + GIC_BASE_IRQ; 959a32134aaSMark Langsdorf if (irq >= s->num_irq) 960e69954b9Spbrook goto bad_reg; 9615b0adce1SChristoffer Dall if (irq < GIC_NR_SGIS) { 9625b0adce1SChristoffer Dall value = 0; 9635b0adce1SChristoffer Dall } 9645b0adce1SChristoffer Dall 965e69954b9Spbrook for (i = 0; i < 8; i++) { 966fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 967fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 968fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 969fea8a08eSJens Wiklander } 970fea8a08eSJens Wiklander 9719ee6e8bbSpbrook /* ??? This currently clears the pending bit for all CPUs, even 9729ee6e8bbSpbrook for per-CPU interrupts. It's unclear whether this is the 9739ee6e8bbSpbrook corect behavior. */ 974e69954b9Spbrook if (value & (1 << i)) { 9759ee6e8bbSpbrook GIC_CLEAR_PENDING(irq + i, ALL_CPU_MASK); 976e69954b9Spbrook } 977e69954b9Spbrook } 978e69954b9Spbrook } else if (offset < 0x400) { 979e69954b9Spbrook /* Interrupt Active. */ 980e69954b9Spbrook goto bad_reg; 981e69954b9Spbrook } else if (offset < 0x800) { 982e69954b9Spbrook /* Interrupt Priority. */ 9839ee6e8bbSpbrook irq = (offset - 0x400) + GIC_BASE_IRQ; 984a32134aaSMark Langsdorf if (irq >= s->num_irq) 985e69954b9Spbrook goto bad_reg; 98681508470SFabian Aggeler gic_set_priority(s, cpu, irq, value, attrs); 987e69954b9Spbrook } else if (offset < 0xc00) { 9886b9680bbSPeter Maydell /* Interrupt CPU Target. RAZ/WI on uniprocessor GICs, with the 9896b9680bbSPeter Maydell * annoying exception of the 11MPCore's GIC. 9906b9680bbSPeter Maydell */ 9916b9680bbSPeter Maydell if (s->num_cpu != 1 || s->revision == REV_11MPCORE) { 9929ee6e8bbSpbrook irq = (offset - 0x800) + GIC_BASE_IRQ; 9936b9680bbSPeter Maydell if (irq >= s->num_irq) { 994e69954b9Spbrook goto bad_reg; 9956b9680bbSPeter Maydell } 9966b9680bbSPeter Maydell if (irq < 29) { 9979ee6e8bbSpbrook value = 0; 9986b9680bbSPeter Maydell } else if (irq < GIC_INTERNAL) { 9999ee6e8bbSpbrook value = ALL_CPU_MASK; 10006b9680bbSPeter Maydell } 10019ee6e8bbSpbrook s->irq_target[irq] = value & ALL_CPU_MASK; 10026b9680bbSPeter Maydell } 1003e69954b9Spbrook } else if (offset < 0xf00) { 1004e69954b9Spbrook /* Interrupt Configuration. */ 10059ee6e8bbSpbrook irq = (offset - 0xc00) * 4 + GIC_BASE_IRQ; 1006a32134aaSMark Langsdorf if (irq >= s->num_irq) 1007e69954b9Spbrook goto bad_reg; 1008de7a900fSAdam Lackorzynski if (irq < GIC_NR_SGIS) 10099ee6e8bbSpbrook value |= 0xaa; 1010e69954b9Spbrook for (i = 0; i < 4; i++) { 1011fea8a08eSJens Wiklander if (s->security_extn && !attrs.secure && 1012fea8a08eSJens Wiklander !GIC_TEST_GROUP(irq + i, 1 << cpu)) { 1013fea8a08eSJens Wiklander continue; /* Ignore Non-secure access of Group0 IRQ */ 1014fea8a08eSJens Wiklander } 1015fea8a08eSJens Wiklander 10167c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 1017e69954b9Spbrook if (value & (1 << (i * 2))) { 1018e69954b9Spbrook GIC_SET_MODEL(irq + i); 1019e69954b9Spbrook } else { 1020e69954b9Spbrook GIC_CLEAR_MODEL(irq + i); 1021e69954b9Spbrook } 102224b790dfSAdam Lackorzynski } 1023e69954b9Spbrook if (value & (2 << (i * 2))) { 102404050c5cSChristoffer Dall GIC_SET_EDGE_TRIGGER(irq + i); 1025e69954b9Spbrook } else { 102604050c5cSChristoffer Dall GIC_CLEAR_EDGE_TRIGGER(irq + i); 1027e69954b9Spbrook } 1028e69954b9Spbrook } 102940d22500SChristoffer Dall } else if (offset < 0xf10) { 10309ee6e8bbSpbrook /* 0xf00 is only handled for 32-bit writes. */ 1031e69954b9Spbrook goto bad_reg; 103240d22500SChristoffer Dall } else if (offset < 0xf20) { 103340d22500SChristoffer Dall /* GICD_CPENDSGIRn */ 10347c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 103540d22500SChristoffer Dall goto bad_reg; 103640d22500SChristoffer Dall } 103740d22500SChristoffer Dall irq = (offset - 0xf10); 103840d22500SChristoffer Dall 1039fea8a08eSJens Wiklander if (!s->security_extn || attrs.secure || 1040fea8a08eSJens Wiklander GIC_TEST_GROUP(irq, 1 << cpu)) { 104140d22500SChristoffer Dall s->sgi_pending[irq][cpu] &= ~value; 104240d22500SChristoffer Dall if (s->sgi_pending[irq][cpu] == 0) { 104340d22500SChristoffer Dall GIC_CLEAR_PENDING(irq, 1 << cpu); 104440d22500SChristoffer Dall } 1045fea8a08eSJens Wiklander } 104640d22500SChristoffer Dall } else if (offset < 0xf30) { 104740d22500SChristoffer Dall /* GICD_SPENDSGIRn */ 10487c14b3acSMichael Davidsaver if (s->revision == REV_11MPCORE) { 104940d22500SChristoffer Dall goto bad_reg; 105040d22500SChristoffer Dall } 105140d22500SChristoffer Dall irq = (offset - 0xf20); 105240d22500SChristoffer Dall 1053fea8a08eSJens Wiklander if (!s->security_extn || attrs.secure || 1054fea8a08eSJens Wiklander GIC_TEST_GROUP(irq, 1 << cpu)) { 105540d22500SChristoffer Dall GIC_SET_PENDING(irq, 1 << cpu); 105640d22500SChristoffer Dall s->sgi_pending[irq][cpu] |= value; 1057fea8a08eSJens Wiklander } 105840d22500SChristoffer Dall } else { 105940d22500SChristoffer Dall goto bad_reg; 1060e69954b9Spbrook } 1061e69954b9Spbrook gic_update(s); 1062e69954b9Spbrook return; 1063e69954b9Spbrook bad_reg: 10648c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 10658c8dc39fSPeter Maydell "gic_dist_writeb: Bad offset %x\n", (int)offset); 1066e69954b9Spbrook } 1067e69954b9Spbrook 1068a8170e5eSAvi Kivity static void gic_dist_writew(void *opaque, hwaddr offset, 1069a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1070e69954b9Spbrook { 1071a9d85353SPeter Maydell gic_dist_writeb(opaque, offset, value & 0xff, attrs); 1072a9d85353SPeter Maydell gic_dist_writeb(opaque, offset + 1, value >> 8, attrs); 1073e69954b9Spbrook } 1074e69954b9Spbrook 1075a8170e5eSAvi Kivity static void gic_dist_writel(void *opaque, hwaddr offset, 1076a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1077e69954b9Spbrook { 1078fae15286SPeter Maydell GICState *s = (GICState *)opaque; 10798da3ff18Spbrook if (offset == 0xf00) { 10809ee6e8bbSpbrook int cpu; 10819ee6e8bbSpbrook int irq; 10829ee6e8bbSpbrook int mask; 108340d22500SChristoffer Dall int target_cpu; 10849ee6e8bbSpbrook 1085926c4affSPeter Maydell cpu = gic_get_current_cpu(s); 10869ee6e8bbSpbrook irq = value & 0x3ff; 10879ee6e8bbSpbrook switch ((value >> 24) & 3) { 10889ee6e8bbSpbrook case 0: 10899ee6e8bbSpbrook mask = (value >> 16) & ALL_CPU_MASK; 10909ee6e8bbSpbrook break; 10919ee6e8bbSpbrook case 1: 1092fa250144SAdam Lackorzynski mask = ALL_CPU_MASK ^ (1 << cpu); 10939ee6e8bbSpbrook break; 10949ee6e8bbSpbrook case 2: 1095fa250144SAdam Lackorzynski mask = 1 << cpu; 10969ee6e8bbSpbrook break; 10979ee6e8bbSpbrook default: 10989ee6e8bbSpbrook DPRINTF("Bad Soft Int target filter\n"); 10999ee6e8bbSpbrook mask = ALL_CPU_MASK; 11009ee6e8bbSpbrook break; 11019ee6e8bbSpbrook } 11029ee6e8bbSpbrook GIC_SET_PENDING(irq, mask); 110340d22500SChristoffer Dall target_cpu = ctz32(mask); 110440d22500SChristoffer Dall while (target_cpu < GIC_NCPU) { 110540d22500SChristoffer Dall s->sgi_pending[irq][target_cpu] |= (1 << cpu); 110640d22500SChristoffer Dall mask &= ~(1 << target_cpu); 110740d22500SChristoffer Dall target_cpu = ctz32(mask); 110840d22500SChristoffer Dall } 11099ee6e8bbSpbrook gic_update(s); 11109ee6e8bbSpbrook return; 11119ee6e8bbSpbrook } 1112a9d85353SPeter Maydell gic_dist_writew(opaque, offset, value & 0xffff, attrs); 1113a9d85353SPeter Maydell gic_dist_writew(opaque, offset + 2, value >> 16, attrs); 1114a9d85353SPeter Maydell } 1115a9d85353SPeter Maydell 1116a9d85353SPeter Maydell static MemTxResult gic_dist_write(void *opaque, hwaddr offset, uint64_t data, 1117a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1118a9d85353SPeter Maydell { 1119a9d85353SPeter Maydell switch (size) { 1120a9d85353SPeter Maydell case 1: 1121a9d85353SPeter Maydell gic_dist_writeb(opaque, offset, data, attrs); 1122a9d85353SPeter Maydell return MEMTX_OK; 1123a9d85353SPeter Maydell case 2: 1124a9d85353SPeter Maydell gic_dist_writew(opaque, offset, data, attrs); 1125a9d85353SPeter Maydell return MEMTX_OK; 1126a9d85353SPeter Maydell case 4: 1127a9d85353SPeter Maydell gic_dist_writel(opaque, offset, data, attrs); 1128a9d85353SPeter Maydell return MEMTX_OK; 1129a9d85353SPeter Maydell default: 1130a9d85353SPeter Maydell return MEMTX_ERROR; 1131a9d85353SPeter Maydell } 1132e69954b9Spbrook } 1133e69954b9Spbrook 113451fd06e0SPeter Maydell static inline uint32_t gic_apr_ns_view(GICState *s, int cpu, int regno) 113551fd06e0SPeter Maydell { 113651fd06e0SPeter Maydell /* Return the Nonsecure view of GICC_APR<regno>. This is the 113751fd06e0SPeter Maydell * second half of GICC_NSAPR. 113851fd06e0SPeter Maydell */ 113951fd06e0SPeter Maydell switch (GIC_MIN_BPR) { 114051fd06e0SPeter Maydell case 0: 114151fd06e0SPeter Maydell if (regno < 2) { 114251fd06e0SPeter Maydell return s->nsapr[regno + 2][cpu]; 114351fd06e0SPeter Maydell } 114451fd06e0SPeter Maydell break; 114551fd06e0SPeter Maydell case 1: 114651fd06e0SPeter Maydell if (regno == 0) { 114751fd06e0SPeter Maydell return s->nsapr[regno + 1][cpu]; 114851fd06e0SPeter Maydell } 114951fd06e0SPeter Maydell break; 115051fd06e0SPeter Maydell case 2: 115151fd06e0SPeter Maydell if (regno == 0) { 115251fd06e0SPeter Maydell return extract32(s->nsapr[0][cpu], 16, 16); 115351fd06e0SPeter Maydell } 115451fd06e0SPeter Maydell break; 115551fd06e0SPeter Maydell case 3: 115651fd06e0SPeter Maydell if (regno == 0) { 115751fd06e0SPeter Maydell return extract32(s->nsapr[0][cpu], 8, 8); 115851fd06e0SPeter Maydell } 115951fd06e0SPeter Maydell break; 116051fd06e0SPeter Maydell default: 116151fd06e0SPeter Maydell g_assert_not_reached(); 116251fd06e0SPeter Maydell } 116351fd06e0SPeter Maydell return 0; 116451fd06e0SPeter Maydell } 116551fd06e0SPeter Maydell 116651fd06e0SPeter Maydell static inline void gic_apr_write_ns_view(GICState *s, int cpu, int regno, 116751fd06e0SPeter Maydell uint32_t value) 116851fd06e0SPeter Maydell { 116951fd06e0SPeter Maydell /* Write the Nonsecure view of GICC_APR<regno>. */ 117051fd06e0SPeter Maydell switch (GIC_MIN_BPR) { 117151fd06e0SPeter Maydell case 0: 117251fd06e0SPeter Maydell if (regno < 2) { 117351fd06e0SPeter Maydell s->nsapr[regno + 2][cpu] = value; 117451fd06e0SPeter Maydell } 117551fd06e0SPeter Maydell break; 117651fd06e0SPeter Maydell case 1: 117751fd06e0SPeter Maydell if (regno == 0) { 117851fd06e0SPeter Maydell s->nsapr[regno + 1][cpu] = value; 117951fd06e0SPeter Maydell } 118051fd06e0SPeter Maydell break; 118151fd06e0SPeter Maydell case 2: 118251fd06e0SPeter Maydell if (regno == 0) { 118351fd06e0SPeter Maydell s->nsapr[0][cpu] = deposit32(s->nsapr[0][cpu], 16, 16, value); 118451fd06e0SPeter Maydell } 118551fd06e0SPeter Maydell break; 118651fd06e0SPeter Maydell case 3: 118751fd06e0SPeter Maydell if (regno == 0) { 118851fd06e0SPeter Maydell s->nsapr[0][cpu] = deposit32(s->nsapr[0][cpu], 8, 8, value); 118951fd06e0SPeter Maydell } 119051fd06e0SPeter Maydell break; 119151fd06e0SPeter Maydell default: 119251fd06e0SPeter Maydell g_assert_not_reached(); 119351fd06e0SPeter Maydell } 119451fd06e0SPeter Maydell } 119551fd06e0SPeter Maydell 1196a9d85353SPeter Maydell static MemTxResult gic_cpu_read(GICState *s, int cpu, int offset, 1197a9d85353SPeter Maydell uint64_t *data, MemTxAttrs attrs) 1198e69954b9Spbrook { 1199e69954b9Spbrook switch (offset) { 1200e69954b9Spbrook case 0x00: /* Control */ 120132951860SFabian Aggeler *data = gic_get_cpu_control(s, cpu, attrs); 1202a9d85353SPeter Maydell break; 1203e69954b9Spbrook case 0x04: /* Priority mask */ 120481508470SFabian Aggeler *data = gic_get_priority_mask(s, cpu, attrs); 1205a9d85353SPeter Maydell break; 1206e69954b9Spbrook case 0x08: /* Binary Point */ 1207822e9cc3SFabian Aggeler if (s->security_extn && !attrs.secure) { 1208822e9cc3SFabian Aggeler /* BPR is banked. Non-secure copy stored in ABPR. */ 1209822e9cc3SFabian Aggeler *data = s->abpr[cpu]; 1210822e9cc3SFabian Aggeler } else { 1211a9d85353SPeter Maydell *data = s->bpr[cpu]; 1212822e9cc3SFabian Aggeler } 1213a9d85353SPeter Maydell break; 1214e69954b9Spbrook case 0x0c: /* Acknowledge */ 1215c5619bf9SFabian Aggeler *data = gic_acknowledge_irq(s, cpu, attrs); 1216a9d85353SPeter Maydell break; 121766a0a2cbSDong Xu Wang case 0x14: /* Running Priority */ 121808efa9f2SFabian Aggeler *data = gic_get_running_priority(s, cpu, attrs); 1219a9d85353SPeter Maydell break; 1220e69954b9Spbrook case 0x18: /* Highest Pending Interrupt */ 12217c0fa108SFabian Aggeler *data = gic_get_current_pending_irq(s, cpu, attrs); 1222a9d85353SPeter Maydell break; 1223aa7d461aSChristoffer Dall case 0x1c: /* Aliased Binary Point */ 1224822e9cc3SFabian Aggeler /* GIC v2, no security: ABPR 1225822e9cc3SFabian Aggeler * GIC v1, no security: not implemented (RAZ/WI) 1226822e9cc3SFabian Aggeler * With security extensions, secure access: ABPR (alias of NS BPR) 1227822e9cc3SFabian Aggeler * With security extensions, nonsecure access: RAZ/WI 1228822e9cc3SFabian Aggeler */ 1229822e9cc3SFabian Aggeler if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 1230822e9cc3SFabian Aggeler *data = 0; 1231822e9cc3SFabian Aggeler } else { 1232a9d85353SPeter Maydell *data = s->abpr[cpu]; 1233822e9cc3SFabian Aggeler } 1234a9d85353SPeter Maydell break; 1235a9d477c4SChristoffer Dall case 0xd0: case 0xd4: case 0xd8: case 0xdc: 123651fd06e0SPeter Maydell { 123751fd06e0SPeter Maydell int regno = (offset - 0xd0) / 4; 123851fd06e0SPeter Maydell 123951fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 124051fd06e0SPeter Maydell *data = 0; 124151fd06e0SPeter Maydell } else if (s->security_extn && !attrs.secure) { 124251fd06e0SPeter Maydell /* NS view of GICC_APR<n> is the top half of GIC_NSAPR<n> */ 124351fd06e0SPeter Maydell *data = gic_apr_ns_view(s, regno, cpu); 124451fd06e0SPeter Maydell } else { 124551fd06e0SPeter Maydell *data = s->apr[regno][cpu]; 124651fd06e0SPeter Maydell } 1247a9d85353SPeter Maydell break; 124851fd06e0SPeter Maydell } 124951fd06e0SPeter Maydell case 0xe0: case 0xe4: case 0xe8: case 0xec: 125051fd06e0SPeter Maydell { 125151fd06e0SPeter Maydell int regno = (offset - 0xe0) / 4; 125251fd06e0SPeter Maydell 125351fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2 || !gic_has_groups(s) || 125451fd06e0SPeter Maydell (s->security_extn && !attrs.secure)) { 125551fd06e0SPeter Maydell *data = 0; 125651fd06e0SPeter Maydell } else { 125751fd06e0SPeter Maydell *data = s->nsapr[regno][cpu]; 125851fd06e0SPeter Maydell } 125951fd06e0SPeter Maydell break; 126051fd06e0SPeter Maydell } 1261e69954b9Spbrook default: 12628c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 12638c8dc39fSPeter Maydell "gic_cpu_read: Bad offset %x\n", (int)offset); 1264*0cf09852SPeter Maydell *data = 0; 1265*0cf09852SPeter Maydell break; 1266e69954b9Spbrook } 1267a9d85353SPeter Maydell return MEMTX_OK; 1268e69954b9Spbrook } 1269e69954b9Spbrook 1270a9d85353SPeter Maydell static MemTxResult gic_cpu_write(GICState *s, int cpu, int offset, 1271a9d85353SPeter Maydell uint32_t value, MemTxAttrs attrs) 1272e69954b9Spbrook { 1273e69954b9Spbrook switch (offset) { 1274e69954b9Spbrook case 0x00: /* Control */ 127532951860SFabian Aggeler gic_set_cpu_control(s, cpu, value, attrs); 1276e69954b9Spbrook break; 1277e69954b9Spbrook case 0x04: /* Priority mask */ 127881508470SFabian Aggeler gic_set_priority_mask(s, cpu, value, attrs); 1279e69954b9Spbrook break; 1280e69954b9Spbrook case 0x08: /* Binary Point */ 1281822e9cc3SFabian Aggeler if (s->security_extn && !attrs.secure) { 1282822e9cc3SFabian Aggeler s->abpr[cpu] = MAX(value & 0x7, GIC_MIN_ABPR); 1283822e9cc3SFabian Aggeler } else { 1284822e9cc3SFabian Aggeler s->bpr[cpu] = MAX(value & 0x7, GIC_MIN_BPR); 1285822e9cc3SFabian Aggeler } 1286e69954b9Spbrook break; 1287e69954b9Spbrook case 0x10: /* End Of Interrupt */ 1288f9c6a7f1SFabian Aggeler gic_complete_irq(s, cpu, value & 0x3ff, attrs); 1289a9d85353SPeter Maydell return MEMTX_OK; 1290aa7d461aSChristoffer Dall case 0x1c: /* Aliased Binary Point */ 1291822e9cc3SFabian Aggeler if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 1292822e9cc3SFabian Aggeler /* unimplemented, or NS access: RAZ/WI */ 1293822e9cc3SFabian Aggeler return MEMTX_OK; 1294822e9cc3SFabian Aggeler } else { 1295822e9cc3SFabian Aggeler s->abpr[cpu] = MAX(value & 0x7, GIC_MIN_ABPR); 1296aa7d461aSChristoffer Dall } 1297aa7d461aSChristoffer Dall break; 1298a9d477c4SChristoffer Dall case 0xd0: case 0xd4: case 0xd8: case 0xdc: 129951fd06e0SPeter Maydell { 130051fd06e0SPeter Maydell int regno = (offset - 0xd0) / 4; 130151fd06e0SPeter Maydell 130251fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 130351fd06e0SPeter Maydell return MEMTX_OK; 130451fd06e0SPeter Maydell } 130551fd06e0SPeter Maydell if (s->security_extn && !attrs.secure) { 130651fd06e0SPeter Maydell /* NS view of GICC_APR<n> is the top half of GIC_NSAPR<n> */ 130751fd06e0SPeter Maydell gic_apr_write_ns_view(s, regno, cpu, value); 130851fd06e0SPeter Maydell } else { 130951fd06e0SPeter Maydell s->apr[regno][cpu] = value; 131051fd06e0SPeter Maydell } 1311a9d477c4SChristoffer Dall break; 131251fd06e0SPeter Maydell } 131351fd06e0SPeter Maydell case 0xe0: case 0xe4: case 0xe8: case 0xec: 131451fd06e0SPeter Maydell { 131551fd06e0SPeter Maydell int regno = (offset - 0xe0) / 4; 131651fd06e0SPeter Maydell 131751fd06e0SPeter Maydell if (regno >= GIC_NR_APRS || s->revision != 2) { 131851fd06e0SPeter Maydell return MEMTX_OK; 131951fd06e0SPeter Maydell } 132051fd06e0SPeter Maydell if (!gic_has_groups(s) || (s->security_extn && !attrs.secure)) { 132151fd06e0SPeter Maydell return MEMTX_OK; 132251fd06e0SPeter Maydell } 132351fd06e0SPeter Maydell s->nsapr[regno][cpu] = value; 132451fd06e0SPeter Maydell break; 132551fd06e0SPeter Maydell } 1326a55c910eSPeter Maydell case 0x1000: 1327a55c910eSPeter Maydell /* GICC_DIR */ 1328a55c910eSPeter Maydell gic_deactivate_irq(s, cpu, value & 0x3ff, attrs); 1329a55c910eSPeter Maydell break; 1330e69954b9Spbrook default: 13318c8dc39fSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 13328c8dc39fSPeter Maydell "gic_cpu_write: Bad offset %x\n", (int)offset); 1333*0cf09852SPeter Maydell return MEMTX_OK; 1334e69954b9Spbrook } 1335e69954b9Spbrook gic_update(s); 1336a9d85353SPeter Maydell return MEMTX_OK; 1337e69954b9Spbrook } 1338e2c56465SPeter Maydell 1339e2c56465SPeter Maydell /* Wrappers to read/write the GIC CPU interface for the current CPU */ 1340a9d85353SPeter Maydell static MemTxResult gic_thiscpu_read(void *opaque, hwaddr addr, uint64_t *data, 1341a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1342e2c56465SPeter Maydell { 1343fae15286SPeter Maydell GICState *s = (GICState *)opaque; 1344a9d85353SPeter Maydell return gic_cpu_read(s, gic_get_current_cpu(s), addr, data, attrs); 1345e2c56465SPeter Maydell } 1346e2c56465SPeter Maydell 1347a9d85353SPeter Maydell static MemTxResult gic_thiscpu_write(void *opaque, hwaddr addr, 1348a9d85353SPeter Maydell uint64_t value, unsigned size, 1349a9d85353SPeter Maydell MemTxAttrs attrs) 1350e2c56465SPeter Maydell { 1351fae15286SPeter Maydell GICState *s = (GICState *)opaque; 1352a9d85353SPeter Maydell return gic_cpu_write(s, gic_get_current_cpu(s), addr, value, attrs); 1353e2c56465SPeter Maydell } 1354e2c56465SPeter Maydell 1355e2c56465SPeter Maydell /* Wrappers to read/write the GIC CPU interface for a specific CPU. 1356fae15286SPeter Maydell * These just decode the opaque pointer into GICState* + cpu id. 1357e2c56465SPeter Maydell */ 1358a9d85353SPeter Maydell static MemTxResult gic_do_cpu_read(void *opaque, hwaddr addr, uint64_t *data, 1359a9d85353SPeter Maydell unsigned size, MemTxAttrs attrs) 1360e2c56465SPeter Maydell { 1361fae15286SPeter Maydell GICState **backref = (GICState **)opaque; 1362fae15286SPeter Maydell GICState *s = *backref; 1363e2c56465SPeter Maydell int id = (backref - s->backref); 1364a9d85353SPeter Maydell return gic_cpu_read(s, id, addr, data, attrs); 1365e2c56465SPeter Maydell } 1366e2c56465SPeter Maydell 1367a9d85353SPeter Maydell static MemTxResult gic_do_cpu_write(void *opaque, hwaddr addr, 1368a9d85353SPeter Maydell uint64_t value, unsigned size, 1369a9d85353SPeter Maydell MemTxAttrs attrs) 1370e2c56465SPeter Maydell { 1371fae15286SPeter Maydell GICState **backref = (GICState **)opaque; 1372fae15286SPeter Maydell GICState *s = *backref; 1373e2c56465SPeter Maydell int id = (backref - s->backref); 1374a9d85353SPeter Maydell return gic_cpu_write(s, id, addr, value, attrs); 1375e2c56465SPeter Maydell } 1376e2c56465SPeter Maydell 13777926c210SPavel Fedin static const MemoryRegionOps gic_ops[2] = { 13787926c210SPavel Fedin { 13797926c210SPavel Fedin .read_with_attrs = gic_dist_read, 13807926c210SPavel Fedin .write_with_attrs = gic_dist_write, 13817926c210SPavel Fedin .endianness = DEVICE_NATIVE_ENDIAN, 13827926c210SPavel Fedin }, 13837926c210SPavel Fedin { 1384a9d85353SPeter Maydell .read_with_attrs = gic_thiscpu_read, 1385a9d85353SPeter Maydell .write_with_attrs = gic_thiscpu_write, 1386e2c56465SPeter Maydell .endianness = DEVICE_NATIVE_ENDIAN, 13877926c210SPavel Fedin } 1388e2c56465SPeter Maydell }; 1389e2c56465SPeter Maydell 1390e2c56465SPeter Maydell static const MemoryRegionOps gic_cpu_ops = { 1391a9d85353SPeter Maydell .read_with_attrs = gic_do_cpu_read, 1392a9d85353SPeter Maydell .write_with_attrs = gic_do_cpu_write, 1393e2c56465SPeter Maydell .endianness = DEVICE_NATIVE_ENDIAN, 1394e2c56465SPeter Maydell }; 1395e69954b9Spbrook 13967926c210SPavel Fedin /* This function is used by nvic model */ 13977b95a508SKONRAD Frederic void gic_init_irqs_and_distributor(GICState *s) 1398e69954b9Spbrook { 13997926c210SPavel Fedin gic_init_irqs_and_mmio(s, gic_set_irq, gic_ops); 14002b518c56SPeter Maydell } 14012b518c56SPeter Maydell 140253111180SPeter Maydell static void arm_gic_realize(DeviceState *dev, Error **errp) 14032b518c56SPeter Maydell { 140453111180SPeter Maydell /* Device instance realize function for the GIC sysbus device */ 14052b518c56SPeter Maydell int i; 140653111180SPeter Maydell GICState *s = ARM_GIC(dev); 140753111180SPeter Maydell SysBusDevice *sbd = SYS_BUS_DEVICE(dev); 14081e8cae4dSPeter Maydell ARMGICClass *agc = ARM_GIC_GET_CLASS(s); 14090175ba10SMarkus Armbruster Error *local_err = NULL; 14101e8cae4dSPeter Maydell 14110175ba10SMarkus Armbruster agc->parent_realize(dev, &local_err); 14120175ba10SMarkus Armbruster if (local_err) { 14130175ba10SMarkus Armbruster error_propagate(errp, local_err); 141453111180SPeter Maydell return; 141553111180SPeter Maydell } 14161e8cae4dSPeter Maydell 14175d721b78SAlexander Graf if (kvm_enabled() && !kvm_arm_supports_user_irq()) { 14185d721b78SAlexander Graf error_setg(errp, "KVM with user space irqchip only works when the " 14195d721b78SAlexander Graf "host kernel supports KVM_CAP_ARM_USER_IRQ"); 14205d721b78SAlexander Graf return; 14215d721b78SAlexander Graf } 14225d721b78SAlexander Graf 14237926c210SPavel Fedin /* This creates distributor and main CPU interface (s->cpuiomem[0]) */ 14247926c210SPavel Fedin gic_init_irqs_and_mmio(s, gic_set_irq, gic_ops); 14252b518c56SPeter Maydell 14267926c210SPavel Fedin /* Extra core-specific regions for the CPU interfaces. This is 14277926c210SPavel Fedin * necessary for "franken-GIC" implementations, for example on 14287926c210SPavel Fedin * Exynos 4. 1429e2c56465SPeter Maydell * NB that the memory region size of 0x100 applies for the 11MPCore 1430e2c56465SPeter Maydell * and also cores following the GIC v1 spec (ie A9). 1431e2c56465SPeter Maydell * GIC v2 defines a larger memory region (0x1000) so this will need 1432e2c56465SPeter Maydell * to be extended when we implement A15. 1433e2c56465SPeter Maydell */ 1434b95690c9SWei Huang for (i = 0; i < s->num_cpu; i++) { 1435e2c56465SPeter Maydell s->backref[i] = s; 14361437c94bSPaolo Bonzini memory_region_init_io(&s->cpuiomem[i+1], OBJECT(s), &gic_cpu_ops, 14371437c94bSPaolo Bonzini &s->backref[i], "gic_cpu", 0x100); 14387926c210SPavel Fedin sysbus_init_mmio(sbd, &s->cpuiomem[i+1]); 1439496dbcd1SPeter Maydell } 1440496dbcd1SPeter Maydell } 1441496dbcd1SPeter Maydell 1442496dbcd1SPeter Maydell static void arm_gic_class_init(ObjectClass *klass, void *data) 1443496dbcd1SPeter Maydell { 1444496dbcd1SPeter Maydell DeviceClass *dc = DEVICE_CLASS(klass); 14451e8cae4dSPeter Maydell ARMGICClass *agc = ARM_GIC_CLASS(klass); 144653111180SPeter Maydell 144753111180SPeter Maydell agc->parent_realize = dc->realize; 144853111180SPeter Maydell dc->realize = arm_gic_realize; 1449496dbcd1SPeter Maydell } 1450496dbcd1SPeter Maydell 14518c43a6f0SAndreas Färber static const TypeInfo arm_gic_info = { 14521e8cae4dSPeter Maydell .name = TYPE_ARM_GIC, 14531e8cae4dSPeter Maydell .parent = TYPE_ARM_GIC_COMMON, 1454fae15286SPeter Maydell .instance_size = sizeof(GICState), 1455496dbcd1SPeter Maydell .class_init = arm_gic_class_init, 1456998a74bcSPeter Maydell .class_size = sizeof(ARMGICClass), 1457496dbcd1SPeter Maydell }; 1458496dbcd1SPeter Maydell 1459496dbcd1SPeter Maydell static void arm_gic_register_types(void) 1460496dbcd1SPeter Maydell { 1461496dbcd1SPeter Maydell type_register_static(&arm_gic_info); 1462496dbcd1SPeter Maydell } 1463496dbcd1SPeter Maydell 1464496dbcd1SPeter Maydell type_init(arm_gic_register_types) 1465